power: reset: corrections for simple syscon reboot driver
This patch is to fix some bugs in reboot driver. Which includes auto selection of the MFD_SYSCON for the driver, use of container to locate restart handler, correction of the count down failure timer and ordering of the header file. Signed-off-by: Feng Kan <fkan@apm.com> Reviewed-by: Guenter Roeck <linux@roeck-us.net> [ sre: return err instead of 0 in syscon_reboot_probe() ] Signed-off-by: Sebastian Reichel <sre@kernel.org>
This commit is contained in:
parent
a7ba749e01
commit
afaebbdbd4
@ -120,6 +120,7 @@ config POWER_RESET_KEYSTONE
|
||||
|
||||
config POWER_RESET_SYSCON
|
||||
bool "Generic SYSCON regmap reset driver"
|
||||
depends on POWER_RESET && MFD_SYSCON && OF
|
||||
depends on POWER_RESET && OF
|
||||
select MFD_SYSCON
|
||||
help
|
||||
Reboot support for generic SYSCON mapped register reset.
|
||||
|
@ -14,14 +14,15 @@
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*/
|
||||
#include <linux/delay.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/of_address.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/notifier.h>
|
||||
#include <linux/mfd/syscon.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/of_address.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/reboot.h>
|
||||
#include <linux/regmap.h>
|
||||
|
||||
struct syscon_reboot_context {
|
||||
struct regmap *map;
|
||||
@ -30,21 +31,17 @@ struct syscon_reboot_context {
|
||||
struct notifier_block restart_handler;
|
||||
};
|
||||
|
||||
static struct syscon_reboot_context *syscon_reboot_ctx;
|
||||
|
||||
static int syscon_restart_handle(struct notifier_block *this,
|
||||
unsigned long mode, void *cmd)
|
||||
{
|
||||
struct syscon_reboot_context *ctx = syscon_reboot_ctx;
|
||||
unsigned long timeout;
|
||||
struct syscon_reboot_context *ctx =
|
||||
container_of(this, struct syscon_reboot_context,
|
||||
restart_handler);
|
||||
|
||||
/* Issue the reboot */
|
||||
if (ctx->map)
|
||||
regmap_write(ctx->map, ctx->offset, ctx->mask);
|
||||
regmap_write(ctx->map, ctx->offset, ctx->mask);
|
||||
|
||||
timeout = jiffies + HZ;
|
||||
while (time_before(jiffies, timeout))
|
||||
cpu_relax();
|
||||
mdelay(1000);
|
||||
|
||||
pr_emerg("Unable to restart system\n");
|
||||
return NOTIFY_DONE;
|
||||
@ -76,9 +73,7 @@ static int syscon_reboot_probe(struct platform_device *pdev)
|
||||
if (err)
|
||||
dev_err(dev, "can't register restart notifier (err=%d)\n", err);
|
||||
|
||||
syscon_reboot_ctx = ctx;
|
||||
|
||||
return 0;
|
||||
return err;
|
||||
}
|
||||
|
||||
static struct of_device_id syscon_reboot_of_match[] = {
|
||||
|
Loading…
Reference in New Issue
Block a user