pvh_consinit.c revision 1.2 1 1.2 bouyer /* $NetBSD: pvh_consinit.c,v 1.2 2020/05/03 17:23:14 bouyer Exp $ */
2 1.1 bouyer
3 1.1 bouyer /*
4 1.1 bouyer * Copyright (c) 2020 Manuel Bouyer.
5 1.1 bouyer *
6 1.1 bouyer * Redistribution and use in source and binary forms, with or without
7 1.1 bouyer * modification, are permitted provided that the following conditions
8 1.1 bouyer * are met:
9 1.1 bouyer * 1. Redistributions of source code must retain the above copyright
10 1.1 bouyer * notice, this list of conditions and the following disclaimer.
11 1.1 bouyer * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 bouyer * notice, this list of conditions and the following disclaimer in the
13 1.1 bouyer * documentation and/or other materials provided with the distribution.
14 1.1 bouyer *
15 1.1 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 1.1 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 1.1 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 1.1 bouyer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 1.1 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 1.1 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 1.1 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 1.1 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 1.1 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 1.1 bouyer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25 1.1 bouyer *
26 1.1 bouyer */
27 1.1 bouyer
28 1.1 bouyer #include <sys/cdefs.h>
29 1.2 bouyer __KERNEL_RCSID(0, "$NetBSD: pvh_consinit.c,v 1.2 2020/05/03 17:23:14 bouyer Exp $");
30 1.1 bouyer
31 1.1 bouyer #include "xencons.h"
32 1.1 bouyer #include <sys/param.h>
33 1.1 bouyer #include <sys/systm.h>
34 1.1 bouyer #include <sys/device.h>
35 1.1 bouyer #include <uvm/uvm_extern.h>
36 1.1 bouyer #include <uvm/uvm_prot.h>
37 1.1 bouyer
38 1.1 bouyer #include <dev/cons.h>
39 1.1 bouyer #include <xen/xen.h>
40 1.1 bouyer #include <xen/hypervisor.h>
41 1.1 bouyer #include <xen/include/public/hvm/hvm_op.h>
42 1.1 bouyer #include <xen/include/public/hvm/params.h>
43 1.1 bouyer
44 1.1 bouyer static int pvh_xenconscn_getc(dev_t);
45 1.1 bouyer static void pvh_xenconscn_putc(dev_t, int);
46 1.1 bouyer static void pvh_xenconscn_pollc(dev_t, int);
47 1.1 bouyer
48 1.1 bouyer static struct consdev pvh_xencons = {
49 1.1 bouyer NULL, NULL, pvh_xenconscn_getc, pvh_xenconscn_putc, pvh_xenconscn_pollc,
50 1.1 bouyer NULL, NULL, NULL, NODEV, CN_NORMAL
51 1.1 bouyer };
52 1.1 bouyer
53 1.1 bouyer
54 1.1 bouyer void
55 1.1 bouyer xen_pvh_consinit(void)
56 1.1 bouyer {
57 1.1 bouyer /*
58 1.1 bouyer * hugly hack because we're called multiple times at different
59 1.1 bouyer * boot stage.
60 1.1 bouyer */
61 1.1 bouyer static int initted = 0;
62 1.2 bouyer if (initted == 0 && !xendomain_is_dom0()) {
63 1.1 bouyer /* pmap not up yet, fall back to printk() */
64 1.1 bouyer cn_tab = &pvh_xencons;
65 1.1 bouyer initted++;
66 1.1 bouyer return;
67 1.1 bouyer } else if (initted > 1) {
68 1.1 bouyer return;
69 1.1 bouyer }
70 1.1 bouyer initted++;
71 1.2 bouyer if (xendomain_is_dom0()) {
72 1.2 bouyer xenconscn_attach(); /* no ring in this case */
73 1.2 bouyer initted++; /* don't init console twice */
74 1.2 bouyer return;
75 1.2 bouyer }
76 1.2 bouyer
77 1.1 bouyer #if NXENCONS > 0
78 1.1 bouyer /* we can now map the xencons rings. */
79 1.1 bouyer struct xen_hvm_param xen_hvm_param;
80 1.1 bouyer
81 1.1 bouyer
82 1.1 bouyer xen_hvm_param.domid = DOMID_SELF;
83 1.1 bouyer xen_hvm_param.index = HVM_PARAM_CONSOLE_PFN;
84 1.1 bouyer
85 1.1 bouyer if ( HYPERVISOR_hvm_op(HVMOP_get_param, &xen_hvm_param) < 0)
86 1.1 bouyer panic("xen_pvh_consinit: can't get console PFN");
87 1.1 bouyer
88 1.1 bouyer xen_start_info.console.domU.mfn = xen_hvm_param.value;
89 1.1 bouyer pmap_kenter_pa((vaddr_t) xencons_interface, ptoa(xen_hvm_param.value),
90 1.1 bouyer VM_PROT_READ|VM_PROT_WRITE, 0);
91 1.1 bouyer
92 1.1 bouyer xen_hvm_param.domid = DOMID_SELF;
93 1.1 bouyer xen_hvm_param.index = HVM_PARAM_CONSOLE_EVTCHN;
94 1.1 bouyer
95 1.1 bouyer if ( HYPERVISOR_hvm_op(HVMOP_get_param, &xen_hvm_param) < 0)
96 1.1 bouyer panic("xen_pvh_consinit: can't get console event");
97 1.1 bouyer
98 1.1 bouyer xen_start_info.console.domU.evtchn = xen_hvm_param.value;
99 1.1 bouyer xenconscn_attach();
100 1.1 bouyer #endif
101 1.1 bouyer }
102 1.1 bouyer
103 1.1 bouyer static int
104 1.1 bouyer pvh_xenconscn_getc(dev_t dev)
105 1.1 bouyer {
106 1.1 bouyer while(1)
107 1.1 bouyer ;
108 1.1 bouyer return -1;
109 1.1 bouyer }
110 1.1 bouyer
111 1.1 bouyer static void
112 1.1 bouyer pvh_xenconscn_putc(dev_t dev, int c)
113 1.1 bouyer {
114 1.1 bouyer printk("%c", c);
115 1.1 bouyer }
116 1.1 bouyer
117 1.1 bouyer static void
118 1.1 bouyer pvh_xenconscn_pollc(dev_t dev, int on)
119 1.1 bouyer {
120 1.1 bouyer return;
121 1.1 bouyer }
122