From 08e913c0939065680f2a74028fde21778461c6f5 Mon Sep 17 00:00:00 2001 From: jmcneill Date: Sat, 3 Jun 2017 17:03:36 +0000 Subject: [PATCH] Add driver for ARM PrimeCell PL050 (KMI) PS2 keyboard/mouse interface --- sys/conf/files | 6 +- sys/dev/ic/pl050.c | 186 ++++++++++++++++++++++++++++++++++++++++++ sys/dev/ic/pl050var.h | 46 +++++++++++ 3 files changed, 237 insertions(+), 1 deletion(-) create mode 100644 sys/dev/ic/pl050.c create mode 100644 sys/dev/ic/pl050var.h diff --git a/sys/conf/files b/sys/conf/files index 16e2ca89660d..d7f74e69c07e 100644 --- a/sys/conf/files +++ b/sys/conf/files @@ -1,4 +1,4 @@ -# $NetBSD: files,v 1.1172 2017/05/27 21:02:56 bouyer Exp $ +# $NetBSD: files,v 1.1173 2017/06/03 17:03:36 jmcneill Exp $ # @(#)files.newconf 7.5 (Berkeley) 5/10/93 version 20150846 @@ -1315,6 +1315,10 @@ defflag opt_dwc_mmc.h DWC_MMC_DEBUG device dwcmmc: sdmmcbus file dev/ic/dwc_mmc.c dwcmmc +# ARM PrimeCell PL050 (KMI) PS2 keyboard/mouse interface +device plkmi: pckbport +file dev/ic/pl050.c plkmi + # ARM PrimeCell PL181 (MMCI) host controller device plmmc: sdmmcbus file dev/ic/pl181.c plmmc diff --git a/sys/dev/ic/pl050.c b/sys/dev/ic/pl050.c new file mode 100644 index 000000000000..b0f270e607be --- /dev/null +++ b/sys/dev/ic/pl050.c @@ -0,0 +1,186 @@ +/* $NetBSD: pl050.c,v 1.1 2017/06/03 17:03:36 jmcneill Exp $ */ + +/*- + * Copyright (c) 2017 Jared McNeill + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES + * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. + * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, + * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; + * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED + * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, + * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +__KERNEL_RCSID(0, "$NetBSD: pl050.c,v 1.1 2017/06/03 17:03:36 jmcneill Exp $"); + +#include +#include +#include +#include +#include + +#include + +#include + +#define KMICR 0x00 +#define KMIRXINTREN __BIT(4) +#define KMIEN __BIT(2) +#define KMISTAT 0x04 +#define TXEMPTY __BIT(6) +#define RXFULL __BIT(4) +#define KMIDATA 0x08 +#define KMICLKDIV 0x0c +#define KMIIR 0x10 +#define KMIRXINTR __BIT(0) + +#define PLKMI_READ(sc, reg) \ + bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg)) +#define PLKMI_WRITE(sc, reg, val) \ + bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val)) + +static int +plkmi_wait(struct plkmi_softc *sc, uint32_t mask, bool set) +{ + int timeout = 1000; + + const uint32_t val = (set ? mask : 0); + + while (timeout-- > 0) { + const uint32_t stat = PLKMI_READ(sc, KMISTAT); + if ((stat & mask) == val) + return 0; + delay(10); + } + + return ETIMEDOUT; +} + +static int +plkmi_xt_translation(void *priv, pckbport_slot_t port, int on) +{ + if (on) + return 0; + return 1; +} + +static int +plkmi_send_devcmd(void *priv, pckbport_slot_t slot, u_char byte) +{ + struct plkmi_softc * const sc = priv; + + if (plkmi_wait(sc, TXEMPTY, true)) + return 0; + + PLKMI_WRITE(sc, KMIDATA, byte & 0xff); + + return 1; +} + +static int +plkmi_poll_data1(void *priv, pckbport_slot_t slot) +{ + struct plkmi_softc * const sc = priv; + + if (plkmi_wait(sc, RXFULL, true)) + return -1; + + return PLKMI_READ(sc, KMIDATA) & 0xff; +} + +static void +plkmi_slot_enable(void *priv, pckbport_slot_t slot, int on) +{ + struct plkmi_softc * const sc = priv; + uint32_t cr; + + cr = PLKMI_READ(sc, KMICR); + if (on) + cr |= KMIEN; + else + cr &= ~KMIEN; + PLKMI_WRITE(sc, KMICR, cr); +} + +static void +plkmi_set_poll(void *priv, pckbport_slot_t slot, int on) +{ + struct plkmi_softc * const sc = priv; + uint32_t cr; + + cr = PLKMI_READ(sc, KMICR); + if (on) + cr &= ~KMIRXINTREN; + else + cr |= KMIRXINTREN; + PLKMI_WRITE(sc, KMICR, cr); +} + +static void +plkmi_intr_establish(void *priv, pckbport_slot_t slot) +{ + /* XXX */ + plkmi_set_poll(priv, slot, 0); +} + +static struct pckbport_accessops plkmi_ops = { + .t_xt_translation = plkmi_xt_translation, + .t_send_devcmd = plkmi_send_devcmd, + .t_poll_data1 = plkmi_poll_data1, + .t_slot_enable = plkmi_slot_enable, + .t_set_poll = plkmi_set_poll, + .t_intr_establish = plkmi_intr_establish, +}; + +void +plkmi_attach(struct plkmi_softc *sc) +{ + aprint_naive("\n"); + aprint_normal(": PS2 controller\n"); + + sc->sc_pt = pckbport_attach(sc, &plkmi_ops); + sc->sc_slot = -1; + + PLKMI_WRITE(sc, KMICR, KMIEN); + + for (int slot = 0; slot < PCKBPORT_NSLOTS; slot++) + if (pckbport_attach_slot(sc->sc_dev, sc->sc_pt, slot)) { + sc->sc_slot = slot; + break; + } +} + +int +plkmi_intr(void *priv) +{ + struct plkmi_softc * const sc = priv; + int handled = 0; + + if (sc->sc_slot == -1) + return 0; + + const uint32_t stat = PLKMI_READ(sc, KMISTAT); + if (stat & RXFULL) { + const uint32_t val = PLKMI_READ(sc, KMIDATA); + pckbportintr(sc->sc_pt, sc->sc_slot, val & 0xff); + handled = 1; + } + + return handled; +} diff --git a/sys/dev/ic/pl050var.h b/sys/dev/ic/pl050var.h new file mode 100644 index 000000000000..710ca733b2d9 --- /dev/null +++ b/sys/dev/ic/pl050var.h @@ -0,0 +1,46 @@ +/* $NetBSD: pl050var.h,v 1.1 2017/06/03 17:03:36 jmcneill Exp $ */ + +/*- + * Copyright (c) 2017 Jared McNeill + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES + * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. + * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, + * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; + * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED + * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, + * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#ifndef _PL050VAR_H +#define _PL050VAR_H + +#include + +struct plkmi_softc { + device_t sc_dev; + bus_space_tag_t sc_bst; + bus_space_handle_t sc_bsh; + + pckbport_tag_t sc_pt; + int sc_slot; +}; + +void plkmi_attach(struct plkmi_softc *); +int plkmi_intr(void *); + +#endif /* !_PL050VAR_H */