132d1354aSWojciech Macek /*- 232d1354aSWojciech Macek * Copyright (c) 2015 Nathan Whitehorn 332d1354aSWojciech Macek * All rights reserved. 432d1354aSWojciech Macek * 532d1354aSWojciech Macek * Redistribution and use in source and binary forms, with or without 632d1354aSWojciech Macek * modification, are permitted provided that the following conditions 732d1354aSWojciech Macek * are met: 832d1354aSWojciech Macek * 1. Redistributions of source code must retain the above copyright 932d1354aSWojciech Macek * notice, this list of conditions and the following disclaimer. 1032d1354aSWojciech Macek * 2. Redistributions in binary form must reproduce the above copyright 1132d1354aSWojciech Macek * notice, this list of conditions and the following disclaimer in the 1232d1354aSWojciech Macek * documentation and/or other materials provided with the distribution. 1332d1354aSWojciech Macek * 1432d1354aSWojciech Macek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1532d1354aSWojciech Macek * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1632d1354aSWojciech Macek * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1732d1354aSWojciech Macek * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1832d1354aSWojciech Macek * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1932d1354aSWojciech Macek * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2032d1354aSWojciech Macek * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2132d1354aSWojciech Macek * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2232d1354aSWojciech Macek * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2332d1354aSWojciech Macek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2432d1354aSWojciech Macek * SUCH DAMAGE. 2532d1354aSWojciech Macek */ 2632d1354aSWojciech Macek 2732d1354aSWojciech Macek #include <sys/cdefs.h> 2832d1354aSWojciech Macek __FBSDID("$FreeBSD$"); 2932d1354aSWojciech Macek 3032d1354aSWojciech Macek #include <sys/param.h> 3132d1354aSWojciech Macek #include <sys/systm.h> 3232d1354aSWojciech Macek #include <sys/module.h> 3332d1354aSWojciech Macek #include <sys/bus.h> 3432d1354aSWojciech Macek #include <sys/conf.h> 3532d1354aSWojciech Macek #include <sys/clock.h> 3632d1354aSWojciech Macek #include <sys/cpu.h> 3732d1354aSWojciech Macek #include <sys/kernel.h> 3832d1354aSWojciech Macek #include <sys/reboot.h> 3932d1354aSWojciech Macek #include <sys/sysctl.h> 40*504d9b60SWojciech Macek #include <sys/endian.h> 41*504d9b60SWojciech Macek 42*504d9b60SWojciech Macek #include <vm/vm.h> 43*504d9b60SWojciech Macek #include <vm/pmap.h> 4432d1354aSWojciech Macek 4532d1354aSWojciech Macek #include <dev/ofw/ofw_bus.h> 4632d1354aSWojciech Macek #include <dev/ofw/ofw_bus_subr.h> 4732d1354aSWojciech Macek #include <dev/ofw/openfirm.h> 4832d1354aSWojciech Macek 4932d1354aSWojciech Macek #include "clock_if.h" 5032d1354aSWojciech Macek #include "opal.h" 5132d1354aSWojciech Macek 5232d1354aSWojciech Macek static int opaldev_probe(device_t); 5332d1354aSWojciech Macek static int opaldev_attach(device_t); 5432d1354aSWojciech Macek /* clock interface */ 5532d1354aSWojciech Macek static int opal_gettime(device_t dev, struct timespec *ts); 5632d1354aSWojciech Macek static int opal_settime(device_t dev, struct timespec *ts); 5732d1354aSWojciech Macek /* ofw bus interface */ 5832d1354aSWojciech Macek static const struct ofw_bus_devinfo *opaldev_get_devinfo(device_t dev, 5932d1354aSWojciech Macek device_t child); 6032d1354aSWojciech Macek 6132d1354aSWojciech Macek static void opal_shutdown(void *arg, int howto); 62*504d9b60SWojciech Macek static void opal_intr(void *); 6332d1354aSWojciech Macek 6432d1354aSWojciech Macek static device_method_t opaldev_methods[] = { 6532d1354aSWojciech Macek /* Device interface */ 6632d1354aSWojciech Macek DEVMETHOD(device_probe, opaldev_probe), 6732d1354aSWojciech Macek DEVMETHOD(device_attach, opaldev_attach), 6832d1354aSWojciech Macek 6932d1354aSWojciech Macek /* clock interface */ 7032d1354aSWojciech Macek DEVMETHOD(clock_gettime, opal_gettime), 7132d1354aSWojciech Macek DEVMETHOD(clock_settime, opal_settime), 7232d1354aSWojciech Macek 7332d1354aSWojciech Macek /* ofw_bus interface */ 7432d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_devinfo, opaldev_get_devinfo), 7532d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_compat, ofw_bus_gen_get_compat), 7632d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_model, ofw_bus_gen_get_model), 7732d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_name, ofw_bus_gen_get_name), 7832d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_node, ofw_bus_gen_get_node), 7932d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_type, ofw_bus_gen_get_type), 8032d1354aSWojciech Macek 8132d1354aSWojciech Macek DEVMETHOD_END 8232d1354aSWojciech Macek }; 8332d1354aSWojciech Macek 8432d1354aSWojciech Macek static driver_t opaldev_driver = { 8532d1354aSWojciech Macek "opal", 8632d1354aSWojciech Macek opaldev_methods, 8732d1354aSWojciech Macek 0 8832d1354aSWojciech Macek }; 8932d1354aSWojciech Macek 9032d1354aSWojciech Macek static devclass_t opaldev_devclass; 9132d1354aSWojciech Macek 9232d1354aSWojciech Macek DRIVER_MODULE(opaldev, ofwbus, opaldev_driver, opaldev_devclass, 0, 0); 9332d1354aSWojciech Macek 9432d1354aSWojciech Macek static int 9532d1354aSWojciech Macek opaldev_probe(device_t dev) 9632d1354aSWojciech Macek { 97*504d9b60SWojciech Macek phandle_t iparent; 98*504d9b60SWojciech Macek pcell_t *irqs; 99*504d9b60SWojciech Macek int i, n_irqs; 10032d1354aSWojciech Macek 10132d1354aSWojciech Macek if (!ofw_bus_is_compatible(dev, "ibm,opal-v3")) 10232d1354aSWojciech Macek return (ENXIO); 10332d1354aSWojciech Macek if (opal_check() != 0) 10432d1354aSWojciech Macek return (ENXIO); 10532d1354aSWojciech Macek 10632d1354aSWojciech Macek device_set_desc(dev, "OPAL Abstraction Firmware"); 107*504d9b60SWojciech Macek 108*504d9b60SWojciech Macek /* Manually add IRQs before attaching */ 109*504d9b60SWojciech Macek if (OF_hasprop(ofw_bus_get_node(dev), "opal-interrupts")) { 110*504d9b60SWojciech Macek iparent = OF_finddevice("/interrupt-controller@0"); 111*504d9b60SWojciech Macek iparent = OF_xref_from_node(iparent); 112*504d9b60SWojciech Macek 113*504d9b60SWojciech Macek n_irqs = OF_getproplen(ofw_bus_get_node(dev), 114*504d9b60SWojciech Macek "opal-interrupts") / sizeof(*irqs); 115*504d9b60SWojciech Macek irqs = malloc(n_irqs * sizeof(*irqs), M_DEVBUF, M_WAITOK); 116*504d9b60SWojciech Macek OF_getencprop(ofw_bus_get_node(dev), "opal-interrupts", irqs, 117*504d9b60SWojciech Macek n_irqs * sizeof(*irqs)); 118*504d9b60SWojciech Macek for (i = 0; i < n_irqs; i++) 119*504d9b60SWojciech Macek bus_set_resource(dev, SYS_RES_IRQ, i, 120*504d9b60SWojciech Macek ofw_bus_map_intr(dev, iparent, 1, &irqs[i]), 1); 121*504d9b60SWojciech Macek free(irqs, M_DEVBUF); 122*504d9b60SWojciech Macek } 123*504d9b60SWojciech Macek 124*504d9b60SWojciech Macek 12532d1354aSWojciech Macek return (BUS_PROBE_SPECIFIC); 12632d1354aSWojciech Macek } 12732d1354aSWojciech Macek 12832d1354aSWojciech Macek static int 12932d1354aSWojciech Macek opaldev_attach(device_t dev) 13032d1354aSWojciech Macek { 13132d1354aSWojciech Macek phandle_t child; 13232d1354aSWojciech Macek device_t cdev; 133*504d9b60SWojciech Macek uint64_t junk; 134*504d9b60SWojciech Macek int i, rv; 13532d1354aSWojciech Macek struct ofw_bus_devinfo *dinfo; 136*504d9b60SWojciech Macek struct resource *irq; 13732d1354aSWojciech Macek 138*504d9b60SWojciech Macek /* Test for RTC support and register clock if it works */ 139*504d9b60SWojciech Macek rv = opal_call(OPAL_RTC_READ, vtophys(&junk), vtophys(&junk)); 140*504d9b60SWojciech Macek do { 141*504d9b60SWojciech Macek rv = opal_call(OPAL_RTC_READ, vtophys(&junk), vtophys(&junk)); 142*504d9b60SWojciech Macek if (rv == OPAL_BUSY_EVENT) 143*504d9b60SWojciech Macek rv = opal_call(OPAL_POLL_EVENTS, 0); 144*504d9b60SWojciech Macek } while (rv == OPAL_BUSY_EVENT); 145*504d9b60SWojciech Macek 146*504d9b60SWojciech Macek if (rv == OPAL_SUCCESS) 14732d1354aSWojciech Macek clock_register(dev, 2000); 14832d1354aSWojciech Macek 14932d1354aSWojciech Macek EVENTHANDLER_REGISTER(shutdown_final, opal_shutdown, NULL, 15032d1354aSWojciech Macek SHUTDOWN_PRI_LAST); 15132d1354aSWojciech Macek 152*504d9b60SWojciech Macek /* Bind to interrupts */ 153*504d9b60SWojciech Macek for (i = 0; (irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &i, 154*504d9b60SWojciech Macek RF_ACTIVE)) != NULL; i++) 155*504d9b60SWojciech Macek bus_setup_intr(dev, irq, INTR_TYPE_TTY | INTR_MPSAFE | 156*504d9b60SWojciech Macek INTR_ENTROPY, NULL, opal_intr, (void *)rman_get_start(irq), 157*504d9b60SWojciech Macek NULL); 158*504d9b60SWojciech Macek 15932d1354aSWojciech Macek for (child = OF_child(ofw_bus_get_node(dev)); child != 0; 16032d1354aSWojciech Macek child = OF_peer(child)) { 16132d1354aSWojciech Macek dinfo = malloc(sizeof(*dinfo), M_DEVBUF, M_WAITOK | M_ZERO); 16232d1354aSWojciech Macek if (ofw_bus_gen_setup_devinfo(dinfo, child) != 0) { 16332d1354aSWojciech Macek free(dinfo, M_DEVBUF); 16432d1354aSWojciech Macek continue; 16532d1354aSWojciech Macek } 16632d1354aSWojciech Macek cdev = device_add_child(dev, NULL, -1); 16732d1354aSWojciech Macek if (cdev == NULL) { 16832d1354aSWojciech Macek device_printf(dev, "<%s>: device_add_child failed\n", 16932d1354aSWojciech Macek dinfo->obd_name); 17032d1354aSWojciech Macek ofw_bus_gen_destroy_devinfo(dinfo); 17132d1354aSWojciech Macek free(dinfo, M_DEVBUF); 17232d1354aSWojciech Macek continue; 17332d1354aSWojciech Macek } 17432d1354aSWojciech Macek device_set_ivars(cdev, dinfo); 17532d1354aSWojciech Macek } 17632d1354aSWojciech Macek 17732d1354aSWojciech Macek return (bus_generic_attach(dev)); 17832d1354aSWojciech Macek } 17932d1354aSWojciech Macek 18032d1354aSWojciech Macek static int 181*504d9b60SWojciech Macek bcd2bin32(int bcd) 182*504d9b60SWojciech Macek { 183*504d9b60SWojciech Macek int out = 0; 184*504d9b60SWojciech Macek 185*504d9b60SWojciech Macek out += bcd2bin(bcd & 0xff); 186*504d9b60SWojciech Macek out += 100*bcd2bin((bcd & 0x0000ff00) >> 8); 187*504d9b60SWojciech Macek out += 10000*bcd2bin((bcd & 0x00ff0000) >> 16); 188*504d9b60SWojciech Macek out += 1000000*bcd2bin((bcd & 0xffff0000) >> 24); 189*504d9b60SWojciech Macek 190*504d9b60SWojciech Macek return (out); 191*504d9b60SWojciech Macek } 192*504d9b60SWojciech Macek 193*504d9b60SWojciech Macek static int 194*504d9b60SWojciech Macek opal_gettime(device_t dev, struct timespec *ts) 195*504d9b60SWojciech Macek { 196*504d9b60SWojciech Macek int rv; 197*504d9b60SWojciech Macek struct clocktime ct; 198*504d9b60SWojciech Macek uint32_t ymd; 199*504d9b60SWojciech Macek uint64_t hmsm; 200*504d9b60SWojciech Macek 201*504d9b60SWojciech Macek do { 202*504d9b60SWojciech Macek rv = opal_call(OPAL_RTC_READ, vtophys(&ymd), vtophys(&hmsm)); 203*504d9b60SWojciech Macek if (rv == OPAL_BUSY_EVENT) { 204*504d9b60SWojciech Macek rv = opal_call(OPAL_POLL_EVENTS, 0); 205*504d9b60SWojciech Macek pause("opalrtc", 1); 206*504d9b60SWojciech Macek } 207*504d9b60SWojciech Macek } while (rv == OPAL_BUSY_EVENT); 208*504d9b60SWojciech Macek 209*504d9b60SWojciech Macek if (rv != OPAL_SUCCESS) 21032d1354aSWojciech Macek return (ENXIO); 211*504d9b60SWojciech Macek 212*504d9b60SWojciech Macek hmsm = be64toh(hmsm); 213*504d9b60SWojciech Macek ymd = be32toh(ymd); 214*504d9b60SWojciech Macek 215*504d9b60SWojciech Macek ct.nsec = bcd2bin32((hmsm & 0x000000ffffff0000) >> 16) * 1000; 216*504d9b60SWojciech Macek ct.sec = bcd2bin((hmsm & 0x0000ff0000000000) >> 40); 217*504d9b60SWojciech Macek ct.min = bcd2bin((hmsm & 0x00ff000000000000) >> 48); 218*504d9b60SWojciech Macek ct.hour = bcd2bin((hmsm & 0xff00000000000000) >> 56); 219*504d9b60SWojciech Macek 220*504d9b60SWojciech Macek ct.day = bcd2bin((ymd & 0x000000ff) >> 0); 221*504d9b60SWojciech Macek ct.mon = bcd2bin((ymd & 0x0000ff00) >> 8); 222*504d9b60SWojciech Macek ct.year = bcd2bin32((ymd & 0xffff0000) >> 16); 223*504d9b60SWojciech Macek 224*504d9b60SWojciech Macek return (clock_ct_to_ts(&ct, ts)); 22532d1354aSWojciech Macek } 22632d1354aSWojciech Macek 22732d1354aSWojciech Macek static int 22832d1354aSWojciech Macek opal_settime(device_t dev, struct timespec *ts) 22932d1354aSWojciech Macek { 230*504d9b60SWojciech Macek 23132d1354aSWojciech Macek return (0); 23232d1354aSWojciech Macek } 23332d1354aSWojciech Macek 23432d1354aSWojciech Macek static const struct ofw_bus_devinfo * 23532d1354aSWojciech Macek opaldev_get_devinfo(device_t dev, device_t child) 23632d1354aSWojciech Macek { 23732d1354aSWojciech Macek return (device_get_ivars(child)); 23832d1354aSWojciech Macek } 23932d1354aSWojciech Macek 24032d1354aSWojciech Macek static void 24132d1354aSWojciech Macek opal_shutdown(void *arg, int howto) 24232d1354aSWojciech Macek { 24332d1354aSWojciech Macek 24432d1354aSWojciech Macek if (howto & RB_HALT) 24532d1354aSWojciech Macek opal_call(OPAL_CEC_POWER_DOWN, 0 /* Normal power off */); 24632d1354aSWojciech Macek else 24732d1354aSWojciech Macek opal_call(OPAL_CEC_REBOOT); 248*504d9b60SWojciech Macek 249*504d9b60SWojciech Macek opal_call(OPAL_RETURN_CPU); 250*504d9b60SWojciech Macek } 251*504d9b60SWojciech Macek 252*504d9b60SWojciech Macek static void 253*504d9b60SWojciech Macek opal_intr(void *xintr) 254*504d9b60SWojciech Macek { 255*504d9b60SWojciech Macek uint64_t events = 0; 256*504d9b60SWojciech Macek 257*504d9b60SWojciech Macek opal_call(OPAL_HANDLE_INTERRUPT, (uint32_t)(uint64_t)xintr, 258*504d9b60SWojciech Macek vtophys(&events)); 259*504d9b60SWojciech Macek /* XXX: do something useful with this information */ 260*504d9b60SWojciech Macek 26132d1354aSWojciech Macek } 26232d1354aSWojciech Macek 263