#include <sys/types.h>
#include <sys/hypervisor.h>
#include <sys/machparam.h>
#include <xen/public/io/console.h>
#include <sys/mach_mmu.h>
shared_info_t *HYPERVISOR_shared_info;
void *HYPERVISOR_console_page;
#if defined(_BOOT)
#include "dboot/dboot_printf.h"
char big_empty[MMU_PAGESIZE * 3];
#endif
unsigned short video_fb_buf[32 * 1024 + MMU_PAGESIZE];
unsigned char kb_status_buf[MMU_PAGESIZE * 2];
unsigned short *video_fb = NULL;
unsigned char *kb_status = NULL;
static volatile struct xencons_interface *cons_ifp;
#define XR_FULL(r) ((r)->xr_in_cnt - (r)->xr_out_cnt == XR_SIZE)
#define XR_EMPTY(r) ((r)->xr_in_cnt == (r)->xr_out_cnt)
#define PTE_BITS (PT_VALID | PT_WRITABLE)
#define PTE_DEV_BITS (PT_VALID | PT_WRITABLE | PT_NOCACHE | PT_NOCONSIST | \
PT_FOREIGN)
void
bcons_init_xen(char *cmdline)
{
#ifdef _BOOT
int i = 0;
uintptr_t vaddr;
vaddr = (uintptr_t)&big_empty;
vaddr = (vaddr + MMU_PAGEOFFSET) & MMU_PAGEMASK;
HYPERVISOR_shared_info = (shared_info_t *)vaddr;
(void) HYPERVISOR_update_va_mapping(vaddr,
xen_info->shared_info | PTE_BITS, UVMF_INVLPG | UVMF_LOCAL);
if (!DOMAIN_IS_INITDOMAIN(xen_info)) {
(void) HYPERVISOR_update_va_mapping(vaddr + MMU_PAGESIZE,
mmu_ptob((x86pte_t)xen_info->console.domU.mfn) | PTE_BITS,
UVMF_INVLPG | UVMF_LOCAL);
} else {
vaddr = (uintptr_t)&video_fb_buf;
vaddr = (vaddr + MMU_PAGEOFFSET) & MMU_PAGEMASK;
for (i = 0; i < 32 * 1024; i += MMU_PAGESIZE)
(void) HYPERVISOR_update_va_mapping(vaddr + i,
0xb8000 + i | PTE_DEV_BITS,
UVMF_INVLPG | UVMF_LOCAL);
video_fb = (unsigned short *)vaddr;
vaddr = (uintptr_t)&kb_status_buf;
vaddr = (vaddr + MMU_PAGEOFFSET) & MMU_PAGEMASK;
(void) HYPERVISOR_update_va_mapping(vaddr, 0x0 | PTE_DEV_BITS,
UVMF_INVLPG | UVMF_LOCAL);
kb_status = (unsigned char *)vaddr;
}
#endif
if (!DOMAIN_IS_INITDOMAIN(xen_info)) {
HYPERVISOR_console_page =
(void *)((uintptr_t)HYPERVISOR_shared_info + MMU_PAGESIZE);
} else {
HYPERVISOR_console_page = NULL;
}
}
void
bcons_putchar_xen(int c)
{
evtchn_send_t send;
char buffer = (char)c;
if (DOMAIN_IS_INITDOMAIN(xen_info)) {
(void) HYPERVISOR_console_io(CONSOLEIO_write, 1, &buffer);
return;
}
cons_ifp = (volatile struct xencons_interface *)HYPERVISOR_console_page;
if (c == '\n')
bcons_putchar_xen('\r');
while (cons_ifp->out_prod - cons_ifp->out_cons >=
sizeof (cons_ifp->out))
(void) HYPERVISOR_yield();
cons_ifp->out[MASK_XENCONS_IDX(cons_ifp->out_prod, cons_ifp->out)] =
(char)c;
++cons_ifp->out_prod;
send.port = xen_info->console.domU.evtchn;
(void) HYPERVISOR_event_channel_op(EVTCHNOP_send, &send);
}
static uint_t have_char = 0;
static char buffered;
int
bcons_ischar_xen(void)
{
if (DOMAIN_IS_INITDOMAIN(xen_info)) {
if (have_char)
return (1);
if (HYPERVISOR_console_io(CONSOLEIO_read, 1, &buffered) > 0)
return (have_char = 1);
return (0);
}
cons_ifp = (volatile struct xencons_interface *)HYPERVISOR_console_page;
if (cons_ifp->in_cons == cons_ifp->in_prod)
return (0);
return (1);
}
int
bcons_getchar_xen(void)
{
evtchn_send_t send;
char c;
if (DOMAIN_IS_INITDOMAIN(xen_info)) {
while (have_char == 0)
(void) bcons_ischar_xen();
have_char = 0;
return (buffered);
}
cons_ifp = (volatile struct xencons_interface *)HYPERVISOR_console_page;
while (cons_ifp->in_cons == cons_ifp->in_prod)
(void) HYPERVISOR_yield();
c = cons_ifp->in[MASK_XENCONS_IDX(cons_ifp->in_cons, cons_ifp->in)];
++cons_ifp->in_cons;
send.port = xen_info->console.domU.evtchn;
(void) HYPERVISOR_event_channel_op(EVTCHNOP_send, &send);
return (c);
}