|
@@ -20,21 +20,27 @@
|
|
#include <linux/platform_device.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
#include <linux/reboot.h>
|
|
#include <linux/reboot.h>
|
|
-
|
|
|
|
-#include <asm/system_misc.h>
|
|
|
|
|
|
+#include <linux/pm.h>
|
|
|
|
|
|
static void __iomem *msm_ps_hold;
|
|
static void __iomem *msm_ps_hold;
|
|
-
|
|
|
|
-static void do_msm_restart(enum reboot_mode reboot_mode, const char *cmd)
|
|
|
|
|
|
+static int do_msm_restart(struct notifier_block *nb, unsigned long action,
|
|
|
|
+ void *data)
|
|
{
|
|
{
|
|
writel(0, msm_ps_hold);
|
|
writel(0, msm_ps_hold);
|
|
mdelay(10000);
|
|
mdelay(10000);
|
|
|
|
+
|
|
|
|
+ return NOTIFY_DONE;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static struct notifier_block restart_nb = {
|
|
|
|
+ .notifier_call = do_msm_restart,
|
|
|
|
+ .priority = 128,
|
|
|
|
+};
|
|
|
|
+
|
|
static void do_msm_poweroff(void)
|
|
static void do_msm_poweroff(void)
|
|
{
|
|
{
|
|
/* TODO: Add poweroff capability */
|
|
/* TODO: Add poweroff capability */
|
|
- do_msm_restart(REBOOT_HARD, NULL);
|
|
|
|
|
|
+ do_msm_restart(&restart_nb, 0, NULL);
|
|
}
|
|
}
|
|
|
|
|
|
static int msm_restart_probe(struct platform_device *pdev)
|
|
static int msm_restart_probe(struct platform_device *pdev)
|
|
@@ -47,8 +53,10 @@ static int msm_restart_probe(struct platform_device *pdev)
|
|
if (IS_ERR(msm_ps_hold))
|
|
if (IS_ERR(msm_ps_hold))
|
|
return PTR_ERR(msm_ps_hold);
|
|
return PTR_ERR(msm_ps_hold);
|
|
|
|
|
|
|
|
+ register_restart_handler(&restart_nb);
|
|
|
|
+
|
|
pm_power_off = do_msm_poweroff;
|
|
pm_power_off = do_msm_poweroff;
|
|
- arm_pm_restart = do_msm_restart;
|
|
|
|
|
|
+
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|