ARM: imx: move timer resources into a structure
Instead of passing around as individual argument, let's move timer resources like irq and clocks together with base address into a data structure, and pass pointer of the structure as argument to simplify the function call interface. Signed-off-by: Shawn Guo <shawn.guo@linaro.org>
This commit is contained in:
Родитель
c7770bbae2
Коммит
6dd747825b
|
@ -28,6 +28,7 @@
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
#include <linux/err.h>
|
#include <linux/err.h>
|
||||||
#include <linux/sched_clock.h>
|
#include <linux/sched_clock.h>
|
||||||
|
#include <linux/slab.h>
|
||||||
#include <linux/of.h>
|
#include <linux/of.h>
|
||||||
#include <linux/of_address.h>
|
#include <linux/of_address.h>
|
||||||
#include <linux/of_irq.h>
|
#include <linux/of_irq.h>
|
||||||
|
@ -84,6 +85,13 @@
|
||||||
static struct clock_event_device clockevent_mxc;
|
static struct clock_event_device clockevent_mxc;
|
||||||
static enum clock_event_mode clockevent_mode = CLOCK_EVT_MODE_UNUSED;
|
static enum clock_event_mode clockevent_mode = CLOCK_EVT_MODE_UNUSED;
|
||||||
|
|
||||||
|
struct imx_timer {
|
||||||
|
void __iomem *base;
|
||||||
|
int irq;
|
||||||
|
struct clk *clk_per;
|
||||||
|
struct clk *clk_ipg;
|
||||||
|
};
|
||||||
|
|
||||||
static void __iomem *timer_base;
|
static void __iomem *timer_base;
|
||||||
|
|
||||||
static inline void gpt_irq_disable(void)
|
static inline void gpt_irq_disable(void)
|
||||||
|
@ -134,10 +142,10 @@ static unsigned long imx_read_current_timer(void)
|
||||||
return readl_relaxed(sched_clock_reg);
|
return readl_relaxed(sched_clock_reg);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int __init mxc_clocksource_init(struct clk *timer_clk)
|
static int __init mxc_clocksource_init(struct imx_timer *imxtm)
|
||||||
{
|
{
|
||||||
unsigned int c = clk_get_rate(timer_clk);
|
unsigned int c = clk_get_rate(imxtm->clk_per);
|
||||||
void __iomem *reg = timer_base + (timer_is_v2() ? V2_TCN : MX1_2_TCN);
|
void __iomem *reg = imxtm->base + (timer_is_v2() ? V2_TCN : MX1_2_TCN);
|
||||||
|
|
||||||
imx_delay_timer.read_current_timer = &imx_read_current_timer;
|
imx_delay_timer.read_current_timer = &imx_read_current_timer;
|
||||||
imx_delay_timer.freq = c;
|
imx_delay_timer.freq = c;
|
||||||
|
@ -284,49 +292,51 @@ static struct clock_event_device clockevent_mxc = {
|
||||||
.rating = 200,
|
.rating = 200,
|
||||||
};
|
};
|
||||||
|
|
||||||
static int __init mxc_clockevent_init(struct clk *timer_clk)
|
static int __init mxc_clockevent_init(struct imx_timer *imxtm)
|
||||||
{
|
{
|
||||||
if (timer_is_v2())
|
if (timer_is_v2())
|
||||||
clockevent_mxc.set_next_event = v2_set_next_event;
|
clockevent_mxc.set_next_event = v2_set_next_event;
|
||||||
|
|
||||||
clockevent_mxc.cpumask = cpumask_of(0);
|
clockevent_mxc.cpumask = cpumask_of(0);
|
||||||
clockevents_config_and_register(&clockevent_mxc,
|
clockevents_config_and_register(&clockevent_mxc,
|
||||||
clk_get_rate(timer_clk),
|
clk_get_rate(imxtm->clk_per),
|
||||||
0xff, 0xfffffffe);
|
0xff, 0xfffffffe);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void __init _mxc_timer_init(int irq,
|
static void __init _mxc_timer_init(struct imx_timer *imxtm)
|
||||||
struct clk *clk_per, struct clk *clk_ipg)
|
|
||||||
{
|
{
|
||||||
uint32_t tctl_val;
|
uint32_t tctl_val;
|
||||||
|
|
||||||
if (IS_ERR(clk_per)) {
|
/* Temporary */
|
||||||
|
timer_base = imxtm->base;
|
||||||
|
|
||||||
|
if (IS_ERR(imxtm->clk_per)) {
|
||||||
pr_err("i.MX timer: unable to get clk\n");
|
pr_err("i.MX timer: unable to get clk\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (!IS_ERR(clk_ipg))
|
if (!IS_ERR(imxtm->clk_ipg))
|
||||||
clk_prepare_enable(clk_ipg);
|
clk_prepare_enable(imxtm->clk_ipg);
|
||||||
|
|
||||||
clk_prepare_enable(clk_per);
|
clk_prepare_enable(imxtm->clk_per);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Initialise to a known state (all timers off, and timing reset)
|
* Initialise to a known state (all timers off, and timing reset)
|
||||||
*/
|
*/
|
||||||
|
|
||||||
writel_relaxed(0, timer_base + MXC_TCTL);
|
writel_relaxed(0, imxtm->base + MXC_TCTL);
|
||||||
writel_relaxed(0, timer_base + MXC_TPRER); /* see datasheet note */
|
writel_relaxed(0, imxtm->base + MXC_TPRER); /* see datasheet note */
|
||||||
|
|
||||||
if (timer_is_v2()) {
|
if (timer_is_v2()) {
|
||||||
tctl_val = V2_TCTL_FRR | V2_TCTL_WAITEN | MXC_TCTL_TEN;
|
tctl_val = V2_TCTL_FRR | V2_TCTL_WAITEN | MXC_TCTL_TEN;
|
||||||
if (clk_get_rate(clk_per) == V2_TIMER_RATE_OSC_DIV8) {
|
if (clk_get_rate(imxtm->clk_per) == V2_TIMER_RATE_OSC_DIV8) {
|
||||||
tctl_val |= V2_TCTL_CLK_OSC_DIV8;
|
tctl_val |= V2_TCTL_CLK_OSC_DIV8;
|
||||||
if (cpu_is_imx6dl() || cpu_is_imx6sx()) {
|
if (cpu_is_imx6dl() || cpu_is_imx6sx()) {
|
||||||
/* 24 / 8 = 3 MHz */
|
/* 24 / 8 = 3 MHz */
|
||||||
writel_relaxed(7 << V2_TPRER_PRE24M,
|
writel_relaxed(7 << V2_TPRER_PRE24M,
|
||||||
timer_base + MXC_TPRER);
|
imxtm->base + MXC_TPRER);
|
||||||
tctl_val |= V2_TCTL_24MEN;
|
tctl_val |= V2_TCTL_24MEN;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
|
@ -336,47 +346,58 @@ static void __init _mxc_timer_init(int irq,
|
||||||
tctl_val = MX1_2_TCTL_FRR | MX1_2_TCTL_CLK_PCLK1 | MXC_TCTL_TEN;
|
tctl_val = MX1_2_TCTL_FRR | MX1_2_TCTL_CLK_PCLK1 | MXC_TCTL_TEN;
|
||||||
}
|
}
|
||||||
|
|
||||||
writel_relaxed(tctl_val, timer_base + MXC_TCTL);
|
writel_relaxed(tctl_val, imxtm->base + MXC_TCTL);
|
||||||
|
|
||||||
/* init and register the timer to the framework */
|
/* init and register the timer to the framework */
|
||||||
mxc_clocksource_init(clk_per);
|
mxc_clocksource_init(imxtm);
|
||||||
mxc_clockevent_init(clk_per);
|
mxc_clockevent_init(imxtm);
|
||||||
|
|
||||||
/* Make irqs happen */
|
/* Make irqs happen */
|
||||||
setup_irq(irq, &mxc_timer_irq);
|
setup_irq(imxtm->irq, &mxc_timer_irq);
|
||||||
}
|
}
|
||||||
|
|
||||||
void __init mxc_timer_init(unsigned long pbase, int irq)
|
void __init mxc_timer_init(unsigned long pbase, int irq)
|
||||||
{
|
{
|
||||||
struct clk *clk_per = clk_get_sys("imx-gpt.0", "per");
|
struct imx_timer *imxtm;
|
||||||
struct clk *clk_ipg = clk_get_sys("imx-gpt.0", "ipg");
|
|
||||||
|
|
||||||
timer_base = ioremap(pbase, SZ_4K);
|
imxtm = kzalloc(sizeof(*imxtm), GFP_KERNEL);
|
||||||
BUG_ON(!timer_base);
|
BUG_ON(!imxtm);
|
||||||
|
|
||||||
_mxc_timer_init(irq, clk_per, clk_ipg);
|
imxtm->clk_per = clk_get_sys("imx-gpt.0", "per");
|
||||||
|
imxtm->clk_ipg = clk_get_sys("imx-gpt.0", "ipg");
|
||||||
|
|
||||||
|
imxtm->base = ioremap(pbase, SZ_4K);
|
||||||
|
BUG_ON(!imxtm->base);
|
||||||
|
|
||||||
|
_mxc_timer_init(imxtm);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void __init mxc_timer_init_dt(struct device_node *np)
|
static void __init mxc_timer_init_dt(struct device_node *np)
|
||||||
{
|
{
|
||||||
struct clk *clk_per, *clk_ipg;
|
struct imx_timer *imxtm;
|
||||||
int irq;
|
static int initialized;
|
||||||
|
|
||||||
if (timer_base)
|
/* Support one instance only */
|
||||||
|
if (initialized)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
timer_base = of_iomap(np, 0);
|
imxtm = kzalloc(sizeof(*imxtm), GFP_KERNEL);
|
||||||
WARN_ON(!timer_base);
|
BUG_ON(!imxtm);
|
||||||
irq = irq_of_parse_and_map(np, 0);
|
|
||||||
|
|
||||||
clk_ipg = of_clk_get_by_name(np, "ipg");
|
imxtm->base = of_iomap(np, 0);
|
||||||
|
WARN_ON(!imxtm->base);
|
||||||
|
imxtm->irq = irq_of_parse_and_map(np, 0);
|
||||||
|
|
||||||
|
imxtm->clk_ipg = of_clk_get_by_name(np, "ipg");
|
||||||
|
|
||||||
/* Try osc_per first, and fall back to per otherwise */
|
/* Try osc_per first, and fall back to per otherwise */
|
||||||
clk_per = of_clk_get_by_name(np, "osc_per");
|
imxtm->clk_per = of_clk_get_by_name(np, "osc_per");
|
||||||
if (IS_ERR(clk_per))
|
if (IS_ERR(imxtm->clk_per))
|
||||||
clk_per = of_clk_get_by_name(np, "per");
|
imxtm->clk_per = of_clk_get_by_name(np, "per");
|
||||||
|
|
||||||
_mxc_timer_init(irq, clk_per, clk_ipg);
|
_mxc_timer_init(imxtm);
|
||||||
|
|
||||||
|
initialized = 1;
|
||||||
}
|
}
|
||||||
CLOCKSOURCE_OF_DECLARE(mx1_timer, "fsl,imx1-gpt", mxc_timer_init_dt);
|
CLOCKSOURCE_OF_DECLARE(mx1_timer, "fsl,imx1-gpt", mxc_timer_init_dt);
|
||||||
CLOCKSOURCE_OF_DECLARE(mx25_timer, "fsl,imx25-gpt", mxc_timer_init_dt);
|
CLOCKSOURCE_OF_DECLARE(mx25_timer, "fsl,imx25-gpt", mxc_timer_init_dt);
|
||||||
|
|
Загрузка…
Ссылка в новой задаче