2
* arch/arm/mach-netx/time.c
4
* Copyright (c) 2005 Sascha Hauer <s.hauer@pengutronix.de>, Pengutronix
6
* This program is free software; you can redistribute it and/or modify
7
* it under the terms of the GNU General Public License version 2
8
* as published by the Free Software Foundation.
10
* This program is distributed in the hope that it will be useful,
11
* but WITHOUT ANY WARRANTY; without even the implied warranty of
12
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13
* GNU General Public License for more details.
15
* You should have received a copy of the GNU General Public License
16
* along with this program; if not, write to the Free Software
17
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20
#include <linux/init.h>
21
#include <linux/interrupt.h>
22
#include <linux/irq.h>
23
#include <linux/clocksource.h>
24
#include <linux/clockchips.h>
27
#include <mach/hardware.h>
28
#include <asm/mach/time.h>
29
#include <mach/netx-regs.h>
31
#define TIMER_CLOCKEVENT 0
32
#define TIMER_CLOCKSOURCE 1
34
static void netx_set_mode(enum clock_event_mode mode,
35
struct clock_event_device *clk)
40
writel(0, NETX_GPIO_COUNTER_CTRL(TIMER_CLOCKEVENT));
43
case CLOCK_EVT_MODE_PERIODIC:
44
writel(LATCH, NETX_GPIO_COUNTER_MAX(TIMER_CLOCKEVENT));
45
tmode = NETX_GPIO_COUNTER_CTRL_RST_EN |
46
NETX_GPIO_COUNTER_CTRL_IRQ_EN |
47
NETX_GPIO_COUNTER_CTRL_RUN;
50
case CLOCK_EVT_MODE_ONESHOT:
51
writel(0, NETX_GPIO_COUNTER_MAX(TIMER_CLOCKEVENT));
52
tmode = NETX_GPIO_COUNTER_CTRL_IRQ_EN |
53
NETX_GPIO_COUNTER_CTRL_RUN;
57
WARN(1, "%s: unhandled mode %d\n", __func__, mode);
60
case CLOCK_EVT_MODE_SHUTDOWN:
61
case CLOCK_EVT_MODE_UNUSED:
62
case CLOCK_EVT_MODE_RESUME:
67
writel(tmode, NETX_GPIO_COUNTER_CTRL(TIMER_CLOCKEVENT));
70
static int netx_set_next_event(unsigned long evt,
71
struct clock_event_device *clk)
73
writel(0 - evt, NETX_GPIO_COUNTER_CURRENT(TIMER_CLOCKEVENT));
77
static struct clock_event_device netx_clockevent = {
78
.name = "netx-timer" __stringify(TIMER_CLOCKEVENT),
80
.features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT,
81
.set_next_event = netx_set_next_event,
82
.set_mode = netx_set_mode,
86
* IRQ handler for the timer
89
netx_timer_interrupt(int irq, void *dev_id)
91
struct clock_event_device *evt = &netx_clockevent;
93
/* acknowledge interrupt */
94
writel(COUNTER_BIT(0), NETX_GPIO_IRQ);
96
evt->event_handler(evt);
101
static struct irqaction netx_timer_irq = {
102
.name = "NetX Timer Tick",
103
.flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL,
104
.handler = netx_timer_interrupt,
108
* Set up timer interrupt
110
static void __init netx_timer_init(void)
112
/* disable timer initially */
113
writel(0, NETX_GPIO_COUNTER_CTRL(0));
115
/* Reset the timer value to zero */
116
writel(0, NETX_GPIO_COUNTER_CURRENT(0));
118
writel(LATCH, NETX_GPIO_COUNTER_MAX(0));
120
/* acknowledge interrupt */
121
writel(COUNTER_BIT(0), NETX_GPIO_IRQ);
123
/* Enable the interrupt in the specific timer
124
* register and start timer
126
writel(COUNTER_BIT(0), NETX_GPIO_IRQ_ENABLE);
127
writel(NETX_GPIO_COUNTER_CTRL_IRQ_EN | NETX_GPIO_COUNTER_CTRL_RUN,
128
NETX_GPIO_COUNTER_CTRL(0));
130
setup_irq(NETX_IRQ_TIMER0, &netx_timer_irq);
132
/* Setup timer one for clocksource */
133
writel(0, NETX_GPIO_COUNTER_CTRL(TIMER_CLOCKSOURCE));
134
writel(0, NETX_GPIO_COUNTER_CURRENT(TIMER_CLOCKSOURCE));
135
writel(0xffffffff, NETX_GPIO_COUNTER_MAX(TIMER_CLOCKSOURCE));
137
writel(NETX_GPIO_COUNTER_CTRL_RUN,
138
NETX_GPIO_COUNTER_CTRL(TIMER_CLOCKSOURCE));
140
clocksource_mmio_init(NETX_GPIO_COUNTER_CURRENT(TIMER_CLOCKSOURCE),
141
"netx_timer", CLOCK_TICK_RATE, 200, 32, clocksource_mmio_readl_up);
143
netx_clockevent.mult = div_sc(CLOCK_TICK_RATE, NSEC_PER_SEC,
144
netx_clockevent.shift);
145
netx_clockevent.max_delta_ns =
146
clockevent_delta2ns(0xfffffffe, &netx_clockevent);
147
/* with max_delta_ns >= delta2ns(0x800) the system currently runs fine.
148
* Adding some safety ... */
149
netx_clockevent.min_delta_ns =
150
clockevent_delta2ns(0xa00, &netx_clockevent);
151
netx_clockevent.cpumask = cpumask_of(0);
152
clockevents_register_device(&netx_clockevent);
155
struct sys_timer netx_timer = {
156
.init = netx_timer_init,