2 * Copyright (C) International Business Machines Corp., 2005
3 * Author(s): Anthony Liguori <aliguori@us.ibm.com>
5 * Copyright (C) Red Hat 2007
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.
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.
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/>.
22 #include "qemu/osdep.h"
23 #include <sys/select.h>
28 #include "sysemu/char.h"
29 #include "hw/xen/xen_backend.h"
31 #include <xen/io/console.h>
42 struct XenDevice xendev
; /* must be first */
44 char console
[XEN_BUFSIZE
];
51 static void buffer_append(struct XenConsole
*con
)
53 struct buffer
*buffer
= &con
->buffer
;
54 XENCONS_RING_IDX cons
, prod
, size
;
55 struct xencons_interface
*intf
= con
->sring
;
57 cons
= intf
->out_cons
;
58 prod
= intf
->out_prod
;
62 if ((size
== 0) || (size
> sizeof(intf
->out
)))
65 if ((buffer
->capacity
- buffer
->size
) < size
) {
66 buffer
->capacity
+= (size
+ 1024);
67 buffer
->data
= g_realloc(buffer
->data
, buffer
->capacity
);
71 buffer
->data
[buffer
->size
++] = intf
->out
[
72 MASK_XENCONS_IDX(cons
++, intf
->out
)];
75 intf
->out_cons
= cons
;
76 xen_be_send_notify(&con
->xendev
);
78 if (buffer
->max_capacity
&&
79 buffer
->size
> buffer
->max_capacity
) {
80 /* Discard the middle of the data. */
82 size_t over
= buffer
->size
- buffer
->max_capacity
;
83 uint8_t *maxpos
= buffer
->data
+ buffer
->max_capacity
;
85 memmove(maxpos
- over
, maxpos
, over
);
86 buffer
->data
= g_realloc(buffer
->data
, buffer
->max_capacity
);
87 buffer
->size
= buffer
->capacity
= buffer
->max_capacity
;
89 if (buffer
->consumed
> buffer
->max_capacity
- over
)
90 buffer
->consumed
= buffer
->max_capacity
- over
;
94 static void buffer_advance(struct buffer
*buffer
, size_t len
)
96 buffer
->consumed
+= len
;
97 if (buffer
->consumed
== buffer
->size
) {
103 static int ring_free_bytes(struct XenConsole
*con
)
105 struct xencons_interface
*intf
= con
->sring
;
106 XENCONS_RING_IDX cons
, prod
, space
;
108 cons
= intf
->in_cons
;
109 prod
= intf
->in_prod
;
113 if (space
> sizeof(intf
->in
))
114 return 0; /* ring is screwed: ignore it */
116 return (sizeof(intf
->in
) - space
);
119 static int xencons_can_receive(void *opaque
)
121 struct XenConsole
*con
= opaque
;
122 return ring_free_bytes(con
);
125 static void xencons_receive(void *opaque
, const uint8_t *buf
, int len
)
127 struct XenConsole
*con
= opaque
;
128 struct xencons_interface
*intf
= con
->sring
;
129 XENCONS_RING_IDX prod
;
132 max
= ring_free_bytes(con
);
133 /* The can_receive() func limits this, but check again anyway */
137 prod
= intf
->in_prod
;
138 for (i
= 0; i
< len
; i
++) {
139 intf
->in
[MASK_XENCONS_IDX(prod
++, intf
->in
)] =
143 intf
->in_prod
= prod
;
144 xen_be_send_notify(&con
->xendev
);
147 static void xencons_send(struct XenConsole
*con
)
151 size
= con
->buffer
.size
- con
->buffer
.consumed
;
153 len
= qemu_chr_fe_write(con
->chr
, con
->buffer
.data
+ con
->buffer
.consumed
,
160 xen_be_printf(&con
->xendev
, 1, "backlog piling up, nobody listening?\n");
163 buffer_advance(&con
->buffer
, len
);
164 if (con
->backlog
&& len
== size
) {
166 xen_be_printf(&con
->xendev
, 1, "backlog is gone\n");
171 /* -------------------------------------------------------------------- */
173 static int con_init(struct XenDevice
*xendev
)
175 struct XenConsole
*con
= container_of(xendev
, struct XenConsole
, xendev
);
176 char *type
, *dom
, label
[32];
181 dom
= xs_get_domain_path(xenstore
, con
->xendev
.dom
);
183 snprintf(con
->console
, sizeof(con
->console
), "%s/console", dom
);
185 snprintf(con
->console
, sizeof(con
->console
), "%s/device/console/%d", dom
, xendev
->dev
);
189 type
= xenstore_read_str(con
->console
, "type");
190 if (!type
|| strcmp(type
, "ioemu") != 0) {
191 xen_be_printf(xendev
, 1, "not for me (type=%s)\n", type
);
196 output
= xenstore_read_str(con
->console
, "output");
198 /* no Xen override, use qemu output device */
199 if (output
== NULL
) {
200 con
->chr
= serial_hds
[con
->xendev
.dev
];
202 snprintf(label
, sizeof(label
), "xencons%d", con
->xendev
.dev
);
203 con
->chr
= qemu_chr_new(label
, output
, NULL
);
206 xenstore_store_pv_console_info(con
->xendev
.dev
, con
->chr
);
213 static int con_initialise(struct XenDevice
*xendev
)
215 struct XenConsole
*con
= container_of(xendev
, struct XenConsole
, xendev
);
218 if (xenstore_read_int(con
->console
, "ring-ref", &con
->ring_ref
) == -1)
220 if (xenstore_read_int(con
->console
, "port", &con
->xendev
.remote_port
) == -1)
222 if (xenstore_read_int(con
->console
, "limit", &limit
) == 0)
223 con
->buffer
.max_capacity
= limit
;
226 xen_pfn_t mfn
= con
->ring_ref
;
227 con
->sring
= xenforeignmemory_map(xen_fmem
, con
->xendev
.dom
,
228 PROT_READ
|PROT_WRITE
,
231 con
->sring
= xengnttab_map_grant_ref(xendev
->gnttabdev
, con
->xendev
.dom
,
233 PROT_READ
|PROT_WRITE
);
238 xen_be_bind_evtchn(&con
->xendev
);
240 if (qemu_chr_fe_claim(con
->chr
) == 0) {
241 qemu_chr_add_handlers(con
->chr
, xencons_can_receive
,
242 xencons_receive
, NULL
, con
);
244 xen_be_printf(xendev
, 0,
245 "xen_console_init error chardev %s already used\n",
251 xen_be_printf(xendev
, 1, "ring mfn %d, remote port %d, local port %d, limit %zd\n",
253 con
->xendev
.remote_port
,
254 con
->xendev
.local_port
,
255 con
->buffer
.max_capacity
);
259 static void con_disconnect(struct XenDevice
*xendev
)
261 struct XenConsole
*con
= container_of(xendev
, struct XenConsole
, xendev
);
264 qemu_chr_add_handlers(con
->chr
, NULL
, NULL
, NULL
, NULL
);
265 qemu_chr_fe_release(con
->chr
);
267 xen_be_unbind_evtchn(&con
->xendev
);
271 xenforeignmemory_unmap(xen_fmem
, con
->sring
, 1);
273 xengnttab_unmap(xendev
->gnttabdev
, con
->sring
, 1);
279 static void con_event(struct XenDevice
*xendev
)
281 struct XenConsole
*con
= container_of(xendev
, struct XenConsole
, xendev
);
284 if (con
->buffer
.size
- con
->buffer
.consumed
)
288 /* -------------------------------------------------------------------- */
290 struct XenDevOps xen_console_ops
= {
291 .size
= sizeof(struct XenConsole
),
292 .flags
= DEVOPS_FLAG_IGNORE_STATE
|DEVOPS_FLAG_NEED_GNTDEV
,
294 .initialise
= con_initialise
,
296 .disconnect
= con_disconnect
,