1
0
Fork 0

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>
hifive-unleashed-5.1
Guenter Roeck 2015-01-25 12:30:40 -08:00 committed by Sebastian Reichel
parent a30067bb54
commit 25a5b57dd7
1 changed files with 14 additions and 3 deletions

View File

@ -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;
}