Message ID | 1436171730-21175-1-git-send-email-jun.nie@linaro.org |
---|---|
State | New |
Headers | show |
2015-07-13 20:00 GMT+08:00 Sebastian Reichel <sre@kernel.org>: > Hi, > > On Mon, Jul 06, 2015 at 04:35:30PM +0800, Jun Nie wrote: >> Register with kernel restart handler instead of setting arm_pm_restart >> directly. >> >> [...] >> >> +static void __iomem *base; >> +static void __iomem *pcu_base; >> + >> +static int zx_restart_handler(struct notifier_block *this, >> + unsigned long mode, void *cmd) >> +{ >> + writel_relaxed(1, base + 0xb0); >> + writel_relaxed(1, pcu_base + 0x34); >> + >> + while (1) >> + cpu_do_idle(); > > mdelay(some_time); > pr_emerg("Unable to restart system\n"); I do not think these code can be executed as reset will happen after register writing and while loop will stop any further code execution. Please point out issue if any. > >> + >> + return NOTIFY_DONE; >> +} >> + >> >> [...] >> >> +static int zx_reboot_probe(struct platform_device *pdev) >> +{ >> + struct device_node *np = pdev->dev.of_node; >> + int err; >> + >> + base = of_iomap(np, 0); >> + if (!base) { >> + WARN(1, "failed to map base address"); >> + return -ENODEV; >> + } >> + >> + np = of_find_compatible_node(NULL, NULL, "zte,zx296702-pcu"); >> + pcu_base = of_iomap(np, 0); >> + if (!pcu_base) { >> + iounmap(base); >> + WARN(1, "failed to map pcu_base address"); >> + return -ENODEV; >> + } >> + >> + err = register_restart_handler(&zx_restart_nb); >> + if (err) >> + dev_err(&pdev->dev, "Register restart handler failed(err=%d)\n", >> + err); >> + >> + return err; >> +} >> + >> +static const struct of_device_id zx_reboot_of_match[] = { >> + { .compatible = "zte,sysctrl" }, >> + {} >> +}; > > Where's the DT Binding Documentation? DT document is in Documentation/devicetree/bindings/arm/zte.txt > >> [...] > > -- Sebastian -- To unsubscribe from this list: send the line "unsubscribe linux-pm" in the body of a message to majordomo@vger.kernel.org More majordomo info at http://vger.kernel.org/majordomo-info.html
diff --git a/drivers/power/reset/Kconfig b/drivers/power/reset/Kconfig index aad9c33..4ed90f3 100644 --- a/drivers/power/reset/Kconfig +++ b/drivers/power/reset/Kconfig @@ -165,5 +165,12 @@ config POWER_RESET_RMOBILE help Reboot support for Renesas R-Mobile and SH-Mobile SoCs. +config POWER_RESET_ZX + tristate "ZTE SoCs reset driver" + depends on ARCH_ZX || COMPILE_TEST + depends on HAS_IOMEM + help + Reboot support for ZTE SoCs. + endif diff --git a/drivers/power/reset/Makefile b/drivers/power/reset/Makefile index dbe06c3..096fa67 100644 --- a/drivers/power/reset/Makefile +++ b/drivers/power/reset/Makefile @@ -19,3 +19,4 @@ obj-$(CONFIG_POWER_RESET_KEYSTONE) += keystone-reset.o obj-$(CONFIG_POWER_RESET_SYSCON) += syscon-reboot.o obj-$(CONFIG_POWER_RESET_SYSCON_POWEROFF) += syscon-poweroff.o obj-$(CONFIG_POWER_RESET_RMOBILE) += rmobile-reset.o +obj-$(CONFIG_POWER_RESET_ZX) += zx-reboot.o diff --git a/drivers/power/reset/zx-reboot.c b/drivers/power/reset/zx-reboot.c new file mode 100644 index 0000000..e930a44 --- /dev/null +++ b/drivers/power/reset/zx-reboot.c @@ -0,0 +1,82 @@ +/* + * ZTE zx296702 SoC reset code + * + * Copyright (c) 2015 Linaro Ltd. + * + * Author: Jun Nie <jun.nie@linaro.org> + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#include <linux/delay.h> +#include <linux/io.h> +#include <linux/module.h> +#include <linux/notifier.h> +#include <linux/of_address.h> +#include <linux/platform_device.h> +#include <linux/reboot.h> + +#include <asm/proc-fns.h> + +static void __iomem *base; +static void __iomem *pcu_base; + +static int zx_restart_handler(struct notifier_block *this, + unsigned long mode, void *cmd) +{ + writel_relaxed(1, base + 0xb0); + writel_relaxed(1, pcu_base + 0x34); + + while (1) + cpu_do_idle(); + + return NOTIFY_DONE; +} + +static struct notifier_block zx_restart_nb = { + .notifier_call = zx_restart_handler, + .priority = 128, +}; + +static int zx_reboot_probe(struct platform_device *pdev) +{ + struct device_node *np = pdev->dev.of_node; + int err; + + base = of_iomap(np, 0); + if (!base) { + WARN(1, "failed to map base address"); + return -ENODEV; + } + + np = of_find_compatible_node(NULL, NULL, "zte,zx296702-pcu"); + pcu_base = of_iomap(np, 0); + if (!pcu_base) { + iounmap(base); + WARN(1, "failed to map pcu_base address"); + return -ENODEV; + } + + err = register_restart_handler(&zx_restart_nb); + if (err) + dev_err(&pdev->dev, "Register restart handler failed(err=%d)\n", + err); + + return err; +} + +static const struct of_device_id zx_reboot_of_match[] = { + { .compatible = "zte,sysctrl" }, + {} +}; + +static struct platform_driver zx_reboot_driver = { + .probe = zx_reboot_probe, + .driver = { + .name = "zx-reboot", + .of_match_table = zx_reboot_of_match, + }, +}; +module_platform_driver(zx_reboot_driver);
Register with kernel restart handler instead of setting arm_pm_restart directly. Signed-off-by: Jun Nie <jun.nie@linaro.org> --- drivers/power/reset/Kconfig | 7 ++++ drivers/power/reset/Makefile | 1 + drivers/power/reset/zx-reboot.c | 82 +++++++++++++++++++++++++++++++++++++++++ 3 files changed, 90 insertions(+) create mode 100644 drivers/power/reset/zx-reboot.c