[mirror_ubuntu-artful-kernel.git] / drivers / clocksource / time-armada-370-xp.c

/*
 * Marvell Armada 370/XP SoC timer handling.
 *
 * Copyright (C) 2012 Marvell
 *
 * Lior Amsalem <alior@marvell.com>
 * Gregory CLEMENT <gregory.clement@free-electrons.com>
 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
 *
 * This file is licensed under the terms of the GNU General Public
 * License version 2.  This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 *
 * Timer 0 is used as free-running clocksource, while timer 1 is
 * used as clock_event_device.
 *
 * ---
 * Clocksource driver for Armada 370 and Armada XP SoC.
 * This driver implements one compatible string for each SoC, given
 * each has its own characteristics:
 *
 *   * Armada 370 has no 25 MHz fixed timer.
 *
 *   * Armada XP cannot work properly without such 25 MHz fixed timer as
 *     doing otherwise leads to using a clocksource whose frequency varies
 *     when doing cpufreq frequency changes.
 *
 * See Documentation/devicetree/bindings/timer/marvell,armada-370-xp-timer.txt
 */

#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/kernel.h>
#include <linux/clk.h>
#include <linux/cpu.h>
#include <linux/timer.h>
#include <linux/clockchips.h>
#include <linux/interrupt.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/of_address.h>
#include <linux/irq.h>
#include <linux/module.h>
#include <linux/sched_clock.h>
#include <linux/percpu.h>
#include <linux/syscore_ops.h>

#include <asm/delay.h>

/*
 * Timer block registers.
 */
#define TIMER_CTRL_OFF		0x0000
#define  TIMER0_EN		 BIT(0)
#define  TIMER0_RELOAD_EN	 BIT(1)
#define  TIMER0_25MHZ            BIT(11)
#define  TIMER0_DIV(div)         ((div) << 19)
#define  TIMER1_EN		 BIT(2)
#define  TIMER1_RELOAD_EN	 BIT(3)
#define  TIMER1_25MHZ            BIT(12)
#define  TIMER1_DIV(div)         ((div) << 22)
#define TIMER_EVENTS_STATUS	0x0004
#define  TIMER0_CLR_MASK         (~0x1)
#define  TIMER1_CLR_MASK         (~0x100)
#define TIMER0_RELOAD_OFF	0x0010
#define TIMER0_VAL_OFF		0x0014
#define TIMER1_RELOAD_OFF	0x0018
#define TIMER1_VAL_OFF		0x001c

#define LCL_TIMER_EVENTS_STATUS	0x0028
/* Global timers are connected to the coherency fabric clock, and the
   below divider reduces their incrementing frequency. */
#define TIMER_DIVIDER_SHIFT     5
#define TIMER_DIVIDER           (1 << TIMER_DIVIDER_SHIFT)

/*
 * SoC-specific data.
 */
static void __iomem *timer_base, *local_base;
static unsigned int timer_clk;
static bool timer25Mhz = true;
static u32 enable_mask;

/*
 * Number of timer ticks per jiffy.
 */
static u32 ticks_per_jiffy;

static struct clock_event_device __percpu *armada_370_xp_evt;

static void local_timer_ctrl_clrset(u32 clr, u32 set)
{
	writel((readl(local_base + TIMER_CTRL_OFF) & ~clr) | set,
		local_base + TIMER_CTRL_OFF);
}

static u64 notrace armada_370_xp_read_sched_clock(void)
{
	return ~readl(timer_base + TIMER0_VAL_OFF);
}

/*
 * Clockevent handling.
 */
static int
armada_370_xp_clkevt_next_event(unsigned long delta,
				struct clock_event_device *dev)
{
	/*
	 * Clear clockevent timer interrupt.
	 */
	writel(TIMER0_CLR_MASK, local_base + LCL_TIMER_EVENTS_STATUS);

	/*
	 * Setup new clockevent timer value.
	 */
	writel(delta, local_base + TIMER0_VAL_OFF);

	/*
	 * Enable the timer.
	 */
	local_timer_ctrl_clrset(TIMER0_RELOAD_EN, enable_mask);
	return 0;
}

static int armada_370_xp_clkevt_shutdown(struct clock_event_device *evt)
{
	/*
	 * Disable timer.
	 */
	local_timer_ctrl_clrset(TIMER0_EN, 0);

	/*
	 * ACK pending timer interrupt.
	 */
	writel(TIMER0_CLR_MASK, local_base + LCL_TIMER_EVENTS_STATUS);
	return 0;
}

static int armada_370_xp_clkevt_set_periodic(struct clock_event_device *evt)
{
	/*
	 * Setup timer to fire at 1/HZ intervals.
	 */
	writel(ticks_per_jiffy - 1, local_base + TIMER0_RELOAD_OFF);
	writel(ticks_per_jiffy - 1, local_base + TIMER0_VAL_OFF);

	/*
	 * Enable timer.
	 */
	local_timer_ctrl_clrset(0, TIMER0_RELOAD_EN | enable_mask);
	return 0;
}

static int armada_370_xp_clkevt_irq;

static irqreturn_t armada_370_xp_timer_interrupt(int irq, void *dev_id)
{
	/*
	 * ACK timer interrupt and call event handler.
	 */
	struct clock_event_device *evt = dev_id;

	writel(TIMER0_CLR_MASK, local_base + LCL_TIMER_EVENTS_STATUS);
	evt->event_handler(evt);

	return IRQ_HANDLED;
}

/*
 * Setup the local clock events for a CPU.
 */
static int armada_370_xp_timer_setup(struct clock_event_device *evt)
{
	u32 clr = 0, set = 0;
	int cpu = smp_processor_id();

	if (timer25Mhz)
		set = TIMER0_25MHZ;
	else
		clr = TIMER0_25MHZ;
	local_timer_ctrl_clrset(clr, set);

	evt->name		= "armada_370_xp_per_cpu_tick",
	evt->features		= CLOCK_EVT_FEAT_ONESHOT |
				  CLOCK_EVT_FEAT_PERIODIC;
	evt->shift		= 32,
	evt->rating		= 300,
	evt->set_next_event	= armada_370_xp_clkevt_next_event,
	evt->set_state_shutdown	= armada_370_xp_clkevt_shutdown;
	evt->set_state_periodic	= armada_370_xp_clkevt_set_periodic;
	evt->set_state_oneshot	= armada_370_xp_clkevt_shutdown;
	evt->tick_resume	= armada_370_xp_clkevt_shutdown;
	evt->irq		= armada_370_xp_clkevt_irq;
	evt->cpumask		= cpumask_of(cpu);

	clockevents_config_and_register(evt, timer_clk, 1, 0xfffffffe);
	enable_percpu_irq(evt->irq, 0);

	return 0;
}

static void armada_370_xp_timer_stop(struct clock_event_device *evt)
{
	evt->set_state_shutdown(evt);
	disable_percpu_irq(evt->irq);
}

static int armada_370_xp_timer_cpu_notify(struct notifier_block *self,
					   unsigned long action, void *hcpu)
{
	/*
	 * Grab cpu pointer in each case to avoid spurious
	 * preemptible warnings
	 */
	switch (action & ~CPU_TASKS_FROZEN) {
	case CPU_STARTING:
		armada_370_xp_timer_setup(this_cpu_ptr(armada_370_xp_evt));
		break;
	case CPU_DYING:
		armada_370_xp_timer_stop(this_cpu_ptr(armada_370_xp_evt));
		break;
	}

	return NOTIFY_OK;
}

static struct notifier_block armada_370_xp_timer_cpu_nb = {
	.notifier_call = armada_370_xp_timer_cpu_notify,
};

static u32 timer0_ctrl_reg, timer0_local_ctrl_reg;

static int armada_370_xp_timer_suspend(void)
{
	timer0_ctrl_reg = readl(timer_base + TIMER_CTRL_OFF);
	timer0_local_ctrl_reg = readl(local_base + TIMER_CTRL_OFF);
	return 0;
}

static void armada_370_xp_timer_resume(void)
{
	writel(0xffffffff, timer_base + TIMER0_VAL_OFF);
	writel(0xffffffff, timer_base + TIMER0_RELOAD_OFF);
	writel(timer0_ctrl_reg, timer_base + TIMER_CTRL_OFF);
	writel(timer0_local_ctrl_reg, local_base + TIMER_CTRL_OFF);
}

struct syscore_ops armada_370_xp_timer_syscore_ops = {
	.suspend	= armada_370_xp_timer_suspend,
	.resume		= armada_370_xp_timer_resume,
};

static unsigned long armada_370_delay_timer_read(void)
{
	return ~readl(timer_base + TIMER0_VAL_OFF);
}

static struct delay_timer armada_370_delay_timer = {
	.read_current_timer = armada_370_delay_timer_read,
};

static void __init armada_370_xp_timer_common_init(struct device_node *np)
{
	u32 clr = 0, set = 0;
	int res;

	timer_base = of_iomap(np, 0);
	WARN_ON(!timer_base);
	local_base = of_iomap(np, 1);

	if (timer25Mhz) {
		set = TIMER0_25MHZ;		
		enable_mask = TIMER0_EN;
	} else {
		clr = TIMER0_25MHZ;
		enable_mask = TIMER0_EN | TIMER0_DIV(TIMER_DIVIDER_SHIFT);
	}
	atomic_io_modify(timer_base + TIMER_CTRL_OFF, clr | set, set);
	local_timer_ctrl_clrset(clr, set);

	/*
	 * We use timer 0 as clocksource, and private(local) timer 0
	 * for clockevents
	 */
	armada_370_xp_clkevt_irq = irq_of_parse_and_map(np, 4);

	ticks_per_jiffy = (timer_clk + HZ / 2) / HZ;

	/*
	 * Setup free-running clocksource timer (interrupts
	 * disabled).
	 */
	writel(0xffffffff, timer_base + TIMER0_VAL_OFF);
	writel(0xffffffff, timer_base + TIMER0_RELOAD_OFF);

	atomic_io_modify(timer_base + TIMER_CTRL_OFF,
		TIMER0_RELOAD_EN | enable_mask,
		TIMER0_RELOAD_EN | enable_mask);

	armada_370_delay_timer.freq = timer_clk;
	register_current_timer_delay(&armada_370_delay_timer);

	/*
	 * Set scale and timer for sched_clock.
	 */
	sched_clock_register(armada_370_xp_read_sched_clock, 32, timer_clk);

	clocksource_mmio_init(timer_base + TIMER0_VAL_OFF,
			      "armada_370_xp_clocksource",
			      timer_clk, 300, 32, clocksource_mmio_readl_down);

	register_cpu_notifier(&armada_370_xp_timer_cpu_nb);

	armada_370_xp_evt = alloc_percpu(struct clock_event_device);


	/*
	 * Setup clockevent timer (interrupt-driven).
	 */
	res = request_percpu_irq(armada_370_xp_clkevt_irq,
				armada_370_xp_timer_interrupt,
				"armada_370_xp_per_cpu_tick",
				armada_370_xp_evt);
	/* Immediately configure the timer on the boot CPU */
	if (!res)
		armada_370_xp_timer_setup(this_cpu_ptr(armada_370_xp_evt));

	register_syscore_ops(&armada_370_xp_timer_syscore_ops);
}

static void __init armada_xp_timer_init(struct device_node *np)
{
	struct clk *clk = of_clk_get_by_name(np, "fixed");

	/* The 25Mhz fixed clock is mandatory, and must always be available */
	BUG_ON(IS_ERR(clk));
	clk_prepare_enable(clk);
	timer_clk = clk_get_rate(clk);

	armada_370_xp_timer_common_init(np);
}
CLOCKSOURCE_OF_DECLARE(armada_xp, "marvell,armada-xp-timer",
		       armada_xp_timer_init);

static void __init armada_375_timer_init(struct device_node *np)
{
	struct clk *clk;

	clk = of_clk_get_by_name(np, "fixed");
	if (!IS_ERR(clk)) {
		clk_prepare_enable(clk);
		timer_clk = clk_get_rate(clk);
	} else {

		/*
		 * This fallback is required in order to retain proper
		 * devicetree backwards compatibility.
		 */
		clk = of_clk_get(np, 0);

		/* Must have at least a clock */
		BUG_ON(IS_ERR(clk));
		clk_prepare_enable(clk);
		timer_clk = clk_get_rate(clk) / TIMER_DIVIDER;
		timer25Mhz = false;
	}

	armada_370_xp_timer_common_init(np);
}
CLOCKSOURCE_OF_DECLARE(armada_375, "marvell,armada-375-timer",
		       armada_375_timer_init);

static void __init armada_370_timer_init(struct device_node *np)
{
	struct clk *clk = of_clk_get(np, 0);

	BUG_ON(IS_ERR(clk));
	clk_prepare_enable(clk);
	timer_clk = clk_get_rate(clk) / TIMER_DIVIDER;
	timer25Mhz = false;

	armada_370_xp_timer_common_init(np);
}
CLOCKSOURCE_OF_DECLARE(armada_370, "marvell,armada-370-timer",
		       armada_370_timer_init);
Commit	Line	Data
6fe9cbd1 GC	1	/*
	2	* Marvell Armada 370/XP SoC timer handling.
	3	*
	4	* Copyright (C) 2012 Marvell
	5	*
	6	* Lior Amsalem <alior@marvell.com>
	7	* Gregory CLEMENT <gregory.clement@free-electrons.com>
	8	* Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
	9	*
	10	* This file is licensed under the terms of the GNU General Public
	11	* License version 2. This program is licensed "as is" without any
	12	* warranty of any kind, whether express or implied.
	13	*
	14	* Timer 0 is used as free-running clocksource, while timer 1 is
	15	* used as clock_event_device.
7cd6392c EG	16	*
	17	* ---
	18	* Clocksource driver for Armada 370 and Armada XP SoC.
	19	* This driver implements one compatible string for each SoC, given
	20	* each has its own characteristics:
	21	*
	22	* * Armada 370 has no 25 MHz fixed timer.
	23	*
	24	* * Armada XP cannot work properly without such 25 MHz fixed timer as
	25	* doing otherwise leads to using a clocksource whose frequency varies
	26	* when doing cpufreq frequency changes.
	27	*
	28	* See Documentation/devicetree/bindings/timer/marvell,armada-370-xp-timer.txt
6fe9cbd1 GC	29	*/
	30
	31	#include <linux/init.h>
	32	#include <linux/platform_device.h>
	33	#include <linux/kernel.h>
307c2bf4	34	#include <linux/clk.h>
5ddb6d21	35	#include <linux/cpu.h>
6fe9cbd1 GC	36	#include <linux/timer.h>
	37	#include <linux/clockchips.h>
	38	#include <linux/interrupt.h>
	39	#include <linux/of.h>
	40	#include <linux/of_irq.h>
	41	#include <linux/of_address.h>
	42	#include <linux/irq.h>
	43	#include <linux/module.h>
38ff87f7	44	#include <linux/sched_clock.h>
ddd3f69f	45	#include <linux/percpu.h>
f9a49ab5	46	#include <linux/syscore_ops.h>
6fe9cbd1	47
cb0f2538 RK	48	#include <asm/delay.h>
cb0f2538 RK	49
6fe9cbd1 GC	50	/*
	51	* Timer block registers.
	52	*/
	53	#define TIMER_CTRL_OFF 0x0000
ad48bd61 EG	54	#define TIMER0_EN BIT(0)
	55	#define TIMER0_RELOAD_EN BIT(1)
	56	#define TIMER0_25MHZ BIT(11)
6fe9cbd1	57	#define TIMER0_DIV(div) ((div) << 19)
ad48bd61 EG	58	#define TIMER1_EN BIT(2)
	59	#define TIMER1_RELOAD_EN BIT(3)
	60	#define TIMER1_25MHZ BIT(12)
6fe9cbd1 GC	61	#define TIMER1_DIV(div) ((div) << 22)
	62	#define TIMER_EVENTS_STATUS 0x0004
	63	#define TIMER0_CLR_MASK (~0x1)
	64	#define TIMER1_CLR_MASK (~0x100)
	65	#define TIMER0_RELOAD_OFF 0x0010
	66	#define TIMER0_VAL_OFF 0x0014
	67	#define TIMER1_RELOAD_OFF 0x0018
	68	#define TIMER1_VAL_OFF 0x001c
	69
ddd3f69f	70	#define LCL_TIMER_EVENTS_STATUS 0x0028
6fe9cbd1 GC	71	/* Global timers are connected to the coherency fabric clock, and the
	72	below divider reduces their incrementing frequency. */
	73	#define TIMER_DIVIDER_SHIFT 5
	74	#define TIMER_DIVIDER (1 << TIMER_DIVIDER_SHIFT)
	75
	76	/*
	77	* SoC-specific data.
	78	*/
ddd3f69f GC	79	static void __iomem timer_base, local_base;
	80	static unsigned int timer_clk;
	81	static bool timer25Mhz = true;
08cb8e46	82	static u32 enable_mask;
6fe9cbd1 GC	83
	84	/*
	85	* Number of timer ticks per jiffy.
	86	*/
	87	static u32 ticks_per_jiffy;
	88
5ddb6d21	89	static struct clock_event_device __percpu *armada_370_xp_evt;
ddd3f69f	90
3579698e EG	91	static void local_timer_ctrl_clrset(u32 clr, u32 set)
	92	{
	93	writel((readl(local_base + TIMER_CTRL_OFF) & ~clr) \| set,
	94	local_base + TIMER_CTRL_OFF);
	95	}
ddd3f69f	96
d9dbcbe0	97	static u64 notrace armada_370_xp_read_sched_clock(void)
6fe9cbd1 GC	98	{
	99	return ~readl(timer_base + TIMER0_VAL_OFF);
	100	}
	101
	102	/*
	103	* Clockevent handling.
	104	*/
	105	static int
	106	armada_370_xp_clkevt_next_event(unsigned long delta,
	107	struct clock_event_device *dev)
	108	{
6fe9cbd1 GC	109	/*
	110	* Clear clockevent timer interrupt.
	111	*/
ddd3f69f	112	writel(TIMER0_CLR_MASK, local_base + LCL_TIMER_EVENTS_STATUS);
6fe9cbd1 GC	113
	114	/*
	115	* Setup new clockevent timer value.
	116	*/
ddd3f69f	117	writel(delta, local_base + TIMER0_VAL_OFF);
6fe9cbd1 GC	118
	119	/*
	120	* Enable the timer.
	121	*/
08cb8e46	122	local_timer_ctrl_clrset(TIMER0_RELOAD_EN, enable_mask);
6fe9cbd1 GC	123	return 0;
	124	}
	125
d96f4412	126	static int armada_370_xp_clkevt_shutdown(struct clock_event_device *evt)
6fe9cbd1	127	{
d96f4412 VK	128	/*
	129	* Disable timer.
	130	*/
	131	local_timer_ctrl_clrset(TIMER0_EN, 0);
	132
	133	/*
	134	* ACK pending timer interrupt.
	135	*/
	136	writel(TIMER0_CLR_MASK, local_base + LCL_TIMER_EVENTS_STATUS);
	137	return 0;
	138	}
	139
	140	static int armada_370_xp_clkevt_set_periodic(struct clock_event_device *evt)
	141	{
	142	/*
	143	* Setup timer to fire at 1/HZ intervals.
	144	*/
	145	writel(ticks_per_jiffy - 1, local_base + TIMER0_RELOAD_OFF);
	146	writel(ticks_per_jiffy - 1, local_base + TIMER0_VAL_OFF);
	147
	148	/*
	149	* Enable timer.
	150	*/
	151	local_timer_ctrl_clrset(0, TIMER0_RELOAD_EN \| enable_mask);
	152	return 0;
6fe9cbd1 GC	153	}
6fe9cbd1 GC	154
5ddb6d21	155	static int armada_370_xp_clkevt_irq;
6fe9cbd1 GC	156
	157	static irqreturn_t armada_370_xp_timer_interrupt(int irq, void *dev_id)
	158	{
	159	/*
	160	* ACK timer interrupt and call event handler.
	161	*/
5ddb6d21	162	struct clock_event_device *evt = dev_id;
6fe9cbd1	163
ddd3f69f GC	164	writel(TIMER0_CLR_MASK, local_base + LCL_TIMER_EVENTS_STATUS);
ddd3f69f GC	165	evt->event_handler(evt);
6fe9cbd1 GC	166
	167	return IRQ_HANDLED;
	168	}
	169
ddd3f69f GC	170	/*
	171	* Setup the local clock events for a CPU.
	172	*/
8c37bb3a	173	static int armada_370_xp_timer_setup(struct clock_event_device *evt)
ddd3f69f	174	{
3579698e	175	u32 clr = 0, set = 0;
ddd3f69f GC	176	int cpu = smp_processor_id();
ddd3f69f GC	177
ddd3f69f	178	if (timer25Mhz)
3579698e	179	set = TIMER0_25MHZ;
ddd3f69f	180	else
3579698e EG	181	clr = TIMER0_25MHZ;
3579698e EG	182	local_timer_ctrl_clrset(clr, set);
ddd3f69f	183
5ddb6d21 SB	184	evt->name = "armada_370_xp_per_cpu_tick",
	185	evt->features = CLOCK_EVT_FEAT_ONESHOT \|
	186	CLOCK_EVT_FEAT_PERIODIC;
	187	evt->shift = 32,
	188	evt->rating = 300,
ddd3f69f	189	evt->set_next_event = armada_370_xp_clkevt_next_event,
d96f4412 VK	190	evt->set_state_shutdown = armada_370_xp_clkevt_shutdown;
	191	evt->set_state_periodic = armada_370_xp_clkevt_set_periodic;
	192	evt->set_state_oneshot = armada_370_xp_clkevt_shutdown;
	193	evt->tick_resume = armada_370_xp_clkevt_shutdown;
5ddb6d21	194	evt->irq = armada_370_xp_clkevt_irq;
ddd3f69f GC	195	evt->cpumask = cpumask_of(cpu);
ddd3f69f GC	196
ddd3f69f GC	197	clockevents_config_and_register(evt, timer_clk, 1, 0xfffffffe);
	198	enable_percpu_irq(evt->irq, 0);
	199
	200	return 0;
	201	}
	202
47dcd356	203	static void armada_370_xp_timer_stop(struct clock_event_device *evt)
ddd3f69f	204	{
d96f4412	205	evt->set_state_shutdown(evt);
ddd3f69f GC	206	disable_percpu_irq(evt->irq);
	207	}
	208
47dcd356	209	static int armada_370_xp_timer_cpu_notify(struct notifier_block *self,
5ddb6d21 SB	210	unsigned long action, void *hcpu)
	211	{
	212	/*
	213	* Grab cpu pointer in each case to avoid spurious
	214	* preemptible warnings
	215	*/
	216	switch (action & ~CPU_TASKS_FROZEN) {
	217	case CPU_STARTING:
	218	armada_370_xp_timer_setup(this_cpu_ptr(armada_370_xp_evt));
	219	break;
	220	case CPU_DYING:
	221	armada_370_xp_timer_stop(this_cpu_ptr(armada_370_xp_evt));
	222	break;
	223	}
	224
	225	return NOTIFY_OK;
	226	}
	227
47dcd356	228	static struct notifier_block armada_370_xp_timer_cpu_nb = {
5ddb6d21	229	.notifier_call = armada_370_xp_timer_cpu_notify,
6fe9cbd1 GC	230	};
6fe9cbd1 GC	231
f9a49ab5 TP	232	static u32 timer0_ctrl_reg, timer0_local_ctrl_reg;
	233
	234	static int armada_370_xp_timer_suspend(void)
	235	{
	236	timer0_ctrl_reg = readl(timer_base + TIMER_CTRL_OFF);
	237	timer0_local_ctrl_reg = readl(local_base + TIMER_CTRL_OFF);
	238	return 0;
	239	}
	240
	241	static void armada_370_xp_timer_resume(void)
	242	{
	243	writel(0xffffffff, timer_base + TIMER0_VAL_OFF);
	244	writel(0xffffffff, timer_base + TIMER0_RELOAD_OFF);
	245	writel(timer0_ctrl_reg, timer_base + TIMER_CTRL_OFF);
	246	writel(timer0_local_ctrl_reg, local_base + TIMER_CTRL_OFF);
	247	}
	248
	249	struct syscore_ops armada_370_xp_timer_syscore_ops = {
	250	.suspend = armada_370_xp_timer_suspend,
	251	.resume = armada_370_xp_timer_resume,
	252	};
	253
cb0f2538 RK	254	static unsigned long armada_370_delay_timer_read(void)
	255	{
	256	return ~readl(timer_base + TIMER0_VAL_OFF);
	257	}
	258
	259	static struct delay_timer armada_370_delay_timer = {
	260	.read_current_timer = armada_370_delay_timer_read,
	261	};
	262
7cd6392c	263	static void __init armada_370_xp_timer_common_init(struct device_node *np)
6fe9cbd1	264	{
3579698e	265	u32 clr = 0, set = 0;
ddd3f69f GC	266	int res;
ddd3f69f GC	267
6fe9cbd1 GC	268	timer_base = of_iomap(np, 0);
6fe9cbd1 GC	269	WARN_ON(!timer_base);
ddd3f69f	270	local_base = of_iomap(np, 1);
6fe9cbd1	271
08cb8e46	272	if (timer25Mhz) {
a4ae54f9	273	set = TIMER0_25MHZ;
08cb8e46 EG	274	enable_mask = TIMER0_EN;
08cb8e46 EG	275	} else {
3579698e	276	clr = TIMER0_25MHZ;
08cb8e46 EG	277	enable_mask = TIMER0_EN \| TIMER0_DIV(TIMER_DIVIDER_SHIFT);
08cb8e46 EG	278	}
c8af34b4	279	atomic_io_modify(timer_base + TIMER_CTRL_OFF, clr \| set, set);
3579698e	280	local_timer_ctrl_clrset(clr, set);
6fe9cbd1	281
ddd3f69f GC	282	/*
	283	* We use timer 0 as clocksource, and private(local) timer 0
	284	* for clockevents
	285	*/
5ddb6d21	286	armada_370_xp_clkevt_irq = irq_of_parse_and_map(np, 4);
6fe9cbd1 GC	287
	288	ticks_per_jiffy = (timer_clk + HZ / 2) / HZ;
	289
6fe9cbd1 GC	290	/*
	291	* Setup free-running clocksource timer (interrupts
	292	* disabled).
	293	*/
	294	writel(0xffffffff, timer_base + TIMER0_VAL_OFF);
	295	writel(0xffffffff, timer_base + TIMER0_RELOAD_OFF);
	296
c8af34b4 EG	297	atomic_io_modify(timer_base + TIMER_CTRL_OFF,
	298	TIMER0_RELOAD_EN \| enable_mask,
	299	TIMER0_RELOAD_EN \| enable_mask);
6fe9cbd1	300
cb0f2538 RK	301	armada_370_delay_timer.freq = timer_clk;
	302	register_current_timer_delay(&armada_370_delay_timer);
	303
c813eff0 EG	304	/*
	305	* Set scale and timer for sched_clock.
	306	*/
	307	sched_clock_register(armada_370_xp_read_sched_clock, 32, timer_clk);
	308
6fe9cbd1 GC	309	clocksource_mmio_init(timer_base + TIMER0_VAL_OFF,
	310	"armada_370_xp_clocksource",
	311	timer_clk, 300, 32, clocksource_mmio_readl_down);
	312
5ddb6d21	313	register_cpu_notifier(&armada_370_xp_timer_cpu_nb);
6fe9cbd1	314
5ddb6d21	315	armada_370_xp_evt = alloc_percpu(struct clock_event_device);
ddd3f69f GC	316
	317
	318	/*
	319	* Setup clockevent timer (interrupt-driven).
	320	*/
5ddb6d21	321	res = request_percpu_irq(armada_370_xp_clkevt_irq,
ddd3f69f	322	armada_370_xp_timer_interrupt,
5ddb6d21 SB	323	"armada_370_xp_per_cpu_tick",
	324	armada_370_xp_evt);
	325	/* Immediately configure the timer on the boot CPU */
	326	if (!res)
	327	armada_370_xp_timer_setup(this_cpu_ptr(armada_370_xp_evt));
f9a49ab5 TP	328
f9a49ab5 TP	329	register_syscore_ops(&armada_370_xp_timer_syscore_ops);
ddd3f69f	330	}
7cd6392c EG	331
	332	static void __init armada_xp_timer_init(struct device_node *np)
	333	{
5e9fe6cb EG	334	struct clk *clk = of_clk_get_by_name(np, "fixed");
	335
	336	/* The 25Mhz fixed clock is mandatory, and must always be available */
	337	BUG_ON(IS_ERR(clk));
551f2fd5	338	clk_prepare_enable(clk);
5e9fe6cb	339	timer_clk = clk_get_rate(clk);
7cd6392c EG	340
	341	armada_370_xp_timer_common_init(np);
	342	}
	343	CLOCKSOURCE_OF_DECLARE(armada_xp, "marvell,armada-xp-timer",
	344	armada_xp_timer_init);
	345
4a22d9c9 EG	346	static void __init armada_375_timer_init(struct device_node *np)
	347	{
	348	struct clk *clk;
	349
	350	clk = of_clk_get_by_name(np, "fixed");
	351	if (!IS_ERR(clk)) {
	352	clk_prepare_enable(clk);
	353	timer_clk = clk_get_rate(clk);
	354	} else {
	355
	356	/*
	357	* This fallback is required in order to retain proper
	358	* devicetree backwards compatibility.
	359	*/
	360	clk = of_clk_get(np, 0);
	361
	362	/* Must have at least a clock */
	363	BUG_ON(IS_ERR(clk));
	364	clk_prepare_enable(clk);
	365	timer_clk = clk_get_rate(clk) / TIMER_DIVIDER;
	366	timer25Mhz = false;
	367	}
	368
	369	armada_370_xp_timer_common_init(np);
	370	}
	371	CLOCKSOURCE_OF_DECLARE(armada_375, "marvell,armada-375-timer",
	372	armada_375_timer_init);
	373
7cd6392c EG	374	static void __init armada_370_timer_init(struct device_node *np)
	375	{
	376	struct clk *clk = of_clk_get(np, 0);
	377
ec8e5112	378	BUG_ON(IS_ERR(clk));
551f2fd5	379	clk_prepare_enable(clk);
7cd6392c EG	380	timer_clk = clk_get_rate(clk) / TIMER_DIVIDER;
	381	timer25Mhz = false;
	382
	383	armada_370_xp_timer_common_init(np);
ddd3f69f	384	}
7cd6392c EG	385	CLOCKSOURCE_OF_DECLARE(armada_370, "marvell,armada-370-timer",
7cd6392c EG	386	armada_370_timer_init);