Annotation of qemu/qemu-char.c, revision 1.1.1.2

1.1       root        1: /*
                      2:  * QEMU System Emulator
                      3:  *
                      4:  * Copyright (c) 2003-2008 Fabrice Bellard
                      5:  *
                      6:  * Permission is hereby granted, free of charge, to any person obtaining a copy
                      7:  * of this software and associated documentation files (the "Software"), to deal
                      8:  * in the Software without restriction, including without limitation the rights
                      9:  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
                     10:  * copies of the Software, and to permit persons to whom the Software is
                     11:  * furnished to do so, subject to the following conditions:
                     12:  *
                     13:  * The above copyright notice and this permission notice shall be included in
                     14:  * all copies or substantial portions of the Software.
                     15:  *
                     16:  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
                     17:  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
                     18:  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
                     19:  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
                     20:  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
                     21:  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
                     22:  * THE SOFTWARE.
                     23:  */
                     24: #include "qemu-common.h"
                     25: #include "net.h"
                     26: #include "console.h"
                     27: #include "sysemu.h"
                     28: #include "qemu-timer.h"
                     29: #include "qemu-char.h"
                     30: #include "block.h"
                     31: #include "hw/usb.h"
                     32: #include "hw/baum.h"
                     33: #include "hw/msmouse.h"
                     34: 
                     35: #include <unistd.h>
                     36: #include <fcntl.h>
                     37: #include <signal.h>
                     38: #include <time.h>
                     39: #include <errno.h>
                     40: #include <sys/time.h>
                     41: #include <zlib.h>
                     42: 
                     43: #ifndef _WIN32
                     44: #include <sys/times.h>
                     45: #include <sys/wait.h>
                     46: #include <termios.h>
                     47: #include <sys/mman.h>
                     48: #include <sys/ioctl.h>
                     49: #include <sys/resource.h>
                     50: #include <sys/socket.h>
                     51: #include <netinet/in.h>
                     52: #include <net/if.h>
                     53: #ifdef __NetBSD__
                     54: #include <net/if_tap.h>
                     55: #endif
                     56: #ifdef __linux__
                     57: #include <linux/if_tun.h>
                     58: #endif
                     59: #include <arpa/inet.h>
                     60: #include <dirent.h>
                     61: #include <netdb.h>
                     62: #include <sys/select.h>
                     63: #ifdef _BSD
                     64: #include <sys/stat.h>
                     65: #ifdef __FreeBSD__
                     66: #include <libutil.h>
                     67: #include <dev/ppbus/ppi.h>
                     68: #include <dev/ppbus/ppbconf.h>
                     69: #else
                     70: #include <util.h>
                     71: #endif
                     72: #elif defined (__GLIBC__) && defined (__FreeBSD_kernel__)
                     73: #include <freebsd/stdlib.h>
                     74: #else
                     75: #ifdef __linux__
                     76: #include <pty.h>
                     77: 
                     78: #include <linux/ppdev.h>
                     79: #include <linux/parport.h>
                     80: #endif
                     81: #ifdef __sun__
                     82: #include <sys/stat.h>
                     83: #include <sys/ethernet.h>
                     84: #include <sys/sockio.h>
                     85: #include <netinet/arp.h>
                     86: #include <netinet/in.h>
                     87: #include <netinet/in_systm.h>
                     88: #include <netinet/ip.h>
                     89: #include <netinet/ip_icmp.h> // must come after ip.h
                     90: #include <netinet/udp.h>
                     91: #include <netinet/tcp.h>
                     92: #include <net/if.h>
                     93: #include <syslog.h>
                     94: #include <stropts.h>
                     95: #endif
                     96: #endif
                     97: #endif
                     98: 
                     99: #include "qemu_socket.h"
                    100: 
                    101: /***********************************************************/
                    102: /* character device */
                    103: 
1.1.1.2 ! root      104: static TAILQ_HEAD(CharDriverStateHead, CharDriverState) chardevs =
        !           105:     TAILQ_HEAD_INITIALIZER(chardevs);
        !           106: static int initial_reset_issued;
        !           107: 
1.1       root      108: static void qemu_chr_event(CharDriverState *s, int event)
                    109: {
                    110:     if (!s->chr_event)
                    111:         return;
                    112:     s->chr_event(s->handler_opaque, event);
                    113: }
                    114: 
                    115: static void qemu_chr_reset_bh(void *opaque)
                    116: {
                    117:     CharDriverState *s = opaque;
                    118:     qemu_chr_event(s, CHR_EVENT_RESET);
                    119:     qemu_bh_delete(s->bh);
                    120:     s->bh = NULL;
                    121: }
                    122: 
                    123: void qemu_chr_reset(CharDriverState *s)
                    124: {
1.1.1.2 ! root      125:     if (s->bh == NULL && initial_reset_issued) {
1.1       root      126:        s->bh = qemu_bh_new(qemu_chr_reset_bh, s);
                    127:        qemu_bh_schedule(s->bh);
                    128:     }
                    129: }
                    130: 
1.1.1.2 ! root      131: void qemu_chr_initial_reset(void)
        !           132: {
        !           133:     CharDriverState *chr;
        !           134: 
        !           135:     initial_reset_issued = 1;
        !           136: 
        !           137:     TAILQ_FOREACH(chr, &chardevs, next) {
        !           138:         qemu_chr_reset(chr);
        !           139:     }
        !           140: }
        !           141: 
1.1       root      142: int qemu_chr_write(CharDriverState *s, const uint8_t *buf, int len)
                    143: {
                    144:     return s->chr_write(s, buf, len);
                    145: }
                    146: 
                    147: int qemu_chr_ioctl(CharDriverState *s, int cmd, void *arg)
                    148: {
                    149:     if (!s->chr_ioctl)
                    150:         return -ENOTSUP;
                    151:     return s->chr_ioctl(s, cmd, arg);
                    152: }
                    153: 
                    154: int qemu_chr_can_read(CharDriverState *s)
                    155: {
                    156:     if (!s->chr_can_read)
                    157:         return 0;
                    158:     return s->chr_can_read(s->handler_opaque);
                    159: }
                    160: 
                    161: void qemu_chr_read(CharDriverState *s, uint8_t *buf, int len)
                    162: {
                    163:     s->chr_read(s->handler_opaque, buf, len);
                    164: }
                    165: 
                    166: void qemu_chr_accept_input(CharDriverState *s)
                    167: {
                    168:     if (s->chr_accept_input)
                    169:         s->chr_accept_input(s);
                    170: }
                    171: 
                    172: void qemu_chr_printf(CharDriverState *s, const char *fmt, ...)
                    173: {
                    174:     char buf[4096];
                    175:     va_list ap;
                    176:     va_start(ap, fmt);
                    177:     vsnprintf(buf, sizeof(buf), fmt, ap);
                    178:     qemu_chr_write(s, (uint8_t *)buf, strlen(buf));
                    179:     va_end(ap);
                    180: }
                    181: 
                    182: void qemu_chr_send_event(CharDriverState *s, int event)
                    183: {
                    184:     if (s->chr_send_event)
                    185:         s->chr_send_event(s, event);
                    186: }
                    187: 
                    188: void qemu_chr_add_handlers(CharDriverState *s,
                    189:                            IOCanRWHandler *fd_can_read,
                    190:                            IOReadHandler *fd_read,
                    191:                            IOEventHandler *fd_event,
                    192:                            void *opaque)
                    193: {
                    194:     s->chr_can_read = fd_can_read;
                    195:     s->chr_read = fd_read;
                    196:     s->chr_event = fd_event;
                    197:     s->handler_opaque = opaque;
                    198:     if (s->chr_update_read_handler)
                    199:         s->chr_update_read_handler(s);
                    200: }
                    201: 
                    202: static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
                    203: {
                    204:     return len;
                    205: }
                    206: 
                    207: static CharDriverState *qemu_chr_open_null(void)
                    208: {
                    209:     CharDriverState *chr;
                    210: 
                    211:     chr = qemu_mallocz(sizeof(CharDriverState));
                    212:     chr->chr_write = null_chr_write;
                    213:     return chr;
                    214: }
                    215: 
                    216: /* MUX driver for serial I/O splitting */
                    217: static int term_timestamps;
                    218: static int64_t term_timestamps_start;
                    219: #define MAX_MUX 4
                    220: #define MUX_BUFFER_SIZE 32     /* Must be a power of 2.  */
                    221: #define MUX_BUFFER_MASK (MUX_BUFFER_SIZE - 1)
                    222: typedef struct {
                    223:     IOCanRWHandler *chr_can_read[MAX_MUX];
                    224:     IOReadHandler *chr_read[MAX_MUX];
                    225:     IOEventHandler *chr_event[MAX_MUX];
                    226:     void *ext_opaque[MAX_MUX];
                    227:     CharDriverState *drv;
                    228:     int mux_cnt;
                    229:     int term_got_escape;
                    230:     int max_size;
1.1.1.2 ! root      231:     /* Intermediate input buffer allows to catch escape sequences even if the
        !           232:        currently active device is not accepting any input - but only until it
        !           233:        is full as well. */
        !           234:     unsigned char buffer[MAX_MUX][MUX_BUFFER_SIZE];
        !           235:     int prod[MAX_MUX];
        !           236:     int cons[MAX_MUX];
1.1       root      237: } MuxDriver;
                    238: 
                    239: 
                    240: static int mux_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
                    241: {
                    242:     MuxDriver *d = chr->opaque;
                    243:     int ret;
                    244:     if (!term_timestamps) {
                    245:         ret = d->drv->chr_write(d->drv, buf, len);
                    246:     } else {
                    247:         int i;
                    248: 
                    249:         ret = 0;
                    250:         for(i = 0; i < len; i++) {
                    251:             ret += d->drv->chr_write(d->drv, buf+i, 1);
                    252:             if (buf[i] == '\n') {
                    253:                 char buf1[64];
                    254:                 int64_t ti;
                    255:                 int secs;
                    256: 
                    257:                 ti = qemu_get_clock(rt_clock);
                    258:                 if (term_timestamps_start == -1)
                    259:                     term_timestamps_start = ti;
                    260:                 ti -= term_timestamps_start;
                    261:                 secs = ti / 1000;
                    262:                 snprintf(buf1, sizeof(buf1),
                    263:                          "[%02d:%02d:%02d.%03d] ",
                    264:                          secs / 3600,
                    265:                          (secs / 60) % 60,
                    266:                          secs % 60,
                    267:                          (int)(ti % 1000));
                    268:                 d->drv->chr_write(d->drv, (uint8_t *)buf1, strlen(buf1));
                    269:             }
                    270:         }
                    271:     }
                    272:     return ret;
                    273: }
                    274: 
                    275: static const char * const mux_help[] = {
                    276:     "% h    print this help\n\r",
                    277:     "% x    exit emulator\n\r",
                    278:     "% s    save disk data back to file (if -snapshot)\n\r",
                    279:     "% t    toggle console timestamps\n\r"
                    280:     "% b    send break (magic sysrq)\n\r",
                    281:     "% c    switch between console and monitor\n\r",
                    282:     "% %  sends %\n\r",
                    283:     NULL
                    284: };
                    285: 
                    286: int term_escape_char = 0x01; /* ctrl-a is used for escape */
                    287: static void mux_print_help(CharDriverState *chr)
                    288: {
                    289:     int i, j;
                    290:     char ebuf[15] = "Escape-Char";
                    291:     char cbuf[50] = "\n\r";
                    292: 
                    293:     if (term_escape_char > 0 && term_escape_char < 26) {
                    294:         snprintf(cbuf, sizeof(cbuf), "\n\r");
                    295:         snprintf(ebuf, sizeof(ebuf), "C-%c", term_escape_char - 1 + 'a');
                    296:     } else {
                    297:         snprintf(cbuf, sizeof(cbuf),
                    298:                  "\n\rEscape-Char set to Ascii: 0x%02x\n\r\n\r",
                    299:                  term_escape_char);
                    300:     }
                    301:     chr->chr_write(chr, (uint8_t *)cbuf, strlen(cbuf));
                    302:     for (i = 0; mux_help[i] != NULL; i++) {
                    303:         for (j=0; mux_help[i][j] != '\0'; j++) {
                    304:             if (mux_help[i][j] == '%')
                    305:                 chr->chr_write(chr, (uint8_t *)ebuf, strlen(ebuf));
                    306:             else
                    307:                 chr->chr_write(chr, (uint8_t *)&mux_help[i][j], 1);
                    308:         }
                    309:     }
                    310: }
                    311: 
                    312: static int mux_proc_byte(CharDriverState *chr, MuxDriver *d, int ch)
                    313: {
                    314:     if (d->term_got_escape) {
                    315:         d->term_got_escape = 0;
                    316:         if (ch == term_escape_char)
                    317:             goto send_char;
                    318:         switch(ch) {
                    319:         case '?':
                    320:         case 'h':
                    321:             mux_print_help(chr);
                    322:             break;
                    323:         case 'x':
                    324:             {
                    325:                  const char *term =  "QEMU: Terminated\n\r";
                    326:                  chr->chr_write(chr,(uint8_t *)term,strlen(term));
                    327:                  exit(0);
                    328:                  break;
                    329:             }
                    330:         case 's':
                    331:             {
                    332:                 int i;
                    333:                 for (i = 0; i < nb_drives; i++) {
                    334:                         bdrv_commit(drives_table[i].bdrv);
                    335:                 }
                    336:             }
                    337:             break;
                    338:         case 'b':
                    339:             qemu_chr_event(chr, CHR_EVENT_BREAK);
                    340:             break;
                    341:         case 'c':
                    342:             /* Switch to the next registered device */
                    343:             chr->focus++;
                    344:             if (chr->focus >= d->mux_cnt)
                    345:                 chr->focus = 0;
                    346:             break;
                    347:        case 't':
                    348:            term_timestamps = !term_timestamps;
                    349:            term_timestamps_start = -1;
                    350:            break;
                    351:         }
                    352:     } else if (ch == term_escape_char) {
                    353:         d->term_got_escape = 1;
                    354:     } else {
                    355:     send_char:
                    356:         return 1;
                    357:     }
                    358:     return 0;
                    359: }
                    360: 
                    361: static void mux_chr_accept_input(CharDriverState *chr)
                    362: {
                    363:     int m = chr->focus;
                    364:     MuxDriver *d = chr->opaque;
                    365: 
1.1.1.2 ! root      366:     while (d->prod[m] != d->cons[m] &&
1.1       root      367:            d->chr_can_read[m] &&
                    368:            d->chr_can_read[m](d->ext_opaque[m])) {
                    369:         d->chr_read[m](d->ext_opaque[m],
1.1.1.2 ! root      370:                        &d->buffer[m][d->cons[m]++ & MUX_BUFFER_MASK], 1);
1.1       root      371:     }
                    372: }
                    373: 
                    374: static int mux_chr_can_read(void *opaque)
                    375: {
                    376:     CharDriverState *chr = opaque;
                    377:     MuxDriver *d = chr->opaque;
1.1.1.2 ! root      378:     int m = chr->focus;
1.1       root      379: 
1.1.1.2 ! root      380:     if ((d->prod[m] - d->cons[m]) < MUX_BUFFER_SIZE)
1.1       root      381:         return 1;
1.1.1.2 ! root      382:     if (d->chr_can_read[m])
        !           383:         return d->chr_can_read[m](d->ext_opaque[m]);
1.1       root      384:     return 0;
                    385: }
                    386: 
                    387: static void mux_chr_read(void *opaque, const uint8_t *buf, int size)
                    388: {
                    389:     CharDriverState *chr = opaque;
                    390:     MuxDriver *d = chr->opaque;
                    391:     int m = chr->focus;
                    392:     int i;
                    393: 
                    394:     mux_chr_accept_input (opaque);
                    395: 
                    396:     for(i = 0; i < size; i++)
                    397:         if (mux_proc_byte(chr, d, buf[i])) {
1.1.1.2 ! root      398:             if (d->prod[m] == d->cons[m] &&
1.1       root      399:                 d->chr_can_read[m] &&
                    400:                 d->chr_can_read[m](d->ext_opaque[m]))
                    401:                 d->chr_read[m](d->ext_opaque[m], &buf[i], 1);
                    402:             else
1.1.1.2 ! root      403:                 d->buffer[m][d->prod[m]++ & MUX_BUFFER_MASK] = buf[i];
1.1       root      404:         }
                    405: }
                    406: 
                    407: static void mux_chr_event(void *opaque, int event)
                    408: {
                    409:     CharDriverState *chr = opaque;
                    410:     MuxDriver *d = chr->opaque;
                    411:     int i;
                    412: 
                    413:     /* Send the event to all registered listeners */
                    414:     for (i = 0; i < d->mux_cnt; i++)
                    415:         if (d->chr_event[i])
                    416:             d->chr_event[i](d->ext_opaque[i], event);
                    417: }
                    418: 
                    419: static void mux_chr_update_read_handler(CharDriverState *chr)
                    420: {
                    421:     MuxDriver *d = chr->opaque;
                    422: 
                    423:     if (d->mux_cnt >= MAX_MUX) {
                    424:         fprintf(stderr, "Cannot add I/O handlers, MUX array is full\n");
                    425:         return;
                    426:     }
                    427:     d->ext_opaque[d->mux_cnt] = chr->handler_opaque;
                    428:     d->chr_can_read[d->mux_cnt] = chr->chr_can_read;
                    429:     d->chr_read[d->mux_cnt] = chr->chr_read;
                    430:     d->chr_event[d->mux_cnt] = chr->chr_event;
                    431:     /* Fix up the real driver with mux routines */
                    432:     if (d->mux_cnt == 0) {
                    433:         qemu_chr_add_handlers(d->drv, mux_chr_can_read, mux_chr_read,
                    434:                               mux_chr_event, chr);
                    435:     }
                    436:     chr->focus = d->mux_cnt;
                    437:     d->mux_cnt++;
                    438: }
                    439: 
                    440: static CharDriverState *qemu_chr_open_mux(CharDriverState *drv)
                    441: {
                    442:     CharDriverState *chr;
                    443:     MuxDriver *d;
                    444: 
                    445:     chr = qemu_mallocz(sizeof(CharDriverState));
                    446:     d = qemu_mallocz(sizeof(MuxDriver));
                    447: 
                    448:     chr->opaque = d;
                    449:     d->drv = drv;
                    450:     chr->focus = -1;
                    451:     chr->chr_write = mux_chr_write;
                    452:     chr->chr_update_read_handler = mux_chr_update_read_handler;
                    453:     chr->chr_accept_input = mux_chr_accept_input;
                    454:     return chr;
                    455: }
                    456: 
                    457: 
                    458: #ifdef _WIN32
                    459: int send_all(int fd, const void *buf, int len1)
                    460: {
                    461:     int ret, len;
                    462: 
                    463:     len = len1;
                    464:     while (len > 0) {
                    465:         ret = send(fd, buf, len, 0);
                    466:         if (ret < 0) {
                    467:             errno = WSAGetLastError();
                    468:             if (errno != WSAEWOULDBLOCK) {
                    469:                 return -1;
                    470:             }
                    471:         } else if (ret == 0) {
                    472:             break;
                    473:         } else {
                    474:             buf += ret;
                    475:             len -= ret;
                    476:         }
                    477:     }
                    478:     return len1 - len;
                    479: }
                    480: 
                    481: #else
                    482: 
                    483: static int unix_write(int fd, const uint8_t *buf, int len1)
                    484: {
                    485:     int ret, len;
                    486: 
                    487:     len = len1;
                    488:     while (len > 0) {
                    489:         ret = write(fd, buf, len);
                    490:         if (ret < 0) {
                    491:             if (errno != EINTR && errno != EAGAIN)
                    492:                 return -1;
                    493:         } else if (ret == 0) {
                    494:             break;
                    495:         } else {
                    496:             buf += ret;
                    497:             len -= ret;
                    498:         }
                    499:     }
                    500:     return len1 - len;
                    501: }
                    502: 
                    503: int send_all(int fd, const void *buf, int len1)
                    504: {
                    505:     return unix_write(fd, buf, len1);
                    506: }
                    507: #endif /* !_WIN32 */
                    508: 
                    509: #ifndef _WIN32
                    510: 
                    511: typedef struct {
                    512:     int fd_in, fd_out;
                    513:     int max_size;
                    514: } FDCharDriver;
                    515: 
                    516: #define STDIO_MAX_CLIENTS 1
                    517: static int stdio_nb_clients = 0;
                    518: 
                    519: static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
                    520: {
                    521:     FDCharDriver *s = chr->opaque;
                    522:     return send_all(s->fd_out, buf, len);
                    523: }
                    524: 
                    525: static int fd_chr_read_poll(void *opaque)
                    526: {
                    527:     CharDriverState *chr = opaque;
                    528:     FDCharDriver *s = chr->opaque;
                    529: 
                    530:     s->max_size = qemu_chr_can_read(chr);
                    531:     return s->max_size;
                    532: }
                    533: 
                    534: static void fd_chr_read(void *opaque)
                    535: {
                    536:     CharDriverState *chr = opaque;
                    537:     FDCharDriver *s = chr->opaque;
                    538:     int size, len;
                    539:     uint8_t buf[1024];
                    540: 
                    541:     len = sizeof(buf);
                    542:     if (len > s->max_size)
                    543:         len = s->max_size;
                    544:     if (len == 0)
                    545:         return;
                    546:     size = read(s->fd_in, buf, len);
                    547:     if (size == 0) {
                    548:         /* FD has been closed. Remove it from the active list.  */
                    549:         qemu_set_fd_handler2(s->fd_in, NULL, NULL, NULL, NULL);
                    550:         return;
                    551:     }
                    552:     if (size > 0) {
                    553:         qemu_chr_read(chr, buf, size);
                    554:     }
                    555: }
                    556: 
                    557: static void fd_chr_update_read_handler(CharDriverState *chr)
                    558: {
                    559:     FDCharDriver *s = chr->opaque;
                    560: 
                    561:     if (s->fd_in >= 0) {
                    562:         if (nographic && s->fd_in == 0) {
                    563:         } else {
                    564:             qemu_set_fd_handler2(s->fd_in, fd_chr_read_poll,
                    565:                                  fd_chr_read, NULL, chr);
                    566:         }
                    567:     }
                    568: }
                    569: 
                    570: static void fd_chr_close(struct CharDriverState *chr)
                    571: {
                    572:     FDCharDriver *s = chr->opaque;
                    573: 
                    574:     if (s->fd_in >= 0) {
                    575:         if (nographic && s->fd_in == 0) {
                    576:         } else {
                    577:             qemu_set_fd_handler2(s->fd_in, NULL, NULL, NULL, NULL);
                    578:         }
                    579:     }
                    580: 
                    581:     qemu_free(s);
                    582: }
                    583: 
                    584: /* open a character device to a unix fd */
                    585: static CharDriverState *qemu_chr_open_fd(int fd_in, int fd_out)
                    586: {
                    587:     CharDriverState *chr;
                    588:     FDCharDriver *s;
                    589: 
                    590:     chr = qemu_mallocz(sizeof(CharDriverState));
                    591:     s = qemu_mallocz(sizeof(FDCharDriver));
                    592:     s->fd_in = fd_in;
                    593:     s->fd_out = fd_out;
                    594:     chr->opaque = s;
                    595:     chr->chr_write = fd_chr_write;
                    596:     chr->chr_update_read_handler = fd_chr_update_read_handler;
                    597:     chr->chr_close = fd_chr_close;
                    598: 
                    599:     qemu_chr_reset(chr);
                    600: 
                    601:     return chr;
                    602: }
                    603: 
                    604: static CharDriverState *qemu_chr_open_file_out(const char *file_out)
                    605: {
                    606:     int fd_out;
                    607: 
                    608:     TFR(fd_out = open(file_out, O_WRONLY | O_TRUNC | O_CREAT | O_BINARY, 0666));
                    609:     if (fd_out < 0)
                    610:         return NULL;
                    611:     return qemu_chr_open_fd(-1, fd_out);
                    612: }
                    613: 
                    614: static CharDriverState *qemu_chr_open_pipe(const char *filename)
                    615: {
                    616:     int fd_in, fd_out;
                    617:     char filename_in[256], filename_out[256];
                    618: 
                    619:     snprintf(filename_in, 256, "%s.in", filename);
                    620:     snprintf(filename_out, 256, "%s.out", filename);
                    621:     TFR(fd_in = open(filename_in, O_RDWR | O_BINARY));
                    622:     TFR(fd_out = open(filename_out, O_RDWR | O_BINARY));
                    623:     if (fd_in < 0 || fd_out < 0) {
                    624:        if (fd_in >= 0)
                    625:            close(fd_in);
                    626:        if (fd_out >= 0)
                    627:            close(fd_out);
                    628:         TFR(fd_in = fd_out = open(filename, O_RDWR | O_BINARY));
                    629:         if (fd_in < 0)
                    630:             return NULL;
                    631:     }
                    632:     return qemu_chr_open_fd(fd_in, fd_out);
                    633: }
                    634: 
                    635: 
                    636: /* for STDIO, we handle the case where several clients use it
                    637:    (nographic mode) */
                    638: 
                    639: #define TERM_FIFO_MAX_SIZE 1
                    640: 
                    641: static uint8_t term_fifo[TERM_FIFO_MAX_SIZE];
                    642: static int term_fifo_size;
                    643: 
                    644: static int stdio_read_poll(void *opaque)
                    645: {
                    646:     CharDriverState *chr = opaque;
                    647: 
                    648:     /* try to flush the queue if needed */
                    649:     if (term_fifo_size != 0 && qemu_chr_can_read(chr) > 0) {
                    650:         qemu_chr_read(chr, term_fifo, 1);
                    651:         term_fifo_size = 0;
                    652:     }
                    653:     /* see if we can absorb more chars */
                    654:     if (term_fifo_size == 0)
                    655:         return 1;
                    656:     else
                    657:         return 0;
                    658: }
                    659: 
                    660: static void stdio_read(void *opaque)
                    661: {
                    662:     int size;
                    663:     uint8_t buf[1];
                    664:     CharDriverState *chr = opaque;
                    665: 
                    666:     size = read(0, buf, 1);
                    667:     if (size == 0) {
                    668:         /* stdin has been closed. Remove it from the active list.  */
                    669:         qemu_set_fd_handler2(0, NULL, NULL, NULL, NULL);
                    670:         return;
                    671:     }
                    672:     if (size > 0) {
                    673:         if (qemu_chr_can_read(chr) > 0) {
                    674:             qemu_chr_read(chr, buf, 1);
                    675:         } else if (term_fifo_size == 0) {
                    676:             term_fifo[term_fifo_size++] = buf[0];
                    677:         }
                    678:     }
                    679: }
                    680: 
                    681: /* init terminal so that we can grab keys */
                    682: static struct termios oldtty;
                    683: static int old_fd0_flags;
                    684: static int term_atexit_done;
                    685: 
                    686: static void term_exit(void)
                    687: {
                    688:     tcsetattr (0, TCSANOW, &oldtty);
                    689:     fcntl(0, F_SETFL, old_fd0_flags);
                    690: }
                    691: 
                    692: static void term_init(void)
                    693: {
                    694:     struct termios tty;
                    695: 
                    696:     tcgetattr (0, &tty);
                    697:     oldtty = tty;
                    698:     old_fd0_flags = fcntl(0, F_GETFL);
                    699: 
                    700:     tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
                    701:                           |INLCR|IGNCR|ICRNL|IXON);
                    702:     tty.c_oflag |= OPOST;
                    703:     tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN);
                    704:     /* if graphical mode, we allow Ctrl-C handling */
                    705:     if (nographic)
                    706:         tty.c_lflag &= ~ISIG;
                    707:     tty.c_cflag &= ~(CSIZE|PARENB);
                    708:     tty.c_cflag |= CS8;
                    709:     tty.c_cc[VMIN] = 1;
                    710:     tty.c_cc[VTIME] = 0;
                    711: 
                    712:     tcsetattr (0, TCSANOW, &tty);
                    713: 
                    714:     if (!term_atexit_done++)
                    715:         atexit(term_exit);
                    716: 
                    717:     fcntl(0, F_SETFL, O_NONBLOCK);
                    718: }
                    719: 
                    720: static void qemu_chr_close_stdio(struct CharDriverState *chr)
                    721: {
                    722:     term_exit();
                    723:     stdio_nb_clients--;
                    724:     qemu_set_fd_handler2(0, NULL, NULL, NULL, NULL);
                    725:     fd_chr_close(chr);
                    726: }
                    727: 
                    728: static CharDriverState *qemu_chr_open_stdio(void)
                    729: {
                    730:     CharDriverState *chr;
                    731: 
                    732:     if (stdio_nb_clients >= STDIO_MAX_CLIENTS)
                    733:         return NULL;
                    734:     chr = qemu_chr_open_fd(0, 1);
                    735:     chr->chr_close = qemu_chr_close_stdio;
                    736:     qemu_set_fd_handler2(0, stdio_read_poll, stdio_read, NULL, chr);
                    737:     stdio_nb_clients++;
                    738:     term_init();
                    739: 
                    740:     return chr;
                    741: }
                    742: 
                    743: #ifdef __sun__
                    744: /* Once Solaris has openpty(), this is going to be removed. */
                    745: int openpty(int *amaster, int *aslave, char *name,
                    746:             struct termios *termp, struct winsize *winp)
                    747: {
                    748:         const char *slave;
                    749:         int mfd = -1, sfd = -1;
                    750: 
                    751:         *amaster = *aslave = -1;
                    752: 
                    753:         mfd = open("/dev/ptmx", O_RDWR | O_NOCTTY);
                    754:         if (mfd < 0)
                    755:                 goto err;
                    756: 
                    757:         if (grantpt(mfd) == -1 || unlockpt(mfd) == -1)
                    758:                 goto err;
                    759: 
                    760:         if ((slave = ptsname(mfd)) == NULL)
                    761:                 goto err;
                    762: 
                    763:         if ((sfd = open(slave, O_RDONLY | O_NOCTTY)) == -1)
                    764:                 goto err;
                    765: 
                    766:         if (ioctl(sfd, I_PUSH, "ptem") == -1 ||
                    767:             (termp != NULL && tcgetattr(sfd, termp) < 0))
                    768:                 goto err;
                    769: 
                    770:         if (amaster)
                    771:                 *amaster = mfd;
                    772:         if (aslave)
                    773:                 *aslave = sfd;
                    774:         if (winp)
                    775:                 ioctl(sfd, TIOCSWINSZ, winp);
                    776: 
                    777:         return 0;
                    778: 
                    779: err:
                    780:         if (sfd != -1)
                    781:                 close(sfd);
                    782:         close(mfd);
                    783:         return -1;
                    784: }
                    785: 
                    786: void cfmakeraw (struct termios *termios_p)
                    787: {
                    788:         termios_p->c_iflag &=
                    789:                 ~(IGNBRK|BRKINT|PARMRK|ISTRIP|INLCR|IGNCR|ICRNL|IXON);
                    790:         termios_p->c_oflag &= ~OPOST;
                    791:         termios_p->c_lflag &= ~(ECHO|ECHONL|ICANON|ISIG|IEXTEN);
                    792:         termios_p->c_cflag &= ~(CSIZE|PARENB);
                    793:         termios_p->c_cflag |= CS8;
                    794: 
                    795:         termios_p->c_cc[VMIN] = 0;
                    796:         termios_p->c_cc[VTIME] = 0;
                    797: }
                    798: #endif
                    799: 
                    800: #if defined(__linux__) || defined(__sun__) || defined(__FreeBSD__) \
                    801:     || defined(__NetBSD__) || defined(__OpenBSD__)
                    802: 
                    803: typedef struct {
                    804:     int fd;
                    805:     int connected;
                    806:     int polling;
                    807:     int read_bytes;
                    808:     QEMUTimer *timer;
                    809: } PtyCharDriver;
                    810: 
                    811: static void pty_chr_update_read_handler(CharDriverState *chr);
                    812: static void pty_chr_state(CharDriverState *chr, int connected);
                    813: 
                    814: static int pty_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
                    815: {
                    816:     PtyCharDriver *s = chr->opaque;
                    817: 
                    818:     if (!s->connected) {
                    819:         /* guest sends data, check for (re-)connect */
                    820:         pty_chr_update_read_handler(chr);
                    821:         return 0;
                    822:     }
                    823:     return send_all(s->fd, buf, len);
                    824: }
                    825: 
                    826: static int pty_chr_read_poll(void *opaque)
                    827: {
                    828:     CharDriverState *chr = opaque;
                    829:     PtyCharDriver *s = chr->opaque;
                    830: 
                    831:     s->read_bytes = qemu_chr_can_read(chr);
                    832:     return s->read_bytes;
                    833: }
                    834: 
                    835: static void pty_chr_read(void *opaque)
                    836: {
                    837:     CharDriverState *chr = opaque;
                    838:     PtyCharDriver *s = chr->opaque;
                    839:     int size, len;
                    840:     uint8_t buf[1024];
                    841: 
                    842:     len = sizeof(buf);
                    843:     if (len > s->read_bytes)
                    844:         len = s->read_bytes;
                    845:     if (len == 0)
                    846:         return;
                    847:     size = read(s->fd, buf, len);
                    848:     if ((size == -1 && errno == EIO) ||
                    849:         (size == 0)) {
                    850:         pty_chr_state(chr, 0);
                    851:         return;
                    852:     }
                    853:     if (size > 0) {
                    854:         pty_chr_state(chr, 1);
                    855:         qemu_chr_read(chr, buf, size);
                    856:     }
                    857: }
                    858: 
                    859: static void pty_chr_update_read_handler(CharDriverState *chr)
                    860: {
                    861:     PtyCharDriver *s = chr->opaque;
                    862: 
                    863:     qemu_set_fd_handler2(s->fd, pty_chr_read_poll,
                    864:                          pty_chr_read, NULL, chr);
                    865:     s->polling = 1;
                    866:     /*
                    867:      * Short timeout here: just need wait long enougth that qemu makes
                    868:      * it through the poll loop once.  When reconnected we want a
                    869:      * short timeout so we notice it almost instantly.  Otherwise
                    870:      * read() gives us -EIO instantly, making pty_chr_state() reset the
                    871:      * timeout to the normal (much longer) poll interval before the
                    872:      * timer triggers.
                    873:      */
                    874:     qemu_mod_timer(s->timer, qemu_get_clock(rt_clock) + 10);
                    875: }
                    876: 
                    877: static void pty_chr_state(CharDriverState *chr, int connected)
                    878: {
                    879:     PtyCharDriver *s = chr->opaque;
                    880: 
                    881:     if (!connected) {
                    882:         qemu_set_fd_handler2(s->fd, NULL, NULL, NULL, NULL);
                    883:         s->connected = 0;
                    884:         s->polling = 0;
                    885:         /* (re-)connect poll interval for idle guests: once per second.
                    886:          * We check more frequently in case the guests sends data to
                    887:          * the virtual device linked to our pty. */
                    888:         qemu_mod_timer(s->timer, qemu_get_clock(rt_clock) + 1000);
                    889:     } else {
                    890:         if (!s->connected)
                    891:             qemu_chr_reset(chr);
                    892:         s->connected = 1;
                    893:     }
                    894: }
                    895: 
                    896: static void pty_chr_timer(void *opaque)
                    897: {
                    898:     struct CharDriverState *chr = opaque;
                    899:     PtyCharDriver *s = chr->opaque;
                    900: 
                    901:     if (s->connected)
                    902:         return;
                    903:     if (s->polling) {
                    904:         /* If we arrive here without polling being cleared due
                    905:          * read returning -EIO, then we are (re-)connected */
                    906:         pty_chr_state(chr, 1);
                    907:         return;
                    908:     }
                    909: 
                    910:     /* Next poll ... */
                    911:     pty_chr_update_read_handler(chr);
                    912: }
                    913: 
                    914: static void pty_chr_close(struct CharDriverState *chr)
                    915: {
                    916:     PtyCharDriver *s = chr->opaque;
                    917: 
                    918:     qemu_set_fd_handler2(s->fd, NULL, NULL, NULL, NULL);
                    919:     close(s->fd);
                    920:     qemu_free(s);
                    921: }
                    922: 
                    923: static CharDriverState *qemu_chr_open_pty(void)
                    924: {
                    925:     CharDriverState *chr;
                    926:     PtyCharDriver *s;
                    927:     struct termios tty;
                    928:     int slave_fd, len;
                    929: #if defined(__OpenBSD__)
                    930:     char pty_name[PATH_MAX];
                    931: #define q_ptsname(x) pty_name
                    932: #else
                    933:     char *pty_name = NULL;
                    934: #define q_ptsname(x) ptsname(x)
                    935: #endif
                    936: 
                    937:     chr = qemu_mallocz(sizeof(CharDriverState));
                    938:     s = qemu_mallocz(sizeof(PtyCharDriver));
                    939: 
                    940:     if (openpty(&s->fd, &slave_fd, pty_name, NULL, NULL) < 0) {
                    941:         return NULL;
                    942:     }
                    943: 
                    944:     /* Set raw attributes on the pty. */
                    945:     tcgetattr(slave_fd, &tty);
                    946:     cfmakeraw(&tty);
                    947:     tcsetattr(slave_fd, TCSAFLUSH, &tty);
                    948:     close(slave_fd);
                    949: 
                    950:     len = strlen(q_ptsname(s->fd)) + 5;
                    951:     chr->filename = qemu_malloc(len);
                    952:     snprintf(chr->filename, len, "pty:%s", q_ptsname(s->fd));
                    953:     fprintf(stderr, "char device redirected to %s\n", q_ptsname(s->fd));
                    954: 
                    955:     chr->opaque = s;
                    956:     chr->chr_write = pty_chr_write;
                    957:     chr->chr_update_read_handler = pty_chr_update_read_handler;
                    958:     chr->chr_close = pty_chr_close;
                    959: 
                    960:     s->timer = qemu_new_timer(rt_clock, pty_chr_timer, chr);
                    961: 
                    962:     return chr;
                    963: }
                    964: 
                    965: static void tty_serial_init(int fd, int speed,
                    966:                             int parity, int data_bits, int stop_bits)
                    967: {
                    968:     struct termios tty;
                    969:     speed_t spd;
                    970: 
                    971: #if 0
                    972:     printf("tty_serial_init: speed=%d parity=%c data=%d stop=%d\n",
                    973:            speed, parity, data_bits, stop_bits);
                    974: #endif
                    975:     tcgetattr (fd, &tty);
                    976: 
                    977: #define MARGIN 1.1
                    978:     if (speed <= 50 * MARGIN)
                    979:         spd = B50;
                    980:     else if (speed <= 75 * MARGIN)
                    981:         spd = B75;
                    982:     else if (speed <= 300 * MARGIN)
                    983:         spd = B300;
                    984:     else if (speed <= 600 * MARGIN)
                    985:         spd = B600;
                    986:     else if (speed <= 1200 * MARGIN)
                    987:         spd = B1200;
                    988:     else if (speed <= 2400 * MARGIN)
                    989:         spd = B2400;
                    990:     else if (speed <= 4800 * MARGIN)
                    991:         spd = B4800;
                    992:     else if (speed <= 9600 * MARGIN)
                    993:         spd = B9600;
                    994:     else if (speed <= 19200 * MARGIN)
                    995:         spd = B19200;
                    996:     else if (speed <= 38400 * MARGIN)
                    997:         spd = B38400;
                    998:     else if (speed <= 57600 * MARGIN)
                    999:         spd = B57600;
                   1000:     else if (speed <= 115200 * MARGIN)
                   1001:         spd = B115200;
                   1002:     else
                   1003:         spd = B115200;
                   1004: 
                   1005:     cfsetispeed(&tty, spd);
                   1006:     cfsetospeed(&tty, spd);
                   1007: 
                   1008:     tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
                   1009:                           |INLCR|IGNCR|ICRNL|IXON);
                   1010:     tty.c_oflag |= OPOST;
                   1011:     tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN|ISIG);
                   1012:     tty.c_cflag &= ~(CSIZE|PARENB|PARODD|CRTSCTS|CSTOPB);
                   1013:     switch(data_bits) {
                   1014:     default:
                   1015:     case 8:
                   1016:         tty.c_cflag |= CS8;
                   1017:         break;
                   1018:     case 7:
                   1019:         tty.c_cflag |= CS7;
                   1020:         break;
                   1021:     case 6:
                   1022:         tty.c_cflag |= CS6;
                   1023:         break;
                   1024:     case 5:
                   1025:         tty.c_cflag |= CS5;
                   1026:         break;
                   1027:     }
                   1028:     switch(parity) {
                   1029:     default:
                   1030:     case 'N':
                   1031:         break;
                   1032:     case 'E':
                   1033:         tty.c_cflag |= PARENB;
                   1034:         break;
                   1035:     case 'O':
                   1036:         tty.c_cflag |= PARENB | PARODD;
                   1037:         break;
                   1038:     }
                   1039:     if (stop_bits == 2)
                   1040:         tty.c_cflag |= CSTOPB;
                   1041: 
                   1042:     tcsetattr (fd, TCSANOW, &tty);
                   1043: }
                   1044: 
                   1045: static int tty_serial_ioctl(CharDriverState *chr, int cmd, void *arg)
                   1046: {
                   1047:     FDCharDriver *s = chr->opaque;
                   1048: 
                   1049:     switch(cmd) {
                   1050:     case CHR_IOCTL_SERIAL_SET_PARAMS:
                   1051:         {
                   1052:             QEMUSerialSetParams *ssp = arg;
                   1053:             tty_serial_init(s->fd_in, ssp->speed, ssp->parity,
                   1054:                             ssp->data_bits, ssp->stop_bits);
                   1055:         }
                   1056:         break;
                   1057:     case CHR_IOCTL_SERIAL_SET_BREAK:
                   1058:         {
                   1059:             int enable = *(int *)arg;
                   1060:             if (enable)
                   1061:                 tcsendbreak(s->fd_in, 1);
                   1062:         }
                   1063:         break;
                   1064:     case CHR_IOCTL_SERIAL_GET_TIOCM:
                   1065:         {
                   1066:             int sarg = 0;
                   1067:             int *targ = (int *)arg;
                   1068:             ioctl(s->fd_in, TIOCMGET, &sarg);
                   1069:             *targ = 0;
                   1070:             if (sarg & TIOCM_CTS)
                   1071:                 *targ |= CHR_TIOCM_CTS;
                   1072:             if (sarg & TIOCM_CAR)
                   1073:                 *targ |= CHR_TIOCM_CAR;
                   1074:             if (sarg & TIOCM_DSR)
                   1075:                 *targ |= CHR_TIOCM_DSR;
                   1076:             if (sarg & TIOCM_RI)
                   1077:                 *targ |= CHR_TIOCM_RI;
                   1078:             if (sarg & TIOCM_DTR)
                   1079:                 *targ |= CHR_TIOCM_DTR;
                   1080:             if (sarg & TIOCM_RTS)
                   1081:                 *targ |= CHR_TIOCM_RTS;
                   1082:         }
                   1083:         break;
                   1084:     case CHR_IOCTL_SERIAL_SET_TIOCM:
                   1085:         {
                   1086:             int sarg = *(int *)arg;
                   1087:             int targ = 0;
                   1088:             ioctl(s->fd_in, TIOCMGET, &targ);
                   1089:             targ &= ~(CHR_TIOCM_CTS | CHR_TIOCM_CAR | CHR_TIOCM_DSR
                   1090:                      | CHR_TIOCM_RI | CHR_TIOCM_DTR | CHR_TIOCM_RTS);
                   1091:             if (sarg & CHR_TIOCM_CTS)
                   1092:                 targ |= TIOCM_CTS;
                   1093:             if (sarg & CHR_TIOCM_CAR)
                   1094:                 targ |= TIOCM_CAR;
                   1095:             if (sarg & CHR_TIOCM_DSR)
                   1096:                 targ |= TIOCM_DSR;
                   1097:             if (sarg & CHR_TIOCM_RI)
                   1098:                 targ |= TIOCM_RI;
                   1099:             if (sarg & CHR_TIOCM_DTR)
                   1100:                 targ |= TIOCM_DTR;
                   1101:             if (sarg & CHR_TIOCM_RTS)
                   1102:                 targ |= TIOCM_RTS;
                   1103:             ioctl(s->fd_in, TIOCMSET, &targ);
                   1104:         }
                   1105:         break;
                   1106:     default:
                   1107:         return -ENOTSUP;
                   1108:     }
                   1109:     return 0;
                   1110: }
                   1111: 
                   1112: static CharDriverState *qemu_chr_open_tty(const char *filename)
                   1113: {
                   1114:     CharDriverState *chr;
                   1115:     int fd;
                   1116: 
                   1117:     TFR(fd = open(filename, O_RDWR | O_NONBLOCK));
                   1118:     tty_serial_init(fd, 115200, 'N', 8, 1);
                   1119:     chr = qemu_chr_open_fd(fd, fd);
                   1120:     if (!chr) {
                   1121:         close(fd);
                   1122:         return NULL;
                   1123:     }
                   1124:     chr->chr_ioctl = tty_serial_ioctl;
                   1125:     qemu_chr_reset(chr);
                   1126:     return chr;
                   1127: }
                   1128: #else  /* ! __linux__ && ! __sun__ */
                   1129: static CharDriverState *qemu_chr_open_pty(void)
                   1130: {
                   1131:     return NULL;
                   1132: }
                   1133: #endif /* __linux__ || __sun__ */
                   1134: 
                   1135: #if defined(__linux__)
                   1136: typedef struct {
                   1137:     int fd;
                   1138:     int mode;
                   1139: } ParallelCharDriver;
                   1140: 
                   1141: static int pp_hw_mode(ParallelCharDriver *s, uint16_t mode)
                   1142: {
                   1143:     if (s->mode != mode) {
                   1144:        int m = mode;
                   1145:         if (ioctl(s->fd, PPSETMODE, &m) < 0)
                   1146:             return 0;
                   1147:        s->mode = mode;
                   1148:     }
                   1149:     return 1;
                   1150: }
                   1151: 
                   1152: static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
                   1153: {
                   1154:     ParallelCharDriver *drv = chr->opaque;
                   1155:     int fd = drv->fd;
                   1156:     uint8_t b;
                   1157: 
                   1158:     switch(cmd) {
                   1159:     case CHR_IOCTL_PP_READ_DATA:
                   1160:         if (ioctl(fd, PPRDATA, &b) < 0)
                   1161:             return -ENOTSUP;
                   1162:         *(uint8_t *)arg = b;
                   1163:         break;
                   1164:     case CHR_IOCTL_PP_WRITE_DATA:
                   1165:         b = *(uint8_t *)arg;
                   1166:         if (ioctl(fd, PPWDATA, &b) < 0)
                   1167:             return -ENOTSUP;
                   1168:         break;
                   1169:     case CHR_IOCTL_PP_READ_CONTROL:
                   1170:         if (ioctl(fd, PPRCONTROL, &b) < 0)
                   1171:             return -ENOTSUP;
                   1172:        /* Linux gives only the lowest bits, and no way to know data
                   1173:           direction! For better compatibility set the fixed upper
                   1174:           bits. */
                   1175:         *(uint8_t *)arg = b | 0xc0;
                   1176:         break;
                   1177:     case CHR_IOCTL_PP_WRITE_CONTROL:
                   1178:         b = *(uint8_t *)arg;
                   1179:         if (ioctl(fd, PPWCONTROL, &b) < 0)
                   1180:             return -ENOTSUP;
                   1181:         break;
                   1182:     case CHR_IOCTL_PP_READ_STATUS:
                   1183:         if (ioctl(fd, PPRSTATUS, &b) < 0)
                   1184:             return -ENOTSUP;
                   1185:         *(uint8_t *)arg = b;
                   1186:         break;
                   1187:     case CHR_IOCTL_PP_DATA_DIR:
                   1188:         if (ioctl(fd, PPDATADIR, (int *)arg) < 0)
                   1189:             return -ENOTSUP;
                   1190:         break;
                   1191:     case CHR_IOCTL_PP_EPP_READ_ADDR:
                   1192:        if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
                   1193:            struct ParallelIOArg *parg = arg;
                   1194:            int n = read(fd, parg->buffer, parg->count);
                   1195:            if (n != parg->count) {
                   1196:                return -EIO;
                   1197:            }
                   1198:        }
                   1199:         break;
                   1200:     case CHR_IOCTL_PP_EPP_READ:
                   1201:        if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
                   1202:            struct ParallelIOArg *parg = arg;
                   1203:            int n = read(fd, parg->buffer, parg->count);
                   1204:            if (n != parg->count) {
                   1205:                return -EIO;
                   1206:            }
                   1207:        }
                   1208:         break;
                   1209:     case CHR_IOCTL_PP_EPP_WRITE_ADDR:
                   1210:        if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
                   1211:            struct ParallelIOArg *parg = arg;
                   1212:            int n = write(fd, parg->buffer, parg->count);
                   1213:            if (n != parg->count) {
                   1214:                return -EIO;
                   1215:            }
                   1216:        }
                   1217:         break;
                   1218:     case CHR_IOCTL_PP_EPP_WRITE:
                   1219:        if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
                   1220:            struct ParallelIOArg *parg = arg;
                   1221:            int n = write(fd, parg->buffer, parg->count);
                   1222:            if (n != parg->count) {
                   1223:                return -EIO;
                   1224:            }
                   1225:        }
                   1226:         break;
                   1227:     default:
                   1228:         return -ENOTSUP;
                   1229:     }
                   1230:     return 0;
                   1231: }
                   1232: 
                   1233: static void pp_close(CharDriverState *chr)
                   1234: {
                   1235:     ParallelCharDriver *drv = chr->opaque;
                   1236:     int fd = drv->fd;
                   1237: 
                   1238:     pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
                   1239:     ioctl(fd, PPRELEASE);
                   1240:     close(fd);
                   1241:     qemu_free(drv);
                   1242: }
                   1243: 
                   1244: static CharDriverState *qemu_chr_open_pp(const char *filename)
                   1245: {
                   1246:     CharDriverState *chr;
                   1247:     ParallelCharDriver *drv;
                   1248:     int fd;
                   1249: 
                   1250:     TFR(fd = open(filename, O_RDWR));
                   1251:     if (fd < 0)
                   1252:         return NULL;
                   1253: 
                   1254:     if (ioctl(fd, PPCLAIM) < 0) {
                   1255:         close(fd);
                   1256:         return NULL;
                   1257:     }
                   1258: 
                   1259:     drv = qemu_mallocz(sizeof(ParallelCharDriver));
                   1260:     drv->fd = fd;
                   1261:     drv->mode = IEEE1284_MODE_COMPAT;
                   1262: 
                   1263:     chr = qemu_mallocz(sizeof(CharDriverState));
                   1264:     chr->chr_write = null_chr_write;
                   1265:     chr->chr_ioctl = pp_ioctl;
                   1266:     chr->chr_close = pp_close;
                   1267:     chr->opaque = drv;
                   1268: 
                   1269:     qemu_chr_reset(chr);
                   1270: 
                   1271:     return chr;
                   1272: }
                   1273: #endif /* __linux__ */
                   1274: 
                   1275: #if defined(__FreeBSD__)
                   1276: static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
                   1277: {
                   1278:     int fd = (int)chr->opaque;
                   1279:     uint8_t b;
                   1280: 
                   1281:     switch(cmd) {
                   1282:     case CHR_IOCTL_PP_READ_DATA:
                   1283:         if (ioctl(fd, PPIGDATA, &b) < 0)
                   1284:             return -ENOTSUP;
                   1285:         *(uint8_t *)arg = b;
                   1286:         break;
                   1287:     case CHR_IOCTL_PP_WRITE_DATA:
                   1288:         b = *(uint8_t *)arg;
                   1289:         if (ioctl(fd, PPISDATA, &b) < 0)
                   1290:             return -ENOTSUP;
                   1291:         break;
                   1292:     case CHR_IOCTL_PP_READ_CONTROL:
                   1293:         if (ioctl(fd, PPIGCTRL, &b) < 0)
                   1294:             return -ENOTSUP;
                   1295:         *(uint8_t *)arg = b;
                   1296:         break;
                   1297:     case CHR_IOCTL_PP_WRITE_CONTROL:
                   1298:         b = *(uint8_t *)arg;
                   1299:         if (ioctl(fd, PPISCTRL, &b) < 0)
                   1300:             return -ENOTSUP;
                   1301:         break;
                   1302:     case CHR_IOCTL_PP_READ_STATUS:
                   1303:         if (ioctl(fd, PPIGSTATUS, &b) < 0)
                   1304:             return -ENOTSUP;
                   1305:         *(uint8_t *)arg = b;
                   1306:         break;
                   1307:     default:
                   1308:         return -ENOTSUP;
                   1309:     }
                   1310:     return 0;
                   1311: }
                   1312: 
                   1313: static CharDriverState *qemu_chr_open_pp(const char *filename)
                   1314: {
                   1315:     CharDriverState *chr;
                   1316:     int fd;
                   1317: 
                   1318:     fd = open(filename, O_RDWR);
                   1319:     if (fd < 0)
                   1320:         return NULL;
                   1321: 
                   1322:     chr = qemu_mallocz(sizeof(CharDriverState));
                   1323:     chr->opaque = (void *)fd;
                   1324:     chr->chr_write = null_chr_write;
                   1325:     chr->chr_ioctl = pp_ioctl;
                   1326:     return chr;
                   1327: }
                   1328: #endif
                   1329: 
                   1330: #else /* _WIN32 */
                   1331: 
                   1332: typedef struct {
                   1333:     int max_size;
                   1334:     HANDLE hcom, hrecv, hsend;
                   1335:     OVERLAPPED orecv, osend;
                   1336:     BOOL fpipe;
                   1337:     DWORD len;
                   1338: } WinCharState;
                   1339: 
                   1340: #define NSENDBUF 2048
                   1341: #define NRECVBUF 2048
                   1342: #define MAXCONNECT 1
                   1343: #define NTIMEOUT 5000
                   1344: 
                   1345: static int win_chr_poll(void *opaque);
                   1346: static int win_chr_pipe_poll(void *opaque);
                   1347: 
                   1348: static void win_chr_close(CharDriverState *chr)
                   1349: {
                   1350:     WinCharState *s = chr->opaque;
                   1351: 
                   1352:     if (s->hsend) {
                   1353:         CloseHandle(s->hsend);
                   1354:         s->hsend = NULL;
                   1355:     }
                   1356:     if (s->hrecv) {
                   1357:         CloseHandle(s->hrecv);
                   1358:         s->hrecv = NULL;
                   1359:     }
                   1360:     if (s->hcom) {
                   1361:         CloseHandle(s->hcom);
                   1362:         s->hcom = NULL;
                   1363:     }
                   1364:     if (s->fpipe)
                   1365:         qemu_del_polling_cb(win_chr_pipe_poll, chr);
                   1366:     else
                   1367:         qemu_del_polling_cb(win_chr_poll, chr);
                   1368: }
                   1369: 
                   1370: static int win_chr_init(CharDriverState *chr, const char *filename)
                   1371: {
                   1372:     WinCharState *s = chr->opaque;
                   1373:     COMMCONFIG comcfg;
                   1374:     COMMTIMEOUTS cto = { 0, 0, 0, 0, 0};
                   1375:     COMSTAT comstat;
                   1376:     DWORD size;
                   1377:     DWORD err;
                   1378: 
                   1379:     s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
                   1380:     if (!s->hsend) {
                   1381:         fprintf(stderr, "Failed CreateEvent\n");
                   1382:         goto fail;
                   1383:     }
                   1384:     s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
                   1385:     if (!s->hrecv) {
                   1386:         fprintf(stderr, "Failed CreateEvent\n");
                   1387:         goto fail;
                   1388:     }
                   1389: 
                   1390:     s->hcom = CreateFile(filename, GENERIC_READ|GENERIC_WRITE, 0, NULL,
                   1391:                       OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
                   1392:     if (s->hcom == INVALID_HANDLE_VALUE) {
                   1393:         fprintf(stderr, "Failed CreateFile (%lu)\n", GetLastError());
                   1394:         s->hcom = NULL;
                   1395:         goto fail;
                   1396:     }
                   1397: 
                   1398:     if (!SetupComm(s->hcom, NRECVBUF, NSENDBUF)) {
                   1399:         fprintf(stderr, "Failed SetupComm\n");
                   1400:         goto fail;
                   1401:     }
                   1402: 
                   1403:     ZeroMemory(&comcfg, sizeof(COMMCONFIG));
                   1404:     size = sizeof(COMMCONFIG);
                   1405:     GetDefaultCommConfig(filename, &comcfg, &size);
                   1406:     comcfg.dcb.DCBlength = sizeof(DCB);
                   1407:     CommConfigDialog(filename, NULL, &comcfg);
                   1408: 
                   1409:     if (!SetCommState(s->hcom, &comcfg.dcb)) {
                   1410:         fprintf(stderr, "Failed SetCommState\n");
                   1411:         goto fail;
                   1412:     }
                   1413: 
                   1414:     if (!SetCommMask(s->hcom, EV_ERR)) {
                   1415:         fprintf(stderr, "Failed SetCommMask\n");
                   1416:         goto fail;
                   1417:     }
                   1418: 
                   1419:     cto.ReadIntervalTimeout = MAXDWORD;
                   1420:     if (!SetCommTimeouts(s->hcom, &cto)) {
                   1421:         fprintf(stderr, "Failed SetCommTimeouts\n");
                   1422:         goto fail;
                   1423:     }
                   1424: 
                   1425:     if (!ClearCommError(s->hcom, &err, &comstat)) {
                   1426:         fprintf(stderr, "Failed ClearCommError\n");
                   1427:         goto fail;
                   1428:     }
                   1429:     qemu_add_polling_cb(win_chr_poll, chr);
                   1430:     return 0;
                   1431: 
                   1432:  fail:
                   1433:     win_chr_close(chr);
                   1434:     return -1;
                   1435: }
                   1436: 
                   1437: static int win_chr_write(CharDriverState *chr, const uint8_t *buf, int len1)
                   1438: {
                   1439:     WinCharState *s = chr->opaque;
                   1440:     DWORD len, ret, size, err;
                   1441: 
                   1442:     len = len1;
                   1443:     ZeroMemory(&s->osend, sizeof(s->osend));
                   1444:     s->osend.hEvent = s->hsend;
                   1445:     while (len > 0) {
                   1446:         if (s->hsend)
                   1447:             ret = WriteFile(s->hcom, buf, len, &size, &s->osend);
                   1448:         else
                   1449:             ret = WriteFile(s->hcom, buf, len, &size, NULL);
                   1450:         if (!ret) {
                   1451:             err = GetLastError();
                   1452:             if (err == ERROR_IO_PENDING) {
                   1453:                 ret = GetOverlappedResult(s->hcom, &s->osend, &size, TRUE);
                   1454:                 if (ret) {
                   1455:                     buf += size;
                   1456:                     len -= size;
                   1457:                 } else {
                   1458:                     break;
                   1459:                 }
                   1460:             } else {
                   1461:                 break;
                   1462:             }
                   1463:         } else {
                   1464:             buf += size;
                   1465:             len -= size;
                   1466:         }
                   1467:     }
                   1468:     return len1 - len;
                   1469: }
                   1470: 
                   1471: static int win_chr_read_poll(CharDriverState *chr)
                   1472: {
                   1473:     WinCharState *s = chr->opaque;
                   1474: 
                   1475:     s->max_size = qemu_chr_can_read(chr);
                   1476:     return s->max_size;
                   1477: }
                   1478: 
                   1479: static void win_chr_readfile(CharDriverState *chr)
                   1480: {
                   1481:     WinCharState *s = chr->opaque;
                   1482:     int ret, err;
                   1483:     uint8_t buf[1024];
                   1484:     DWORD size;
                   1485: 
                   1486:     ZeroMemory(&s->orecv, sizeof(s->orecv));
                   1487:     s->orecv.hEvent = s->hrecv;
                   1488:     ret = ReadFile(s->hcom, buf, s->len, &size, &s->orecv);
                   1489:     if (!ret) {
                   1490:         err = GetLastError();
                   1491:         if (err == ERROR_IO_PENDING) {
                   1492:             ret = GetOverlappedResult(s->hcom, &s->orecv, &size, TRUE);
                   1493:         }
                   1494:     }
                   1495: 
                   1496:     if (size > 0) {
                   1497:         qemu_chr_read(chr, buf, size);
                   1498:     }
                   1499: }
                   1500: 
                   1501: static void win_chr_read(CharDriverState *chr)
                   1502: {
                   1503:     WinCharState *s = chr->opaque;
                   1504: 
                   1505:     if (s->len > s->max_size)
                   1506:         s->len = s->max_size;
                   1507:     if (s->len == 0)
                   1508:         return;
                   1509: 
                   1510:     win_chr_readfile(chr);
                   1511: }
                   1512: 
                   1513: static int win_chr_poll(void *opaque)
                   1514: {
                   1515:     CharDriverState *chr = opaque;
                   1516:     WinCharState *s = chr->opaque;
                   1517:     COMSTAT status;
                   1518:     DWORD comerr;
                   1519: 
                   1520:     ClearCommError(s->hcom, &comerr, &status);
                   1521:     if (status.cbInQue > 0) {
                   1522:         s->len = status.cbInQue;
                   1523:         win_chr_read_poll(chr);
                   1524:         win_chr_read(chr);
                   1525:         return 1;
                   1526:     }
                   1527:     return 0;
                   1528: }
                   1529: 
                   1530: static CharDriverState *qemu_chr_open_win(const char *filename)
                   1531: {
                   1532:     CharDriverState *chr;
                   1533:     WinCharState *s;
                   1534: 
                   1535:     chr = qemu_mallocz(sizeof(CharDriverState));
                   1536:     s = qemu_mallocz(sizeof(WinCharState));
                   1537:     chr->opaque = s;
                   1538:     chr->chr_write = win_chr_write;
                   1539:     chr->chr_close = win_chr_close;
                   1540: 
                   1541:     if (win_chr_init(chr, filename) < 0) {
                   1542:         free(s);
                   1543:         free(chr);
                   1544:         return NULL;
                   1545:     }
                   1546:     qemu_chr_reset(chr);
                   1547:     return chr;
                   1548: }
                   1549: 
                   1550: static int win_chr_pipe_poll(void *opaque)
                   1551: {
                   1552:     CharDriverState *chr = opaque;
                   1553:     WinCharState *s = chr->opaque;
                   1554:     DWORD size;
                   1555: 
                   1556:     PeekNamedPipe(s->hcom, NULL, 0, NULL, &size, NULL);
                   1557:     if (size > 0) {
                   1558:         s->len = size;
                   1559:         win_chr_read_poll(chr);
                   1560:         win_chr_read(chr);
                   1561:         return 1;
                   1562:     }
                   1563:     return 0;
                   1564: }
                   1565: 
                   1566: static int win_chr_pipe_init(CharDriverState *chr, const char *filename)
                   1567: {
                   1568:     WinCharState *s = chr->opaque;
                   1569:     OVERLAPPED ov;
                   1570:     int ret;
                   1571:     DWORD size;
                   1572:     char openname[256];
                   1573: 
                   1574:     s->fpipe = TRUE;
                   1575: 
                   1576:     s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
                   1577:     if (!s->hsend) {
                   1578:         fprintf(stderr, "Failed CreateEvent\n");
                   1579:         goto fail;
                   1580:     }
                   1581:     s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
                   1582:     if (!s->hrecv) {
                   1583:         fprintf(stderr, "Failed CreateEvent\n");
                   1584:         goto fail;
                   1585:     }
                   1586: 
                   1587:     snprintf(openname, sizeof(openname), "\\\\.\\pipe\\%s", filename);
                   1588:     s->hcom = CreateNamedPipe(openname, PIPE_ACCESS_DUPLEX | FILE_FLAG_OVERLAPPED,
                   1589:                               PIPE_TYPE_BYTE | PIPE_READMODE_BYTE |
                   1590:                               PIPE_WAIT,
                   1591:                               MAXCONNECT, NSENDBUF, NRECVBUF, NTIMEOUT, NULL);
                   1592:     if (s->hcom == INVALID_HANDLE_VALUE) {
                   1593:         fprintf(stderr, "Failed CreateNamedPipe (%lu)\n", GetLastError());
                   1594:         s->hcom = NULL;
                   1595:         goto fail;
                   1596:     }
                   1597: 
                   1598:     ZeroMemory(&ov, sizeof(ov));
                   1599:     ov.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
                   1600:     ret = ConnectNamedPipe(s->hcom, &ov);
                   1601:     if (ret) {
                   1602:         fprintf(stderr, "Failed ConnectNamedPipe\n");
                   1603:         goto fail;
                   1604:     }
                   1605: 
                   1606:     ret = GetOverlappedResult(s->hcom, &ov, &size, TRUE);
                   1607:     if (!ret) {
                   1608:         fprintf(stderr, "Failed GetOverlappedResult\n");
                   1609:         if (ov.hEvent) {
                   1610:             CloseHandle(ov.hEvent);
                   1611:             ov.hEvent = NULL;
                   1612:         }
                   1613:         goto fail;
                   1614:     }
                   1615: 
                   1616:     if (ov.hEvent) {
                   1617:         CloseHandle(ov.hEvent);
                   1618:         ov.hEvent = NULL;
                   1619:     }
                   1620:     qemu_add_polling_cb(win_chr_pipe_poll, chr);
                   1621:     return 0;
                   1622: 
                   1623:  fail:
                   1624:     win_chr_close(chr);
                   1625:     return -1;
                   1626: }
                   1627: 
                   1628: 
                   1629: static CharDriverState *qemu_chr_open_win_pipe(const char *filename)
                   1630: {
                   1631:     CharDriverState *chr;
                   1632:     WinCharState *s;
                   1633: 
                   1634:     chr = qemu_mallocz(sizeof(CharDriverState));
                   1635:     s = qemu_mallocz(sizeof(WinCharState));
                   1636:     chr->opaque = s;
                   1637:     chr->chr_write = win_chr_write;
                   1638:     chr->chr_close = win_chr_close;
                   1639: 
                   1640:     if (win_chr_pipe_init(chr, filename) < 0) {
                   1641:         free(s);
                   1642:         free(chr);
                   1643:         return NULL;
                   1644:     }
                   1645:     qemu_chr_reset(chr);
                   1646:     return chr;
                   1647: }
                   1648: 
                   1649: static CharDriverState *qemu_chr_open_win_file(HANDLE fd_out)
                   1650: {
                   1651:     CharDriverState *chr;
                   1652:     WinCharState *s;
                   1653: 
                   1654:     chr = qemu_mallocz(sizeof(CharDriverState));
                   1655:     s = qemu_mallocz(sizeof(WinCharState));
                   1656:     s->hcom = fd_out;
                   1657:     chr->opaque = s;
                   1658:     chr->chr_write = win_chr_write;
                   1659:     qemu_chr_reset(chr);
                   1660:     return chr;
                   1661: }
                   1662: 
                   1663: static CharDriverState *qemu_chr_open_win_con(const char *filename)
                   1664: {
                   1665:     return qemu_chr_open_win_file(GetStdHandle(STD_OUTPUT_HANDLE));
                   1666: }
                   1667: 
                   1668: static CharDriverState *qemu_chr_open_win_file_out(const char *file_out)
                   1669: {
                   1670:     HANDLE fd_out;
                   1671: 
                   1672:     fd_out = CreateFile(file_out, GENERIC_WRITE, FILE_SHARE_READ, NULL,
                   1673:                         OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
                   1674:     if (fd_out == INVALID_HANDLE_VALUE)
                   1675:         return NULL;
                   1676: 
                   1677:     return qemu_chr_open_win_file(fd_out);
                   1678: }
                   1679: #endif /* !_WIN32 */
                   1680: 
                   1681: /***********************************************************/
                   1682: /* UDP Net console */
                   1683: 
                   1684: typedef struct {
                   1685:     int fd;
                   1686:     struct sockaddr_in daddr;
                   1687:     uint8_t buf[1024];
                   1688:     int bufcnt;
                   1689:     int bufptr;
                   1690:     int max_size;
                   1691: } NetCharDriver;
                   1692: 
                   1693: static int udp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
                   1694: {
                   1695:     NetCharDriver *s = chr->opaque;
                   1696: 
                   1697:     return sendto(s->fd, buf, len, 0,
                   1698:                   (struct sockaddr *)&s->daddr, sizeof(struct sockaddr_in));
                   1699: }
                   1700: 
                   1701: static int udp_chr_read_poll(void *opaque)
                   1702: {
                   1703:     CharDriverState *chr = opaque;
                   1704:     NetCharDriver *s = chr->opaque;
                   1705: 
                   1706:     s->max_size = qemu_chr_can_read(chr);
                   1707: 
                   1708:     /* If there were any stray characters in the queue process them
                   1709:      * first
                   1710:      */
                   1711:     while (s->max_size > 0 && s->bufptr < s->bufcnt) {
                   1712:         qemu_chr_read(chr, &s->buf[s->bufptr], 1);
                   1713:         s->bufptr++;
                   1714:         s->max_size = qemu_chr_can_read(chr);
                   1715:     }
                   1716:     return s->max_size;
                   1717: }
                   1718: 
                   1719: static void udp_chr_read(void *opaque)
                   1720: {
                   1721:     CharDriverState *chr = opaque;
                   1722:     NetCharDriver *s = chr->opaque;
                   1723: 
                   1724:     if (s->max_size == 0)
                   1725:         return;
                   1726:     s->bufcnt = recv(s->fd, s->buf, sizeof(s->buf), 0);
                   1727:     s->bufptr = s->bufcnt;
                   1728:     if (s->bufcnt <= 0)
                   1729:         return;
                   1730: 
                   1731:     s->bufptr = 0;
                   1732:     while (s->max_size > 0 && s->bufptr < s->bufcnt) {
                   1733:         qemu_chr_read(chr, &s->buf[s->bufptr], 1);
                   1734:         s->bufptr++;
                   1735:         s->max_size = qemu_chr_can_read(chr);
                   1736:     }
                   1737: }
                   1738: 
                   1739: static void udp_chr_update_read_handler(CharDriverState *chr)
                   1740: {
                   1741:     NetCharDriver *s = chr->opaque;
                   1742: 
                   1743:     if (s->fd >= 0) {
                   1744:         qemu_set_fd_handler2(s->fd, udp_chr_read_poll,
                   1745:                              udp_chr_read, NULL, chr);
                   1746:     }
                   1747: }
                   1748: 
                   1749: static CharDriverState *qemu_chr_open_udp(const char *def)
                   1750: {
                   1751:     CharDriverState *chr = NULL;
                   1752:     NetCharDriver *s = NULL;
                   1753:     int fd = -1;
                   1754:     struct sockaddr_in saddr;
                   1755: 
                   1756:     chr = qemu_mallocz(sizeof(CharDriverState));
                   1757:     s = qemu_mallocz(sizeof(NetCharDriver));
                   1758: 
                   1759:     fd = socket(PF_INET, SOCK_DGRAM, 0);
                   1760:     if (fd < 0) {
                   1761:         perror("socket(PF_INET, SOCK_DGRAM)");
                   1762:         goto return_err;
                   1763:     }
                   1764: 
                   1765:     if (parse_host_src_port(&s->daddr, &saddr, def) < 0) {
                   1766:         printf("Could not parse: %s\n", def);
                   1767:         goto return_err;
                   1768:     }
                   1769: 
                   1770:     if (bind(fd, (struct sockaddr *)&saddr, sizeof(saddr)) < 0)
                   1771:     {
                   1772:         perror("bind");
                   1773:         goto return_err;
                   1774:     }
                   1775: 
                   1776:     s->fd = fd;
                   1777:     s->bufcnt = 0;
                   1778:     s->bufptr = 0;
                   1779:     chr->opaque = s;
                   1780:     chr->chr_write = udp_chr_write;
                   1781:     chr->chr_update_read_handler = udp_chr_update_read_handler;
                   1782:     return chr;
                   1783: 
                   1784: return_err:
                   1785:     if (chr)
                   1786:         free(chr);
                   1787:     if (s)
                   1788:         free(s);
                   1789:     if (fd >= 0)
                   1790:         closesocket(fd);
                   1791:     return NULL;
                   1792: }
                   1793: 
                   1794: /***********************************************************/
                   1795: /* TCP Net console */
                   1796: 
                   1797: typedef struct {
                   1798:     int fd, listen_fd;
                   1799:     int connected;
                   1800:     int max_size;
                   1801:     int do_telnetopt;
                   1802:     int do_nodelay;
                   1803:     int is_unix;
                   1804: } TCPCharDriver;
                   1805: 
                   1806: static void tcp_chr_accept(void *opaque);
                   1807: 
                   1808: static int tcp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
                   1809: {
                   1810:     TCPCharDriver *s = chr->opaque;
                   1811:     if (s->connected) {
                   1812:         return send_all(s->fd, buf, len);
                   1813:     } else {
                   1814:         /* XXX: indicate an error ? */
                   1815:         return len;
                   1816:     }
                   1817: }
                   1818: 
                   1819: static int tcp_chr_read_poll(void *opaque)
                   1820: {
                   1821:     CharDriverState *chr = opaque;
                   1822:     TCPCharDriver *s = chr->opaque;
                   1823:     if (!s->connected)
                   1824:         return 0;
                   1825:     s->max_size = qemu_chr_can_read(chr);
                   1826:     return s->max_size;
                   1827: }
                   1828: 
                   1829: #define IAC 255
                   1830: #define IAC_BREAK 243
                   1831: static void tcp_chr_process_IAC_bytes(CharDriverState *chr,
                   1832:                                       TCPCharDriver *s,
                   1833:                                       uint8_t *buf, int *size)
                   1834: {
                   1835:     /* Handle any telnet client's basic IAC options to satisfy char by
                   1836:      * char mode with no echo.  All IAC options will be removed from
                   1837:      * the buf and the do_telnetopt variable will be used to track the
                   1838:      * state of the width of the IAC information.
                   1839:      *
                   1840:      * IAC commands come in sets of 3 bytes with the exception of the
                   1841:      * "IAC BREAK" command and the double IAC.
                   1842:      */
                   1843: 
                   1844:     int i;
                   1845:     int j = 0;
                   1846: 
                   1847:     for (i = 0; i < *size; i++) {
                   1848:         if (s->do_telnetopt > 1) {
                   1849:             if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
                   1850:                 /* Double IAC means send an IAC */
                   1851:                 if (j != i)
                   1852:                     buf[j] = buf[i];
                   1853:                 j++;
                   1854:                 s->do_telnetopt = 1;
                   1855:             } else {
                   1856:                 if ((unsigned char)buf[i] == IAC_BREAK && s->do_telnetopt == 2) {
                   1857:                     /* Handle IAC break commands by sending a serial break */
                   1858:                     qemu_chr_event(chr, CHR_EVENT_BREAK);
                   1859:                     s->do_telnetopt++;
                   1860:                 }
                   1861:                 s->do_telnetopt++;
                   1862:             }
                   1863:             if (s->do_telnetopt >= 4) {
                   1864:                 s->do_telnetopt = 1;
                   1865:             }
                   1866:         } else {
                   1867:             if ((unsigned char)buf[i] == IAC) {
                   1868:                 s->do_telnetopt = 2;
                   1869:             } else {
                   1870:                 if (j != i)
                   1871:                     buf[j] = buf[i];
                   1872:                 j++;
                   1873:             }
                   1874:         }
                   1875:     }
                   1876:     *size = j;
                   1877: }
                   1878: 
                   1879: static void tcp_chr_read(void *opaque)
                   1880: {
                   1881:     CharDriverState *chr = opaque;
                   1882:     TCPCharDriver *s = chr->opaque;
                   1883:     uint8_t buf[1024];
                   1884:     int len, size;
                   1885: 
                   1886:     if (!s->connected || s->max_size <= 0)
                   1887:         return;
                   1888:     len = sizeof(buf);
                   1889:     if (len > s->max_size)
                   1890:         len = s->max_size;
                   1891:     size = recv(s->fd, buf, len, 0);
                   1892:     if (size == 0) {
                   1893:         /* connection closed */
                   1894:         s->connected = 0;
                   1895:         if (s->listen_fd >= 0) {
                   1896:             qemu_set_fd_handler(s->listen_fd, tcp_chr_accept, NULL, chr);
                   1897:         }
                   1898:         qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
                   1899:         closesocket(s->fd);
                   1900:         s->fd = -1;
                   1901:     } else if (size > 0) {
                   1902:         if (s->do_telnetopt)
                   1903:             tcp_chr_process_IAC_bytes(chr, s, buf, &size);
                   1904:         if (size > 0)
                   1905:             qemu_chr_read(chr, buf, size);
                   1906:     }
                   1907: }
                   1908: 
                   1909: static void tcp_chr_connect(void *opaque)
                   1910: {
                   1911:     CharDriverState *chr = opaque;
                   1912:     TCPCharDriver *s = chr->opaque;
                   1913: 
                   1914:     s->connected = 1;
                   1915:     qemu_set_fd_handler2(s->fd, tcp_chr_read_poll,
                   1916:                          tcp_chr_read, NULL, chr);
                   1917:     qemu_chr_reset(chr);
                   1918: }
                   1919: 
                   1920: #define IACSET(x,a,b,c) x[0] = a; x[1] = b; x[2] = c;
                   1921: static void tcp_chr_telnet_init(int fd)
                   1922: {
                   1923:     char buf[3];
                   1924:     /* Send the telnet negotion to put telnet in binary, no echo, single char mode */
                   1925:     IACSET(buf, 0xff, 0xfb, 0x01);  /* IAC WILL ECHO */
                   1926:     send(fd, (char *)buf, 3, 0);
                   1927:     IACSET(buf, 0xff, 0xfb, 0x03);  /* IAC WILL Suppress go ahead */
                   1928:     send(fd, (char *)buf, 3, 0);
                   1929:     IACSET(buf, 0xff, 0xfb, 0x00);  /* IAC WILL Binary */
                   1930:     send(fd, (char *)buf, 3, 0);
                   1931:     IACSET(buf, 0xff, 0xfd, 0x00);  /* IAC DO Binary */
                   1932:     send(fd, (char *)buf, 3, 0);
                   1933: }
                   1934: 
                   1935: static void socket_set_nodelay(int fd)
                   1936: {
                   1937:     int val = 1;
                   1938:     setsockopt(fd, IPPROTO_TCP, TCP_NODELAY, (char *)&val, sizeof(val));
                   1939: }
                   1940: 
                   1941: static void tcp_chr_accept(void *opaque)
                   1942: {
                   1943:     CharDriverState *chr = opaque;
                   1944:     TCPCharDriver *s = chr->opaque;
                   1945:     struct sockaddr_in saddr;
                   1946: #ifndef _WIN32
                   1947:     struct sockaddr_un uaddr;
                   1948: #endif
                   1949:     struct sockaddr *addr;
                   1950:     socklen_t len;
                   1951:     int fd;
                   1952: 
                   1953:     for(;;) {
                   1954: #ifndef _WIN32
                   1955:        if (s->is_unix) {
                   1956:            len = sizeof(uaddr);
                   1957:            addr = (struct sockaddr *)&uaddr;
                   1958:        } else
                   1959: #endif
                   1960:        {
                   1961:            len = sizeof(saddr);
                   1962:            addr = (struct sockaddr *)&saddr;
                   1963:        }
                   1964:         fd = accept(s->listen_fd, addr, &len);
                   1965:         if (fd < 0 && errno != EINTR) {
                   1966:             return;
                   1967:         } else if (fd >= 0) {
                   1968:             if (s->do_telnetopt)
                   1969:                 tcp_chr_telnet_init(fd);
                   1970:             break;
                   1971:         }
                   1972:     }
                   1973:     socket_set_nonblock(fd);
                   1974:     if (s->do_nodelay)
                   1975:         socket_set_nodelay(fd);
                   1976:     s->fd = fd;
                   1977:     qemu_set_fd_handler(s->listen_fd, NULL, NULL, NULL);
                   1978:     tcp_chr_connect(chr);
                   1979: }
                   1980: 
                   1981: static void tcp_chr_close(CharDriverState *chr)
                   1982: {
                   1983:     TCPCharDriver *s = chr->opaque;
                   1984:     if (s->fd >= 0)
                   1985:         closesocket(s->fd);
                   1986:     if (s->listen_fd >= 0)
                   1987:         closesocket(s->listen_fd);
                   1988:     qemu_free(s);
                   1989: }
                   1990: 
                   1991: static CharDriverState *qemu_chr_open_tcp(const char *host_str,
                   1992:                                           int is_telnet,
                   1993:                                          int is_unix)
                   1994: {
                   1995:     CharDriverState *chr = NULL;
                   1996:     TCPCharDriver *s = NULL;
                   1997:     int fd = -1, offset = 0;
                   1998:     int is_listen = 0;
                   1999:     int is_waitconnect = 1;
                   2000:     int do_nodelay = 0;
                   2001:     const char *ptr;
                   2002: 
                   2003:     ptr = host_str;
                   2004:     while((ptr = strchr(ptr,','))) {
                   2005:         ptr++;
                   2006:         if (!strncmp(ptr,"server",6)) {
                   2007:             is_listen = 1;
                   2008:         } else if (!strncmp(ptr,"nowait",6)) {
                   2009:             is_waitconnect = 0;
                   2010:         } else if (!strncmp(ptr,"nodelay",6)) {
                   2011:             do_nodelay = 1;
                   2012:         } else if (!strncmp(ptr,"to=",3)) {
                   2013:             /* nothing, inet_listen() parses this one */;
                   2014:         } else if (!strncmp(ptr,"ipv4",4)) {
                   2015:             /* nothing, inet_connect() and inet_listen() parse this one */;
                   2016:         } else if (!strncmp(ptr,"ipv6",4)) {
                   2017:             /* nothing, inet_connect() and inet_listen() parse this one */;
                   2018:         } else {
                   2019:             printf("Unknown option: %s\n", ptr);
                   2020:             goto fail;
                   2021:         }
                   2022:     }
                   2023:     if (!is_listen)
                   2024:         is_waitconnect = 0;
                   2025: 
                   2026:     chr = qemu_mallocz(sizeof(CharDriverState));
                   2027:     s = qemu_mallocz(sizeof(TCPCharDriver));
                   2028: 
                   2029:     if (is_listen) {
                   2030:         chr->filename = qemu_malloc(256);
                   2031:         if (is_unix) {
                   2032:             pstrcpy(chr->filename, 256, "unix:");
                   2033:         } else if (is_telnet) {
                   2034:             pstrcpy(chr->filename, 256, "telnet:");
                   2035:         } else {
                   2036:             pstrcpy(chr->filename, 256, "tcp:");
                   2037:         }
                   2038:         offset = strlen(chr->filename);
                   2039:     }
                   2040:     if (is_unix) {
                   2041:         if (is_listen) {
                   2042:             fd = unix_listen(host_str, chr->filename + offset, 256 - offset);
                   2043:         } else {
                   2044:             fd = unix_connect(host_str);
                   2045:         }
                   2046:     } else {
                   2047:         if (is_listen) {
                   2048:             fd = inet_listen(host_str, chr->filename + offset, 256 - offset,
                   2049:                              SOCK_STREAM, 0);
                   2050:         } else {
                   2051:             fd = inet_connect(host_str, SOCK_STREAM);
                   2052:         }
                   2053:     }
                   2054:     if (fd < 0)
                   2055:         goto fail;
                   2056: 
                   2057:     if (!is_waitconnect)
                   2058:         socket_set_nonblock(fd);
                   2059: 
                   2060:     s->connected = 0;
                   2061:     s->fd = -1;
                   2062:     s->listen_fd = -1;
                   2063:     s->is_unix = is_unix;
                   2064:     s->do_nodelay = do_nodelay && !is_unix;
                   2065: 
                   2066:     chr->opaque = s;
                   2067:     chr->chr_write = tcp_chr_write;
                   2068:     chr->chr_close = tcp_chr_close;
                   2069: 
                   2070:     if (is_listen) {
                   2071:         s->listen_fd = fd;
                   2072:         qemu_set_fd_handler(s->listen_fd, tcp_chr_accept, NULL, chr);
                   2073:         if (is_telnet)
                   2074:             s->do_telnetopt = 1;
                   2075:     } else {
                   2076:         s->connected = 1;
                   2077:         s->fd = fd;
                   2078:         socket_set_nodelay(fd);
                   2079:         tcp_chr_connect(chr);
                   2080:     }
                   2081: 
                   2082:     if (is_listen && is_waitconnect) {
                   2083:         printf("QEMU waiting for connection on: %s\n",
                   2084:                chr->filename ? chr->filename : host_str);
                   2085:         tcp_chr_accept(chr);
                   2086:         socket_set_nonblock(s->listen_fd);
                   2087:     }
                   2088: 
                   2089:     return chr;
                   2090:  fail:
                   2091:     if (fd >= 0)
                   2092:         closesocket(fd);
                   2093:     qemu_free(s);
                   2094:     qemu_free(chr);
                   2095:     return NULL;
                   2096: }
                   2097: 
                   2098: CharDriverState *qemu_chr_open(const char *label, const char *filename, void (*init)(struct CharDriverState *s))
                   2099: {
                   2100:     const char *p;
                   2101:     CharDriverState *chr;
                   2102: 
                   2103:     if (!strcmp(filename, "vc")) {
                   2104:         chr = text_console_init(0);
                   2105:     } else
                   2106:     if (strstart(filename, "vc:", &p)) {
                   2107:         chr = text_console_init(p);
                   2108:     } else
                   2109:     if (!strcmp(filename, "null")) {
                   2110:         chr = qemu_chr_open_null();
                   2111:     } else
                   2112:     if (strstart(filename, "tcp:", &p)) {
                   2113:         chr = qemu_chr_open_tcp(p, 0, 0);
                   2114:     } else
                   2115:     if (strstart(filename, "telnet:", &p)) {
                   2116:         chr = qemu_chr_open_tcp(p, 1, 0);
                   2117:     } else
                   2118:     if (strstart(filename, "udp:", &p)) {
                   2119:         chr = qemu_chr_open_udp(p);
                   2120:     } else
                   2121:     if (strstart(filename, "mon:", &p)) {
                   2122:         chr = qemu_chr_open(label, p, NULL);
                   2123:         if (chr) {
                   2124:             chr = qemu_chr_open_mux(chr);
                   2125:             monitor_init(chr, !nographic);
                   2126:         } else {
                   2127:             printf("Unable to open driver: %s\n", p);
                   2128:         }
                   2129:     } else if (!strcmp(filename, "msmouse")) {
                   2130:         chr = qemu_chr_open_msmouse();
                   2131:     } else
                   2132: #ifndef _WIN32
                   2133:     if (strstart(filename, "unix:", &p)) {
                   2134:        chr = qemu_chr_open_tcp(p, 0, 1);
                   2135:     } else if (strstart(filename, "file:", &p)) {
                   2136:         chr = qemu_chr_open_file_out(p);
                   2137:     } else if (strstart(filename, "pipe:", &p)) {
                   2138:         chr = qemu_chr_open_pipe(p);
                   2139:     } else if (!strcmp(filename, "pty")) {
                   2140:         chr = qemu_chr_open_pty();
                   2141:     } else if (!strcmp(filename, "stdio")) {
                   2142:         chr = qemu_chr_open_stdio();
                   2143:     } else
                   2144: #if defined(__linux__)
                   2145:     if (strstart(filename, "/dev/parport", NULL)) {
                   2146:         chr = qemu_chr_open_pp(filename);
                   2147:     } else
                   2148: #elif defined(__FreeBSD__)
                   2149:     if (strstart(filename, "/dev/ppi", NULL)) {
                   2150:         chr = qemu_chr_open_pp(filename);
                   2151:     } else
                   2152: #endif
                   2153: #if defined(__linux__) || defined(__sun__) || defined(__FreeBSD__) \
                   2154:     || defined(__NetBSD__) || defined(__OpenBSD__)
                   2155:     if (strstart(filename, "/dev/", NULL)) {
                   2156:         chr = qemu_chr_open_tty(filename);
                   2157:     } else
                   2158: #endif
                   2159: #else /* !_WIN32 */
                   2160:     if (strstart(filename, "COM", NULL)) {
                   2161:         chr = qemu_chr_open_win(filename);
                   2162:     } else
                   2163:     if (strstart(filename, "pipe:", &p)) {
                   2164:         chr = qemu_chr_open_win_pipe(p);
                   2165:     } else
                   2166:     if (strstart(filename, "con:", NULL)) {
                   2167:         chr = qemu_chr_open_win_con(filename);
                   2168:     } else
                   2169:     if (strstart(filename, "file:", &p)) {
                   2170:         chr = qemu_chr_open_win_file_out(p);
                   2171:     } else
                   2172: #endif
                   2173: #ifdef CONFIG_BRLAPI
                   2174:     if (!strcmp(filename, "braille")) {
                   2175:         chr = chr_baum_init();
                   2176:     } else
                   2177: #endif
                   2178:     {
                   2179:         chr = NULL;
                   2180:     }
                   2181: 
                   2182:     if (chr) {
                   2183:         if (!chr->filename)
                   2184:             chr->filename = qemu_strdup(filename);
                   2185:         chr->init = init;
                   2186:         chr->label = qemu_strdup(label);
                   2187:         TAILQ_INSERT_TAIL(&chardevs, chr, next);
                   2188:     }
                   2189:     return chr;
                   2190: }
                   2191: 
                   2192: void qemu_chr_close(CharDriverState *chr)
                   2193: {
                   2194:     TAILQ_REMOVE(&chardevs, chr, next);
                   2195:     if (chr->chr_close)
                   2196:         chr->chr_close(chr);
                   2197:     qemu_free(chr->filename);
                   2198:     qemu_free(chr->label);
                   2199:     qemu_free(chr);
                   2200: }
                   2201: 
                   2202: void qemu_chr_info(void)
                   2203: {
                   2204:     CharDriverState *chr;
                   2205: 
                   2206:     TAILQ_FOREACH(chr, &chardevs, next) {
                   2207:         term_printf("%s: filename=%s\n", chr->label, chr->filename);
                   2208:     }
                   2209: }

unix.superglobalmegacorp.com

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.