hvc_xen.c revision 0acf10d8fbd52926217d3933d196b33fe2468f18
1b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge/* 2b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * xen console driver interface to hvc_console.c 3b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * 4b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * (c) 2007 Gerd Hoffmann <kraxel@suse.de> 5b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * 6b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * This program is free software; you can redistribute it and/or modify 7b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * it under the terms of the GNU General Public License as published by 8b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * the Free Software Foundation; either version 2 of the License, or 9b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * (at your option) any later version. 10b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * 11b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * This program is distributed in the hope that it will be useful, 12b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * but WITHOUT ANY WARRANTY; without even the implied warranty of 13b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * GNU General Public License for more details. 15b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * 16b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * You should have received a copy of the GNU General Public License 17b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * along with this program; if not, write to the Free Software 18b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 19b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge */ 20b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 21b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <linux/console.h> 22b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <linux/delay.h> 23b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <linux/err.h> 24b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <linux/init.h> 25b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <linux/types.h> 26b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 27b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <asm/xen/hypervisor.h> 28b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <xen/page.h> 29b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <xen/events.h> 30b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <xen/interface/io/console.h> 31b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include <xen/hvc-console.h> 32b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 33b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#include "hvc_console.h" 34b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 35b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge#define HVC_COOKIE 0x58656e /* "Xen" in hex */ 36b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 37b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic struct hvc_struct *hvc; 38b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic int xencons_irq; 39b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 40b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge/* ------------------------------------------------------------------ */ 41b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 42b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic inline struct xencons_interface *xencons_interface(void) 43b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 44b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return mfn_to_virt(xen_start_info->console.domU.mfn); 45b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 46b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 47b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic inline void notify_daemon(void) 48b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 49b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge /* Use evtchn: this is called early, before irq is set up. */ 50b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge notify_remote_via_evtchn(xen_start_info->console.domU.evtchn); 51b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 52b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 53b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic int write_console(uint32_t vtermno, const char *data, int len) 54b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 55b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge struct xencons_interface *intf = xencons_interface(); 56b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge XENCONS_RING_IDX cons, prod; 57b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge int sent = 0; 58b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 59b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge cons = intf->out_cons; 60b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge prod = intf->out_prod; 61b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge mb(); /* update queue values before going on */ 62b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge BUG_ON((prod - cons) > sizeof(intf->out)); 63b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 64b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge while ((sent < len) && ((prod - cons) < sizeof(intf->out))) 65b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge intf->out[MASK_XENCONS_IDX(prod++, intf->out)] = data[sent++]; 66b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 67b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge wmb(); /* write ring before updating pointer */ 68b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge intf->out_prod = prod; 69b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 70b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge notify_daemon(); 71b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return sent; 72b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 73b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 74b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic int read_console(uint32_t vtermno, char *buf, int len) 75b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 76b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge struct xencons_interface *intf = xencons_interface(); 77b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge XENCONS_RING_IDX cons, prod; 78b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge int recv = 0; 79b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 80b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge cons = intf->in_cons; 81b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge prod = intf->in_prod; 82b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge mb(); /* get pointers before reading ring */ 83b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge BUG_ON((prod - cons) > sizeof(intf->in)); 84b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 85b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge while (cons != prod && recv < len) 86b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge buf[recv++] = intf->in[MASK_XENCONS_IDX(cons++, intf->in)]; 87b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 88b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge mb(); /* read ring before consuming */ 89b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge intf->in_cons = cons; 90b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 91b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge notify_daemon(); 92b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return recv; 93b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 94b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 95b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic struct hv_ops hvc_ops = { 96b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .get_chars = read_console, 97b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .put_chars = write_console, 98b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge}; 99b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 100b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic int __init xen_init(void) 101b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 102b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge struct hvc_struct *hp; 103b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 104b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (!is_running_on_xen()) 105b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return 0; 106b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 107b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge xencons_irq = bind_evtchn_to_irq(xen_start_info->console.domU.evtchn); 108b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (xencons_irq < 0) 109b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge xencons_irq = 0 /* NO_IRQ */; 110b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge hp = hvc_alloc(HVC_COOKIE, xencons_irq, &hvc_ops, 256); 111b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (IS_ERR(hp)) 112b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return PTR_ERR(hp); 113b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 114b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge hvc = hp; 115b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return 0; 116b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 117b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 118b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic void __exit xen_fini(void) 119b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 120b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (hvc) 121b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge hvc_remove(hvc); 122b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 123b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 124b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic int xen_cons_init(void) 125b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 126b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (!is_running_on_xen()) 127b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return 0; 128b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 129b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge hvc_instantiate(HVC_COOKIE, 0, &hvc_ops); 130b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return 0; 131b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 132b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 133b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingemodule_init(xen_init); 134b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingemodule_exit(xen_fini); 135b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingeconsole_initcall(xen_cons_init); 136b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 137b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic void xenboot_write_console(struct console *console, const char *string, 138b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge unsigned len) 139b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 140b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge unsigned int linelen, off = 0; 141b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge const char *pos; 142b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 143b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge while (off < len && NULL != (pos = strchr(string+off, '\n'))) { 144b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge linelen = pos-string+off; 145b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (off + linelen > len) 146b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge break; 147b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge write_console(0, string+off, linelen); 148b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge write_console(0, "\r\n", 2); 149b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge off += linelen + 1; 150b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge } 151b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (off < len) 152b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge write_console(0, string+off, len-off); 153b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 154b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 155b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestruct console xenboot_console = { 156b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .name = "xenboot", 157b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .write = xenboot_write_console, 158b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .flags = CON_PRINTBUFFER | CON_BOOT, 159b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge}; 1600acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 1610acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardingevoid xen_raw_console_write(const char *str) 1620acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge{ 1630acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge int len = strlen(str); 1640acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 1650acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge while(len > 0) { 1660acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge int rc = HYPERVISOR_console_io(CONSOLEIO_write, len, (char *)str); 1670acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge if (rc <= 0) 1680acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge break; 1690acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 1700acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge str += rc; 1710acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge len -= rc; 1720acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge } 1730acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge} 1740acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 1750acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardingevoid xen_raw_printk(const char *fmt, ...) 1760acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge{ 1770acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge static char buf[512]; 1780acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge va_list ap; 1790acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 1800acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge va_start(ap, fmt); 1810acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge vsnprintf(buf, sizeof(buf), fmt, ap); 1820acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge va_end(ap); 1830acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 1840acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge xen_raw_console_write(buf); 1850acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge} 186