power/reset: arm-versatile: Register with kernel restart handler

Register with kernel restart handler instead of setting arm_pm_restart
directly. Select high priority since the restart handler is instantiated
through devicetree, indicating that it should be used if configured.

Signed-off-by: Guenter Roeck <linux@roeck-us.net>
Signed-off-by: Sebastian Reichel <sre@kernel.org>

diff --git a/drivers/power/reset/arm-versatile-reboot.c b/drivers/power/reset/arm-versatile-reboot.c
index adea9d0..b208073 100644 (file)
--- a/drivers/power/reset/arm-versatile-reboot.c
+++ b/drivers/power/reset/arm-versatile-reboot.c
@@ -13,7 +13,6 @@
 #include <linux/reboot.h>
 #include <linux/regmap.h>
 #include <linux/of.h>
-#include <asm/system_misc.h>
 
 #define INTEGRATOR_HDR_CTRL_OFFSET     0x0C
 #define INTEGRATOR_HDR_LOCK_OFFSET     0x14
@@ -69,7 +68,8 @@ static const struct of_device_id versatile_reboot_of_match[] = {
        {},
 };
 
-static void versatile_reboot(enum reboot_mode mode, const char *cmd)
+static int versatile_reboot(struct notifier_block *this, unsigned long mode,
+                           void *cmd)
 {
        /* Unlock the reset register */
        /* Then hit reset on the different machines */
@@ -113,12 +113,20 @@ static void versatile_reboot(enum reboot_mode mode, const char *cmd)
                break;
        }
        dsb();
+
+       return NOTIFY_DONE;
 }
 
+static struct notifier_block versatile_reboot_nb = {
+       .notifier_call = versatile_reboot,
+       .priority = 192,
+};
+
 static int __init versatile_reboot_probe(void)
 {
        const struct of_device_id *reboot_id;
        struct device_node *np;
+       int err;
 
        np = of_find_matching_node_and_match(NULL, versatile_reboot_of_match,
                                                 &reboot_id);
@@ -130,7 +138,10 @@ static int __init versatile_reboot_probe(void)
        if (IS_ERR(syscon_regmap))
                return PTR_ERR(syscon_regmap);
 
-       arm_pm_restart = versatile_reboot;
+       err = register_restart_handler(&versatile_reboot_nb);
+       if (err)
+               return err;
+
        pr_info("versatile reboot driver registered\n");
        return 0;
 }