HALF ECHO LEARN / REFERENCE COLLECTION

v262.2

src/shared/ptyfwd.c

48,331 bytesGit mode 100644Download original fileLGPL-2.1-or-later

Git blob: d2d32008e92a8e9c0e27cc32cde7fdc9dd2e090b

Lines 1–1000 of 1,330

/* SPDX-License-Identifier: LGPL-2.1-or-later */
 
#include <fcntl.h>
#include <signal.h>
#include <string.h>
#include <sys/ioctl.h>
#include <termios.h>
#include <unistd.h>
 
#include "sd-event.h"
 
#include "alloc-util.h"
#include "ansi-color.h"
#include "env-util.h"
#include "errno-util.h"
#include "extract-word.h"
#include "fd-util.h"
#include "glyph-util.h"
#include "hostname-setup.h"
#include "io-util.h"
#include "log.h"
#include "pretty-print.h"
#include "ptyfwd.h"
#include "stat-util.h"
#include "string-util.h"
#include "strv.h"
#include "terminal-util.h"
#include "time-util.h"
 
typedef enum AnsiColorState  {
        ANSI_COLOR_STATE_TEXT,
        ANSI_COLOR_STATE_ESC,
        ANSI_COLOR_STATE_CSI_SEQUENCE,
        ANSI_COLOR_STATE_OSC_SEQUENCE,
        ANSI_COLOR_STATE_OSC_SEQUENCE_TERMINATING,
        _ANSI_COLOR_STATE_MAX,
        _ANSI_COLOR_STATE_INVALID = -EINVAL,
} AnsiColorState;
 
#define ANSI_SEQUENCE_LENGTH_MAX 192U
#define ANSI_SEQUENCE_WINDOW_TITLE_MAX 128U
 
assert_cc(ANSI_SEQUENCE_LENGTH_MAX > ANSI_SEQUENCE_WINDOW_TITLE_MAX);
 
/* We don't list SIGHUP here because that's what you get when your tty has a hangup, and if we do we'll close
 * the pty too which already generates a hangup, and thus a SIGHUP, which means we'd generate SIGHUP twice,
 * once by us, and once by the kernel. */
const int pty_forward_signals[N_PTY_FORWARD_SIGNALS] = { SIGTERM, SIGINT, SIGQUIT, SIGTSTP, SIGCONT, SIGUSR1, SIGUSR2 };
 
struct PTYForward {
        sd_event *event;
 
        int input_fd;
        int output_fd;
        int master;
 
        PTYForwardFlags flags;
 
        sd_event_source *stdin_event_source;
        sd_event_source *stdout_event_source;
        sd_event_source *master_event_source;
        sd_event_source *sigwinch_event_source;
        sd_event_source *exit_event_source;
        sd_event_source *defer_event_source;
 
        struct termios saved_stdin_attr;
        struct termios saved_stdout_attr;
 
        bool close_input_fd:1;
        bool close_output_fd:1;
 
        bool saved_stdin:1;
        bool saved_stdout:1;
 
        bool stdin_readable:1;
        bool stdin_hangup:1;
        bool stdout_writable:1;
        bool stdout_hangup:1;
        bool master_readable:1;
        bool master_writable:1;
        bool master_hangup:1;
 
        bool read_from_master:1;
 
        bool done:1;
        bool drain:1;
 
        bool last_char_set:1;
        char last_char;
        char last_char_safe;
 
        char in_buffer[LINE_MAX], *out_buffer;
        size_t out_buffer_size;
        size_t in_buffer_full, out_buffer_full;
        size_t out_buffer_write_len; /* The length of the output in the buffer except for the trailing
                                      * truncated OSC, CSI, or some (but not all) ESC sequence. */
 
        usec_t escape_timestamp;
        unsigned escape_counter;
 
        PTYForwardHangupHandler hangup_handler;
        void *hangup_userdata;
        PTYForwardHotkeyHandler hotkey_handler;
        void *hotkey_userdata;
 
        char *background_color;
        AnsiColorState ansi_color_state;
        char *csi_sequence;
        char *osc_sequence;
 
        char *title;           /* Window title to show by default */
        char *title_prefix;    /* If terminal client overrides window title, prefix this string */
};
 
#define ESCAPE_USEC (1*USEC_PER_SEC)
 
static void pty_forward_disconnect(PTYForward *f) {
 
        if (!f)
                return;
 
        f->stdin_event_source = sd_event_source_unref(f->stdin_event_source);
        f->stdout_event_source = sd_event_source_unref(f->stdout_event_source);
        f->master_event_source = sd_event_source_unref(f->master_event_source);
        f->sigwinch_event_source = sd_event_source_unref(f->sigwinch_event_source);
        f->exit_event_source = sd_event_source_unref(f->exit_event_source);
        f->defer_event_source = sd_event_source_unref(f->defer_event_source);
        f->event = sd_event_unref(f->event);
 
        if (f->output_fd >= 0) {
                if (f->saved_stdout)
                        (void) tcsetattr(f->output_fd, TCSANOW, &f->saved_stdout_attr);
 
                if (f->last_char_set && f->last_char != '\n') {
                        const char *s;
 
                        if (isatty_safe(f->output_fd) && f->last_char != '\r')
                                s = "\r\n";
                        else
                                s = "\n";
                        (void) loop_write(f->output_fd, s, SIZE_MAX);
 
                        f->last_char_set = true;
                        f->last_char = '\n';
                }
 
                if (colors_enabled()) {
                        if (f->title)
                                (void) loop_write(f->output_fd, ANSI_WINDOW_TITLE_POP, SIZE_MAX);
 
                        terminal_reset_ansi_seq(f->output_fd);
                }
 
                /* STDIN/STDOUT should not be non-blocking normally, so let's reset it */
                (void) fd_nonblock(f->output_fd, false);
 
                if (f->close_output_fd)
                        f->output_fd = safe_close(f->output_fd);
        }
 
        if (f->input_fd >= 0) {
                if (f->saved_stdin)
                        (void) tcsetattr(f->input_fd, TCSANOW, &f->saved_stdin_attr);
 
                (void) fd_nonblock(f->input_fd, false);
                if (f->close_input_fd)
                        f->input_fd = safe_close(f->input_fd);
        }
 
        f->saved_stdout = f->saved_stdin = false;
 
        f->out_buffer = mfree(f->out_buffer);
        f->out_buffer_size = 0;
        f->out_buffer_full = 0;
        f->out_buffer_write_len = 0;
        f->in_buffer_full = 0;
 
        f->csi_sequence = mfree(f->csi_sequence);
        f->osc_sequence = mfree(f->osc_sequence);
        f->ansi_color_state = _ANSI_COLOR_STATE_INVALID;
}
 
static int pty_forward_done(PTYForward *f, int rcode) {
        _cleanup_(sd_event_unrefp) sd_event *e = NULL;
        assert(f);
 
        if (f->done)
                return 0;
 
        e = sd_event_ref(f->event);
 
        f->done = true;
        pty_forward_disconnect(f);
 
        if (f->hangup_handler)
                return f->hangup_handler(f, rcode, f->hangup_userdata);
 
        return sd_event_exit(e, rcode < 0 ? EXIT_FAILURE : rcode);
}
 
typedef enum RequestOperation {
        REQUEST_NOP,
        REQUEST_EXIT,
        REQUEST_HOTKEY_BASE,
        REQUEST_HOTKEY_A = REQUEST_HOTKEY_BASE + 'a',
        REQUEST_HOTKEY_Z = REQUEST_HOTKEY_BASE + 'z',
        _REQUEST_OPERATION_MAX,
        _REQUEST_OPERATION_INVALID = -EINVAL,
} RequestOperation;
 
static RequestOperation look_for_escape(PTYForward *f, const char *buffer, size_t n) {
        assert(f);
        assert(buffer);
        assert(n > 0);
 
        for (const char *p = buffer; p < buffer + n; p++) {
 
                switch (*p) {
 
                case 0x1D: { /* Check for ^] */
                        usec_t nw = now(CLOCK_MONOTONIC);
 
                        if (f->escape_counter == 0 || nw > usec_add(f->escape_timestamp, ESCAPE_USEC)) {
                                f->escape_timestamp = nw;
                                f->escape_counter = 1;
                        } else {
                                f->escape_counter++;
 
                                if (f->escape_counter >= 3)
                                        return REQUEST_EXIT;
                        }
 
                        break;
                }
 
                case 'a'...'z':
                        if (f->escape_counter == 2 &&
                            now(CLOCK_MONOTONIC) <= usec_add(f->escape_timestamp, ESCAPE_USEC)) {
                                f->escape_timestamp = 0;
                                f->escape_counter = 0;
                                return REQUEST_HOTKEY_BASE + *p;
                        }
 
                        _fallthrough_;
 
                default:
                        f->escape_timestamp = 0;
                        f->escape_counter = 0;
                }
        }
 
        return REQUEST_NOP;
}
 
static bool drained(PTYForward *f) {
        int q = 0;
 
        assert(f);
 
        if (f->done)
                return true;
 
        if (f->out_buffer_full > 0)
                return false;
 
        if (f->master_readable)
                return false;
 
        if (ioctl(f->master, TIOCINQ, &q) < 0)
                log_debug_errno(errno, "TIOCINQ failed on master: %m");
        else if (q > 0)
                return false;
 
        if (ioctl(f->master, TIOCOUTQ, &q) < 0)
                log_debug_errno(errno, "TIOCOUTQ failed on master: %m");
        else if (q > 0)
                return false;
 
        return true;
}
 
static char* background_color_sequence(PTYForward *f) {
        assert(f);
        assert(f->background_color);
 
        return strjoin("\x1B[", f->background_color, "m");
}
 
static int insert_string(PTYForward *f, size_t offset, const char *s) {
        assert(f);
        assert(offset <= f->out_buffer_full);
        assert(s);
 
        size_t l = strlen(s);
        assert(l <= INT_MAX); /* Make sure we can still return this */
 
        void *p = realloc(f->out_buffer, MAX(f->out_buffer_full + l, (size_t) LINE_MAX));
        if (!p)
                return -ENOMEM;
 
        f->out_buffer = p;
        f->out_buffer_size = MALLOC_SIZEOF_SAFE(f->out_buffer);
 
        memmove(f->out_buffer + offset + l, f->out_buffer + offset, f->out_buffer_full - offset);
        memcpy(f->out_buffer + offset, s, l);
        f->out_buffer_full += l;
 
        return (int) l;
}
 
static int insert_background_color(PTYForward *f, size_t offset) {
        _cleanup_free_ char *s = NULL;
 
        assert(f);
 
        if (FLAGS_SET(f->flags, PTY_FORWARD_DUMB_TERMINAL))
                return 0;
 
        if (!f->background_color)
                return 0;
 
        if (!shall_tint_background())
                return 0;
 
        s = background_color_sequence(f);
        if (!s)
                return -ENOMEM;
 
        return insert_string(f, offset, s);
}
 
static int is_csi_background_reset_sequence(const char *seq) {
        enum {
                COLOR_TOKEN_NO,
                COLOR_TOKEN_START,
                COLOR_TOKEN_8BIT,
                COLOR_TOKEN_24BIT_R,
                COLOR_TOKEN_24BIT_G,
                COLOR_TOKEN_24BIT_B,
        } token_state = COLOR_TOKEN_NO;
 
        bool b = false;
        int r;
 
        assert(seq);
 
        /* This parses CSI "m" sequences, and determines if they reset the background color. If so returns
         * 1. This can then be used to insert another sequence that sets the color to the desired
         * replacement. */
 
        for (;;) {
                _cleanup_free_ char *token = NULL;
 
                r = extract_first_word(&seq, &token, ";", EXTRACT_RELAX|EXTRACT_DONT_COALESCE_SEPARATORS|EXTRACT_RETAIN_ESCAPE);
                if (r < 0)
                        return r;
                if (r == 0)
                        break;
 
                switch (token_state) {
 
                case COLOR_TOKEN_NO:
 
                        if (STR_IN_SET(token, "", "0", "00", "49"))
                                b = true; /* These tokens set the background back to normal */
                        else if (STR_IN_SET(token, "40", "41", "42", "43", "44", "45", "46", "47", "48"))
                                b = false; /* And these tokens set them to something other than normal */
 
                        if (STR_IN_SET(token, "38", "48", "58"))
                                token_state = COLOR_TOKEN_START; /* These tokens mean an 8bit or 24bit color will follow */
                        break;
 
                case COLOR_TOKEN_START:
 
                        if (STR_IN_SET(token, "5", "05"))
                                token_state = COLOR_TOKEN_8BIT; /* 8bit color */
                        else if (STR_IN_SET(token, "2", "02"))
                                token_state = COLOR_TOKEN_24BIT_R;  /* 24bit color */
                        else
                                token_state = COLOR_TOKEN_NO; /* something weird? */
                        break;
 
                case COLOR_TOKEN_24BIT_R:
                        token_state = COLOR_TOKEN_24BIT_G;
                        break;
 
                case COLOR_TOKEN_24BIT_G:
                        token_state = COLOR_TOKEN_24BIT_B;
                        break;
 
                case COLOR_TOKEN_8BIT:
                case COLOR_TOKEN_24BIT_B:
                        token_state = COLOR_TOKEN_NO;
                        break;
                }
        }
 
        return b;
}
 
static int insert_background_fix(PTYForward *f, size_t offset) {
        assert(f);
 
        if (FLAGS_SET(f->flags, PTY_FORWARD_DUMB_TERMINAL))
                return 0;
 
        if (!f->background_color)
                return 0;
 
        if (!shall_tint_background())
                return 0;
 
        if (!is_csi_background_reset_sequence(strempty(f->csi_sequence)))
                return 0;
 
        _cleanup_free_ char *s = NULL;
        s = strjoin(";", f->background_color);
        if (!s)
                return -ENOMEM;
 
        return insert_string(f, offset, s);
}
 
bool shall_set_terminal_title(void) {
        static int cache = -1;
 
        if (cache >= 0)
                return cache;
 
        cache = getenv_bool("SYSTEMD_ADJUST_TERMINAL_TITLE");
        if (cache == -ENXIO)
                return (cache = true);
        if (cache < 0)
                log_debug_errno(cache, "Failed to parse $SYSTEMD_ADJUST_TERMINAL_TITLE, leaving terminal title setting enabled: %m");
 
        return cache != 0;
}
 
static int insert_window_title_fix(PTYForward *f, size_t offset) {
        assert(f);
 
        if (FLAGS_SET(f->flags, PTY_FORWARD_DUMB_TERMINAL))
                return 0;
 
        if (!f->title_prefix)
                return 0;
 
        if (!f->osc_sequence)
                return 0;
 
        const char *t = startswith(f->osc_sequence, "0;"); /* Set window title OSC sequence */
        if (!t)
                return 0;
 
        _cleanup_free_ char *joined = strjoin(ANSI_OSC "0;", f->title_prefix, t, ANSI_ST);
        if (!joined)
                return -ENOMEM;
 
        return insert_string(f, offset, joined);
}
 
static int pty_forward_ansi_process(PTYForward *f, size_t offset) {
        int r;
 
        assert(f);
        assert(offset <= f->out_buffer_full);
 
        for (size_t i = offset; i < f->out_buffer_full; i++) {
                char c = f->out_buffer[i];
 
                switch (f->ansi_color_state) {
 
                case ANSI_COLOR_STATE_TEXT:
                        if (IN_SET(c, '\n', '\r')) {
                                /* Immediately after a newline (ASCII 10) or carriage return (ASCII 13) insert an
                                 * ANSI sequence set the background color back. */
                                r = insert_background_color(f, i+1);
                                if (r < 0)
                                        return r;
                                i += r;
                                f->last_char_safe = c;
                        } else if (c == 0x1B) /* ESC */
                                f->ansi_color_state = ANSI_COLOR_STATE_ESC;
                        else if (!char_is_cc(c))
                                f->last_char_safe = c;
                        break;
 
                case ANSI_COLOR_STATE_ESC:
 
                        if (c == '[')
                                f->ansi_color_state = ANSI_COLOR_STATE_CSI_SEQUENCE;
                        else if (c == ']')
                                f->ansi_color_state = ANSI_COLOR_STATE_OSC_SEQUENCE;
                        else if (c == 'c') {
                                /* "Full reset" aka "Reset to initial state" */
                                r = insert_background_color(f, i+1);
                                if (r < 0)
                                        return r;
 
                                i += r;
                                f->ansi_color_state = ANSI_COLOR_STATE_TEXT;
                        } else
                                f->ansi_color_state = ANSI_COLOR_STATE_TEXT;
                        break;
 
                case ANSI_COLOR_STATE_CSI_SEQUENCE:
 
                        if (c >= 0x20 && c <= 0x3F) {
                                /* If this is a "parameter" or "intermediary" byte (i.e. ranges 0x20…0x2F and
                                 * 0x30…0x3F) then we are still in the CSI sequence */
 
                                if (strlen_ptr(f->csi_sequence) >= ANSI_SEQUENCE_LENGTH_MAX) {
                                        /* Safety check: lets not accept unbounded CSI sequences */
 
                                        f->csi_sequence = mfree(f->csi_sequence);
                                        f->ansi_color_state = ANSI_COLOR_STATE_TEXT;
                                } else if (!strextend(&f->csi_sequence, CHAR_TO_STR(c)))
                                        return -ENOMEM;
                        } else {
                                /* Otherwise, the CSI sequence is over */
 
                                if (c == 'p' && streq_ptr(f->csi_sequence, "!")) {
 
                                        /* CSI ! p → "Soft Reset", let's immediately fix our bg color again */
                                        r = insert_background_color(f, i+1);
                                        if (r < 0)
                                                return r;
 
                                        i += r;
                                } else if (c == 'm') {
                                        /* This is an "SGR" (Select Graphic Rendition) sequence. Patch in our background color. */
                                        r = insert_background_fix(f, i);
                                        if (r < 0)
                                                return r;
 
                                        i += r;
                                }
 
                                f->csi_sequence = mfree(f->csi_sequence);
                                f->ansi_color_state = ANSI_COLOR_STATE_TEXT;
                        }
                        break;
 
                case ANSI_COLOR_STATE_OSC_SEQUENCE:
 
                        if ((uint8_t) c >= ' ') {
                                if (strlen_ptr(f->osc_sequence) >= ANSI_SEQUENCE_LENGTH_MAX) {
                                        /* Safety check: lets not accept unbounded OSC sequences */
                                        f->osc_sequence = mfree(f->osc_sequence);
                                        f->ansi_color_state = ANSI_COLOR_STATE_TEXT;
                                } else if (!strextend(&f->osc_sequence, CHAR_TO_STR(c)))
                                        return -ENOMEM;
                        } else if (c == '\x07') {
                                /* Otherwise, the OSC sequence is over
                                 *
                                 * There are three documented ways to end an OSC sequence:
                                 *     1. BEL aka ^G aka \x07
                                 *     2. \x9c
                                 *     3. \x1b\x5c
                                 * Note that we do not support \x9c here, because that's also a valid UTF8
                                 * codepoint, and that would create ambiguity. Various terminal emulators
                                 * similar do not support it. */
 
                                r = insert_window_title_fix(f, i+1);
                                if (r < 0)
                                        return r;
                                i += r;
 
                                f->osc_sequence = mfree(f->osc_sequence);
                                f->ansi_color_state = ANSI_COLOR_STATE_TEXT;
                        } else if (c == '\x1b')
                                /* See the comment above. */
                                f->ansi_color_state = ANSI_COLOR_STATE_OSC_SEQUENCE_TERMINATING;
                        else {
                                /* Unexpected or unsupported OSC sequence. */
                                f->osc_sequence = mfree(f->osc_sequence);
                                f->ansi_color_state = ANSI_COLOR_STATE_TEXT;
                        }
                        break;
 
                case ANSI_COLOR_STATE_OSC_SEQUENCE_TERMINATING:
                        if (c == '\x5c') {
                                r = insert_window_title_fix(f, i+1);
                                if (r < 0)
                                        return r;
                                i += r;
                        }
 
                        f->osc_sequence = mfree(f->osc_sequence);
                        f->ansi_color_state = ANSI_COLOR_STATE_TEXT;
                        break;
 
                default:
                        assert_not_reached();
                }
 
                if (f->ansi_color_state == ANSI_COLOR_STATE_TEXT)
                        f->out_buffer_write_len = i + 1;
        }
 
        return 0;
}
 
static int do_shovel(PTYForward *f) {
        ssize_t k;
        int r;
 
        assert(f);
 
        if (f->out_buffer_size == 0 && !FLAGS_SET(f->flags, PTY_FORWARD_DUMB_TERMINAL)) {
                /* If the output hasn't been allocated yet, we are at the beginning of the first
                 * shovelling. Hence, possibly send some initial ANSI sequences. But do so only if we are
                 * talking to an actual TTY. */
 
                if (f->background_color && shall_tint_background()) {
                        /* Erase the first line when we start */
                        f->out_buffer = background_color_sequence(f);
                        if (!f->out_buffer)
                                return log_oom();
 
                        if (!strextend(&f->out_buffer, ANSI_ERASE_TO_END_OF_LINE))
                                return log_oom();
                }
 
                if (f->title) {
                        if (!strextend(&f->out_buffer,
                                       ANSI_WINDOW_TITLE_PUSH
                                       ANSI_OSC "2;", f->title, ANSI_ST))
                                return log_oom();
                }
 
                if (f->out_buffer) {
                        f->out_buffer_full = f->out_buffer_write_len = strlen(f->out_buffer);
                        f->out_buffer_size = MALLOC_SIZEOF_SAFE(f->out_buffer);
                }
        }
 
        if (f->out_buffer_size < LINE_MAX) {
                /* Make sure we always have room for at least one "line" */
                void *p = realloc(f->out_buffer, LINE_MAX);
                if (!p)
                        return log_oom();
 
                f->out_buffer = p;
                f->out_buffer_size = MALLOC_SIZEOF_SAFE(p);
        }
 
        for (;;) {
                bool did_something = false;
 
                if (f->stdin_readable && f->in_buffer_full < LINE_MAX) {
 
                        k = read(f->input_fd, f->in_buffer + f->in_buffer_full, LINE_MAX - f->in_buffer_full);
                        if (k < 0) {
 
                                if (errno == EAGAIN)
                                        f->stdin_readable = false;
                                else if (errno == EIO || ERRNO_IS_DISCONNECT(errno)) {
                                        f->stdin_readable = false;
                                        f->stdin_hangup = true;
 
                                        f->stdin_event_source = sd_event_source_unref(f->stdin_event_source);
                                } else
                                        return log_error_errno(errno, "Failed to read from pty input fd: %m");
                        } else if (k == 0) {
                                /* EOF on stdin */
                                f->stdin_readable = false;
                                f->stdin_hangup = true;
 
                                f->stdin_event_source = sd_event_source_unref(f->stdin_event_source);
                        } else {
                                if (!FLAGS_SET(f->flags, PTY_FORWARD_TRANSPARENT)) {
                                        /* Check if ^] has been pressed three times within one second. If we get this we quit
                                         * immediately. */
                                        RequestOperation q = look_for_escape(f, f->in_buffer + f->in_buffer_full, k);
                                        f->in_buffer_full += (size_t) k;
                                        if (q < 0)
                                                return q;
                                        if (q == REQUEST_EXIT)
                                                return -ECANCELED;
                                        if (q >= REQUEST_HOTKEY_A && q <= REQUEST_HOTKEY_Z && f->hotkey_handler) {
                                                r = f->hotkey_handler(f, q - REQUEST_HOTKEY_BASE, f->hotkey_userdata);
                                                if (r < 0)
                                                        return r;
                                        }
                                } else
                                        f->in_buffer_full += (size_t) k;
                        }
 
                        did_something = true;
                }
 
                if (f->master_writable && f->in_buffer_full > 0) {
 
                        k = write(f->master, f->in_buffer, f->in_buffer_full);
                        if (k < 0) {
 
                                if (IN_SET(errno, EAGAIN, EIO))
                                        f->master_writable = false;
                                else if (IN_SET(errno, EPIPE, ECONNRESET)) {
                                        f->master_writable = f->master_readable = false;
                                        f->master_hangup = true;
 
                                        f->master_event_source = sd_event_source_unref(f->master_event_source);
                                } else
                                        return log_error_errno(errno, "write(): %m");
                        } else {
                                assert(f->in_buffer_full >= (size_t) k);
                                memmove(f->in_buffer, f->in_buffer + k, f->in_buffer_full - k);
                                f->in_buffer_full -= k;
                        }
 
                        did_something = true;
                }
 
                if (f->master_readable && f->out_buffer_full < MIN(f->out_buffer_size, (size_t) LINE_MAX)) {
 
                        k = read(f->master, f->out_buffer + f->out_buffer_full, f->out_buffer_size - f->out_buffer_full);
                        if (k < 0) {
 
                                /* Note that EIO on the master device might be caused by vhangup() or
                                 * temporary closing of everything on the other side, we treat it like EAGAIN
                                 * here and try again, unless vhangup() is honored. */
 
                                if (errno == EAGAIN || (errno == EIO && !pty_forward_vhangup_honored(f)))
                                        f->master_readable = false;
                                else if (IN_SET(errno, EPIPE, ECONNRESET, EIO)) {
                                        f->master_readable = f->master_writable = false;
                                        f->master_hangup = true;
 
                                        f->master_event_source = sd_event_source_unref(f->master_event_source);
                                } else
                                        return log_error_errno(errno, "Failed to read from pty master fd: %m");
                        } else {
                                f->read_from_master = true;
                                size_t scan_index = f->out_buffer_full;
                                f->out_buffer_full += (size_t) k;
 
                                r = pty_forward_ansi_process(f, scan_index);
                                if (r < 0)
                                        return log_error_errno(r, "Failed to scan for ANSI sequences: %m");
                        }
 
                        did_something = true;
                }
 
                if (f->stdout_writable && f->out_buffer_write_len > 0) {
                        assert(f->out_buffer_write_len <= f->out_buffer_full);
 
                        k = write(f->output_fd, f->out_buffer, f->out_buffer_write_len);
                        if (k < 0) {
 
                                if (errno == EAGAIN)
                                        f->stdout_writable = false;
                                else if (errno == EIO || ERRNO_IS_DISCONNECT(errno)) {
                                        f->stdout_writable = false;
                                        f->stdout_hangup = true;
                                        f->stdout_event_source = sd_event_source_unref(f->stdout_event_source);
                                } else
                                        return log_error_errno(errno, "Failed to write to pty output fd: %m");
 
                        } else {
 
                                if (k > 0 && f->last_char_safe != '\0') {
                                        if ((size_t) k == f->out_buffer_write_len)
                                                /* If we wrote all, then save the last safe character. */
                                                f->last_char = f->last_char_safe;
                                        else
                                                /* If we wrote partially, then tentatively save the last written character.
                                                 * Hopefully, we will write more in the next loop. */
                                                f->last_char = f->out_buffer[k-1];
 
                                        f->last_char_set = true;
                                }
 
                                assert(f->out_buffer_write_len >= (size_t) k);
                                memmove(f->out_buffer, f->out_buffer + k, f->out_buffer_full - k);
                                f->out_buffer_full -= k;
                                f->out_buffer_write_len -= k;
                        }
 
                        did_something = true;
                }
 
                if (!did_something)
                        break;
        }
 
        return 0;
}
 
static int shovel(PTYForward *f) {
        int r;
 
        assert(f);
 
        r = do_shovel(f);
        if (r < 0)
                return pty_forward_done(f, r);
 
        if (f->stdin_hangup || f->stdout_hangup || f->master_hangup) {
                /* Exit the loop if any side hung up and if there's
                 * nothing more to write or nothing we could write. */
 
                if ((f->out_buffer_write_len <= 0 || f->stdout_hangup) &&
                    (f->in_buffer_full <= 0 || f->master_hangup))
                        return pty_forward_done(f, 0);
        }
 
        /* If we were asked to drain, and there's nothing more to handle from the master, then call the callback
         * too. */
        if (f->drain && drained(f))
                return pty_forward_done(f, 0);
 
        return 0;
}
 
static int shovel_force(PTYForward *f) {
        assert(f);
 
        if (!f->master_hangup)
                f->master_writable = f->master_readable = true;
        if (!f->stdin_hangup && f->input_fd >= 0)
                f->stdin_readable = true;
        if (!f->stdout_hangup)
                f->stdout_writable = true;
 
        return shovel(f);
}
 
static int on_master_event(sd_event_source *e, int fd, uint32_t revents, void *userdata) {
        PTYForward *f = ASSERT_PTR(userdata);
 
        assert(e);
        assert(e == f->master_event_source);
        assert(fd >= 0);
        assert(fd == f->master);
 
        if (revents & (EPOLLIN|EPOLLHUP))
                f->master_readable = true;
 
        if (revents & (EPOLLOUT|EPOLLHUP))
                f->master_writable = true;
 
        return shovel(f);
}
 
static int on_stdin_event(sd_event_source *e, int fd, uint32_t revents, void *userdata) {
        PTYForward *f = ASSERT_PTR(userdata);
 
        assert(e);
        assert(e == f->stdin_event_source);
        assert(fd >= 0);
        assert(fd == f->input_fd);
 
        if (revents & (EPOLLIN|EPOLLHUP))
                f->stdin_readable = true;
 
        return shovel(f);
}
 
static int on_stdout_event(sd_event_source *e, int fd, uint32_t revents, void *userdata) {
        PTYForward *f = ASSERT_PTR(userdata);
 
        assert(e);
        assert(e == f->stdout_event_source);
        assert(fd >= 0);
        assert(fd == f->output_fd);
 
        if (revents & (EPOLLOUT|EPOLLHUP))
                f->stdout_writable = true;
 
        return shovel(f);
}
 
static int on_sigwinch_event(sd_event_source *e, const struct signalfd_siginfo *si, void *userdata) {
        PTYForward *f = ASSERT_PTR(userdata);
        struct winsize ws;
 
        assert(e);
        assert(e == f->sigwinch_event_source);
 
        /* The window size changed, let's forward that. */
        if (ioctl(f->output_fd, TIOCGWINSZ, &ws) >= 0)
                (void) ioctl(f->master, TIOCSWINSZ, &ws);
 
        return 0;
}
 
static int on_exit_event(sd_event_source *e, void *userdata) {
        PTYForward *f = ASSERT_PTR(userdata);
 
        assert(e);
        assert(e == f->exit_event_source);
 
        /* The event loop is exiting while the forwarder is still active. Force a final synchronous drain of
         * whatever is still buffered. shovel() may complete the drain and call pty_forward_done(), which
         * can free f via the hangup handler, so we must not touch f afterwards, only propagate the return
         * value, exactly like on_master_event() does. */
        f->drain = true;
        return shovel_force(f);
}
 
static int on_defer_event(sd_event_source *s, void *userdata) {
        PTYForward *f = ASSERT_PTR(userdata);
        return shovel_force(f);
}
 
static int pty_forward_add_defer(PTYForward *f) {
        assert(f);
 
        if (f->done)
                return 0;
 
        if (f->defer_event_source)
                return sd_event_source_set_enabled(f->defer_event_source, SD_EVENT_ONESHOT);
 
        return sd_event_add_defer(f->event, &f->defer_event_source, on_defer_event, f);
}
 
int pty_forward_new(
                sd_event *event,
                int master,
                PTYForwardFlags flags,
                PTYForward **ret) {
 
        _cleanup_(pty_forward_freep) PTYForward *f = NULL;
        struct winsize ws;
        int r;
 
        assert(master >= 0);
        assert(ret);
 
        if (!FLAGS_SET(flags, PTY_FORWARD_READ_ONLY)) {
                /* If stdin isn't actually opened for reading, or refers to the read end of a pipe (or
                 * socket) whose peer has already hung up, then there's nothing for us to forward — imply
                 * read-only mode. */
                r = RET_NERRNO(fcntl(STDIN_FILENO, F_GETFL));
                if (r < 0 && r != -EBADF)
                        return log_debug_errno(errno, "Failed to query stdin flags: %m");
                if (r == -EBADF || (r & O_ACCMODE_STRICT) == O_WRONLY)
                        flags |= PTY_FORWARD_READ_ONLY;
                else {
                        r = pipe_eof(STDIN_FILENO);
                        if (r < 0)
                                log_debug_errno(r, "Failed to check whether stdin is at EOF, ignoring: %m");
                        else if (r > 0)
                                flags |= PTY_FORWARD_READ_ONLY;
                }
        }
 
        f = new(PTYForward, 1);
        if (!f)
                return -ENOMEM;
 
        *f = (PTYForward) {
                .flags = flags,
                .master = -EBADF,
                .input_fd = -EBADF,
                .output_fd = -EBADF,
        };
 
        if (event)
                f->event = sd_event_ref(event);
        else {
                r = sd_event_default(&f->event);
                if (r < 0)
                        return r;
        }
 
        if (FLAGS_SET(flags, PTY_FORWARD_READ_ONLY))
                f->output_fd = STDOUT_FILENO;
        else {
                /* If we shall be invoked in interactive mode, let's switch on non-blocking mode, so that we
                 * never end up staving one direction while we block on the other. However, let's be careful
                 * here and not turn on O_NONBLOCK for stdin/stdout directly, but of reopened copies of
                 * them. This has two advantages: when we are killed abruptly the stdin/stdout fds won't be
                 * left in O_NONBLOCK state for the next process using them. In addition, if some process
                 * running in the background wants to continue writing to our stdout it can do so without
                 * being confused by O_NONBLOCK. Regular file output is dup'ed instead, to keep the file offset
                 * shared with the caller. */
 
                f->input_fd = fd_dup_or_reopen_stdio_nonblock(STDIN_FILENO, O_RDONLY);
                if (f->input_fd < 0) {
                        /* Handle failures gracefully, after all certain fd types cannot be reopened
                         * (sockets, …) */
                        log_debug_errno(f->input_fd, "Failed to reopen stdin, using original fd: %m");
 
                        r = fd_nonblock(STDIN_FILENO, true);
                        if (r < 0)
                                return r;
 
                        f->input_fd = STDIN_FILENO;
                } else
                        f->close_input_fd = true;
 
                f->output_fd = fd_dup_or_reopen_stdio_nonblock(STDOUT_FILENO, O_WRONLY);
                if (f->output_fd < 0) {
                        log_debug_errno(f->output_fd, "Failed to reopen stdout, using original fd: %m");