static void putchar_console_ring(int c)
{
ASSERT(spin_is_locked(&console_lock));
conring[CONRING_IDX_MASK(conringp++)] = c;
if ( (uint32_t)(conringp - conringc) > conring_size )
conringc = conringp - conring_size;
}
static void conring_puts(const char *str)
{
char c;
ASSERT(spin_is_locked(&console_lock));
while ( (c = *str++) != '\0' )
conring[CONRING_IDX_MASK(conringp++)] = c;
if ( (uint32_t)(conringp - conringc) > conring_size )
conringc = conringp - conring_size;
}
long read_console_ring(struct xen_sysctl_readconsole *op)
{
XEN_GUEST_HANDLE_PARAM(char) str;
uint32_t idx, len, max, sofar, c;
str = guest_handle_cast(op->buffer, char),
max = op->count;
sofar = 0;
c = conringc;
if ( op->incremental && ((int32_t)(op->index - c) > 0) )
c = op->index;
while ( (c != conringp) && (sofar < max) )
{
idx = CONRING_IDX_MASK(c);
len = conringp - c;
if ( (idx + len) > conring_size )
len = conring_size - idx;
if ( (sofar + len) > max )
len = max - sofar;
if ( copy_to_guest_offset(str, sofar, &conring[idx], len) )
return -EFAULT;
sofar += len;
c += len;
}
if ( op->clear )
{
spin_lock_irq(&console_lock);
if ( (uint32_t)(conringp - c) > conring_size )
conringc = conringp - conring_size;
else
conringc = c;
spin_unlock_irq(&console_lock);
}
op->count = sofar;
op->index = c;
return 0;
}
static void dump_console_ring_key(unsigned char key)
{
uint32_t idx, len, sofar, c;
unsigned int order;
char *buf;
printk("'%c' pressed -> dumping console ring buffer (dmesg)\n", key);
/* create a buffer in which we'll copy the ring in the correct
order and NUL terminate */
order = get_order_from_bytes(conring_size + 1);
buf = alloc_xenheap_pages(order, 0);
if ( buf == NULL )
{
printk("unable to allocate memory!\n");
return;
}
c = conringc;
sofar = 0;
while ( (c != conringp) )
{
idx = CONRING_IDX_MASK(c);
len = conringp - c;
if ( (idx + len) > conring_size )
len = conring_size - idx;
memcpy(buf + sofar, &conring[idx], len);
sofar += len;
c += len;
}
buf[sofar] = '\0';
sercon_puts(buf);
video_puts(buf);
free_xenheap_pages(buf, order);
}
