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$"); 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 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 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 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