Commit 948b9c60 authored by Sebastian Andrzej Siewior's avatar Sebastian Andrzej Siewior Committed by Thomas Gleixner

watchdog/octeon: Convert to hotplug state machine

Install the callbacks via the state machine and let the core invoke
the callbacks on the already online CPUs.
Signed-off-by: default avatarSebastian Andrzej Siewior <bigeasy@linutronix.de>
Cc: Wim Van Sebroeck <wim@iguana.be>
Cc: rt@linuxtronix.de
Cc: Guenter Roeck <linux@roeck-us.net>
Cc: linux-watchdog@vger.kernel.org
Link: http://lkml.kernel.org/r/20161117183541.8588-12-bigeasy@linutronix.deSigned-off-by: default avatarThomas Gleixner <tglx@linutronix.de>
parent 9c248f88
...@@ -374,7 +374,7 @@ void octeon_wdt_nmi_stage3(u64 reg[32]) ...@@ -374,7 +374,7 @@ void octeon_wdt_nmi_stage3(u64 reg[32])
octeon_wdt_write_string("*** Chip soft reset soon ***\r\n"); octeon_wdt_write_string("*** Chip soft reset soon ***\r\n");
} }
static void octeon_wdt_disable_interrupt(int cpu) static int octeon_wdt_cpu_pre_down(unsigned int cpu)
{ {
unsigned int core; unsigned int core;
unsigned int irq; unsigned int irq;
...@@ -392,9 +392,10 @@ static void octeon_wdt_disable_interrupt(int cpu) ...@@ -392,9 +392,10 @@ static void octeon_wdt_disable_interrupt(int cpu)
cvmx_write_csr(CVMX_CIU_WDOGX(core), ciu_wdog.u64); cvmx_write_csr(CVMX_CIU_WDOGX(core), ciu_wdog.u64);
free_irq(irq, octeon_wdt_poke_irq); free_irq(irq, octeon_wdt_poke_irq);
return 0;
} }
static void octeon_wdt_setup_interrupt(int cpu) static int octeon_wdt_cpu_online(unsigned int cpu)
{ {
unsigned int core; unsigned int core;
unsigned int irq; unsigned int irq;
...@@ -424,25 +425,8 @@ static void octeon_wdt_setup_interrupt(int cpu) ...@@ -424,25 +425,8 @@ static void octeon_wdt_setup_interrupt(int cpu)
ciu_wdog.s.len = timeout_cnt; ciu_wdog.s.len = timeout_cnt;
ciu_wdog.s.mode = 3; /* 3 = Interrupt + NMI + Soft-Reset */ ciu_wdog.s.mode = 3; /* 3 = Interrupt + NMI + Soft-Reset */
cvmx_write_csr(CVMX_CIU_WDOGX(core), ciu_wdog.u64); cvmx_write_csr(CVMX_CIU_WDOGX(core), ciu_wdog.u64);
}
static int octeon_wdt_cpu_callback(struct notifier_block *nfb, return 0;
unsigned long action, void *hcpu)
{
unsigned int cpu = (unsigned long)hcpu;
switch (action & ~CPU_TASKS_FROZEN) {
case CPU_DOWN_PREPARE:
octeon_wdt_disable_interrupt(cpu);
break;
case CPU_ONLINE:
case CPU_DOWN_FAILED:
octeon_wdt_setup_interrupt(cpu);
break;
default:
break;
}
return NOTIFY_OK;
} }
static int octeon_wdt_ping(struct watchdog_device __always_unused *wdog) static int octeon_wdt_ping(struct watchdog_device __always_unused *wdog)
...@@ -531,10 +515,6 @@ static int octeon_wdt_stop(struct watchdog_device *wdog) ...@@ -531,10 +515,6 @@ static int octeon_wdt_stop(struct watchdog_device *wdog)
return 0; return 0;
} }
static struct notifier_block octeon_wdt_cpu_notifier = {
.notifier_call = octeon_wdt_cpu_callback,
};
static const struct watchdog_info octeon_wdt_info = { static const struct watchdog_info octeon_wdt_info = {
.options = WDIOF_SETTIMEOUT | WDIOF_MAGICCLOSE | WDIOF_KEEPALIVEPING, .options = WDIOF_SETTIMEOUT | WDIOF_MAGICCLOSE | WDIOF_KEEPALIVEPING,
.identity = "OCTEON", .identity = "OCTEON",
...@@ -553,6 +533,7 @@ static struct watchdog_device octeon_wdt = { ...@@ -553,6 +533,7 @@ static struct watchdog_device octeon_wdt = {
.ops = &octeon_wdt_ops, .ops = &octeon_wdt_ops,
}; };
static enum cpuhp_state octeon_wdt_online;
/** /**
* Module/ driver initialization. * Module/ driver initialization.
* *
...@@ -562,7 +543,6 @@ static int __init octeon_wdt_init(void) ...@@ -562,7 +543,6 @@ static int __init octeon_wdt_init(void)
{ {
int i; int i;
int ret; int ret;
int cpu;
u64 *ptr; u64 *ptr;
/* /*
...@@ -610,14 +590,16 @@ static int __init octeon_wdt_init(void) ...@@ -610,14 +590,16 @@ static int __init octeon_wdt_init(void)
cpumask_clear(&irq_enabled_cpus); cpumask_clear(&irq_enabled_cpus);
cpu_notifier_register_begin(); ret = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "watchdog/octeon:online",
for_each_online_cpu(cpu) octeon_wdt_cpu_online, octeon_wdt_cpu_pre_down);
octeon_wdt_setup_interrupt(cpu); if (ret < 0)
goto err;
__register_hotcpu_notifier(&octeon_wdt_cpu_notifier); octeon_wdt_online = ret;
cpu_notifier_register_done();
return 0; return 0;
err:
cvmx_write_csr(CVMX_MIO_BOOT_LOC_CFGX(0), 0);
watchdog_unregister_device(&octeon_wdt);
return ret;
} }
/** /**
...@@ -625,22 +607,8 @@ static int __init octeon_wdt_init(void) ...@@ -625,22 +607,8 @@ static int __init octeon_wdt_init(void)
*/ */
static void __exit octeon_wdt_cleanup(void) static void __exit octeon_wdt_cleanup(void)
{ {
int cpu;
watchdog_unregister_device(&octeon_wdt); watchdog_unregister_device(&octeon_wdt);
cpuhp_remove_state(octeon_wdt_online);
cpu_notifier_register_begin();
__unregister_hotcpu_notifier(&octeon_wdt_cpu_notifier);
for_each_online_cpu(cpu) {
int core = cpu2core(cpu);
/* Disable the watchdog */
cvmx_write_csr(CVMX_CIU_WDOGX(core), 0);
/* Free the interrupt handler */
free_irq(OCTEON_IRQ_WDOG0 + core, octeon_wdt_poke_irq);
}
cpu_notifier_register_done();
/* /*
* Disable the boot-bus memory, the code it points to is soon * Disable the boot-bus memory, the code it points to is soon
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment