Commit 226be92b authored by Viresh Kumar's avatar Viresh Kumar Committed by Daniel Lezcano

clockevents/drivers/dw_apb: Migrate to new 'set-state' interface

Migrate dw_apb driver to the new 'set-state' interface provided by
clockevents core, the earlier 'set-mode' interface is marked obsolete
now.

This also enables us to implement callbacks for new states of clockevent
devices, for example: ONESHOT_STOPPED.

Cc: Jacob Pan <jacob.jun.pan@linux.intel.com>
Cc: Jamie Iles <jamie@jamieiles.com>
Signed-off-by: default avatarViresh Kumar <viresh.kumar@linaro.org>
Signed-off-by: default avatarDaniel Lezcano <daniel.lezcano@linaro.org>
parent 5c78b265
...@@ -110,71 +110,87 @@ static void apbt_enable_int(struct dw_apb_timer *timer) ...@@ -110,71 +110,87 @@ static void apbt_enable_int(struct dw_apb_timer *timer)
apbt_writel(timer, ctrl, APBTMR_N_CONTROL); apbt_writel(timer, ctrl, APBTMR_N_CONTROL);
} }
static void apbt_set_mode(enum clock_event_mode mode, static int apbt_shutdown(struct clock_event_device *evt)
struct clock_event_device *evt)
{ {
struct dw_apb_clock_event_device *dw_ced = ced_to_dw_apb_ced(evt);
unsigned long ctrl; unsigned long ctrl;
unsigned long period;
pr_debug("%s CPU %d state=shutdown\n", __func__,
cpumask_first(evt->cpumask));
ctrl = apbt_readl(&dw_ced->timer, APBTMR_N_CONTROL);
ctrl &= ~APBTMR_CONTROL_ENABLE;
apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
return 0;
}
static int apbt_set_oneshot(struct clock_event_device *evt)
{
struct dw_apb_clock_event_device *dw_ced = ced_to_dw_apb_ced(evt); struct dw_apb_clock_event_device *dw_ced = ced_to_dw_apb_ced(evt);
unsigned long ctrl;
pr_debug("%s CPU %d mode=%d\n", __func__, pr_debug("%s CPU %d state=oneshot\n", __func__,
cpumask_first(evt->cpumask), cpumask_first(evt->cpumask));
mode);
ctrl = apbt_readl(&dw_ced->timer, APBTMR_N_CONTROL);
switch (mode) { /*
case CLOCK_EVT_MODE_PERIODIC: * set free running mode, this mode will let timer reload max
period = DIV_ROUND_UP(dw_ced->timer.freq, HZ); * timeout which will give time (3min on 25MHz clock) to rearm
ctrl = apbt_readl(&dw_ced->timer, APBTMR_N_CONTROL); * the next event, therefore emulate the one-shot mode.
ctrl |= APBTMR_CONTROL_MODE_PERIODIC; */
apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL); ctrl &= ~APBTMR_CONTROL_ENABLE;
/* ctrl &= ~APBTMR_CONTROL_MODE_PERIODIC;
* DW APB p. 46, have to disable timer before load counter,
* may cause sync problem. apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
*/ /* write again to set free running mode */
ctrl &= ~APBTMR_CONTROL_ENABLE; apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
udelay(1); /*
pr_debug("Setting clock period %lu for HZ %d\n", period, HZ); * DW APB p. 46, load counter with all 1s before starting free
apbt_writel(&dw_ced->timer, period, APBTMR_N_LOAD_COUNT); * running mode.
ctrl |= APBTMR_CONTROL_ENABLE; */
apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL); apbt_writel(&dw_ced->timer, ~0, APBTMR_N_LOAD_COUNT);
break; ctrl &= ~APBTMR_CONTROL_INT;
ctrl |= APBTMR_CONTROL_ENABLE;
case CLOCK_EVT_MODE_ONESHOT: apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
ctrl = apbt_readl(&dw_ced->timer, APBTMR_N_CONTROL); return 0;
/* }
* set free running mode, this mode will let timer reload max
* timeout which will give time (3min on 25MHz clock) to rearm static int apbt_set_periodic(struct clock_event_device *evt)
* the next event, therefore emulate the one-shot mode. {
*/ struct dw_apb_clock_event_device *dw_ced = ced_to_dw_apb_ced(evt);
ctrl &= ~APBTMR_CONTROL_ENABLE; unsigned long period = DIV_ROUND_UP(dw_ced->timer.freq, HZ);
ctrl &= ~APBTMR_CONTROL_MODE_PERIODIC; unsigned long ctrl;
apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL); pr_debug("%s CPU %d state=periodic\n", __func__,
/* write again to set free running mode */ cpumask_first(evt->cpumask));
apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
ctrl = apbt_readl(&dw_ced->timer, APBTMR_N_CONTROL);
/* ctrl |= APBTMR_CONTROL_MODE_PERIODIC;
* DW APB p. 46, load counter with all 1s before starting free apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
* running mode. /*
*/ * DW APB p. 46, have to disable timer before load counter,
apbt_writel(&dw_ced->timer, ~0, APBTMR_N_LOAD_COUNT); * may cause sync problem.
ctrl &= ~APBTMR_CONTROL_INT; */
ctrl |= APBTMR_CONTROL_ENABLE; ctrl &= ~APBTMR_CONTROL_ENABLE;
apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL); apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
break; udelay(1);
pr_debug("Setting clock period %lu for HZ %d\n", period, HZ);
case CLOCK_EVT_MODE_UNUSED: apbt_writel(&dw_ced->timer, period, APBTMR_N_LOAD_COUNT);
case CLOCK_EVT_MODE_SHUTDOWN: ctrl |= APBTMR_CONTROL_ENABLE;
ctrl = apbt_readl(&dw_ced->timer, APBTMR_N_CONTROL); apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL);
ctrl &= ~APBTMR_CONTROL_ENABLE; return 0;
apbt_writel(&dw_ced->timer, ctrl, APBTMR_N_CONTROL); }
break;
static int apbt_resume(struct clock_event_device *evt)
case CLOCK_EVT_MODE_RESUME: {
apbt_enable_int(&dw_ced->timer); struct dw_apb_clock_event_device *dw_ced = ced_to_dw_apb_ced(evt);
break;
} pr_debug("%s CPU %d state=resume\n", __func__,
cpumask_first(evt->cpumask));
apbt_enable_int(&dw_ced->timer);
return 0;
} }
static int apbt_next_event(unsigned long delta, static int apbt_next_event(unsigned long delta,
...@@ -233,7 +249,10 @@ dw_apb_clockevent_init(int cpu, const char *name, unsigned rating, ...@@ -233,7 +249,10 @@ dw_apb_clockevent_init(int cpu, const char *name, unsigned rating,
dw_ced->ced.min_delta_ns = clockevent_delta2ns(5000, &dw_ced->ced); dw_ced->ced.min_delta_ns = clockevent_delta2ns(5000, &dw_ced->ced);
dw_ced->ced.cpumask = cpumask_of(cpu); dw_ced->ced.cpumask = cpumask_of(cpu);
dw_ced->ced.features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT; dw_ced->ced.features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT;
dw_ced->ced.set_mode = apbt_set_mode; dw_ced->ced.set_state_shutdown = apbt_shutdown;
dw_ced->ced.set_state_periodic = apbt_set_periodic;
dw_ced->ced.set_state_oneshot = apbt_set_oneshot;
dw_ced->ced.tick_resume = apbt_resume;
dw_ced->ced.set_next_event = apbt_next_event; dw_ced->ced.set_next_event = apbt_next_event;
dw_ced->ced.irq = dw_ced->timer.irq; dw_ced->ced.irq = dw_ced->timer.irq;
dw_ced->ced.rating = rating; dw_ced->ced.rating = rating;
......
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