[deliverable/linux.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>

/*
 * 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 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);

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