hw/xen_console.c

   1 /*
   2  *  Copyright (C) International Business Machines  Corp., 2005
   3  *  Author(s): Anthony Liguori <aliguori@us.ibm.com>
   4  *
   5  *  Copyright (C) Red Hat 2007
   6  *
   7  *  Xen Console
   8  *
   9  *  This program is free software; you can redistribute it and/or modify
  10  *  it under the terms of the GNU General Public License as published by
  11  *  the Free Software Foundation; under version 2 of the License.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License along
  19  *  with this program; if not, see <http://www.gnu.org/licenses/>.
  20  */
  21
  22 #include <stdlib.h>
  23 #include <errno.h>
  24 #include <string.h>
  25 #include <sys/select.h>
  26 #include <fcntl.h>
  27 #include <unistd.h>
  28 #include <termios.h>
  29 #include <stdarg.h>
  30 #include <sys/mman.h>
  31 #include <xs.h>
  32 #include <xen/io/console.h>
  33 #include <xenctrl.h>
  34
  35 #include "hw.h"
  36 #include "qemu-char.h"
  37 #include "xen_backend.h"
  38
  39 struct buffer {
  40     uint8_t *data;
  41     size_t consumed;
  42     size_t size;
  43     size_t capacity;
  44     size_t max_capacity;
  45 };
  46
  47 struct XenConsole {
  48     struct XenDevice  xendev;  /* must be first */
  49     struct buffer     buffer;
  50     char              console[XEN_BUFSIZE];
  51     int               ring_ref;
  52     void              *sring;
  53     CharDriverState   *chr;
  54     int               backlog;
  55 };
  56
  57 static void buffer_append(struct XenConsole *con)
  58 {
  59     struct buffer *buffer = &con->buffer;
  60     XENCONS_RING_IDX cons, prod, size;
  61     struct xencons_interface *intf = con->sring;
  62
  63     cons = intf->out_cons;
  64     prod = intf->out_prod;
  65     xen_mb();
  66
  67     size = prod - cons;
  68     if ((size == 0) || (size > sizeof(intf->out)))
  69         return;
  70
  71     if ((buffer->capacity - buffer->size) < size) {
  72         buffer->capacity += (size + 1024);
  73         buffer->data = qemu_realloc(buffer->data, buffer->capacity);
  74     }
  75
  76     while (cons != prod)
  77         buffer->data[buffer->size++] = intf->out[
  78             MASK_XENCONS_IDX(cons++, intf->out)];
  79
  80     xen_mb();
  81     intf->out_cons = cons;
  82     xen_be_send_notify(&con->xendev);
  83
  84     if (buffer->max_capacity &&
  85         buffer->size > buffer->max_capacity) {
  86         /* Discard the middle of the data. */
  87
  88         size_t over = buffer->size - buffer->max_capacity;
  89         uint8_t *maxpos = buffer->data + buffer->max_capacity;
  90
  91         memmove(maxpos - over, maxpos, over);
  92         buffer->data = qemu_realloc(buffer->data, buffer->max_capacity);
  93         buffer->size = buffer->capacity = buffer->max_capacity;
  94
  95         if (buffer->consumed > buffer->max_capacity - over)
  96             buffer->consumed = buffer->max_capacity - over;
  97     }
  98 }
  99
 100 static void buffer_advance(struct buffer *buffer, size_t len)
 101 {
 102     buffer->consumed += len;
 103     if (buffer->consumed == buffer->size) {
 104         buffer->consumed = 0;
 105         buffer->size = 0;
 106     }
 107 }
 108
 109 static int ring_free_bytes(struct XenConsole *con)
 110 {
 111     struct xencons_interface *intf = con->sring;
 112     XENCONS_RING_IDX cons, prod, space;
 113
 114     cons = intf->in_cons;
 115     prod = intf->in_prod;
 116     xen_mb();
 117
 118     space = prod - cons;
 119     if (space > sizeof(intf->in))
 120         return 0; /* ring is screwed: ignore it */
 121
 122     return (sizeof(intf->in) - space);
 123 }
 124
 125 static int xencons_can_receive(void *opaque)
 126 {
 127     struct XenConsole *con = opaque;
 128     return ring_free_bytes(con);
 129 }
 130
 131 static void xencons_receive(void *opaque)
 132 {
 133     struct XenConsole *con = opaque;
 134     struct xencons_interface *intf = con->sring;
 135     XENCONS_RING_IDX prod;
 136     uint8_t buf[1024];
 137     int i, max, len;
 138
 139     max = ring_free_bytes(con);
 140     max = MIN(max, sizeof(buf));
 141     len = qemu_chr_fe_read(con->chr, buf, max);
 142
 143     prod = intf->in_prod;
 144     for (i = 0; i < len; i++) {
 145         intf->in[MASK_XENCONS_IDX(prod++, intf->in)] =
 146             buf[i];
 147     }
 148     xen_wmb();
 149     intf->in_prod = prod;
 150     xen_be_send_notify(&con->xendev);
 151 }
 152
 153 static void xencons_update_handlers(struct XenConsole *con)
 154 {
 155     if (xencons_can_receive(con) > 0) {
 156         qemu_chr_fe_set_handlers(con->chr, xencons_receive,
 157                                  NULL, NULL, con);
 158     } else {
 159         qemu_chr_fe_set_handlers(con->chr, NULL, NULL, NULL, con);
 160     }
 161 }
 162
 163 static void xencons_send(struct XenConsole *con)
 164 {
 165     ssize_t len, size;
 166
 167     size = con->buffer.size - con->buffer.consumed;
 168     if (con->chr)
 169         len = qemu_chr_fe_write(con->chr, con->buffer.data + con->buffer.consumed,
 170                              size);
 171     else
 172         len = size;
 173     if (len < 1) {
 174         if (!con->backlog) {
 175             con->backlog = 1;
 176             xen_be_printf(&con->xendev, 1, "backlog piling up, nobody listening?\n");
 177         }
 178     } else {
 179         buffer_advance(&con->buffer, len);
 180         if (con->backlog && len == size) {
 181             con->backlog = 0;
 182             xen_be_printf(&con->xendev, 1, "backlog is gone\n");
 183         }
 184     }
 185 }
 186
 187 /* -------------------------------------------------------------------- */
 188
 189 static int con_init(struct XenDevice *xendev)
 190 {
 191     struct XenConsole *con = container_of(xendev, struct XenConsole, xendev);
 192     char *type, *dom, label[32];
 193     int ret = 0;
 194     const char *output;
 195
 196     /* setup */
 197     dom = xs_get_domain_path(xenstore, con->xendev.dom);
 198     snprintf(con->console, sizeof(con->console), "%s/console", dom);
 199     free(dom);
 200
 201     type = xenstore_read_str(con->console, "type");
 202     if (!type || strcmp(type, "ioemu") != 0) {
 203         xen_be_printf(xendev, 1, "not for me (type=%s)\n", type);
 204         ret = -1;
 205         goto out;
 206     }
 207
 208     output = xenstore_read_str(con->console, "output");
 209
 210     /* no Xen override, use qemu output device */
 211     if (output == NULL) {
 212         con->chr = serial_hds[con->xendev.dev];
 213     } else {
 214         snprintf(label, sizeof(label), "xencons%d", con->xendev.dev);
 215         con->chr = qemu_chr_new(label, output, NULL);
 216     }
 217
 218     xenstore_store_pv_console_info(con->xendev.dev, con->chr);
 219
 220 out:
 221     qemu_free(type);
 222     return ret;
 223 }
 224
 225 static int con_connect(struct XenDevice *xendev)
 226 {
 227     struct XenConsole *con = container_of(xendev, struct XenConsole, xendev);
 228     int limit;
 229
 230     if (xenstore_read_int(con->console, "ring-ref", &con->ring_ref) == -1)
 231         return -1;
 232     if (xenstore_read_int(con->console, "port", &con->xendev.remote_port) == -1)
 233         return -1;
 234     if (xenstore_read_int(con->console, "limit", &limit) == 0)
 235         con->buffer.max_capacity = limit;
 236
 237     con->sring = xc_map_foreign_range(xen_xc, con->xendev.dom,
 238                                       XC_PAGE_SIZE,
 239                                       PROT_READ|PROT_WRITE,
 240                                       con->ring_ref);
 241     if (!con->sring)
 242         return -1;
 243
 244     xen_be_bind_evtchn(&con->xendev);
 245     if (con->chr) {
 246         qemu_chr_fe_open(con->chr);
 247         xencons_update_handlers(con);
 248     }
 249
 250     xen_be_printf(xendev, 1, "ring mfn %d, remote port %d, local port %d, limit %zd\n",
 251                   con->ring_ref,
 252                   con->xendev.remote_port,
 253                   con->xendev.local_port,
 254                   con->buffer.max_capacity);
 255     return 0;
 256 }
 257
 258 static void con_disconnect(struct XenDevice *xendev)
 259 {
 260     struct XenConsole *con = container_of(xendev, struct XenConsole, xendev);
 261
 262     if (con->chr) {
 263         qemu_chr_fe_set_handlers(con->chr, NULL, NULL, NULL, NULL);
 264         qemu_chr_fe_close(con->chr);
 265     }
 266     xen_be_unbind_evtchn(&con->xendev);
 267
 268     if (con->sring) {
 269         munmap(con->sring, XC_PAGE_SIZE);
 270         con->sring = NULL;
 271     }
 272 }
 273
 274 static void con_event(struct XenDevice *xendev)
 275 {
 276     struct XenConsole *con = container_of(xendev, struct XenConsole, xendev);
 277
 278     buffer_append(con);
 279     if (con->buffer.size - con->buffer.consumed)
 280         xencons_send(con);
 281     xencons_update_handlers(con);
 282 }
 283
 284 /* -------------------------------------------------------------------- */
 285
 286 struct XenDevOps xen_console_ops = {
 287     .size       = sizeof(struct XenConsole),
 288     .flags      = DEVOPS_FLAG_IGNORE_STATE,
 289     .init       = con_init,
 290     .connect    = con_connect,
 291     .event      = con_event,
 292     .disconnect = con_disconnect,
 293 };