hvc_xen.c revision 7825cf10e31c64ece3cac66fb01a742f1094da51
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 426b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardingestatic unsigned long console_pfn = ~0ul; 436b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge 44b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic inline struct xencons_interface *xencons_interface(void) 45b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 466b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge if (console_pfn == ~0ul) 476b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge return mfn_to_virt(xen_start_info->console.domU.mfn); 486b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge else 496b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge return __va(console_pfn << PAGE_SHIFT); 50b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 51b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 52b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic inline void notify_daemon(void) 53b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 54b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge /* Use evtchn: this is called early, before irq is set up. */ 55b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge notify_remote_via_evtchn(xen_start_info->console.domU.evtchn); 56b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 57b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 587825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardingestatic int __write_console(const char *data, int len) 59b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 60b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge struct xencons_interface *intf = xencons_interface(); 61b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge XENCONS_RING_IDX cons, prod; 62b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge int sent = 0; 63b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 64b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge cons = intf->out_cons; 65b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge prod = intf->out_prod; 66b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge mb(); /* update queue values before going on */ 67b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge BUG_ON((prod - cons) > sizeof(intf->out)); 68b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 69b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge while ((sent < len) && ((prod - cons) < sizeof(intf->out))) 70b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge intf->out[MASK_XENCONS_IDX(prod++, intf->out)] = data[sent++]; 71b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 72b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge wmb(); /* write ring before updating pointer */ 73b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge intf->out_prod = prod; 74b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 75b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge notify_daemon(); 76b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return sent; 77b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 78b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 797825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardingestatic int write_console(uint32_t vtermno, const char *data, int len) 807825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge{ 817825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge int ret = len; 827825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge 837825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge /* 847825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge * Make sure the whole buffer is emitted, polling if 857825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge * necessary. We don't ever want to rely on the hvc daemon 867825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge * because the most interesting console output is when the 877825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge * kernel is crippled. 887825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge */ 897825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge while (len) { 907825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge int sent = __write_console(data, len); 917825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge 927825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge data += sent; 937825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge len -= sent; 947825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge 957825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge if (unlikely(len)) 967825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge HYPERVISOR_sched_op(SCHEDOP_yield, NULL); 977825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge } 987825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge 997825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge return ret; 1007825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge} 1017825cf10e31c64ece3cac66fb01a742f1094da51Jeremy Fitzhardinge 102b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic int read_console(uint32_t vtermno, char *buf, int len) 103b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 104b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge struct xencons_interface *intf = xencons_interface(); 105b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge XENCONS_RING_IDX cons, prod; 106b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge int recv = 0; 107b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 108b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge cons = intf->in_cons; 109b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge prod = intf->in_prod; 110b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge mb(); /* get pointers before reading ring */ 111b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge BUG_ON((prod - cons) > sizeof(intf->in)); 112b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 113b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge while (cons != prod && recv < len) 114b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge buf[recv++] = intf->in[MASK_XENCONS_IDX(cons++, intf->in)]; 115b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 116b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge mb(); /* read ring before consuming */ 117b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge intf->in_cons = cons; 118b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 119b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge notify_daemon(); 120b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return recv; 121b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 122b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 123b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic struct hv_ops hvc_ops = { 124b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .get_chars = read_console, 125b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .put_chars = write_console, 126611e097d7707741a336a0677d9d69bec40f29f3dChristian Borntraeger .notifier_add = notifier_add_irq, 127611e097d7707741a336a0677d9d69bec40f29f3dChristian Borntraeger .notifier_del = notifier_del_irq, 128fc362e2e0efd8b652ebfb409a4e43e6189c04f6fHendrik Brueckner .notifier_hangup = notifier_hangup_irq, 129b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge}; 130b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 131b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic int __init xen_init(void) 132b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 133b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge struct hvc_struct *hp; 134b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 1356e833587e11ed0dbf12e647127f2650e2f80b26dJeremy Fitzhardinge if (!xen_pv_domain() || 1366e833587e11ed0dbf12e647127f2650e2f80b26dJeremy Fitzhardinge xen_initial_domain() || 1376b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge !xen_start_info->console.domU.evtchn) 1386b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge return -ENODEV; 139b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 140b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge xencons_irq = bind_evtchn_to_irq(xen_start_info->console.domU.evtchn); 141b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (xencons_irq < 0) 1426b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge xencons_irq = 0; /* NO_IRQ */ 1436b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge 144b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge hp = hvc_alloc(HVC_COOKIE, xencons_irq, &hvc_ops, 256); 145b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (IS_ERR(hp)) 146b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return PTR_ERR(hp); 147b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 148b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge hvc = hp; 1496b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge 1506b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge console_pfn = mfn_to_pfn(xen_start_info->console.domU.mfn); 1516b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge 152b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return 0; 153b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 154b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 1556b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardingevoid xen_console_resume(void) 1566b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge{ 1576b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge if (xencons_irq) 1586b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge rebind_evtchn_irq(xen_start_info->console.domU.evtchn, xencons_irq); 1596b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge} 1606b9b732d0e396a3f1a95977162a8624aafce38a1Jeremy Fitzhardinge 161b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic void __exit xen_fini(void) 162b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 163b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (hvc) 164b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge hvc_remove(hvc); 165b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 166b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 167b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic int xen_cons_init(void) 168b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 1696e833587e11ed0dbf12e647127f2650e2f80b26dJeremy Fitzhardinge if (!xen_pv_domain()) 170b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return 0; 171b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 172b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge hvc_instantiate(HVC_COOKIE, 0, &hvc_ops); 173b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge return 0; 174b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 175b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 176b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingemodule_init(xen_init); 177b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingemodule_exit(xen_fini); 178b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingeconsole_initcall(xen_cons_init); 179b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 1800922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardingestatic void raw_console_write(const char *str, int len) 1810922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge{ 1820922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge while(len > 0) { 1830922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge int rc = HYPERVISOR_console_io(CONSOLEIO_write, len, (char *)str); 1840922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge if (rc <= 0) 1850922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge break; 1860922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge 1870922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge str += rc; 1880922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge len -= rc; 1890922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge } 1900922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge} 1910922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge 1920922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge#ifdef CONFIG_EARLY_PRINTK 193b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestatic void xenboot_write_console(struct console *console, const char *string, 194b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge unsigned len) 195b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge{ 196b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge unsigned int linelen, off = 0; 197b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge const char *pos; 198b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 1990922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge raw_console_write(string, len); 2000922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge 20183abc70a4c6e306f4c1672e25884322f797e4fcbJeremy Fitzhardinge write_console(0, "(early) ", 8); 202b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge while (off < len && NULL != (pos = strchr(string+off, '\n'))) { 203b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge linelen = pos-string+off; 204b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (off + linelen > len) 205b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge break; 206b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge write_console(0, string+off, linelen); 207b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge write_console(0, "\r\n", 2); 208b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge off += linelen + 1; 209b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge } 210b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge if (off < len) 211b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge write_console(0, string+off, len-off); 212b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge} 213b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge 214b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardingestruct console xenboot_console = { 215b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .name = "xenboot", 216b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge .write = xenboot_write_console, 2170922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge .flags = CON_PRINTBUFFER | CON_BOOT | CON_ANYTIME, 218b536b4b9623084d86f2b1f19cb44a2d6d74f00bfJeremy Fitzhardinge}; 2190922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge#endif /* CONFIG_EARLY_PRINTK */ 2200acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 2210acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardingevoid xen_raw_console_write(const char *str) 2220acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge{ 2230922abdc3982ae54cbe1b24ac5aa91a260eca1bbJeremy Fitzhardinge raw_console_write(str, strlen(str)); 2240acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge} 2250acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 2260acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardingevoid xen_raw_printk(const char *fmt, ...) 2270acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge{ 2280acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge static char buf[512]; 2290acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge va_list ap; 2300acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 2310acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge va_start(ap, fmt); 2320acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge vsnprintf(buf, sizeof(buf), fmt, ap); 2330acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge va_end(ap); 2340acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge 2350acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge xen_raw_console_write(buf); 2360acf10d8fbd52926217d3933d196b33fe2468f18Jeremy Fitzhardinge} 237