diff options
Diffstat (limited to 'arch/arm/mach-zynq/timer.c')
| -rw-r--r-- | arch/arm/mach-zynq/timer.c | 324 | 
1 files changed, 0 insertions, 324 deletions
diff --git a/arch/arm/mach-zynq/timer.c b/arch/arm/mach-zynq/timer.c deleted file mode 100644 index f9fbc9c1e7a..00000000000 --- a/arch/arm/mach-zynq/timer.c +++ /dev/null @@ -1,324 +0,0 @@ -/* - * This file contains driver for the Xilinx PS Timer Counter IP. - * - *  Copyright (C) 2011 Xilinx - * - * based on arch/mips/kernel/time.c timer driver - * - * This software is licensed under the terms of the GNU General Public - * License version 2, as published by the Free Software Foundation, and - * may be copied, distributed, and modified under those terms. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the - * GNU General Public License for more details. - */ - -#include <linux/interrupt.h> -#include <linux/clockchips.h> -#include <linux/of_address.h> -#include <linux/of_irq.h> -#include <linux/slab.h> -#include <linux/clk-provider.h> -#include "common.h" - -/* - * Timer Register Offset Definitions of Timer 1, Increment base address by 4 - * and use same offsets for Timer 2 - */ -#define XTTCPS_CLK_CNTRL_OFFSET		0x00 /* Clock Control Reg, RW */ -#define XTTCPS_CNT_CNTRL_OFFSET		0x0C /* Counter Control Reg, RW */ -#define XTTCPS_COUNT_VAL_OFFSET		0x18 /* Counter Value Reg, RO */ -#define XTTCPS_INTR_VAL_OFFSET		0x24 /* Interval Count Reg, RW */ -#define XTTCPS_ISR_OFFSET		0x54 /* Interrupt Status Reg, RO */ -#define XTTCPS_IER_OFFSET		0x60 /* Interrupt Enable Reg, RW */ - -#define XTTCPS_CNT_CNTRL_DISABLE_MASK	0x1 - -/* - * Setup the timers to use pre-scaling, using a fixed value for now that will - * work across most input frequency, but it may need to be more dynamic - */ -#define PRESCALE_EXPONENT	11	/* 2 ^ PRESCALE_EXPONENT = PRESCALE */ -#define PRESCALE		2048	/* The exponent must match this */ -#define CLK_CNTRL_PRESCALE	((PRESCALE_EXPONENT - 1) << 1) -#define CLK_CNTRL_PRESCALE_EN	1 -#define CNT_CNTRL_RESET		(1<<4) - -/** - * struct xttcps_timer - This definition defines local timer structure - * - * @base_addr:	Base address of timer - **/ -struct xttcps_timer { -	void __iomem	*base_addr; -}; - -struct xttcps_timer_clocksource { -	struct xttcps_timer	xttc; -	struct clocksource	cs; -}; - -#define to_xttcps_timer_clksrc(x) \ -		container_of(x, struct xttcps_timer_clocksource, cs) - -struct xttcps_timer_clockevent { -	struct xttcps_timer		xttc; -	struct clock_event_device	ce; -	struct clk			*clk; -}; - -#define to_xttcps_timer_clkevent(x) \ -		container_of(x, struct xttcps_timer_clockevent, ce) - -/** - * xttcps_set_interval - Set the timer interval value - * - * @timer:	Pointer to the timer instance - * @cycles:	Timer interval ticks - **/ -static void xttcps_set_interval(struct xttcps_timer *timer, -					unsigned long cycles) -{ -	u32 ctrl_reg; - -	/* Disable the counter, set the counter value  and re-enable counter */ -	ctrl_reg = __raw_readl(timer->base_addr + XTTCPS_CNT_CNTRL_OFFSET); -	ctrl_reg |= XTTCPS_CNT_CNTRL_DISABLE_MASK; -	__raw_writel(ctrl_reg, timer->base_addr + XTTCPS_CNT_CNTRL_OFFSET); - -	__raw_writel(cycles, timer->base_addr + XTTCPS_INTR_VAL_OFFSET); - -	/* -	 * Reset the counter (0x10) so that it starts from 0, one-shot -	 * mode makes this needed for timing to be right. -	 */ -	ctrl_reg |= CNT_CNTRL_RESET; -	ctrl_reg &= ~XTTCPS_CNT_CNTRL_DISABLE_MASK; -	__raw_writel(ctrl_reg, timer->base_addr + XTTCPS_CNT_CNTRL_OFFSET); -} - -/** - * xttcps_clock_event_interrupt - Clock event timer interrupt handler - * - * @irq:	IRQ number of the Timer - * @dev_id:	void pointer to the xttcps_timer instance - * - * returns: Always IRQ_HANDLED - success - **/ -static irqreturn_t xttcps_clock_event_interrupt(int irq, void *dev_id) -{ -	struct xttcps_timer_clockevent *xttce = dev_id; -	struct xttcps_timer *timer = &xttce->xttc; - -	/* Acknowledge the interrupt and call event handler */ -	__raw_readl(timer->base_addr + XTTCPS_ISR_OFFSET); - -	xttce->ce.event_handler(&xttce->ce); - -	return IRQ_HANDLED; -} - -/** - * __xttc_clocksource_read - Reads the timer counter register - * - * returns: Current timer counter register value - **/ -static cycle_t __xttc_clocksource_read(struct clocksource *cs) -{ -	struct xttcps_timer *timer = &to_xttcps_timer_clksrc(cs)->xttc; - -	return (cycle_t)__raw_readl(timer->base_addr + -				XTTCPS_COUNT_VAL_OFFSET); -} - -/** - * xttcps_set_next_event - Sets the time interval for next event - * - * @cycles:	Timer interval ticks - * @evt:	Address of clock event instance - * - * returns: Always 0 - success - **/ -static int xttcps_set_next_event(unsigned long cycles, -					struct clock_event_device *evt) -{ -	struct xttcps_timer_clockevent *xttce = to_xttcps_timer_clkevent(evt); -	struct xttcps_timer *timer = &xttce->xttc; - -	xttcps_set_interval(timer, cycles); -	return 0; -} - -/** - * xttcps_set_mode - Sets the mode of timer - * - * @mode:	Mode to be set - * @evt:	Address of clock event instance - **/ -static void xttcps_set_mode(enum clock_event_mode mode, -					struct clock_event_device *evt) -{ -	struct xttcps_timer_clockevent *xttce = to_xttcps_timer_clkevent(evt); -	struct xttcps_timer *timer = &xttce->xttc; -	u32 ctrl_reg; - -	switch (mode) { -	case CLOCK_EVT_MODE_PERIODIC: -		xttcps_set_interval(timer, -				     DIV_ROUND_CLOSEST(clk_get_rate(xttce->clk), -						       PRESCALE * HZ)); -		break; -	case CLOCK_EVT_MODE_ONESHOT: -	case CLOCK_EVT_MODE_UNUSED: -	case CLOCK_EVT_MODE_SHUTDOWN: -		ctrl_reg = __raw_readl(timer->base_addr + -					XTTCPS_CNT_CNTRL_OFFSET); -		ctrl_reg |= XTTCPS_CNT_CNTRL_DISABLE_MASK; -		__raw_writel(ctrl_reg, -				timer->base_addr + XTTCPS_CNT_CNTRL_OFFSET); -		break; -	case CLOCK_EVT_MODE_RESUME: -		ctrl_reg = __raw_readl(timer->base_addr + -					XTTCPS_CNT_CNTRL_OFFSET); -		ctrl_reg &= ~XTTCPS_CNT_CNTRL_DISABLE_MASK; -		__raw_writel(ctrl_reg, -				timer->base_addr + XTTCPS_CNT_CNTRL_OFFSET); -		break; -	} -} - -static void __init zynq_ttc_setup_clocksource(struct device_node *np, -					     void __iomem *base) -{ -	struct xttcps_timer_clocksource *ttccs; -	struct clk *clk; -	int err; -	u32 reg; - -	ttccs = kzalloc(sizeof(*ttccs), GFP_KERNEL); -	if (WARN_ON(!ttccs)) -		return; - -	err = of_property_read_u32(np, "reg", ®); -	if (WARN_ON(err)) -		return; - -	clk = of_clk_get_by_name(np, "cpu_1x"); -	if (WARN_ON(IS_ERR(clk))) -		return; - -	err = clk_prepare_enable(clk); -	if (WARN_ON(err)) -		return; - -	ttccs->xttc.base_addr = base + reg * 4; - -	ttccs->cs.name = np->name; -	ttccs->cs.rating = 200; -	ttccs->cs.read = __xttc_clocksource_read; -	ttccs->cs.mask = CLOCKSOURCE_MASK(16); -	ttccs->cs.flags = CLOCK_SOURCE_IS_CONTINUOUS; - -	__raw_writel(0x0,  ttccs->xttc.base_addr + XTTCPS_IER_OFFSET); -	__raw_writel(CLK_CNTRL_PRESCALE | CLK_CNTRL_PRESCALE_EN, -		     ttccs->xttc.base_addr + XTTCPS_CLK_CNTRL_OFFSET); -	__raw_writel(CNT_CNTRL_RESET, -		     ttccs->xttc.base_addr + XTTCPS_CNT_CNTRL_OFFSET); - -	err = clocksource_register_hz(&ttccs->cs, clk_get_rate(clk) / PRESCALE); -	if (WARN_ON(err)) -		return; -} - -static void __init zynq_ttc_setup_clockevent(struct device_node *np, -					    void __iomem *base) -{ -	struct xttcps_timer_clockevent *ttcce; -	int err, irq; -	u32 reg; - -	ttcce = kzalloc(sizeof(*ttcce), GFP_KERNEL); -	if (WARN_ON(!ttcce)) -		return; - -	err = of_property_read_u32(np, "reg", ®); -	if (WARN_ON(err)) -		return; - -	ttcce->xttc.base_addr = base + reg * 4; - -	ttcce->clk = of_clk_get_by_name(np, "cpu_1x"); -	if (WARN_ON(IS_ERR(ttcce->clk))) -		return; - -	err = clk_prepare_enable(ttcce->clk); -	if (WARN_ON(err)) -		return; - -	irq = irq_of_parse_and_map(np, 0); -	if (WARN_ON(!irq)) -		return; - -	ttcce->ce.name = np->name; -	ttcce->ce.features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT; -	ttcce->ce.set_next_event = xttcps_set_next_event; -	ttcce->ce.set_mode = xttcps_set_mode; -	ttcce->ce.rating = 200; -	ttcce->ce.irq = irq; -	ttcce->ce.cpumask = cpu_possible_mask; - -	__raw_writel(0x23, ttcce->xttc.base_addr + XTTCPS_CNT_CNTRL_OFFSET); -	__raw_writel(CLK_CNTRL_PRESCALE | CLK_CNTRL_PRESCALE_EN, -		     ttcce->xttc.base_addr + XTTCPS_CLK_CNTRL_OFFSET); -	__raw_writel(0x1,  ttcce->xttc.base_addr + XTTCPS_IER_OFFSET); - -	err = request_irq(irq, xttcps_clock_event_interrupt, IRQF_TIMER, -			  np->name, ttcce); -	if (WARN_ON(err)) -		return; - -	clockevents_config_and_register(&ttcce->ce, -					clk_get_rate(ttcce->clk) / PRESCALE, -					1, 0xfffe); -} - -static const __initconst struct of_device_id zynq_ttc_match[] = { -	{ .compatible = "xlnx,ttc-counter-clocksource", -		.data = zynq_ttc_setup_clocksource, }, -	{ .compatible = "xlnx,ttc-counter-clockevent", -		.data = zynq_ttc_setup_clockevent, }, -	{} -}; - -/** - * xttcps_timer_init - Initialize the timer - * - * Initializes the timer hardware and register the clock source and clock event - * timers with Linux kernal timer framework - **/ -void __init xttcps_timer_init(void) -{ -	struct device_node *np; - -	for_each_compatible_node(np, NULL, "xlnx,ttc") { -		struct device_node *np_chld; -		void __iomem *base; - -		base = of_iomap(np, 0); -		if (WARN_ON(!base)) -			return; - -		for_each_available_child_of_node(np, np_chld) { -			int (*cb)(struct device_node *np, void __iomem *base); -			const struct of_device_id *match; - -			match = of_match_node(zynq_ttc_match, np_chld); -			if (match) { -				cb = match->data; -				cb(np_chld, base); -			} -		} -	} -}  |