add reset type detect and persist setting.

Signed-off-by: Jim Liu <jjl...@nuvoton.com>
---
 arch/arm/include/asm/arch-npcm8xx/rst.h   |  2 +-
 drivers/pinctrl/nuvoton/pinctrl-npcm7xx.c | 20 ++++++++++++++++++++
 drivers/pinctrl/nuvoton/pinctrl-npcm8xx.c | 22 +++++++++++++++++++++-
 3 files changed, 42 insertions(+), 2 deletions(-)

diff --git a/arch/arm/include/asm/arch-npcm8xx/rst.h 
b/arch/arm/include/asm/arch-npcm8xx/rst.h
index 379e841fca..09e1485063 100644
--- a/arch/arm/include/asm/arch-npcm8xx/rst.h
+++ b/arch/arm/include/asm/arch-npcm8xx/rst.h
@@ -16,7 +16,7 @@
 #define SW1RST         BIT(28)
 #define SW2RST         BIT(27)
 #define SW3RST         BIT(26)
-#define SW4RST         BIT(25)
+#define TIPRST         BIT(25)
 #define WD1RST         BIT(24)
 #define WD2RST         BIT(23)
 #define RST_STS_MASK   GENMASK(31, 23)
diff --git a/drivers/pinctrl/nuvoton/pinctrl-npcm7xx.c 
b/drivers/pinctrl/nuvoton/pinctrl-npcm7xx.c
index 31678f5537..1ad8bfbd88 100644
--- a/drivers/pinctrl/nuvoton/pinctrl-npcm7xx.c
+++ b/drivers/pinctrl/nuvoton/pinctrl-npcm7xx.c
@@ -47,6 +47,10 @@
 #define WD0RST                         BIT(29)
 #define WD1RST                         BIT(24)
 #define WD2RST                         BIT(23)
+#define SWRST1                         BIT(28)
+#define SWRST2                         BIT(27)
+#define SWRST3                         BIT(26)
+#define SW4RST                         BIT(25)
 
 #define GPIOX_MODULE_RESET             16
 #define CA9C_RESET                     BIT(0)
@@ -1374,6 +1378,14 @@ static bool is_gpio_persist(struct udevice *dev, u8 bank)
                regmap_read(priv->rst_regmap, NPCM7XX_RST_WD1RCR, &tmp);
        else if (value & WD2RST)
                regmap_read(priv->rst_regmap, NPCM7XX_RST_WD2RCR, &tmp);
+       else if (value & SWRST1)
+                regmap_read(priv->rst_regmap, NPCM7XX_RST_SWRSTC1, &tmp);
+       else if (value & SWRST2)
+                regmap_read(priv->rst_regmap, NPCM7XX_RST_SWRSTC2, &tmp);
+       else if (value & SWRST3)
+                regmap_read(priv->rst_regmap, NPCM7XX_RST_SWRSTC3, &tmp);
+       else if (value & SW4RST)
+                regmap_read(priv->rst_regmap, NPCM7XX_RST_SWRSTC4, &tmp);
        else
                return false;
 
@@ -1392,11 +1404,19 @@ static int npcm7xx_gpio_reset_persist(struct udevice 
*dev, unsigned int banknum,
                regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_WD1RCR, 
BIT(num), 0);
                regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_WD2RCR, 
BIT(num), 0);
                regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_CORSTC, 
BIT(num), 0);
+               regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_SWRSTC1, 
BIT(num), 0);
+               regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_SWRSTC2, 
BIT(num), 0);
+               regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_SWRSTC3, 
BIT(num), 0);
+               regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_SWRSTC4, 
BIT(num), 0);
        } else {
                regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_WD0RCR, 
BIT(num) | CA9C_RESET, BIT(num) | CA9C_RESET);
                regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_WD1RCR, 
BIT(num) | CA9C_RESET, BIT(num) | CA9C_RESET);
                regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_WD2RCR, 
BIT(num) | CA9C_RESET, BIT(num) | CA9C_RESET);
                regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_CORSTC, 
BIT(num) | CA9C_RESET, BIT(num) | CA9C_RESET);
+               regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_SWRSTC1, 
BIT(num) | CA9C_RESET, BIT(num) | CA9C_RESET);
+               regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_SWRSTC2, 
BIT(num) | CA9C_RESET, BIT(num) | CA9C_RESET);
+               regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_SWRSTC3, 
BIT(num) | CA9C_RESET, BIT(num) | CA9C_RESET);
+               regmap_update_bits(priv->rst_regmap, NPCM7XX_RST_SWRSTC4, 
BIT(num) | CA9C_RESET, BIT(num) | CA9C_RESET);
        }
 
        return 0;
diff --git a/drivers/pinctrl/nuvoton/pinctrl-npcm8xx.c 
b/drivers/pinctrl/nuvoton/pinctrl-npcm8xx.c
index c6ffa89f77..0ec47e9577 100644
--- a/drivers/pinctrl/nuvoton/pinctrl-npcm8xx.c
+++ b/drivers/pinctrl/nuvoton/pinctrl-npcm8xx.c
@@ -20,7 +20,7 @@
 #define SWRSTC1                0x44
 #define SWRSTC2                0x48
 #define SWRSTC3                0x4c
-#define SWRSTC4                0x50
+#define TIPRSTC                0x50
 #define CORSTC         0x5c
 #define FLOCKR1                0x74
 #define INTCR4         0xc0
@@ -772,6 +772,10 @@ static int npcm8xx_gpio_reset_persist(struct udevice *dev, 
uint bank,
                regmap_update_bits(priv->rst_regmap, WD1RCR, BIT(offset), 0);
                regmap_update_bits(priv->rst_regmap, WD2RCR, BIT(offset), 0);
                regmap_update_bits(priv->rst_regmap, CORSTC, BIT(offset), 0);
+               regmap_update_bits(priv->rst_regmap, SWRSTC1, BIT(offset), 0);
+               regmap_update_bits(priv->rst_regmap, SWRSTC2, BIT(offset), 0);
+               regmap_update_bits(priv->rst_regmap, SWRSTC3, BIT(offset), 0);
+               regmap_update_bits(priv->rst_regmap, TIPRSTC, BIT(offset), 0);
        } else {
                regmap_update_bits(priv->rst_regmap, WD0RCR, BIT(offset),
                                   BIT(offset));
@@ -781,6 +785,14 @@ static int npcm8xx_gpio_reset_persist(struct udevice *dev, 
uint bank,
                                   BIT(offset));
                regmap_update_bits(priv->rst_regmap, CORSTC, BIT(offset),
                                   BIT(offset));
+               regmap_update_bits(priv->rst_regmap, SWRSTC1, BIT(offset),
+                                  BIT(offset));
+               regmap_update_bits(priv->rst_regmap, SWRSTC2, BIT(offset),
+                                  BIT(offset));
+               regmap_update_bits(priv->rst_regmap, SWRSTC3, BIT(offset),
+                                  BIT(offset));
+               regmap_update_bits(priv->rst_regmap, TIPRSTC, BIT(offset),
+                                  BIT(offset));
        }
 
        return 0;
@@ -804,6 +816,14 @@ static bool is_gpio_persist(struct udevice *dev, uint bank)
                regmap_read(priv->rst_regmap, WD1RCR, &val);
        else if (status & WD2RST)
                regmap_read(priv->rst_regmap, WD2RCR, &val);
+       else if (status & SW1RST)
+               regmap_read(priv->rst_regmap, SWRSTC1, &val);
+       else if (status & SW2RST)
+               regmap_read(priv->rst_regmap, SWRSTC2, &val);
+       else if (status & SW3RST)
+               regmap_read(priv->rst_regmap, SWRSTC3, &val);
+       else if (status & TIPRST)
+               regmap_read(priv->rst_regmap, TIPRSTC, &val);
        else
                return false;
 
-- 
2.17.1

Reply via email to