Source-Changes-HG archive

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]

[src/trunk]: src/sys/arch Add a driver for the Apple GPIO controller found in...



details:   https://anonhg.NetBSD.org/src/rev/58578a37c669
branches:  trunk
changeset: 365827:58578a37c669
user:      skrll <skrll%NetBSD.org@localhost>
date:      Wed Apr 27 07:59:18 2022 +0000

description:
Add a driver for the Apple GPIO controller found in Apple silicon.

Derived from the OpenBSD driver.

diffstat:

 sys/arch/arm/apple/apple_pinctrl.c |  299 +++++++++++++++++++++++++++++++++++++
 sys/arch/arm/apple/files.apple     |    8 +-
 sys/arch/evbarm/conf/GENERIC64     |    3 +-
 3 files changed, 308 insertions(+), 2 deletions(-)

diffs (truncated from 343 to 300 lines):

diff -r 439258384885 -r 58578a37c669 sys/arch/arm/apple/apple_pinctrl.c
--- /dev/null   Thu Jan 01 00:00:00 1970 +0000
+++ b/sys/arch/arm/apple/apple_pinctrl.c        Wed Apr 27 07:59:18 2022 +0000
@@ -0,0 +1,299 @@
+/*     $NetBSD: apple_pinctrl.c,v 1.1 2022/04/27 07:59:18 skrll Exp $  */
+/*     $OpenBSD: aplpinctrl.c,v 1.4 2022/04/06 18:59:26 naddy Exp $    */
+
+/*-
+ * Copyright (c) 2022 The NetBSD Foundation, Inc.
+ * All rights reserved.
+ *
+ * This code is derived from software contributed to The NetBSD Foundation
+ * by Nick Hudson
+ *
+ * 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 NETBSD FOUNDATION, INC. AND CONTRIBUTORS
+ * ``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 FOUNDATION OR CONTRIBUTORS
+ * 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.
+ */
+
+/*
+ * Copyright (c) 2021 Mark Kettenis <kettenis%openbsd.org@localhost>
+ *
+ * Permission to use, copy, modify, and distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#include <sys/cdefs.h>
+__KERNEL_RCSID(0, "$NetBSD: apple_pinctrl.c,v 1.1 2022/04/27 07:59:18 skrll Exp $");
+
+#include <sys/param.h>
+#include <sys/bus.h>
+#include <sys/device.h>
+#include <sys/kmem.h>
+
+#include <dev/fdt/fdtvar.h>
+
+#include <arm/pic/picvar.h>
+
+#define APPLE_PIN(pinmux)      __SHIFTOUT((pinmux), __BITS(15, 0))
+#define APPLE_FUNC(pinmux)     __SHIFTOUT((pinmux), __BITS(31, 16))
+
+#define GPIO_PIN(pin)          ((pin) * 4)
+#define  GPIO_PIN_GROUP_MASK   __BITS(18, 16)
+#define  GPIO_PIN_INPUT_ENABLE __BIT(9)
+#define  GPIO_PIN_FUNC_MASK    __BITS(6, 5)
+#define  GPIO_PIN_MODE_MASK    __BITS(3, 1)
+#define  GPIO_PIN_MODE_INPUT    __SHIFTIN(0, GPIO_PIN_MODE_MASK);
+#define  GPIO_PIN_MODE_OUTPUT   __SHIFTIN(1, GPIO_PIN_MODE_MASK);
+#define  GPIO_PIN_MODE_IRQ_HI   __SHIFTIN(2, GPIO_PIN_MODE_MASK);
+#define  GPIO_PIN_MODE_IRQ_LO   __SHIFTIN(3, GPIO_PIN_MODE_MASK);
+#define  GPIO_PIN_MODE_IRQ_UP   __SHIFTIN(4, GPIO_PIN_MODE_MASK);
+#define  GPIO_PIN_MODE_IRQ_DN   __SHIFTIN(5, GPIO_PIN_MODE_MASK);
+#define  GPIO_PIN_MODE_IRQ_ANY  __SHIFTIN(6, GPIO_PIN_MODE_MASK);
+#define  GPIO_PIN_MODE_IRQ_OFF  __SHIFTIN(7, GPIO_PIN_MODE_MASK);
+#define  GPIO_PIN_DATA         __BIT(0)
+#define GPIO_IRQ(grp, pin)     (0x800 + (grp) * 64 + ((pin) >> 5) * 4)
+
+#define PINCTRL_READ(sc, reg)                                          \
+       (bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg)))
+#define PINCTRL_WRITE(sc, reg, val)                                    \
+       bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
+#define PINCTRL_SET(sc, reg, bits)                                     \
+       PINCTRL_WRITE((sc), (reg), PINCTRL_READ((sc), (reg)) | (bits))
+#define PINCTRL_CLR(sc, reg, bits)                                     \
+       PINCTRL_WRITE((sc), (reg), PINCTRL_READ((sc), (reg)) & ~(bits))
+
+
+struct apple_pinctrl_softc {
+       device_t sc_dev;
+       int sc_phandle;
+       bus_space_tag_t sc_bst;
+       bus_space_handle_t sc_bsh;
+       u_int sc_npins;
+};
+
+struct apple_gpio_pin {
+       int             pin_no;
+       u_int           pin_flags;
+       bool            pin_actlo;
+};
+
+static const struct device_compatible_entry compat_data[] = {
+       { .compat = "apple,pinctrl" },
+       DEVICE_COMPAT_EOL
+};
+
+static void
+apple_gpio_pin_ctl(void *cookie, int pin, int flags)
+{
+       struct apple_pinctrl_softc * const sc = cookie;
+
+       KASSERT(pin < sc->sc_npins);
+
+       uint32_t reg = PINCTRL_READ(sc, GPIO_PIN(pin));
+       reg &= ~GPIO_PIN_FUNC_MASK;
+       reg &= ~GPIO_PIN_MODE_MASK;
+
+       if (flags & (GPIO_PIN_OUTPUT | GPIO_PIN_INPUT)) {
+               if (flags & GPIO_PIN_INPUT) {
+                       /* for safety INPUT will override output */
+                       reg |= GPIO_PIN_MODE_INPUT;
+               } else {
+                       reg |= GPIO_PIN_MODE_OUTPUT;
+               }
+       }
+       PINCTRL_WRITE(sc, GPIO_PIN(pin), reg);
+}
+
+static void *
+apple_pinctrl_gpio_acquire(device_t dev, const void *data, size_t len, int flags)
+{
+       struct apple_pinctrl_softc * const sc = device_private(dev);
+       struct apple_gpio_pin *pin;
+       const u_int *gpio = data;
+
+       if (len != 12)
+               return NULL;
+
+       const u_int pinno = be32toh(gpio[1]);
+       const bool actlo = be32toh(gpio[2]) & 1;
+
+       if (pinno >= sc->sc_npins)
+               return NULL;
+
+       pin = kmem_alloc(sizeof(*pin), KM_SLEEP);
+       pin->pin_no = pinno;
+       pin->pin_flags = flags;
+       pin->pin_actlo = actlo;
+
+       apple_gpio_pin_ctl(sc, pin->pin_no, pin->pin_flags);
+
+       return pin;
+}
+
+static void
+apple_pinctrl_gpio_release(device_t dev, void *priv)
+{
+       struct apple_pinctrl_softc * const sc = device_private(dev);
+       struct apple_gpio_pin *pin = priv;
+
+       apple_gpio_pin_ctl(sc, pin->pin_no, GPIO_PIN_INPUT);
+       kmem_free(pin, sizeof(*pin));
+}
+
+static int
+apple_pinctrl_gpio_read(device_t dev, void *priv, bool raw)
+{
+       struct apple_pinctrl_softc * const sc = device_private(dev);
+       struct apple_gpio_pin *pin = priv;
+
+       KASSERT(pin->pin_no < sc->sc_npins);
+
+       uint32_t reg = PINCTRL_READ(sc, GPIO_PIN(pin->pin_no));
+       int val = __SHIFTOUT(reg, GPIO_PIN_DATA);
+       if (!raw && pin->pin_actlo)
+               val = !val;
+
+       return val;
+}
+
+static void
+apple_pinctrl_gpio_write(device_t dev, void *priv, int val, bool raw)
+{
+       struct apple_pinctrl_softc * const sc = device_private(dev);
+       struct apple_gpio_pin *pin = priv;
+
+       KASSERT(pin->pin_no < sc->sc_npins);
+
+       if (!raw && pin->pin_actlo)
+               val = !val;
+
+       if (val)
+               PINCTRL_SET(sc, GPIO_PIN(pin->pin_no), GPIO_PIN_DATA);
+       else
+               PINCTRL_CLR(sc, GPIO_PIN(pin->pin_no), GPIO_PIN_DATA);
+}
+
+static int
+apple_pinctrl_set_config(device_t dev, const void *data, size_t len)
+{
+       struct apple_pinctrl_softc * const sc = device_private(dev);
+
+       if (len != 4)
+               return -1;
+
+       int pins_len;
+       const int phandle = fdtbus_get_phandle_from_native(be32dec(data));
+       const u_int *pins = fdtbus_get_prop(phandle, "pinmux", &pins_len);
+
+       if (pins == NULL)
+               return -1;
+
+       const u_int npins = pins_len / sizeof(uint32_t);
+
+       for (u_int i = 0; i < npins; i++) {
+               uint32_t pinmux = be32dec(&pins[i]);
+               u_int pinno = APPLE_PIN(pinmux);
+               u_int func = APPLE_FUNC(pinmux);
+
+               uint32_t reg = PINCTRL_READ(sc, GPIO_PIN(pinno));
+               reg &= ~GPIO_PIN_FUNC_MASK;
+               reg |= __SHIFTIN(func, GPIO_PIN_FUNC_MASK);
+
+               PINCTRL_WRITE(sc, GPIO_PIN(pinno), reg);
+       }
+
+       return 0;
+}
+
+static struct fdtbus_gpio_controller_func apple_pinctrl_gpio_funcs = {
+       .acquire = apple_pinctrl_gpio_acquire,
+       .release = apple_pinctrl_gpio_release,
+       .read = apple_pinctrl_gpio_read,
+       .write = apple_pinctrl_gpio_write
+};
+
+static struct fdtbus_pinctrl_controller_func apple_pinctrl_funcs = {
+       .set_config = apple_pinctrl_set_config,
+};
+
+static int
+apple_pinctrl_match(device_t parent, cfdata_t cf, void *aux)
+{
+       struct fdt_attach_args * const faa = aux;
+
+       return of_compatible_match(faa->faa_phandle, compat_data);
+}
+
+static void
+apple_pinctrl_attach(device_t parent, device_t self, void *aux)
+{
+       struct apple_pinctrl_softc * const sc = device_private(self);
+       struct fdt_attach_args * const faa = aux;
+       const int phandle = faa->faa_phandle;
+       bus_addr_t addr;
+       bus_size_t size;
+
+       if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
+               aprint_error(": couldn't get registers\n");
+               return;
+       }
+
+       sc->sc_dev = self;
+       sc->sc_bst = faa->faa_bst;
+
+       if (bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh) != 0) {
+               aprint_error(": couldn't map registers\n");
+               return;
+       }
+
+       if (of_getprop_uint32(phandle, "apple,npins", &sc->sc_npins)) {
+               aprint_error(": couldn't get number of pins\n");
+               return;
+       }
+
+       if (!of_hasprop(phandle, "gpio-controller")) {
+               aprint_error(": no gpio controller");
+               return;
+       }
+
+       aprint_naive("\n");
+       aprint_normal(": Apple Pinctrl\n");
+
+       fdtbus_register_gpio_controller(self, phandle, &apple_pinctrl_gpio_funcs);
+
+       for (int child = OF_child(phandle); child; child = OF_peer(child)) {
+               if (!of_hasprop(child, "pinmux"))
+                       continue;
+               fdtbus_register_pinctrl_config(self, child,
+                   &apple_pinctrl_funcs);
+
+       }
+}
+



Home | Main Index | Thread Index | Old Index