In A733 SoC, the GPIO IP block has changed its arrangement, so initial
GPIO base address and bank size need to be adjusted.

Introduce new SUNXI_NEW2_PINCTRL in order to reuse the driver in future.

There is no PA bank exist in A733, but introducing a virtual one as offset
0x80, and with the bank size 0x80, it will iterate other bank correctly
starting from PB as offset 0x100.

Signed-off-by: Yixun Lan <[email protected]>
---
 arch/arm/mach-sunxi/Kconfig |  1 +
 drivers/gpio/Kconfig        |  7 +++++++
 drivers/gpio/sunxi_gpio.c   | 17 ++++++++++++++---
 include/sunxi_gpio.h        | 14 ++++++++++++++
 4 files changed, 36 insertions(+), 3 deletions(-)

diff --git a/arch/arm/mach-sunxi/Kconfig b/arch/arm/mach-sunxi/Kconfig
index e6b4ac3688b..c3d4e0ab3c8 100644
--- a/arch/arm/mach-sunxi/Kconfig
+++ b/arch/arm/mach-sunxi/Kconfig
@@ -561,6 +561,7 @@ config MACH_SUN60I_A733
        bool "sun60i (Allwinner A733)"
        select ARM64
        select SUNXI_GEN_NCAT2
+       select SUNXI_NEW2_PINCTRL
        select FIT
        select SPL_LOAD_FIT if SPL
        select SUPPORT_SPL
diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig
index db077e472a8..8a578b872c2 100644
--- a/drivers/gpio/Kconfig
+++ b/drivers/gpio/Kconfig
@@ -426,6 +426,13 @@ config SUNXI_NEW_PINCTRL
        The Allwinner D1 and other new SoCs use a different register map
        for the GPIO block, which we need to know about in the SPL.
 
+config SUNXI_NEW2_PINCTRL
+       bool
+       depends on SUNXI_GPIO
+       ---help---
+       The Allwinner A733 SoCs use a different register map
+       for the GPIO block, which we need to know about in the SPL.
+
 config XILINX_GPIO
        bool "Xilinx GPIO driver"
        depends on DM_GPIO
diff --git a/drivers/gpio/sunxi_gpio.c b/drivers/gpio/sunxi_gpio.c
index 094c45a6927..f6f7d0005ad 100644
--- a/drivers/gpio/sunxi_gpio.c
+++ b/drivers/gpio/sunxi_gpio.c
@@ -38,18 +38,26 @@
 
 #define GPIO_DAT_REG_OFFSET    0x10
 
-#define GPIO_DRV_REG_OFFSET    0x14
 
 /*             Newer SoCs use a slightly different register layout */
 #ifdef CONFIG_SUNXI_NEW_PINCTRL
 /* pin drive strength: 4 bits per pin */
+#define GPIO_DRV_REG_OFFSET    0x14
 #define GPIO_DRV_INDEX(pin)    ((pin) / 8)
 #define GPIO_DRV_OFFSET(pin)   (((pin) % 8) * 4)
 
 #define GPIO_PULL_REG_OFFSET   0x24
 
+#elif CONFIG_SUNXI_NEW2_PINCTRL
+#define GPIO_DRV_REG_OFFSET    0x20
+#define GPIO_DRV_INDEX(pin)    ((pin) / 8)
+#define GPIO_DRV_OFFSET(pin)   (((pin) % 8) * 4)
+
+#define GPIO_PULL_REG_OFFSET   0x30
+
 #else /* older generation pin controllers */
 /* pin drive strength: 2 bits per pin */
+#define GPIO_DRV_REG_OFFSET    0x14
 #define GPIO_DRV_INDEX(pin)    ((pin) / 16)
 #define GPIO_DRV_OFFSET(pin)   (((pin) % 16) * 2)
 
@@ -62,15 +70,18 @@
 static void* BANK_TO_GPIO(int bank)
 {
        void *pio_base;
+       u32 bank_size;
 
        if (bank < SUNXI_GPIO_L) {
-               pio_base = (void *)(uintptr_t)SUNXI_PIO_BASE;
+               pio_base = (void *)(uintptr_t)(SUNXI_PIO_BASE + 
SUNXI_PIO_OFFSET);
+               bank_size = SUNXI_PINCTRL_BANK_SIZE;
        } else {
                pio_base = (void *)(uintptr_t)SUNXI_R_PIO_BASE;
+               bank_size = SUNXI_R_PINCTRL_BANK_SIZE;
                bank -= SUNXI_GPIO_L;
        }
 
-       return pio_base + bank * SUNXI_PINCTRL_BANK_SIZE;
+       return pio_base + bank * bank_size;
 }
 
 void sunxi_gpio_set_cfgbank(void *bank_base, int pin_offset, u32 val)
diff --git a/include/sunxi_gpio.h b/include/sunxi_gpio.h
index 12b54c8dda4..67d012fa0fa 100644
--- a/include/sunxi_gpio.h
+++ b/include/sunxi_gpio.h
@@ -19,6 +19,9 @@
 #elif defined(CONFIG_SUN50I_GEN_H6)
 #define SUNXI_PIO_BASE         0x0300b000
 #define SUNXI_R_PIO_BASE       0x07022000
+#elif defined(CONFIG_MACH_SUN60I_A733)
+#define SUNXI_PIO_BASE         0x02000000
+#define SUNXI_R_PIO_BASE       0x07025000
 #elif defined(CONFIG_SUNXI_GEN_NCAT2)
 #define SUNXI_PIO_BASE         0x02000000
 #define SUNXI_R_PIO_BASE       0x07022000
@@ -172,11 +175,22 @@ enum sunxi_gpio_number {
 #ifdef CONFIG_SUNXI_NEW_PINCTRL
        #define SUNXI_PINCTRL_BANK_SIZE 0x30
        #define SUNXI_GPIO_DISABLE      0xf
+#elif CONFIG_SUNXI_NEW2_PINCTRL
+       #define SUNXI_PINCTRL_BANK_SIZE 0x80
+       #define SUNXI_GPIO_DISABLE      0xf
 #else
        #define SUNXI_PINCTRL_BANK_SIZE 0x24
        #define SUNXI_GPIO_DISABLE      0x7
 #endif
 
+#if CONFIG_SUNXI_NEW2_PINCTRL
+#define SUNXI_PIO_OFFSET               0x80 /* offset for virtual PA port */
+#define SUNXI_R_PINCTRL_BANK_SIZE      0x30
+#else
+#define SUNXI_PIO_OFFSET               0x00
+#define SUNXI_R_PINCTRL_BANK_SIZE      SUNXI_PINCTRL_BANK_SIZE
+#endif
+
 /* GPIO pin pull-up/down config */
 #define SUNXI_GPIO_PULL_DISABLE        0
 #define SUNXI_GPIO_PULL_UP     1

-- 
2.51.2

Reply via email to