|
@@ -0,0 +1,611 @@
|
|
|
+/*
|
|
|
+ * Pinctrl driver for Rockchip RK3188 SoCs
|
|
|
+ * Copyright (c) 2016 Heiko Stuebner <heiko@sntech.de>
|
|
|
+ *
|
|
|
+ * SPDX-License-Identifier: GPL-2.0+
|
|
|
+ */
|
|
|
+
|
|
|
+#include <common.h>
|
|
|
+#include <dm.h>
|
|
|
+#include <errno.h>
|
|
|
+#include <syscon.h>
|
|
|
+#include <asm/io.h>
|
|
|
+#include <asm/arch/clock.h>
|
|
|
+#include <asm/arch/grf_rk3188.h>
|
|
|
+#include <asm/arch/hardware.h>
|
|
|
+#include <asm/arch/periph.h>
|
|
|
+#include <asm/arch/pmu_rk3188.h>
|
|
|
+#include <dm/pinctrl.h>
|
|
|
+#include <dm/root.h>
|
|
|
+
|
|
|
+DECLARE_GLOBAL_DATA_PTR;
|
|
|
+
|
|
|
+struct rk3188_pinctrl_priv {
|
|
|
+ struct rk3188_grf *grf;
|
|
|
+ struct rk3188_pmu *pmu;
|
|
|
+ int num_banks;
|
|
|
+};
|
|
|
+
|
|
|
+/**
|
|
|
+ * Encode variants of iomux registers into a type variable
|
|
|
+ */
|
|
|
+#define IOMUX_GPIO_ONLY BIT(0)
|
|
|
+
|
|
|
+/**
|
|
|
+ * @type: iomux variant using IOMUX_* constants
|
|
|
+ * @offset: if initialized to -1 it will be autocalculated, by specifying
|
|
|
+ * an initial offset value the relevant source offset can be reset
|
|
|
+ * to a new value for autocalculating the following iomux registers.
|
|
|
+ */
|
|
|
+struct rockchip_iomux {
|
|
|
+ u8 type;
|
|
|
+ s16 offset;
|
|
|
+};
|
|
|
+
|
|
|
+/**
|
|
|
+ * @reg: register offset of the gpio bank
|
|
|
+ * @nr_pins: number of pins in this bank
|
|
|
+ * @bank_num: number of the bank, to account for holes
|
|
|
+ * @name: name of the bank
|
|
|
+ * @iomux: array describing the 4 iomux sources of the bank
|
|
|
+ */
|
|
|
+struct rockchip_pin_bank {
|
|
|
+ u16 reg;
|
|
|
+ u8 nr_pins;
|
|
|
+ u8 bank_num;
|
|
|
+ char *name;
|
|
|
+ struct rockchip_iomux iomux[4];
|
|
|
+};
|
|
|
+
|
|
|
+#define PIN_BANK(id, pins, label) \
|
|
|
+ { \
|
|
|
+ .bank_num = id, \
|
|
|
+ .nr_pins = pins, \
|
|
|
+ .name = label, \
|
|
|
+ .iomux = { \
|
|
|
+ { .offset = -1 }, \
|
|
|
+ { .offset = -1 }, \
|
|
|
+ { .offset = -1 }, \
|
|
|
+ { .offset = -1 }, \
|
|
|
+ }, \
|
|
|
+ }
|
|
|
+
|
|
|
+#define PIN_BANK_IOMUX_FLAGS(id, pins, label, iom0, iom1, iom2, iom3) \
|
|
|
+ { \
|
|
|
+ .bank_num = id, \
|
|
|
+ .nr_pins = pins, \
|
|
|
+ .name = label, \
|
|
|
+ .iomux = { \
|
|
|
+ { .type = iom0, .offset = -1 }, \
|
|
|
+ { .type = iom1, .offset = -1 }, \
|
|
|
+ { .type = iom2, .offset = -1 }, \
|
|
|
+ { .type = iom3, .offset = -1 }, \
|
|
|
+ }, \
|
|
|
+ }
|
|
|
+
|
|
|
+#ifndef CONFIG_SPL_BUILD
|
|
|
+static struct rockchip_pin_bank rk3188_pin_banks[] = {
|
|
|
+ PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_GPIO_ONLY, 0, 0, 0),
|
|
|
+ PIN_BANK(1, 32, "gpio1"),
|
|
|
+ PIN_BANK(2, 32, "gpio2"),
|
|
|
+ PIN_BANK(3, 32, "gpio3"),
|
|
|
+};
|
|
|
+#endif
|
|
|
+
|
|
|
+static void pinctrl_rk3188_pwm_config(struct rk3188_grf *grf, int pwm_id)
|
|
|
+{
|
|
|
+ switch (pwm_id) {
|
|
|
+ case PERIPH_ID_PWM0:
|
|
|
+ rk_clrsetreg(&grf->gpio3d_iomux, GPIO3D3_MASK << GPIO3D3_SHIFT,
|
|
|
+ GPIO3D3_PWM_0 << GPIO3D3_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_PWM1:
|
|
|
+ rk_clrsetreg(&grf->gpio3d_iomux, GPIO3D4_MASK << GPIO3D4_SHIFT,
|
|
|
+ GPIO3D4_PWM_1 << GPIO3D4_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_PWM2:
|
|
|
+ rk_clrsetreg(&grf->gpio3d_iomux, GPIO3D5_MASK << GPIO3D5_SHIFT,
|
|
|
+ GPIO3D5_PWM_2 << GPIO3D5_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_PWM3:
|
|
|
+ rk_clrsetreg(&grf->gpio3d_iomux, GPIO3D6_MASK << GPIO3D6_SHIFT,
|
|
|
+ GPIO3D6_PWM_3 << GPIO3D6_SHIFT);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ debug("pwm id = %d iomux error!\n", pwm_id);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void pinctrl_rk3188_i2c_config(struct rk3188_grf *grf,
|
|
|
+ struct rk3188_pmu *pmu, int i2c_id)
|
|
|
+{
|
|
|
+ switch (i2c_id) {
|
|
|
+ case PERIPH_ID_I2C0:
|
|
|
+ rk_clrsetreg(&grf->gpio1d_iomux,
|
|
|
+ GPIO1D1_MASK << GPIO1D1_SHIFT |
|
|
|
+ GPIO1D0_MASK << GPIO1D0_SHIFT,
|
|
|
+ GPIO1D1_I2C0_SCL << GPIO1D1_SHIFT |
|
|
|
+ GPIO1D0_I2C0_SDA << GPIO1D0_SHIFT);
|
|
|
+ /* enable new i2c controller */
|
|
|
+ rk_clrsetreg(&grf->soc_con1, 1 << RKI2C0_SEL_SHIFT,
|
|
|
+ 1 << RKI2C0_SEL_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_I2C1:
|
|
|
+ rk_clrsetreg(&grf->gpio1d_iomux,
|
|
|
+ GPIO1D3_MASK << GPIO1D3_SHIFT |
|
|
|
+ GPIO1D2_MASK << GPIO1D2_SHIFT,
|
|
|
+ GPIO1D3_I2C1_SCL << GPIO1D2_SHIFT |
|
|
|
+ GPIO1D2_I2C1_SDA << GPIO1D2_SHIFT);
|
|
|
+ rk_clrsetreg(&grf->soc_con1, 1 << RKI2C1_SEL_SHIFT,
|
|
|
+ 1 << RKI2C1_SEL_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_I2C2:
|
|
|
+ rk_clrsetreg(&grf->gpio1d_iomux,
|
|
|
+ GPIO1D5_MASK << GPIO1D5_SHIFT |
|
|
|
+ GPIO1D4_MASK << GPIO1D4_SHIFT,
|
|
|
+ GPIO1D5_I2C2_SCL << GPIO1D5_SHIFT |
|
|
|
+ GPIO1D4_I2C2_SDA << GPIO1D4_SHIFT);
|
|
|
+ rk_clrsetreg(&grf->soc_con1, 1 << RKI2C2_SEL_SHIFT,
|
|
|
+ 1 << RKI2C2_SEL_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_I2C3:
|
|
|
+ rk_clrsetreg(&grf->gpio3b_iomux,
|
|
|
+ GPIO3B7_MASK << GPIO3B7_SHIFT |
|
|
|
+ GPIO3B6_MASK << GPIO3B6_SHIFT,
|
|
|
+ GPIO3B7_I2C3_SCL << GPIO3B7_SHIFT |
|
|
|
+ GPIO3B6_I2C3_SDA << GPIO3B6_SHIFT);
|
|
|
+ rk_clrsetreg(&grf->soc_con1, 1 << RKI2C3_SEL_SHIFT,
|
|
|
+ 1 << RKI2C3_SEL_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_I2C4:
|
|
|
+ rk_clrsetreg(&grf->gpio1d_iomux,
|
|
|
+ GPIO1D7_MASK << GPIO1D7_SHIFT |
|
|
|
+ GPIO1D6_MASK << GPIO1D6_SHIFT,
|
|
|
+ GPIO1D7_I2C4_SCL << GPIO1D7_SHIFT |
|
|
|
+ GPIO1D6_I2C4_SDA << GPIO1D6_SHIFT);
|
|
|
+ rk_clrsetreg(&grf->soc_con1, 1 << RKI2C4_SEL_SHIFT,
|
|
|
+ 1 << RKI2C4_SEL_SHIFT);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ debug("i2c id = %d iomux error!\n", i2c_id);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static int pinctrl_rk3188_spi_config(struct rk3188_grf *grf,
|
|
|
+ enum periph_id spi_id, int cs)
|
|
|
+{
|
|
|
+ switch (spi_id) {
|
|
|
+ case PERIPH_ID_SPI0:
|
|
|
+ switch (cs) {
|
|
|
+ case 0:
|
|
|
+ rk_clrsetreg(&grf->gpio1a_iomux,
|
|
|
+ GPIO1A7_MASK << GPIO1A7_SHIFT,
|
|
|
+ GPIO1A7_SPI0_CSN0 << GPIO1A7_SHIFT);
|
|
|
+ break;
|
|
|
+ case 1:
|
|
|
+ rk_clrsetreg(&grf->gpio1b_iomux,
|
|
|
+ GPIO1B7_MASK << GPIO1B7_SHIFT,
|
|
|
+ GPIO1B7_SPI0_CSN1 << GPIO1B7_SHIFT);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ goto err;
|
|
|
+ }
|
|
|
+ rk_clrsetreg(&grf->gpio1a_iomux,
|
|
|
+ GPIO1A4_MASK << GPIO1A4_SHIFT |
|
|
|
+ GPIO1A5_MASK << GPIO1A5_SHIFT |
|
|
|
+ GPIO1A6_MASK << GPIO1A6_SHIFT,
|
|
|
+ GPIO1A4_SPI0_RXD << GPIO1A4_SHIFT |
|
|
|
+ GPIO1A5_SPI0_TXD << GPIO1A5_SHIFT |
|
|
|
+ GPIO1A6_SPI0_CLK << GPIO1A6_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_SPI1:
|
|
|
+ switch (cs) {
|
|
|
+ case 0:
|
|
|
+ rk_clrsetreg(&grf->gpio0d_iomux,
|
|
|
+ GPIO0D7_MASK << GPIO0D7_SHIFT,
|
|
|
+ GPIO0D7_SPI1_CSN0 << GPIO0D7_SHIFT);
|
|
|
+ break;
|
|
|
+ case 1:
|
|
|
+ rk_clrsetreg(&grf->gpio1b_iomux,
|
|
|
+ GPIO1B6_MASK << GPIO1B6_SHIFT,
|
|
|
+ GPIO1B6_SPI1_CSN1 << GPIO1B6_SHIFT);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ goto err;
|
|
|
+ }
|
|
|
+ rk_clrsetreg(&grf->gpio0d_iomux,
|
|
|
+ GPIO0D4_MASK << GPIO0D4_SHIFT |
|
|
|
+ GPIO0D5_MASK << GPIO0D5_SHIFT |
|
|
|
+ GPIO0D6_MASK << GPIO0D6_SHIFT,
|
|
|
+ GPIO0D4_SPI0_RXD << GPIO0D4_SHIFT |
|
|
|
+ GPIO0D5_SPI1_TXD << GPIO0D5_SHIFT |
|
|
|
+ GPIO0D6_SPI1_CLK << GPIO0D6_SHIFT);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ goto err;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+err:
|
|
|
+ debug("rkspi: periph%d cs=%d not supported", spi_id, cs);
|
|
|
+ return -ENOENT;
|
|
|
+}
|
|
|
+
|
|
|
+static void pinctrl_rk3188_uart_config(struct rk3188_grf *grf, int uart_id)
|
|
|
+{
|
|
|
+ switch (uart_id) {
|
|
|
+ case PERIPH_ID_UART0:
|
|
|
+ rk_clrsetreg(&grf->gpio1a_iomux,
|
|
|
+ GPIO1A3_MASK << GPIO1A3_SHIFT |
|
|
|
+ GPIO1A2_MASK << GPIO1A2_SHIFT |
|
|
|
+ GPIO1A1_MASK << GPIO1A1_SHIFT |
|
|
|
+ GPIO1A0_MASK << GPIO1A0_SHIFT,
|
|
|
+ GPIO1A3_UART0_RTS_N << GPIO1A3_SHIFT |
|
|
|
+ GPIO1A2_UART0_CTS_N << GPIO1A2_SHIFT |
|
|
|
+ GPIO1A1_UART0_SOUT << GPIO1A1_SHIFT |
|
|
|
+ GPIO1A0_UART0_SIN << GPIO1A0_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_UART1:
|
|
|
+ rk_clrsetreg(&grf->gpio1a_iomux,
|
|
|
+ GPIO1A7_MASK << GPIO1A7_SHIFT |
|
|
|
+ GPIO1A6_MASK << GPIO1A6_SHIFT |
|
|
|
+ GPIO1A5_MASK << GPIO1A5_SHIFT |
|
|
|
+ GPIO1A4_MASK << GPIO1A4_SHIFT,
|
|
|
+ GPIO1A7_UART1_RTS_N << GPIO1A7_SHIFT |
|
|
|
+ GPIO1A6_UART1_CTS_N << GPIO1A6_SHIFT |
|
|
|
+ GPIO1A5_UART1_SOUT << GPIO1A5_SHIFT |
|
|
|
+ GPIO1A4_UART1_SIN << GPIO1A4_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_UART2:
|
|
|
+ rk_clrsetreg(&grf->gpio1b_iomux,
|
|
|
+ GPIO1B1_MASK << GPIO1B1_SHIFT |
|
|
|
+ GPIO1B0_MASK << GPIO1B0_SHIFT,
|
|
|
+ GPIO1B1_UART2_SOUT << GPIO1B1_SHIFT |
|
|
|
+ GPIO1B0_UART2_SIN << GPIO1B0_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_UART3:
|
|
|
+ rk_clrsetreg(&grf->gpio1b_iomux,
|
|
|
+ GPIO1B5_MASK << GPIO1B5_SHIFT |
|
|
|
+ GPIO1B4_MASK << GPIO1B4_SHIFT |
|
|
|
+ GPIO1B3_MASK << GPIO1B3_SHIFT |
|
|
|
+ GPIO1B2_MASK << GPIO1B2_SHIFT,
|
|
|
+ GPIO1B5_UART3_RTS_N << GPIO1B5_SHIFT |
|
|
|
+ GPIO1B4_UART3_CTS_N << GPIO1B4_SHIFT |
|
|
|
+ GPIO1B3_UART3_SOUT << GPIO1B3_SHIFT |
|
|
|
+ GPIO1B2_UART3_SIN << GPIO1B2_SHIFT);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ debug("uart id = %d iomux error!\n", uart_id);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void pinctrl_rk3188_sdmmc_config(struct rk3188_grf *grf, int mmc_id)
|
|
|
+{
|
|
|
+ switch (mmc_id) {
|
|
|
+ case PERIPH_ID_EMMC:
|
|
|
+ rk_clrsetreg(&grf->soc_con0, 1 << EMMC_FLASH_SEL_SHIFT,
|
|
|
+ 1 << EMMC_FLASH_SEL_SHIFT);
|
|
|
+ rk_clrsetreg(&grf->gpio0d_iomux,
|
|
|
+ GPIO0D2_MASK << GPIO0D2_SHIFT |
|
|
|
+ GPIO0D0_MASK << GPIO0D0_SHIFT,
|
|
|
+ GPIO0D2_EMMC_CMD << GPIO0D2_SHIFT |
|
|
|
+ GPIO0D0_EMMC_CLKOUT << GPIO0D0_SHIFT);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_SDCARD:
|
|
|
+ rk_clrsetreg(&grf->gpio3b_iomux,
|
|
|
+ GPIO3B0_MASK << GPIO3B0_SHIFT,
|
|
|
+ GPIO3B0_SDMMC_DETECT_N << GPIO3B0_SHIFT);
|
|
|
+ rk_clrsetreg(&grf->gpio3a_iomux,
|
|
|
+ GPIO3A7_MASK << GPIO3A7_SHIFT |
|
|
|
+ GPIO3A6_MASK << GPIO3A6_SHIFT |
|
|
|
+ GPIO3A5_MASK << GPIO3A5_SHIFT |
|
|
|
+ GPIO3A4_MASK << GPIO3A4_SHIFT |
|
|
|
+ GPIO3A3_MASK << GPIO3A3_SHIFT |
|
|
|
+ GPIO3A3_MASK << GPIO3A2_SHIFT,
|
|
|
+ GPIO3A7_SDMMC0_DATA3 << GPIO3A7_SHIFT |
|
|
|
+ GPIO3A6_SDMMC0_DATA2 << GPIO3A6_SHIFT |
|
|
|
+ GPIO3A5_SDMMC0_DATA1 << GPIO3A5_SHIFT |
|
|
|
+ GPIO3A4_SDMMC0_DATA0 << GPIO3A4_SHIFT |
|
|
|
+ GPIO3A3_SDMMC0_CMD << GPIO3A3_SHIFT |
|
|
|
+ GPIO3A2_SDMMC0_CLKOUT << GPIO3A2_SHIFT);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ debug("mmc id = %d iomux error!\n", mmc_id);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static int rk3188_pinctrl_request(struct udevice *dev, int func, int flags)
|
|
|
+{
|
|
|
+ struct rk3188_pinctrl_priv *priv = dev_get_priv(dev);
|
|
|
+
|
|
|
+ debug("%s: func=%x, flags=%x\n", __func__, func, flags);
|
|
|
+ switch (func) {
|
|
|
+ case PERIPH_ID_PWM0:
|
|
|
+ case PERIPH_ID_PWM1:
|
|
|
+ case PERIPH_ID_PWM2:
|
|
|
+ case PERIPH_ID_PWM3:
|
|
|
+ case PERIPH_ID_PWM4:
|
|
|
+ pinctrl_rk3188_pwm_config(priv->grf, func);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_I2C0:
|
|
|
+ case PERIPH_ID_I2C1:
|
|
|
+ case PERIPH_ID_I2C2:
|
|
|
+ case PERIPH_ID_I2C3:
|
|
|
+ case PERIPH_ID_I2C4:
|
|
|
+ case PERIPH_ID_I2C5:
|
|
|
+ pinctrl_rk3188_i2c_config(priv->grf, priv->pmu, func);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_SPI0:
|
|
|
+ case PERIPH_ID_SPI1:
|
|
|
+ case PERIPH_ID_SPI2:
|
|
|
+ pinctrl_rk3188_spi_config(priv->grf, func, flags);
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_UART0:
|
|
|
+ case PERIPH_ID_UART1:
|
|
|
+ case PERIPH_ID_UART2:
|
|
|
+ case PERIPH_ID_UART3:
|
|
|
+ case PERIPH_ID_UART4:
|
|
|
+ pinctrl_rk3188_uart_config(priv->grf, func);
|
|
|
+ break;
|
|
|
+ break;
|
|
|
+ case PERIPH_ID_SDMMC0:
|
|
|
+ case PERIPH_ID_SDMMC1:
|
|
|
+ pinctrl_rk3188_sdmmc_config(priv->grf, func);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int rk3188_pinctrl_get_periph_id(struct udevice *dev,
|
|
|
+ struct udevice *periph)
|
|
|
+{
|
|
|
+#if !CONFIG_IS_ENABLED(OF_PLATDATA)
|
|
|
+ u32 cell[3];
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ ret = fdtdec_get_int_array(gd->fdt_blob, periph->of_offset,
|
|
|
+ "interrupts", cell, ARRAY_SIZE(cell));
|
|
|
+ if (ret < 0)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ switch (cell[1]) {
|
|
|
+ case 44:
|
|
|
+ return PERIPH_ID_SPI0;
|
|
|
+ case 45:
|
|
|
+ return PERIPH_ID_SPI1;
|
|
|
+ case 46:
|
|
|
+ return PERIPH_ID_SPI2;
|
|
|
+ case 60:
|
|
|
+ return PERIPH_ID_I2C0;
|
|
|
+ case 62: /* Note strange order */
|
|
|
+ return PERIPH_ID_I2C1;
|
|
|
+ case 61:
|
|
|
+ return PERIPH_ID_I2C2;
|
|
|
+ case 63:
|
|
|
+ return PERIPH_ID_I2C3;
|
|
|
+ case 64:
|
|
|
+ return PERIPH_ID_I2C4;
|
|
|
+ case 65:
|
|
|
+ return PERIPH_ID_I2C5;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ return -ENOENT;
|
|
|
+}
|
|
|
+
|
|
|
+static int rk3188_pinctrl_set_state_simple(struct udevice *dev,
|
|
|
+ struct udevice *periph)
|
|
|
+{
|
|
|
+ int func;
|
|
|
+
|
|
|
+ func = rk3188_pinctrl_get_periph_id(dev, periph);
|
|
|
+ if (func < 0)
|
|
|
+ return func;
|
|
|
+ return rk3188_pinctrl_request(dev, func, 0);
|
|
|
+}
|
|
|
+
|
|
|
+#ifndef CONFIG_SPL_BUILD
|
|
|
+int rk3188_pinctrl_get_pin_info(struct rk3188_pinctrl_priv *priv,
|
|
|
+ int banknum, int ind, u32 **addrp, uint *shiftp,
|
|
|
+ uint *maskp)
|
|
|
+{
|
|
|
+ struct rockchip_pin_bank *bank = &rk3188_pin_banks[banknum];
|
|
|
+ uint muxnum;
|
|
|
+ u32 *addr;
|
|
|
+
|
|
|
+ for (muxnum = 0; muxnum < 4; muxnum++) {
|
|
|
+ struct rockchip_iomux *mux = &bank->iomux[muxnum];
|
|
|
+
|
|
|
+ if (ind >= 8) {
|
|
|
+ ind -= 8;
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ addr = &priv->grf->gpio0c_iomux - 2;
|
|
|
+ addr += mux->offset;
|
|
|
+ *shiftp = ind & 7;
|
|
|
+ *maskp = 3;
|
|
|
+ *shiftp *= 2;
|
|
|
+
|
|
|
+ debug("%s: addr=%p, mask=%x, shift=%x\n", __func__, addr,
|
|
|
+ *maskp, *shiftp);
|
|
|
+ *addrp = addr;
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ return -EINVAL;
|
|
|
+}
|
|
|
+
|
|
|
+static int rk3188_pinctrl_get_gpio_mux(struct udevice *dev, int banknum,
|
|
|
+ int index)
|
|
|
+{
|
|
|
+ struct rk3188_pinctrl_priv *priv = dev_get_priv(dev);
|
|
|
+ uint shift;
|
|
|
+ uint mask;
|
|
|
+ u32 *addr;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ ret = rk3188_pinctrl_get_pin_info(priv, banknum, index, &addr, &shift,
|
|
|
+ &mask);
|
|
|
+ if (ret)
|
|
|
+ return ret;
|
|
|
+ return (readl(addr) & mask) >> shift;
|
|
|
+}
|
|
|
+
|
|
|
+static int rk3188_pinctrl_set_pins(struct udevice *dev, int banknum, int index,
|
|
|
+ int muxval, int flags)
|
|
|
+{
|
|
|
+ struct rk3188_pinctrl_priv *priv = dev_get_priv(dev);
|
|
|
+ uint shift, ind = index;
|
|
|
+ uint mask;
|
|
|
+ u32 *addr;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ debug("%s: %x %x %x %x\n", __func__, banknum, index, muxval, flags);
|
|
|
+ ret = rk3188_pinctrl_get_pin_info(priv, banknum, index, &addr, &shift,
|
|
|
+ &mask);
|
|
|
+ if (ret)
|
|
|
+ return ret;
|
|
|
+ rk_clrsetreg(addr, mask << shift, muxval << shift);
|
|
|
+
|
|
|
+ /* Handle pullup/pulldown */
|
|
|
+ if (flags) {
|
|
|
+ uint val = 0;
|
|
|
+
|
|
|
+ if (flags & (1 << PIN_CONFIG_BIAS_PULL_UP))
|
|
|
+ val = 1;
|
|
|
+ else if (flags & (1 << PIN_CONFIG_BIAS_PULL_DOWN))
|
|
|
+ val = 2;
|
|
|
+
|
|
|
+ ind = index >> 3;
|
|
|
+
|
|
|
+ if (banknum == 0 && index < 12) {
|
|
|
+ addr = &priv->pmu->gpio0_p[ind];
|
|
|
+ shift = (index & 7) * 2;
|
|
|
+ } else if (banknum == 0 && index >= 12) {
|
|
|
+ addr = &priv->grf->gpio0_p[ind - 1];
|
|
|
+ /*
|
|
|
+ * The bits in the grf-registers have an inverse
|
|
|
+ * ordering with the lowest pin being in bits 15:14
|
|
|
+ * and the highest pin in bits 1:0 .
|
|
|
+ */
|
|
|
+ shift = (7 - (index & 7)) * 2;
|
|
|
+ } else {
|
|
|
+ addr = &priv->grf->gpio1_p[banknum - 1][ind];
|
|
|
+ shift = (7 - (index & 7)) * 2;
|
|
|
+ }
|
|
|
+ debug("%s: addr=%p, val=%x, shift=%x\n", __func__, addr, val,
|
|
|
+ shift);
|
|
|
+ rk_clrsetreg(addr, 3 << shift, val << shift);
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int rk3188_pinctrl_set_state(struct udevice *dev, struct udevice *config)
|
|
|
+{
|
|
|
+ const void *blob = gd->fdt_blob;
|
|
|
+ int pcfg_node, ret, flags, count, i;
|
|
|
+ u32 cell[60], *ptr;
|
|
|
+
|
|
|
+ debug("%s: %s %s\n", __func__, dev->name, config->name);
|
|
|
+ ret = fdtdec_get_int_array_count(blob, config->of_offset,
|
|
|
+ "rockchip,pins", cell,
|
|
|
+ ARRAY_SIZE(cell));
|
|
|
+ if (ret < 0) {
|
|
|
+ debug("%s: bad array %d\n", __func__, ret);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+ count = ret;
|
|
|
+ for (i = 0, ptr = cell; i < count; i += 4, ptr += 4) {
|
|
|
+ pcfg_node = fdt_node_offset_by_phandle(blob, ptr[3]);
|
|
|
+ if (pcfg_node < 0)
|
|
|
+ return -EINVAL;
|
|
|
+ flags = pinctrl_decode_pin_config(blob, pcfg_node);
|
|
|
+ if (flags < 0)
|
|
|
+ return flags;
|
|
|
+
|
|
|
+ ret = rk3188_pinctrl_set_pins(dev, ptr[0], ptr[1], ptr[2],
|
|
|
+ flags);
|
|
|
+ if (ret)
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
+static struct pinctrl_ops rk3188_pinctrl_ops = {
|
|
|
+#ifndef CONFIG_SPL_BUILD
|
|
|
+ .set_state = rk3188_pinctrl_set_state,
|
|
|
+ .get_gpio_mux = rk3188_pinctrl_get_gpio_mux,
|
|
|
+#endif
|
|
|
+ .set_state_simple = rk3188_pinctrl_set_state_simple,
|
|
|
+ .request = rk3188_pinctrl_request,
|
|
|
+ .get_periph_id = rk3188_pinctrl_get_periph_id,
|
|
|
+};
|
|
|
+
|
|
|
+#ifndef CONFIG_SPL_BUILD
|
|
|
+static int rk3188_pinctrl_parse_tables(struct rk3188_pinctrl_priv *priv,
|
|
|
+ struct rockchip_pin_bank *banks,
|
|
|
+ int count)
|
|
|
+{
|
|
|
+ struct rockchip_pin_bank *bank;
|
|
|
+ uint reg, muxnum, banknum;
|
|
|
+
|
|
|
+ reg = 0;
|
|
|
+ for (banknum = 0; banknum < count; banknum++) {
|
|
|
+ bank = &banks[banknum];
|
|
|
+ bank->reg = reg;
|
|
|
+ debug("%s: bank %d, reg %x\n", __func__, banknum, reg * 4);
|
|
|
+ for (muxnum = 0; muxnum < 4; muxnum++) {
|
|
|
+ struct rockchip_iomux *mux = &bank->iomux[muxnum];
|
|
|
+
|
|
|
+ mux->offset = reg;
|
|
|
+ reg += 1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
+static int rk3188_pinctrl_probe(struct udevice *dev)
|
|
|
+{
|
|
|
+ struct rk3188_pinctrl_priv *priv = dev_get_priv(dev);
|
|
|
+ int ret = 0;
|
|
|
+
|
|
|
+ priv->grf = syscon_get_first_range(ROCKCHIP_SYSCON_GRF);
|
|
|
+ priv->pmu = syscon_get_first_range(ROCKCHIP_SYSCON_PMU);
|
|
|
+ debug("%s: grf=%p, pmu=%p\n", __func__, priv->grf, priv->pmu);
|
|
|
+#ifndef CONFIG_SPL_BUILD
|
|
|
+ ret = rk3188_pinctrl_parse_tables(priv, rk3188_pin_banks,
|
|
|
+ ARRAY_SIZE(rk3188_pin_banks));
|
|
|
+#endif
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+static const struct udevice_id rk3188_pinctrl_ids[] = {
|
|
|
+ { .compatible = "rockchip,rk3188-pinctrl" },
|
|
|
+ { }
|
|
|
+};
|
|
|
+
|
|
|
+U_BOOT_DRIVER(pinctrl_rk3188) = {
|
|
|
+ .name = "rockchip_rk3188_pinctrl",
|
|
|
+ .id = UCLASS_PINCTRL,
|
|
|
+ .of_match = rk3188_pinctrl_ids,
|
|
|
+ .priv_auto_alloc_size = sizeof(struct rk3188_pinctrl_priv),
|
|
|
+ .ops = &rk3188_pinctrl_ops,
|
|
|
+#if !CONFIG_IS_ENABLED(OF_PLATDATA)
|
|
|
+ .bind = dm_scan_fdt_dev,
|
|
|
+#endif
|
|
|
+ .probe = rk3188_pinctrl_probe,
|
|
|
+};
|