#include __FBSDID("$FreeBSD$"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define console_evtchn console.domU.evtchn xen_intr_handle_t console_handle; extern struct mtx cn_mtx; extern device_t xencons_dev; extern bool cnsl_evt_reg; #define DOM0_BUFFER_SIZE 16 static inline struct xencons_interface * xencons_interface(void) { return (struct xencons_interface *)console_page; } int xencons_has_input(void) { struct xencons_interface *intf; if (xen_initial_domain()) { /* * Since the Dom0 console works with hypercalls * there's no way to know if there's input unless * we actually try to retrieve it, so always return * like there's pending data. Then if the hypercall * returns no input, we can handle it without problems * in xencons_handle_input(). */ return 1; } intf = xencons_interface(); return (intf->in_cons != intf->in_prod); } int xencons_ring_send(const char *data, unsigned len) { struct xencons_interface *intf; XENCONS_RING_IDX cons, prod; int sent; struct evtchn_send send = { .port = HYPERVISOR_start_info->console_evtchn }; intf = xencons_interface(); cons = intf->out_cons; prod = intf->out_prod; sent = 0; mb(); KASSERT((prod - cons) <= sizeof(intf->out), ("console send ring inconsistent")); while ((sent < len) && ((prod - cons) < sizeof(intf->out))) intf->out[MASK_XENCONS_IDX(prod++, intf->out)] = data[sent++]; wmb(); intf->out_prod = prod; if (cnsl_evt_reg) xen_intr_signal(console_handle); else HYPERVISOR_event_channel_op(EVTCHNOP_send, &send); return sent; } static xencons_receiver_func *xencons_receiver; void xencons_handle_input(void *unused) { struct xencons_interface *intf; XENCONS_RING_IDX cons, prod; CN_LOCK(cn_mtx); if (xen_initial_domain()) { static char rbuf[DOM0_BUFFER_SIZE]; int l; while ((l = HYPERVISOR_console_io(CONSOLEIO_read, DOM0_BUFFER_SIZE, rbuf)) > 0) xencons_rx(rbuf, l); CN_UNLOCK(cn_mtx); return; } intf = xencons_interface(); cons = intf->in_cons; prod = intf->in_prod; CN_UNLOCK(cn_mtx); /* XXX needs locking */ while (cons != prod) { xencons_rx(intf->in + MASK_XENCONS_IDX(cons, intf->in), 1); cons++; } mb(); intf->in_cons = cons; CN_LOCK(cn_mtx); xen_intr_signal(console_handle); xencons_tx(); CN_UNLOCK(cn_mtx); } void xencons_ring_register_receiver(xencons_receiver_func *f) { xencons_receiver = f; } int xencons_ring_init(void) { int err; if (HYPERVISOR_start_info->console_evtchn == 0) return 0; err = xen_intr_bind_local_port(xencons_dev, HYPERVISOR_start_info->console_evtchn, NULL, xencons_handle_input, NULL, INTR_TYPE_MISC | INTR_MPSAFE, &console_handle); if (err) { return err; } return 0; } extern void xencons_suspend(void); extern void xencons_resume(void); void xencons_suspend(void) { if (HYPERVISOR_start_info->console_evtchn == 0) return; xen_intr_unbind(&console_handle); } void xencons_resume(void) { (void)xencons_ring_init(); } /* * Local variables: * mode: C * c-set-style: "BSD" * c-basic-offset: 8 * tab-width: 4 * indent-tabs-mode: t * End: */