This patch allows for platform specific quirks as some of the SoC need
further customization for the watchdog to work properly, like for R-Car
Gen2 and for RZ/G.

Signed-off-by: Fabrizio Castro <[email protected]>
Signed-off-by: Ramesh Shanmugasundaram <[email protected]>
---
 drivers/soc/renesas/rcar-rst.c | 21 ++++++++++++++++++++-
 1 file changed, 20 insertions(+), 1 deletion(-)

diff --git a/drivers/soc/renesas/rcar-rst.c b/drivers/soc/renesas/rcar-rst.c
index f7a0d54..5f52aea 100644
--- a/drivers/soc/renesas/rcar-rst.c
+++ b/drivers/soc/renesas/rcar-rst.c
@@ -13,8 +13,18 @@
 #include <linux/of_address.h>
 #include <linux/soc/renesas/rcar-rst.h>
 
+#define WDTRSTCR_RESET         0xA55A0002
+#define WDTRSTCR               0x0054
+
+static int gen2_configuration(void __iomem *base)
+{
+       iowrite32(WDTRSTCR_RESET, base + WDTRSTCR);
+       return 0;
+}
+
 struct rst_config {
-       unsigned int modemr;    /* Mode Monitoring Register Offset */
+       unsigned int modemr;            /* Mode Monitoring Register Offset */
+       int (*configure)(void *base);   /* Platform specific configuration */
 };
 
 static const struct rst_config rcar_rst_gen1 __initconst = {
@@ -23,6 +33,7 @@ static const struct rst_config rcar_rst_gen1 __initconst = {
 
 static const struct rst_config rcar_rst_gen2 __initconst = {
        .modemr = 0x60,
+       .configure = gen2_configuration,
 };
 
 static const struct rst_config rcar_rst_gen3 __initconst = {
@@ -79,6 +90,14 @@ static int __init rcar_rst_init(void)
        rcar_rst_base = base;
        cfg = match->data;
        saved_mode = ioread32(base + cfg->modemr);
+       if (cfg->configure) {
+               error = cfg->configure(base);
+               if (error) {
+                       pr_warn("%pOF: Cannot run SoC specific configuration\n",
+                               np);
+                       goto out_put;
+               }
+       }
 
        pr_debug("%pOF: MODE = 0x%08x\n", np, saved_mode);
 
-- 
2.7.4

Reply via email to