1 /*-
2 * Copyright (c) 2019 Justin Hibbits
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions
6 * are met:
7 *
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
17 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
18 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
19 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
20 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
21 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
22 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
23 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
24 */
25
26 #include <sys/cdefs.h>
27 __FBSDID("$FreeBSD: stable/12/sys/powerpc/powernv/opal_hmi.c 347495 2019-05-11 18:25:15Z jhibbits $");
28
29 #include <sys/param.h>
30 #include <sys/types.h>
31 #include <sys/kernel.h>
32 #include <sys/systm.h>
33
34 #include <vm/vm.h>
35 #include <vm/pmap.h>
36
37 #include <machine/spr.h>
38 #include <machine/trap.h>
39 #include "opal.h"
40
41 static int
opal_hmi_handler2(struct trapframe * frame)42 opal_hmi_handler2(struct trapframe *frame)
43 {
44 int64_t flags;
45 int err;
46
47 err = opal_call(OPAL_HANDLE_HMI2, vtophys(&flags));
48
49 /* XXX: At some point, handle the flags outvar. */
50 if (err == OPAL_SUCCESS) {
51 mtspr(SPR_HMER, 0);
52 return (0);
53 }
54
55 printf("HMI handler failed! OPAL error code: %d\n", err);
56
57 return (-1);
58 }
59
60 static int
opal_hmi_handler(struct trapframe * frame)61 opal_hmi_handler(struct trapframe *frame)
62 {
63 int err;
64
65 err = opal_call(OPAL_HANDLE_HMI);
66
67 if (err == OPAL_SUCCESS) {
68 mtspr(SPR_HMER, 0);
69 return (0);
70 }
71
72 printf("HMI handler failed! OPAL error code: %d\n", err);
73
74 return (-1);
75 }
76
77 static void
opal_setup_hmi(void * data)78 opal_setup_hmi(void *data)
79 {
80 /* This only works for OPAL, so first make sure we have it. */
81 if (opal_check() != 0)
82 return;
83
84 if (opal_call(OPAL_CHECK_TOKEN, OPAL_HANDLE_HMI2) == OPAL_TOKEN_PRESENT)
85 hmi_handler = opal_hmi_handler2;
86 else if (opal_call(OPAL_CHECK_TOKEN, OPAL_HANDLE_HMI) == OPAL_TOKEN_PRESENT)
87 hmi_handler = opal_hmi_handler;
88 else {
89 printf("Warning: No OPAL HMI handler found.\n");
90 return;
91 }
92
93 if (bootverbose)
94 printf("Installed OPAL HMI handler.\n");
95 }
96
97 SYSINIT(opal_setup_hmi, SI_SUB_HYPERVISOR, SI_ORDER_ANY, opal_setup_hmi, NULL);
98