1fb3855e0SWojciech Macek /*- 2fb3855e0SWojciech Macek * Copyright (C) 2011,2015 by Nathan Whitehorn. All rights reserved. 3fb3855e0SWojciech Macek * 4fb3855e0SWojciech Macek * Redistribution and use in source and binary forms, with or without 5fb3855e0SWojciech Macek * modification, are permitted provided that the following conditions 6fb3855e0SWojciech Macek * are met: 7fb3855e0SWojciech Macek * 1. Redistributions of source code must retain the above copyright 8fb3855e0SWojciech Macek * notice, this list of conditions and the following disclaimer. 9fb3855e0SWojciech Macek * 2. Redistributions in binary form must reproduce the above copyright 10fb3855e0SWojciech Macek * notice, this list of conditions and the following disclaimer in the 11fb3855e0SWojciech Macek * documentation and/or other materials provided with the distribution. 12fb3855e0SWojciech Macek * 13fb3855e0SWojciech Macek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 14fb3855e0SWojciech Macek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 15fb3855e0SWojciech Macek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 16fb3855e0SWojciech Macek * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 17fb3855e0SWojciech Macek * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 18fb3855e0SWojciech Macek * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 19fb3855e0SWojciech Macek * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 20fb3855e0SWojciech Macek * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 21fb3855e0SWojciech Macek * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 22fb3855e0SWojciech Macek * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 23fb3855e0SWojciech Macek */ 24fb3855e0SWojciech Macek 25fb3855e0SWojciech Macek #include <sys/cdefs.h> 2615be37cbSBrandon Bergren #include <sys/endian.h> 27fb3855e0SWojciech Macek #include <sys/param.h> 28fb3855e0SWojciech Macek #include <sys/conf.h> 29fb3855e0SWojciech Macek #include <sys/cons.h> 30e2e050c8SConrad Meyer #include <sys/kdb.h> 31e2e050c8SConrad Meyer #include <sys/kernel.h> 32e2e050c8SConrad Meyer #include <sys/lock.h> 33e2e050c8SConrad Meyer #include <sys/module.h> 34e2e050c8SConrad Meyer #include <sys/mutex.h> 35e2e050c8SConrad Meyer #include <sys/priv.h> 36fc168902SWojciech Macek #include <sys/proc.h> 37e2e050c8SConrad Meyer #include <sys/systm.h> 38fb3855e0SWojciech Macek #include <sys/tty.h> 39fb3855e0SWojciech Macek 40fb3855e0SWojciech Macek #include <vm/vm.h> 41fb3855e0SWojciech Macek #include <vm/pmap.h> 42fb3855e0SWojciech Macek 43fb3855e0SWojciech Macek #include <machine/bus.h> 44fb3855e0SWojciech Macek 45fb3855e0SWojciech Macek #include <dev/ofw/openfirm.h> 46fb3855e0SWojciech Macek #include <dev/ofw/ofw_bus.h> 47fb3855e0SWojciech Macek #include <dev/ofw/ofw_bus_subr.h> 48fb3855e0SWojciech Macek #include <dev/uart/uart.h> 49fb3855e0SWojciech Macek #include <dev/uart/uart_cpu.h> 50fb3855e0SWojciech Macek #include <dev/uart/uart_bus.h> 51fb3855e0SWojciech Macek 52fb3855e0SWojciech Macek #include "opal.h" 53fb3855e0SWojciech Macek #include "uart_if.h" 54fb3855e0SWojciech Macek 55fb3855e0SWojciech Macek struct uart_opal_softc { 56fb3855e0SWojciech Macek device_t dev; 57fb3855e0SWojciech Macek phandle_t node; 58fb3855e0SWojciech Macek int vtermid; 59fb3855e0SWojciech Macek 60fb3855e0SWojciech Macek struct tty *tp; 61fb3855e0SWojciech Macek struct resource *irqres; 62fb3855e0SWojciech Macek int irqrid; 63fb3855e0SWojciech Macek struct callout callout; 64fb3855e0SWojciech Macek void *sc_icookie; 65fb3855e0SWojciech Macek int polltime; 66fb3855e0SWojciech Macek 67fb3855e0SWojciech Macek struct mtx sc_mtx; 68fb3855e0SWojciech Macek int protocol; 69fb3855e0SWojciech Macek 70fb3855e0SWojciech Macek char opal_inbuf[16]; 71fb3855e0SWojciech Macek uint64_t inbuflen; 72fb3855e0SWojciech Macek uint8_t outseqno; 73341679e1SJustin Hibbits #if defined(KDB) 74341679e1SJustin Hibbits int alt_break_state; 75341679e1SJustin Hibbits #endif 76fb3855e0SWojciech Macek }; 77fb3855e0SWojciech Macek 78fb3855e0SWojciech Macek static struct uart_opal_softc *console_sc = NULL; 79341679e1SJustin Hibbits static struct consdev *stdout_cp; 80fb3855e0SWojciech Macek 81fb3855e0SWojciech Macek enum { 82fb3855e0SWojciech Macek OPAL_RAW, OPAL_HVSI 83fb3855e0SWojciech Macek }; 84fb3855e0SWojciech Macek 85fb3855e0SWojciech Macek #define VS_DATA_PACKET_HEADER 0xff 86fb3855e0SWojciech Macek #define VS_CONTROL_PACKET_HEADER 0xfe 87fb3855e0SWojciech Macek #define VSV_SET_MODEM_CTL 0x01 88fb3855e0SWojciech Macek #define VSV_MODEM_CTL_UPDATE 0x02 89fb3855e0SWojciech Macek #define VSV_RENEGOTIATE_CONNECTION 0x03 90fb3855e0SWojciech Macek #define VS_QUERY_PACKET_HEADER 0xfd 91fb3855e0SWojciech Macek #define VSV_SEND_VERSION_NUMBER 0x01 92fb3855e0SWojciech Macek #define VSV_SEND_MODEM_CTL_STATUS 0x02 93fb3855e0SWojciech Macek #define VS_QUERY_RESPONSE_PACKET_HEADER 0xfc 94fb3855e0SWojciech Macek 95fb3855e0SWojciech Macek static int uart_opal_probe(device_t dev); 96fb3855e0SWojciech Macek static int uart_opal_attach(device_t dev); 97fb3855e0SWojciech Macek static void uart_opal_intr(void *v); 98fb3855e0SWojciech Macek 99fb3855e0SWojciech Macek static device_method_t uart_opal_methods[] = { 100fb3855e0SWojciech Macek /* Device interface */ 101fb3855e0SWojciech Macek DEVMETHOD(device_probe, uart_opal_probe), 102fb3855e0SWojciech Macek DEVMETHOD(device_attach, uart_opal_attach), 103fb3855e0SWojciech Macek 104fb3855e0SWojciech Macek DEVMETHOD_END 105fb3855e0SWojciech Macek }; 106fb3855e0SWojciech Macek 107fb3855e0SWojciech Macek static driver_t uart_opal_driver = { 108fb3855e0SWojciech Macek "uart", 109fb3855e0SWojciech Macek uart_opal_methods, 110fb3855e0SWojciech Macek sizeof(struct uart_opal_softc), 111fb3855e0SWojciech Macek }; 112fb3855e0SWojciech Macek 113c90ea831SJohn Baldwin DRIVER_MODULE(uart_opal, opalcons, uart_opal_driver, 0, 0); 114fb3855e0SWojciech Macek 115341679e1SJustin Hibbits static int uart_opal_getc(struct uart_opal_softc *sc); 116fb3855e0SWojciech Macek static cn_probe_t uart_opal_cnprobe; 117fb3855e0SWojciech Macek static cn_init_t uart_opal_cninit; 118fb3855e0SWojciech Macek static cn_term_t uart_opal_cnterm; 119fb3855e0SWojciech Macek static cn_getc_t uart_opal_cngetc; 120fb3855e0SWojciech Macek static cn_putc_t uart_opal_cnputc; 121fb3855e0SWojciech Macek static cn_grab_t uart_opal_cngrab; 122fb3855e0SWojciech Macek static cn_ungrab_t uart_opal_cnungrab; 123fb3855e0SWojciech Macek 124fb3855e0SWojciech Macek CONSOLE_DRIVER(uart_opal); 125fb3855e0SWojciech Macek 126fb3855e0SWojciech Macek static void uart_opal_ttyoutwakeup(struct tty *tp); 127fb3855e0SWojciech Macek 128fb3855e0SWojciech Macek static struct ttydevsw uart_opal_tty_class = { 129fb3855e0SWojciech Macek .tsw_flags = TF_INITLOCK|TF_CALLOUT, 130fb3855e0SWojciech Macek .tsw_outwakeup = uart_opal_ttyoutwakeup, 131fb3855e0SWojciech Macek }; 132fb3855e0SWojciech Macek 133fc168902SWojciech Macek static struct { 134fc168902SWojciech Macek char tmpbuf[16]; 135fc168902SWojciech Macek uint64_t size; 136fc168902SWojciech Macek struct mtx mtx; 137504d9b60SWojciech Macek } opalcons_buffer; 138fc168902SWojciech Macek 139fc168902SWojciech Macek static void 140fc168902SWojciech Macek uart_opal_real_map_outbuffer(uint64_t *bufferp, uint64_t *lenp) 141fc168902SWojciech Macek { 142fc168902SWojciech Macek 143504d9b60SWojciech Macek if (!mtx_initialized(&opalcons_buffer.mtx)) 144504d9b60SWojciech Macek mtx_init(&opalcons_buffer.mtx, "uart_opal", NULL, 145504d9b60SWojciech Macek MTX_SPIN | MTX_QUIET | MTX_NOWITNESS); 146fc168902SWojciech Macek 147fc168902SWojciech Macek if (!pmap_bootstrapped) 148fc168902SWojciech Macek return; 149fc168902SWojciech Macek 150504d9b60SWojciech Macek mtx_lock_spin(&opalcons_buffer.mtx); 151fc168902SWojciech Macek 152504d9b60SWojciech Macek opalcons_buffer.size = *(uint64_t *)(*lenp) = 153504d9b60SWojciech Macek min(sizeof(opalcons_buffer.tmpbuf), *(uint64_t *)(*lenp)); 154504d9b60SWojciech Macek memcpy(opalcons_buffer.tmpbuf, (void *)(*bufferp), 155504d9b60SWojciech Macek *(uint64_t *)(*lenp)); 156504d9b60SWojciech Macek *bufferp = (uint64_t)opalcons_buffer.tmpbuf; 157504d9b60SWojciech Macek *lenp = (uint64_t)&opalcons_buffer.size; 158fc168902SWojciech Macek } 159fc168902SWojciech Macek 160fc168902SWojciech Macek static void 161504d9b60SWojciech Macek uart_opal_real_unmap_outbuffer(uint64_t *len) 162fc168902SWojciech Macek { 163fc168902SWojciech Macek 164504d9b60SWojciech Macek if (!pmap_bootstrapped) 165fc168902SWojciech Macek return; 166fc168902SWojciech Macek 167504d9b60SWojciech Macek mtx_assert(&opalcons_buffer.mtx, MA_OWNED); 168504d9b60SWojciech Macek *len = opalcons_buffer.size; 169504d9b60SWojciech Macek mtx_unlock_spin(&opalcons_buffer.mtx); 170fc168902SWojciech Macek } 171fc168902SWojciech Macek 172b8bc6b79SAlfredo Dal'Ava Junior static int64_t 173b8bc6b79SAlfredo Dal'Ava Junior uart_opal_console_write_buffer_space(int vtermid) 174b8bc6b79SAlfredo Dal'Ava Junior { 175b8bc6b79SAlfredo Dal'Ava Junior int64_t buffer_space_val = 0; 176b8bc6b79SAlfredo Dal'Ava Junior vm_paddr_t buffer_space_ptr; 177b8bc6b79SAlfredo Dal'Ava Junior 178b8bc6b79SAlfredo Dal'Ava Junior if (pmap_bootstrapped) 179b8bc6b79SAlfredo Dal'Ava Junior buffer_space_ptr = vtophys(&buffer_space_val); 180b8bc6b79SAlfredo Dal'Ava Junior else 181b8bc6b79SAlfredo Dal'Ava Junior buffer_space_ptr = (vm_paddr_t)&buffer_space_val; 182b8bc6b79SAlfredo Dal'Ava Junior 183b8bc6b79SAlfredo Dal'Ava Junior if (opal_call(OPAL_CONSOLE_WRITE_BUFFER_SPACE, vtermid, 184b8bc6b79SAlfredo Dal'Ava Junior buffer_space_ptr) != OPAL_SUCCESS) 185b8bc6b79SAlfredo Dal'Ava Junior return (-1); 186b8bc6b79SAlfredo Dal'Ava Junior 187b8bc6b79SAlfredo Dal'Ava Junior return (be64toh(buffer_space_val)); 188b8bc6b79SAlfredo Dal'Ava Junior } 189b8bc6b79SAlfredo Dal'Ava Junior 190fb3855e0SWojciech Macek static int 191fb3855e0SWojciech Macek uart_opal_probe_node(struct uart_opal_softc *sc) 192fb3855e0SWojciech Macek { 193fb3855e0SWojciech Macek phandle_t node = sc->node; 194fb3855e0SWojciech Macek uint32_t reg; 195fb3855e0SWojciech Macek char buf[64]; 196fb3855e0SWojciech Macek 197fb3855e0SWojciech Macek sc->inbuflen = 0; 198fb3855e0SWojciech Macek sc->outseqno = 0; 199fb3855e0SWojciech Macek 200fb3855e0SWojciech Macek if (OF_getprop(node, "device_type", buf, sizeof(buf)) <= 0) 201fb3855e0SWojciech Macek return (ENXIO); 202fb3855e0SWojciech Macek if (strcmp(buf, "serial") != 0) 203fb3855e0SWojciech Macek return (ENXIO); 204fb3855e0SWojciech Macek 205fb3855e0SWojciech Macek reg = -1; 206504d9b60SWojciech Macek OF_getencprop(node, "reg", ®, sizeof(reg)); 207fb3855e0SWojciech Macek if (reg == -1) 208fb3855e0SWojciech Macek return (ENXIO); 209fb3855e0SWojciech Macek sc->vtermid = reg; 210fb3855e0SWojciech Macek sc->node = node; 211fb3855e0SWojciech Macek 212fb3855e0SWojciech Macek if (OF_getprop(node, "compatible", buf, sizeof(buf)) <= 0) 213fb3855e0SWojciech Macek return (ENXIO); 214fb3855e0SWojciech Macek if (strcmp(buf, "ibm,opal-console-raw") == 0) { 215fb3855e0SWojciech Macek sc->protocol = OPAL_RAW; 216fb3855e0SWojciech Macek return (0); 217fb3855e0SWojciech Macek } else if (strcmp(buf, "ibm,opal-console-hvsi") == 0) { 218fb3855e0SWojciech Macek sc->protocol = OPAL_HVSI; 219fb3855e0SWojciech Macek return (0); 220fb3855e0SWojciech Macek } 221fb3855e0SWojciech Macek 222fb3855e0SWojciech Macek return (ENXIO); 223fb3855e0SWojciech Macek } 224fb3855e0SWojciech Macek 225fb3855e0SWojciech Macek static int 226fb3855e0SWojciech Macek uart_opal_probe(device_t dev) 227fb3855e0SWojciech Macek { 228fb3855e0SWojciech Macek struct uart_opal_softc sc; 229fb3855e0SWojciech Macek int err; 230fb3855e0SWojciech Macek 231fb3855e0SWojciech Macek sc.node = ofw_bus_get_node(dev); 232fb3855e0SWojciech Macek err = uart_opal_probe_node(&sc); 233fb3855e0SWojciech Macek if (err != 0) 234fb3855e0SWojciech Macek return (err); 235fb3855e0SWojciech Macek 236fb3855e0SWojciech Macek device_set_desc(dev, "OPAL Serial Port"); 237fb3855e0SWojciech Macek 238fb3855e0SWojciech Macek return (err); 239fb3855e0SWojciech Macek } 240fb3855e0SWojciech Macek 241fb3855e0SWojciech Macek static void 242fb3855e0SWojciech Macek uart_opal_cnprobe(struct consdev *cp) 243fb3855e0SWojciech Macek { 244fb3855e0SWojciech Macek char buf[64]; 245fb3855e0SWojciech Macek phandle_t input, chosen; 246fb3855e0SWojciech Macek static struct uart_opal_softc sc; 247fb3855e0SWojciech Macek 248fb3855e0SWojciech Macek if (opal_check() != 0) 249fb3855e0SWojciech Macek goto fail; 250fb3855e0SWojciech Macek 251fb3855e0SWojciech Macek if ((chosen = OF_finddevice("/chosen")) == -1) 252fb3855e0SWojciech Macek goto fail; 253fb3855e0SWojciech Macek 254fb3855e0SWojciech Macek /* Check if OF has an active stdin/stdout */ 255fb3855e0SWojciech Macek if (OF_getprop(chosen, "linux,stdout-path", buf, sizeof(buf)) <= 0) 256fb3855e0SWojciech Macek goto fail; 257fb3855e0SWojciech Macek 258fb3855e0SWojciech Macek input = OF_finddevice(buf); 259fb3855e0SWojciech Macek if (input == -1) 260fb3855e0SWojciech Macek goto fail; 261fb3855e0SWojciech Macek 262fb3855e0SWojciech Macek sc.node = input; 263fb3855e0SWojciech Macek if (uart_opal_probe_node(&sc) != 0) 264fb3855e0SWojciech Macek goto fail; 265fb3855e0SWojciech Macek mtx_init(&sc.sc_mtx, "uart_opal", NULL, MTX_SPIN | MTX_QUIET | 266fb3855e0SWojciech Macek MTX_NOWITNESS); 267fb3855e0SWojciech Macek 268fb3855e0SWojciech Macek cp->cn_pri = CN_NORMAL; 269fb3855e0SWojciech Macek console_sc = ≻ 270341679e1SJustin Hibbits cp->cn_arg = console_sc; 271341679e1SJustin Hibbits stdout_cp = cp; 272fb3855e0SWojciech Macek return; 273fb3855e0SWojciech Macek 274fb3855e0SWojciech Macek fail: 275fb3855e0SWojciech Macek cp->cn_pri = CN_DEAD; 276fb3855e0SWojciech Macek return; 277fb3855e0SWojciech Macek } 278fb3855e0SWojciech Macek 279fb3855e0SWojciech Macek static int 280fb3855e0SWojciech Macek uart_opal_attach(device_t dev) 281fb3855e0SWojciech Macek { 282fb3855e0SWojciech Macek struct uart_opal_softc *sc; 283fb3855e0SWojciech Macek int unit; 284fb3855e0SWojciech Macek 285fb3855e0SWojciech Macek sc = device_get_softc(dev); 286fb3855e0SWojciech Macek sc->node = ofw_bus_get_node(dev); 287fb3855e0SWojciech Macek uart_opal_probe_node(sc); 288fb3855e0SWojciech Macek 289fb3855e0SWojciech Macek unit = device_get_unit(dev); 290fb3855e0SWojciech Macek mtx_init(&sc->sc_mtx, device_get_nameunit(dev), NULL, 291fb3855e0SWojciech Macek MTX_SPIN | MTX_QUIET | MTX_NOWITNESS); 292fb3855e0SWojciech Macek 293fb3855e0SWojciech Macek if (console_sc != NULL && console_sc->vtermid == sc->vtermid) { 294fc168902SWojciech Macek device_printf(dev, "console\n"); 295341679e1SJustin Hibbits device_set_softc(dev, console_sc); 296341679e1SJustin Hibbits sc = console_sc; 297fb3855e0SWojciech Macek sprintf(uart_opal_consdev.cn_name, "ttyu%r", unit); 298fb3855e0SWojciech Macek } 299341679e1SJustin Hibbits sc->tp = tty_alloc(&uart_opal_tty_class, sc); 300fb3855e0SWojciech Macek 301341679e1SJustin Hibbits if (console_sc == sc) 302341679e1SJustin Hibbits tty_init_console(sc->tp, 0); 303341679e1SJustin Hibbits 304341679e1SJustin Hibbits sc->dev = dev; 305fb3855e0SWojciech Macek sc->irqrid = 0; 306fb3855e0SWojciech Macek sc->irqres = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irqrid, 307fb3855e0SWojciech Macek RF_ACTIVE | RF_SHAREABLE); 308fb3855e0SWojciech Macek if (sc->irqres != NULL) { 309fb3855e0SWojciech Macek bus_setup_intr(dev, sc->irqres, INTR_TYPE_TTY | INTR_MPSAFE, 310fb3855e0SWojciech Macek NULL, uart_opal_intr, sc, &sc->sc_icookie); 311fb3855e0SWojciech Macek } else { 312fb3855e0SWojciech Macek callout_init(&sc->callout, CALLOUT_MPSAFE); 313fb3855e0SWojciech Macek sc->polltime = hz / 20; 314fb3855e0SWojciech Macek if (sc->polltime < 1) 315fb3855e0SWojciech Macek sc->polltime = 1; 316fb3855e0SWojciech Macek callout_reset(&sc->callout, sc->polltime, uart_opal_intr, sc); 317fb3855e0SWojciech Macek } 318fb3855e0SWojciech Macek 319fb3855e0SWojciech Macek tty_makedev(sc->tp, NULL, "u%r", unit); 320fb3855e0SWojciech Macek 321fb3855e0SWojciech Macek return (0); 322fb3855e0SWojciech Macek } 323fb3855e0SWojciech Macek 324fb3855e0SWojciech Macek static void 325fb3855e0SWojciech Macek uart_opal_cninit(struct consdev *cp) 326fb3855e0SWojciech Macek { 327fb3855e0SWojciech Macek 328fb3855e0SWojciech Macek strcpy(cp->cn_name, "opalcons"); 329fb3855e0SWojciech Macek } 330fb3855e0SWojciech Macek 331fb3855e0SWojciech Macek static void 332fb3855e0SWojciech Macek uart_opal_cnterm(struct consdev *cp) 333fb3855e0SWojciech Macek { 334fb3855e0SWojciech Macek } 335fb3855e0SWojciech Macek 336fb3855e0SWojciech Macek static int 337fb3855e0SWojciech Macek uart_opal_get(struct uart_opal_softc *sc, void *buffer, size_t bufsize) 338fb3855e0SWojciech Macek { 339fb3855e0SWojciech Macek int err; 340fb3855e0SWojciech Macek int hdr = 0; 341fb3855e0SWojciech Macek 342fb3855e0SWojciech Macek if (sc->protocol == OPAL_RAW) { 34315be37cbSBrandon Bergren uint64_t len = htobe64(bufsize); 344fb3855e0SWojciech Macek uint64_t olen = (uint64_t)&len; 345fb3855e0SWojciech Macek uint64_t obuf = (uint64_t)buffer; 346fb3855e0SWojciech Macek 347fb3855e0SWojciech Macek if (pmap_bootstrapped) { 348fb3855e0SWojciech Macek olen = vtophys(&len); 349fb3855e0SWojciech Macek obuf = vtophys(buffer); 350fb3855e0SWojciech Macek } 351fb3855e0SWojciech Macek 352fb3855e0SWojciech Macek err = opal_call(OPAL_CONSOLE_READ, sc->vtermid, olen, obuf); 353fb3855e0SWojciech Macek if (err != OPAL_SUCCESS) 354fb3855e0SWojciech Macek return (-1); 355fb3855e0SWojciech Macek 35615be37cbSBrandon Bergren bufsize = be64toh(len); 357fb3855e0SWojciech Macek } else { 358fb3855e0SWojciech Macek uart_lock(&sc->sc_mtx); 359fb3855e0SWojciech Macek if (sc->inbuflen == 0) { 360fb3855e0SWojciech Macek err = opal_call(OPAL_CONSOLE_READ, sc->vtermid, 361fb3855e0SWojciech Macek &sc->inbuflen, sc->opal_inbuf); 362fb3855e0SWojciech Macek if (err != OPAL_SUCCESS) { 363fb3855e0SWojciech Macek uart_unlock(&sc->sc_mtx); 364fb3855e0SWojciech Macek return (-1); 365fb3855e0SWojciech Macek } 366fb3855e0SWojciech Macek hdr = 1; 36715be37cbSBrandon Bergren sc->inbuflen = be64toh(sc->inbuflen); 368fb3855e0SWojciech Macek } 369fb3855e0SWojciech Macek 370fb3855e0SWojciech Macek if (sc->inbuflen == 0) { 371fb3855e0SWojciech Macek uart_unlock(&sc->sc_mtx); 372fb3855e0SWojciech Macek return (0); 373fb3855e0SWojciech Macek } 374fb3855e0SWojciech Macek 375fb3855e0SWojciech Macek if (bufsize > sc->inbuflen) 376fb3855e0SWojciech Macek bufsize = sc->inbuflen; 377fb3855e0SWojciech Macek 378fb3855e0SWojciech Macek if (hdr == 1) { 379fb3855e0SWojciech Macek sc->inbuflen = sc->inbuflen - 4; 380fb3855e0SWojciech Macek /* The HVSI protocol has a 4 byte header, skip it */ 381fb3855e0SWojciech Macek memmove(&sc->opal_inbuf[0], &sc->opal_inbuf[4], 382fb3855e0SWojciech Macek sc->inbuflen); 383fb3855e0SWojciech Macek } 384fb3855e0SWojciech Macek 385fb3855e0SWojciech Macek memcpy(buffer, sc->opal_inbuf, bufsize); 386fb3855e0SWojciech Macek sc->inbuflen -= bufsize; 387fb3855e0SWojciech Macek if (sc->inbuflen > 0) 388fb3855e0SWojciech Macek memmove(&sc->opal_inbuf[0], &sc->opal_inbuf[bufsize], 389fb3855e0SWojciech Macek sc->inbuflen); 390fb3855e0SWojciech Macek 391fb3855e0SWojciech Macek uart_unlock(&sc->sc_mtx); 392fb3855e0SWojciech Macek } 393fb3855e0SWojciech Macek 394fb3855e0SWojciech Macek return (bufsize); 395fb3855e0SWojciech Macek } 396fb3855e0SWojciech Macek 397fb3855e0SWojciech Macek static int 398fb3855e0SWojciech Macek uart_opal_put(struct uart_opal_softc *sc, void *buffer, size_t bufsize) 399fb3855e0SWojciech Macek { 400fb3855e0SWojciech Macek uint16_t seqno; 401fc168902SWojciech Macek uint64_t len; 402fb3855e0SWojciech Macek char cbuf[16]; 403fb3855e0SWojciech Macek int err; 404fb3855e0SWojciech Macek uint64_t olen = (uint64_t)&len; 405fb3855e0SWojciech Macek uint64_t obuf = (uint64_t)cbuf; 406fb3855e0SWojciech Macek 407fb3855e0SWojciech Macek if (sc->protocol == OPAL_RAW) { 408fc168902SWojciech Macek obuf = (uint64_t)buffer; 409fc168902SWojciech Macek len = bufsize; 410fb3855e0SWojciech Macek 411fc168902SWojciech Macek uart_opal_real_map_outbuffer(&obuf, &olen); 41215be37cbSBrandon Bergren *(uint64_t*)olen = htobe64(*(uint64_t*)olen); 413fb3855e0SWojciech Macek err = opal_call(OPAL_CONSOLE_WRITE, sc->vtermid, olen, obuf); 41415be37cbSBrandon Bergren *(uint64_t*)olen = be64toh(*(uint64_t*)olen); 415504d9b60SWojciech Macek uart_opal_real_unmap_outbuffer(&len); 416fb3855e0SWojciech Macek } else { 417fb3855e0SWojciech Macek uart_lock(&sc->sc_mtx); 418fb3855e0SWojciech Macek if (bufsize > 12) 419fb3855e0SWojciech Macek bufsize = 12; 420fb3855e0SWojciech Macek seqno = sc->outseqno++; 421fb3855e0SWojciech Macek cbuf[0] = VS_DATA_PACKET_HEADER; 422fb3855e0SWojciech Macek cbuf[1] = 4 + bufsize; /* total length */ 423fb3855e0SWojciech Macek cbuf[2] = (seqno >> 8) & 0xff; 424fb3855e0SWojciech Macek cbuf[3] = seqno & 0xff; 425fb3855e0SWojciech Macek memcpy(&cbuf[4], buffer, bufsize); 426fb3855e0SWojciech Macek len = 4 + bufsize; 427fc168902SWojciech Macek 428fc168902SWojciech Macek uart_opal_real_map_outbuffer(&obuf, &olen); 42915be37cbSBrandon Bergren *(uint64_t*)olen = htobe64(*(uint64_t*)olen); 430fb3855e0SWojciech Macek err = opal_call(OPAL_CONSOLE_WRITE, sc->vtermid, olen, obuf); 43115be37cbSBrandon Bergren *(uint64_t*)olen = be64toh(*(uint64_t*)olen); 432504d9b60SWojciech Macek uart_opal_real_unmap_outbuffer(&len); 433fc168902SWojciech Macek 434fb3855e0SWojciech Macek uart_unlock(&sc->sc_mtx); 435fb3855e0SWojciech Macek 436fb3855e0SWojciech Macek len -= 4; 437fb3855e0SWojciech Macek } 438fb3855e0SWojciech Macek 439b8bc6b79SAlfredo Dal'Ava Junior if (err == OPAL_SUCCESS) 440fb3855e0SWojciech Macek return (len); 441b8bc6b79SAlfredo Dal'Ava Junior else if (err == OPAL_BUSY_EVENT) 442b8bc6b79SAlfredo Dal'Ava Junior return(0); 443b8bc6b79SAlfredo Dal'Ava Junior 444b8bc6b79SAlfredo Dal'Ava Junior return (-1); 445fb3855e0SWojciech Macek } 446fb3855e0SWojciech Macek 447fb3855e0SWojciech Macek static int 448fb3855e0SWojciech Macek uart_opal_cngetc(struct consdev *cp) 449fb3855e0SWojciech Macek { 450341679e1SJustin Hibbits return (uart_opal_getc(cp->cn_arg)); 451341679e1SJustin Hibbits } 452341679e1SJustin Hibbits 453341679e1SJustin Hibbits static int 454341679e1SJustin Hibbits uart_opal_getc(struct uart_opal_softc *sc) 455341679e1SJustin Hibbits { 456fb3855e0SWojciech Macek unsigned char c; 457fb3855e0SWojciech Macek int retval; 458fb3855e0SWojciech Macek 459341679e1SJustin Hibbits retval = uart_opal_get(sc, &c, 1); 460fb3855e0SWojciech Macek if (retval != 1) 461fb3855e0SWojciech Macek return (-1); 462fb3855e0SWojciech Macek #if defined(KDB) 463341679e1SJustin Hibbits kdb_alt_break(c, &sc->alt_break_state); 464fb3855e0SWojciech Macek #endif 465fb3855e0SWojciech Macek 466fb3855e0SWojciech Macek return (c); 467fb3855e0SWojciech Macek } 468fb3855e0SWojciech Macek 469fb3855e0SWojciech Macek static void 470fb3855e0SWojciech Macek uart_opal_cnputc(struct consdev *cp, int c) 471fb3855e0SWojciech Macek { 472fb3855e0SWojciech Macek unsigned char ch = c; 4736005affbSWojciech Macek int a; 474504d9b60SWojciech Macek 4756005affbSWojciech Macek if (1) { 4766005affbSWojciech Macek /* Clear FIFO if needed. Must be repeated few times. */ 4776005affbSWojciech Macek for (a = 0; a < 20; a++) { 4786005affbSWojciech Macek opal_call(OPAL_POLL_EVENTS, NULL); 4796005affbSWojciech Macek } 4806005affbSWojciech Macek } 481341679e1SJustin Hibbits uart_opal_put(cp->cn_arg, &ch, 1); 482fb3855e0SWojciech Macek } 483fb3855e0SWojciech Macek 484fb3855e0SWojciech Macek static void 485fb3855e0SWojciech Macek uart_opal_cngrab(struct consdev *cp) 486fb3855e0SWojciech Macek { 487fb3855e0SWojciech Macek } 488fb3855e0SWojciech Macek 489fb3855e0SWojciech Macek static void 490fb3855e0SWojciech Macek uart_opal_cnungrab(struct consdev *cp) 491fb3855e0SWojciech Macek { 492fb3855e0SWojciech Macek } 493fb3855e0SWojciech Macek 494fb3855e0SWojciech Macek static void 495fb3855e0SWojciech Macek uart_opal_ttyoutwakeup(struct tty *tp) 496fb3855e0SWojciech Macek { 497fb3855e0SWojciech Macek struct uart_opal_softc *sc; 498fb3855e0SWojciech Macek char buffer[8]; 499fb3855e0SWojciech Macek int len; 500b8bc6b79SAlfredo Dal'Ava Junior int64_t buffer_space; 501fb3855e0SWojciech Macek 502fb3855e0SWojciech Macek sc = tty_softc(tp); 503fb3855e0SWojciech Macek 504b8bc6b79SAlfredo Dal'Ava Junior while ((len = ttydisc_getc(tp, buffer, sizeof(buffer))) != 0) { 505b8bc6b79SAlfredo Dal'Ava Junior int bytes_written = 0; 506b8bc6b79SAlfredo Dal'Ava Junior while (bytes_written == 0) { 507b8bc6b79SAlfredo Dal'Ava Junior buffer_space = uart_opal_console_write_buffer_space(sc->vtermid); 508b8bc6b79SAlfredo Dal'Ava Junior if (buffer_space == -1) 509b8bc6b79SAlfredo Dal'Ava Junior /* OPAL failure or invalid terminal */ 510b8bc6b79SAlfredo Dal'Ava Junior break; 511b8bc6b79SAlfredo Dal'Ava Junior else if (buffer_space >= len) 512b8bc6b79SAlfredo Dal'Ava Junior bytes_written = uart_opal_put(sc, buffer, len); 513b8bc6b79SAlfredo Dal'Ava Junior 514b8bc6b79SAlfredo Dal'Ava Junior if (bytes_written == 0) 515b8bc6b79SAlfredo Dal'Ava Junior /* OPAL must be busy, poll and retry */ 516b8bc6b79SAlfredo Dal'Ava Junior opal_call(OPAL_POLL_EVENTS, NULL); 517b8bc6b79SAlfredo Dal'Ava Junior else if (bytes_written == -1) 518b8bc6b79SAlfredo Dal'Ava Junior /* OPAL failure or invalid terminal */ 519b8bc6b79SAlfredo Dal'Ava Junior break; 520b8bc6b79SAlfredo Dal'Ava Junior } 521b8bc6b79SAlfredo Dal'Ava Junior } 522fb3855e0SWojciech Macek } 523fb3855e0SWojciech Macek 524fb3855e0SWojciech Macek static void 525fb3855e0SWojciech Macek uart_opal_intr(void *v) 526fb3855e0SWojciech Macek { 527fb3855e0SWojciech Macek struct uart_opal_softc *sc = v; 528fb3855e0SWojciech Macek struct tty *tp = sc->tp; 5290b1f36b6SJustin Hibbits int c; 530fb3855e0SWojciech Macek 531fb3855e0SWojciech Macek tty_lock(tp); 532341679e1SJustin Hibbits while ((c = uart_opal_getc(sc)) > 0) 533fb3855e0SWojciech Macek ttydisc_rint(tp, c, 0); 534fb3855e0SWojciech Macek ttydisc_rint_done(tp); 535fb3855e0SWojciech Macek tty_unlock(tp); 536fb3855e0SWojciech Macek 5376005affbSWojciech Macek opal_call(OPAL_POLL_EVENTS, NULL); 5386005affbSWojciech Macek 539fb3855e0SWojciech Macek if (sc->irqres == NULL) 540fb3855e0SWojciech Macek callout_reset(&sc->callout, sc->polltime, uart_opal_intr, sc); 541fb3855e0SWojciech Macek } 542fb3855e0SWojciech Macek 54332d1354aSWojciech Macek static int 54432d1354aSWojciech Macek opalcons_probe(device_t dev) 54532d1354aSWojciech Macek { 54632d1354aSWojciech Macek const char *name; 54732d1354aSWojciech Macek 54832d1354aSWojciech Macek name = ofw_bus_get_name(dev); 54932d1354aSWojciech Macek if (name == NULL || strcmp(name, "consoles") != 0) 55032d1354aSWojciech Macek return (ENXIO); 55132d1354aSWojciech Macek 55232d1354aSWojciech Macek device_set_desc(dev, "OPAL Consoles"); 55332d1354aSWojciech Macek return (BUS_PROBE_SPECIFIC); 55432d1354aSWojciech Macek } 55532d1354aSWojciech Macek 55632d1354aSWojciech Macek static int 55732d1354aSWojciech Macek opalcons_attach(device_t dev) 55832d1354aSWojciech Macek { 55932d1354aSWojciech Macek phandle_t child; 56032d1354aSWojciech Macek device_t cdev; 56132d1354aSWojciech Macek struct ofw_bus_devinfo *dinfo; 56232d1354aSWojciech Macek 56332d1354aSWojciech Macek for (child = OF_child(ofw_bus_get_node(dev)); child != 0; 56432d1354aSWojciech Macek child = OF_peer(child)) { 56532d1354aSWojciech Macek dinfo = malloc(sizeof(*dinfo), M_DEVBUF, M_WAITOK | M_ZERO); 56632d1354aSWojciech Macek if (ofw_bus_gen_setup_devinfo(dinfo, child) != 0) { 56732d1354aSWojciech Macek free(dinfo, M_DEVBUF); 56832d1354aSWojciech Macek continue; 56932d1354aSWojciech Macek } 5705b56413dSWarner Losh cdev = device_add_child(dev, NULL, DEVICE_UNIT_ANY); 57132d1354aSWojciech Macek if (cdev == NULL) { 57232d1354aSWojciech Macek device_printf(dev, "<%s>: device_add_child failed\n", 57332d1354aSWojciech Macek dinfo->obd_name); 57432d1354aSWojciech Macek ofw_bus_gen_destroy_devinfo(dinfo); 57532d1354aSWojciech Macek free(dinfo, M_DEVBUF); 57632d1354aSWojciech Macek continue; 57732d1354aSWojciech Macek } 57832d1354aSWojciech Macek device_set_ivars(cdev, dinfo); 57932d1354aSWojciech Macek } 58032d1354aSWojciech Macek 581*18250ec6SJohn Baldwin bus_attach_children(dev); 582*18250ec6SJohn Baldwin return (0); 58332d1354aSWojciech Macek } 58432d1354aSWojciech Macek 58532d1354aSWojciech Macek static const struct ofw_bus_devinfo * 58632d1354aSWojciech Macek opalcons_get_devinfo(device_t dev, device_t child) 58732d1354aSWojciech Macek { 58832d1354aSWojciech Macek return (device_get_ivars(child)); 58932d1354aSWojciech Macek } 59032d1354aSWojciech Macek 59132d1354aSWojciech Macek static device_method_t opalcons_methods[] = { 59232d1354aSWojciech Macek /* Device interface */ 59332d1354aSWojciech Macek DEVMETHOD(device_probe, opalcons_probe), 59432d1354aSWojciech Macek DEVMETHOD(device_attach, opalcons_attach), 59532d1354aSWojciech Macek 59632d1354aSWojciech Macek /* ofw_bus interface */ 59732d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_devinfo, opalcons_get_devinfo), 59832d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_compat, ofw_bus_gen_get_compat), 59932d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_model, ofw_bus_gen_get_model), 60032d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_name, ofw_bus_gen_get_name), 60132d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_node, ofw_bus_gen_get_node), 60232d1354aSWojciech Macek DEVMETHOD(ofw_bus_get_type, ofw_bus_gen_get_type), 60332d1354aSWojciech Macek 60432d1354aSWojciech Macek DEVMETHOD_END 60532d1354aSWojciech Macek }; 60632d1354aSWojciech Macek 60732d1354aSWojciech Macek static driver_t opalcons_driver = { 60832d1354aSWojciech Macek "opalcons", 60932d1354aSWojciech Macek opalcons_methods, 61032d1354aSWojciech Macek 0 61132d1354aSWojciech Macek }; 61232d1354aSWojciech Macek 6135edf159fSJohn Baldwin DRIVER_MODULE(opalcons, opal, opalcons_driver, 0, 0); 614