Module Name: src
Committed By: jmcneill
Date: Sat Jun 3 17:03:36 UTC 2017
Modified Files:
src/sys/conf: files
Added Files:
src/sys/dev/ic: pl050.c pl050var.h
Log Message:
Add driver for ARM PrimeCell PL050 (KMI) PS2 keyboard/mouse interface
To generate a diff of this commit:
cvs rdiff -u -r1.1172 -r1.1173 src/sys/conf/files
cvs rdiff -u -r0 -r1.1 src/sys/dev/ic/pl050.c src/sys/dev/ic/pl050var.h
Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.
Modified files:
Index: src/sys/conf/files
diff -u src/sys/conf/files:1.1172 src/sys/conf/files:1.1173
--- src/sys/conf/files:1.1172 Sat May 27 21:02:56 2017
+++ src/sys/conf/files Sat Jun 3 17:03:36 2017
@@ -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
Added files:
Index: src/sys/dev/ic/pl050.c
diff -u /dev/null src/sys/dev/ic/pl050.c:1.1
--- /dev/null Sat Jun 3 17:03:36 2017
+++ src/sys/dev/ic/pl050.c Sat Jun 3 17:03:36 2017
@@ -0,0 +1,186 @@
+/* $NetBSD: pl050.c,v 1.1 2017/06/03 17:03:36 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2017 Jared McNeill <[email protected]>
+ * 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 <sys/cdefs.h>
+__KERNEL_RCSID(0, "$NetBSD: pl050.c,v 1.1 2017/06/03 17:03:36 jmcneill Exp $");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/device.h>
+#include <sys/kmem.h>
+#include <sys/bus.h>
+
+#include <dev/pckbport/pckbportvar.h>
+
+#include <dev/ic/pl050var.h>
+
+#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;
+}
Index: src/sys/dev/ic/pl050var.h
diff -u /dev/null src/sys/dev/ic/pl050var.h:1.1
--- /dev/null Sat Jun 3 17:03:36 2017
+++ src/sys/dev/ic/pl050var.h Sat Jun 3 17:03:36 2017
@@ -0,0 +1,46 @@
+/* $NetBSD: pl050var.h,v 1.1 2017/06/03 17:03:36 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2017 Jared McNeill <[email protected]>
+ * 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 <dev/pckbport/pckbportvar.h>
+
+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 */
