|
@@ -181,44 +181,36 @@ static irqreturn_t arch_timer_handler_virt_mem(int irq, void *dev_id)
|
|
|
return timer_handler(ARCH_TIMER_MEM_VIRT_ACCESS, evt);
|
|
|
}
|
|
|
|
|
|
-static __always_inline void timer_set_mode(const int access, int mode,
|
|
|
- struct clock_event_device *clk)
|
|
|
+static __always_inline int timer_shutdown(const int access,
|
|
|
+ struct clock_event_device *clk)
|
|
|
{
|
|
|
unsigned long ctrl;
|
|
|
- switch (mode) {
|
|
|
- case CLOCK_EVT_MODE_UNUSED:
|
|
|
- case CLOCK_EVT_MODE_SHUTDOWN:
|
|
|
- ctrl = arch_timer_reg_read(access, ARCH_TIMER_REG_CTRL, clk);
|
|
|
- ctrl &= ~ARCH_TIMER_CTRL_ENABLE;
|
|
|
- arch_timer_reg_write(access, ARCH_TIMER_REG_CTRL, ctrl, clk);
|
|
|
- break;
|
|
|
- default:
|
|
|
- break;
|
|
|
- }
|
|
|
+
|
|
|
+ ctrl = arch_timer_reg_read(access, ARCH_TIMER_REG_CTRL, clk);
|
|
|
+ ctrl &= ~ARCH_TIMER_CTRL_ENABLE;
|
|
|
+ arch_timer_reg_write(access, ARCH_TIMER_REG_CTRL, ctrl, clk);
|
|
|
+
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
-static void arch_timer_set_mode_virt(enum clock_event_mode mode,
|
|
|
- struct clock_event_device *clk)
|
|
|
+static int arch_timer_shutdown_virt(struct clock_event_device *clk)
|
|
|
{
|
|
|
- timer_set_mode(ARCH_TIMER_VIRT_ACCESS, mode, clk);
|
|
|
+ return timer_shutdown(ARCH_TIMER_VIRT_ACCESS, clk);
|
|
|
}
|
|
|
|
|
|
-static void arch_timer_set_mode_phys(enum clock_event_mode mode,
|
|
|
- struct clock_event_device *clk)
|
|
|
+static int arch_timer_shutdown_phys(struct clock_event_device *clk)
|
|
|
{
|
|
|
- timer_set_mode(ARCH_TIMER_PHYS_ACCESS, mode, clk);
|
|
|
+ return timer_shutdown(ARCH_TIMER_PHYS_ACCESS, clk);
|
|
|
}
|
|
|
|
|
|
-static void arch_timer_set_mode_virt_mem(enum clock_event_mode mode,
|
|
|
- struct clock_event_device *clk)
|
|
|
+static int arch_timer_shutdown_virt_mem(struct clock_event_device *clk)
|
|
|
{
|
|
|
- timer_set_mode(ARCH_TIMER_MEM_VIRT_ACCESS, mode, clk);
|
|
|
+ return timer_shutdown(ARCH_TIMER_MEM_VIRT_ACCESS, clk);
|
|
|
}
|
|
|
|
|
|
-static void arch_timer_set_mode_phys_mem(enum clock_event_mode mode,
|
|
|
- struct clock_event_device *clk)
|
|
|
+static int arch_timer_shutdown_phys_mem(struct clock_event_device *clk)
|
|
|
{
|
|
|
- timer_set_mode(ARCH_TIMER_MEM_PHYS_ACCESS, mode, clk);
|
|
|
+ return timer_shutdown(ARCH_TIMER_MEM_PHYS_ACCESS, clk);
|
|
|
}
|
|
|
|
|
|
static __always_inline void set_next_event(const int access, unsigned long evt,
|
|
@@ -273,11 +265,11 @@ static void __arch_timer_setup(unsigned type,
|
|
|
clk->cpumask = cpumask_of(smp_processor_id());
|
|
|
if (arch_timer_use_virtual) {
|
|
|
clk->irq = arch_timer_ppi[VIRT_PPI];
|
|
|
- clk->set_mode = arch_timer_set_mode_virt;
|
|
|
+ clk->set_state_shutdown = arch_timer_shutdown_virt;
|
|
|
clk->set_next_event = arch_timer_set_next_event_virt;
|
|
|
} else {
|
|
|
clk->irq = arch_timer_ppi[PHYS_SECURE_PPI];
|
|
|
- clk->set_mode = arch_timer_set_mode_phys;
|
|
|
+ clk->set_state_shutdown = arch_timer_shutdown_phys;
|
|
|
clk->set_next_event = arch_timer_set_next_event_phys;
|
|
|
}
|
|
|
} else {
|
|
@@ -286,17 +278,17 @@ static void __arch_timer_setup(unsigned type,
|
|
|
clk->rating = 400;
|
|
|
clk->cpumask = cpu_all_mask;
|
|
|
if (arch_timer_mem_use_virtual) {
|
|
|
- clk->set_mode = arch_timer_set_mode_virt_mem;
|
|
|
+ clk->set_state_shutdown = arch_timer_shutdown_virt_mem;
|
|
|
clk->set_next_event =
|
|
|
arch_timer_set_next_event_virt_mem;
|
|
|
} else {
|
|
|
- clk->set_mode = arch_timer_set_mode_phys_mem;
|
|
|
+ clk->set_state_shutdown = arch_timer_shutdown_phys_mem;
|
|
|
clk->set_next_event =
|
|
|
arch_timer_set_next_event_phys_mem;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
- clk->set_mode(CLOCK_EVT_MODE_SHUTDOWN, clk);
|
|
|
+ clk->set_state_shutdown(clk);
|
|
|
|
|
|
clockevents_config_and_register(clk, arch_timer_rate, 0xf, 0x7fffffff);
|
|
|
}
|
|
@@ -506,7 +498,7 @@ static void arch_timer_stop(struct clock_event_device *clk)
|
|
|
disable_percpu_irq(arch_timer_ppi[PHYS_NONSECURE_PPI]);
|
|
|
}
|
|
|
|
|
|
- clk->set_mode(CLOCK_EVT_MODE_UNUSED, clk);
|
|
|
+ clk->set_state_shutdown(clk);
|
|
|
}
|
|
|
|
|
|
static int arch_timer_cpu_notify(struct notifier_block *self,
|