Author: manu
Date: Thu Apr 26 21:37:38 2018
New Revision: 333038
URL: https://svnweb.freebsd.org/changeset/base/333038

Log:
  arm64: rockchip: Add pinctrl driver
  
  Add pinctrl driver for RockChip SoCs. This device manage which function
  to set on which pin and some other properties like pull up/down, drive
  strength etc ...
  For now the driver only support RK3328 but it is versatile enough to
  add support for other RockChip SoC in the future.

Added:
  head/share/man/man4/rk_pinctrl.4   (contents, props changed)
  head/sys/arm64/rockchip/rk_pinctrl.c   (contents, props changed)
Modified:
  head/share/man/man4/Makefile
  head/sys/conf/files.arm64

Modified: head/share/man/man4/Makefile
==============================================================================
--- head/share/man/man4/Makefile        Thu Apr 26 21:35:04 2018        
(r333037)
+++ head/share/man/man4/Makefile        Thu Apr 26 21:37:38 2018        
(r333038)
@@ -445,6 +445,7 @@ MAN=        aac.4 \
        rgephy.4 \
        rights.4 \
        ${_rk_grf.4} \
+       ${_rk_pinctrl.4} \
        rl.4 \
        rndtest.4 \
        route.4 \
@@ -767,6 +768,7 @@ MLINKS+=xl.4 if_xl.4
 .if ${MACHINE_CPUARCH} == "aarch64"
 _armv8crypto.4=        armv8crypto.4
 _rk_grf.4=     rk_grf.4
+_rk_pinctrl.4= rk_pinctrl.4
 .endif
 
 .if ${MACHINE_CPUARCH} == "arm" || ${MACHINE_CPUARCH} == "aarch64"

Added: head/share/man/man4/rk_pinctrl.4
==============================================================================
--- /dev/null   00:00:00 1970   (empty, because file is newly added)
+++ head/share/man/man4/rk_pinctrl.4    Thu Apr 26 21:37:38 2018        
(r333038)
@@ -0,0 +1,62 @@
+.\"-
+.\" Copyright (c) 2018 Emmanuel Vadot <m...@freebsd.org>
+.\" 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 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 AUTHOR 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.
+.\"
+.\" $FreeBSD$
+.\"
+.Dd Apr 26, 2018
+.Dt RK_PINCTRL 4
+.Os
+.Sh NAME
+.Nm rk_pinctrl
+.Nd driver for the pin multiplexing on RockChip SoCs
+.Sh SYNOPSIS
+.Cd "options SOC_ROCKCHIP_RK3328"
+.Sh DESCRIPTION
+The
+.Nm
+device driver provides support for the pin multiplexing device present
+on RockChip SoC.
+.Sh HARDWARE
+The current version of the
+.Nm
+driver supports the pin controller with one of the following
+compatible strings :
+.Pp
+.Bl -bullet -compact
+.It
+rockchip,rk3328-pinctrl
+.El
+.Sh SEE ALSO
+.Xr fdt_pinctrl 4 ,
+.Sh HISTORY
+The
+.Nm
+device driver first appeared in
+.Fx 12.0 .
+.Sh AUTHORS
+The
+.Nm
+device driver and manpage was written by
+.An Emmanuel Vadot Aq Mt m...@freebsd.org .

Added: head/sys/arm64/rockchip/rk_pinctrl.c
==============================================================================
--- /dev/null   00:00:00 1970   (empty, because file is newly added)
+++ head/sys/arm64/rockchip/rk_pinctrl.c        Thu Apr 26 21:37:38 2018        
(r333038)
@@ -0,0 +1,475 @@
+/*-
+ * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
+ *
+ * Copyright (c) 2018 Emmanuel Vadot <m...@freebsd.org>
+ * 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 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 AUTHOR 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.
+ *
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/bus.h>
+
+#include <sys/kernel.h>
+#include <sys/module.h>
+#include <sys/rman.h>
+#include <sys/lock.h>
+#include <sys/mutex.h>
+
+#include <machine/bus.h>
+#include <machine/resource.h>
+#include <machine/intr.h>
+
+#include <dev/fdt/simplebus.h>
+
+#include <dev/ofw/ofw_bus.h>
+#include <dev/ofw/ofw_bus_subr.h>
+
+#include <dev/fdt/fdt_pinctrl.h>
+
+#include <dev/extres/syscon/syscon.h>
+
+#include "syscon_if.h"
+
+#include "opt_soc.h"
+
+struct rk_pinctrl_pin_drive {
+       uint32_t        value;
+       uint32_t        ma;
+};
+
+struct rk_pinctrl_bank {
+       uint32_t        bank_num;
+       uint32_t        subbank_num;
+       uint32_t        offset;
+       uint32_t        nbits;
+};
+
+struct rk_pinctrl_pin_fixup {
+       uint32_t        bank;
+       uint32_t        subbank;
+       uint32_t        pin;
+       uint32_t        reg;
+       uint32_t        bit;
+       uint32_t        mask;
+};
+
+struct rk_pinctrl_conf {
+       struct rk_pinctrl_bank          *iomux_conf;
+       uint32_t                        iomux_nbanks;
+       struct rk_pinctrl_pin_fixup     *pin_fixup;
+       uint32_t                        npin_fixup;
+       struct rk_pinctrl_pin_drive     *pin_drive;
+       uint32_t                        npin_drive;
+       uint32_t                        pd_offset;
+       uint32_t                        drive_offset;
+};
+
+struct rk_pinctrl_softc {
+       struct simplebus_softc  simplebus_sc;
+       device_t                dev;
+       struct syscon           *grf;
+       struct rk_pinctrl_conf  *conf;
+};
+
+static struct rk_pinctrl_bank rk3328_iomux_bank[] = {
+       {
+               .bank_num = 0,
+               .subbank_num = 0,
+               .offset = 0x00,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 0,
+               .subbank_num = 1,
+               .offset = 0x04,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 0,
+               .subbank_num = 2,
+               .offset = 0x08,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 0,
+               .subbank_num = 3,
+               .offset = 0xc,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 1,
+               .subbank_num = 0,
+               .offset = 0x10,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 1,
+               .subbank_num = 1,
+               .offset = 0x14,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 1,
+               .subbank_num = 2,
+               .offset = 0x18,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 1,
+               .subbank_num = 3,
+               .offset = 0x1C,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 2,
+               .subbank_num = 0,
+               .offset = 0x20,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 2,
+               .subbank_num = 1,
+               .offset = 0x24,
+               .nbits = 3,
+       },
+       {
+               .bank_num = 2,
+               .subbank_num = 2,
+               .offset = 0x2c,
+               .nbits = 3,
+       },
+       {
+               .bank_num = 2,
+               .subbank_num = 3,
+               .offset = 0x34,
+               .nbits = 2,
+       },
+       {
+               .bank_num = 3,
+               .subbank_num = 0,
+               .offset = 0x38,
+               .nbits = 3,
+       },
+       {
+               .bank_num = 3,
+               .subbank_num = 1,
+               .offset = 0x40,
+               .nbits = 3,
+       },
+       {
+               .bank_num = 3,
+               .subbank_num = 2,
+               .offset = 0x48,
+               .nbits = 3,
+       },
+       {
+               .bank_num = 3,
+               .subbank_num = 3,
+               .offset = 0x4c,
+               .nbits = 3,
+       },
+};
+
+static struct rk_pinctrl_pin_fixup rk3328_pin_fixup[] = {
+       {
+               .bank = 2,
+               .pin = 12,
+               .reg = 0x24,
+               .bit = 8,
+               .mask = 0x300,
+       },
+       {
+               .bank = 2,
+               .pin = 15,
+               .reg = 0x28,
+               .bit = 0,
+               .mask = 0x7,
+       },
+       {
+               .bank = 2,
+               .pin = 23,
+               .reg = 0x30,
+               .bit = 14,
+               .mask = 0x6000,
+       },
+};
+
+static struct rk_pinctrl_pin_drive rk3328_pin_drive[] = {
+       {
+               .value = 0,
+               .ma = 2,
+       },
+       {
+               .value = 1,
+               .ma = 4,
+       },
+       {
+               .value = 2,
+               .ma = 8,
+       },
+       {
+               .value = 3,
+               .ma = 12,
+       },
+};
+
+struct rk_pinctrl_conf rk3328_conf = {
+       .iomux_conf = rk3328_iomux_bank,
+       .iomux_nbanks = nitems(rk3328_iomux_bank),
+       .pin_fixup = rk3328_pin_fixup,
+       .npin_fixup = nitems(rk3328_pin_fixup),
+       .pin_drive = rk3328_pin_drive,
+       .npin_drive = nitems(rk3328_pin_drive),
+       .pd_offset = 0x100,
+       .drive_offset = 0x200,
+};
+
+static struct ofw_compat_data compat_data[] = {
+#ifdef SOC_ROCKCHIP_RK3328
+       {"rockchip,rk3328-pinctrl", (uintptr_t)&rk3328_conf},
+#endif
+       {NULL,             0}
+};
+
+static int
+rk_pinctrl_parse_bias(phandle_t node)
+{
+       if (OF_hasprop(node, "bias-disable"))
+               return (0);
+       if (OF_hasprop(node, "bias-pull-up"))
+               return (1);
+       if (OF_hasprop(node, "bias-pull-down"))
+               return (2);
+
+       return (-1);
+}
+
+static int rk_pinctrl_parse_drive(struct rk_pinctrl_softc *sc, phandle_t node,
+    uint32_t *drive)
+{
+       uint32_t value;
+       int i;
+
+       if (OF_getencprop(node, "drive-strength", &value,
+           sizeof(value)) != 0)
+               return (-1);
+
+       /* Map to the correct drive value */
+       for (i = 0; i < sc->conf->npin_drive; i++)
+               if (sc->conf->pin_drive[i].ma == value) {
+                       *drive = sc->conf->pin_drive[i].value;
+                       return (0);
+               }
+
+       return (-1);
+}
+
+static void
+rk_pinctrl_get_fixup(struct rk_pinctrl_softc *sc, uint32_t bank, uint32_t pin,
+    uint32_t *reg, uint32_t *mask, uint32_t *bit)
+{
+       int i;
+
+       for (i = 0; i < sc->conf->npin_fixup; i++)
+               if (sc->conf->pin_fixup[i].bank == bank &&
+                   sc->conf->pin_fixup[i].pin == pin) {
+                       *reg = sc->conf->pin_fixup[i].reg;
+                       *mask = sc->conf->pin_fixup[i].mask;
+                       *bit = sc->conf->pin_fixup[i].bit;
+
+                       return;
+               }
+}
+
+static void
+rk_pinctrl_configure_pin(struct rk_pinctrl_softc *sc, uint32_t *pindata)
+{
+       phandle_t pin_conf;
+       uint32_t bank, subbank, pin, function, bias;
+       uint32_t bit, mask, reg, drive;
+       int i;
+
+       bank = pindata[0];
+       pin = pindata[1];
+       function = pindata[2];
+       pin_conf = OF_node_from_xref(pindata[3]);
+       subbank = pin / 8;
+
+       for (i = 0; i < sc->conf->iomux_nbanks; i++)
+               if (sc->conf->iomux_conf[i].bank_num == bank &&
+                   sc->conf->iomux_conf[i].subbank_num == subbank)
+                       break;
+
+       if (i == sc->conf->iomux_nbanks) {
+               device_printf(sc->dev, "Unknown pin %d in bank %d\n", pin,
+                   bank);
+               return;
+       }
+
+       /* Parse pin function */
+       reg = sc->conf->iomux_conf[i].offset;
+       switch (sc->conf->iomux_conf[i].nbits) {
+       case 3:
+               if ((pin % 8) >= 5)
+                       reg += 4;
+               bit = (pin % 8 % 5) * 3;
+               mask = (0x7 << bit) << 16;
+               break;
+       case 2:
+       default:
+               bit = (pin % 8) * 2;
+               mask = (0x3 << bit) << 16;
+               break;
+       }
+       rk_pinctrl_get_fixup(sc, bank, pin, &reg, &mask, &bit);
+       SYSCON_WRITE_4(sc->grf, reg, function << bit | mask);
+
+       /* Pull-Up/Down */
+       bias = rk_pinctrl_parse_bias(pin_conf);
+       if (bias >= 0) {
+               reg = sc->conf->pd_offset;
+
+               reg += bank * 0x10 + ((pin / 8) * 0x4);
+               bit = (pin % 8) * 2;
+               mask = (0x3 << bit) << 16;
+               SYSCON_WRITE_4(sc->grf, reg, bias << bit | mask);
+       }
+
+       /* Drive Strength */
+       if (rk_pinctrl_parse_drive(sc, pin_conf, &drive) == 0) {
+               reg = sc->conf->drive_offset;
+
+               reg += bank * 0x10 + ((pin / 8) * 0x4);
+               bit = (pin % 8) * 2;
+               mask = (0x3 << bit) << 16;
+               SYSCON_WRITE_4(sc->grf, reg, bias << bit | mask);
+       }
+}
+
+static int
+rk_pinctrl_configure_pins(device_t dev, phandle_t cfgxref)
+{
+       struct rk_pinctrl_softc *sc;
+       phandle_t node;
+       uint32_t *pins;
+       int i, npins;
+
+       sc = device_get_softc(dev);
+       node = OF_node_from_xref(cfgxref);
+
+       npins = OF_getencprop_alloc_multi(node, "rockchip,pins",  sizeof(*pins),
+           (void **)&pins);
+       if (npins <= 0)
+               return (ENOENT);
+
+       for (i = 0; i != npins; i += 4)
+               rk_pinctrl_configure_pin(sc, pins + i);
+
+       return (0);
+}
+
+static int
+rk_pinctrl_probe(device_t dev)
+{
+
+       if (!ofw_bus_status_okay(dev))
+               return (ENXIO);
+
+       if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0)
+               return (ENXIO);
+
+       device_set_desc(dev, "RockChip Pinctrl controller");
+       return (BUS_PROBE_DEFAULT);
+}
+
+static int
+rk_pinctrl_attach(device_t dev)
+{
+       struct rk_pinctrl_softc *sc;
+       phandle_t node;
+       device_t cdev;
+
+       sc = device_get_softc(dev);
+       sc->dev = dev;
+
+       node = ofw_bus_get_node(dev);
+
+       if (OF_hasprop(node, "rockchip,grf") &&
+           syscon_get_by_ofw_property(dev, node,
+           "rockchip,grf", &sc->grf) != 0) {
+               device_printf(dev, "cannot get grf driver handle\n");
+               return (ENXIO);
+       }
+
+       sc->conf = (struct rk_pinctrl_conf *)ofw_bus_search_compatible(dev,
+           compat_data)->ocd_data;
+
+       fdt_pinctrl_register(dev, "rockchip,pins");
+       fdt_pinctrl_configure_tree(dev);
+
+       simplebus_init(dev, node);
+
+       bus_generic_probe(dev);
+
+       /* Attach child devices */
+       for (node = OF_child(node); node > 0; node = OF_peer(node)) {
+               cdev = simplebus_add_device(dev, node, 0, NULL, -1, NULL);
+               if (cdev != NULL)
+                       device_probe_and_attach(cdev);
+       }
+
+       return (bus_generic_attach(dev));
+}
+
+static int
+rk_pinctrl_detach(device_t dev)
+{
+
+       return (EBUSY);
+}
+
+static device_method_t rk_pinctrl_methods[] = {
+       /* Device interface */
+       DEVMETHOD(device_probe,         rk_pinctrl_probe),
+       DEVMETHOD(device_attach,        rk_pinctrl_attach),
+       DEVMETHOD(device_detach,        rk_pinctrl_detach),
+
+        /* fdt_pinctrl interface */
+       DEVMETHOD(fdt_pinctrl_configure,rk_pinctrl_configure_pins),
+
+       DEVMETHOD_END
+};
+
+static devclass_t rk_pinctrl_devclass;
+
+DEFINE_CLASS_1(rk_pinctrl, rk_pinctrl_driver, rk_pinctrl_methods,
+    sizeof(struct rk_pinctrl_softc), simplebus_driver);
+
+EARLY_DRIVER_MODULE(rk_pinctrl, simplebus, rk_pinctrl_driver,
+    rk_pinctrl_devclass, 0, 0, BUS_PASS_INTERRUPT + BUS_PASS_ORDER_MIDDLE);
+MODULE_VERSION(rk_pinctrl, 1);

Modified: head/sys/conf/files.arm64
==============================================================================
--- head/sys/conf/files.arm64   Thu Apr 26 21:35:04 2018        (r333037)
+++ head/sys/conf/files.arm64   Thu Apr 26 21:37:38 2018        (r333038)
@@ -243,6 +243,7 @@ cddl/dev/dtrace/aarch64/dtrace_subr.c                       
optional dtrac
 cddl/dev/fbt/aarch64/fbt_isa.c                         optional dtrace_fbt | 
dtraceall compile-with "${FBT_C}"
 
 arm64/rockchip/rk_grf.c                        optional fdt soc_rockchip_rk3328
+arm64/rockchip/rk_pinctrl.c            optional fdt soc_rockchip_rk3328
 arm64/rockchip/clk/rk_cru.c            optional fdt soc_rockchip_rk3328
 arm64/rockchip/clk/rk_clk_composite.c  optional fdt soc_rockchip_rk3328
 arm64/rockchip/clk/rk_clk_gate.c       optional fdt soc_rockchip_rk3328
_______________________________________________
svn-src-head@freebsd.org mailing list
https://lists.freebsd.org/mailman/listinfo/svn-src-head
To unsubscribe, send any mail to "svn-src-head-unsubscr...@freebsd.org"

Reply via email to