• Home
  • History
  • Annotate
  • Line#
  • Navigate
  • Raw
  • Download
  • only in /asuswrt-rt-n18u-9.0.0.4.380.2695/release/src-rt-6.x.4708/linux/linux-2.6/arch/tile/kernel/
1/*
2 * Copyright 2010 Tilera Corporation. All Rights Reserved.
3 *
4 *   This program is free software; you can redistribute it and/or
5 *   modify it under the terms of the GNU General Public License
6 *   as published by the Free Software Foundation, version 2.
7 *
8 *   This program is distributed in the hope that it will be useful, but
9 *   WITHOUT ANY WARRANTY; without even the implied warranty of
10 *   MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
11 *   NON INFRINGEMENT.  See the GNU General Public License for
12 *   more details.
13 *
14 * Support the cycle counter clocksource and tile timer clock event device.
15 */
16
17#include <linux/time.h>
18#include <linux/timex.h>
19#include <linux/clocksource.h>
20#include <linux/clockchips.h>
21#include <linux/hardirq.h>
22#include <linux/sched.h>
23#include <linux/smp.h>
24#include <linux/delay.h>
25#include <asm/irq_regs.h>
26#include <asm/traps.h>
27#include <hv/hypervisor.h>
28#include <arch/interrupts.h>
29#include <arch/spr_def.h>
30
31
32/*
33 * Define the cycle counter clock source.
34 */
35
36/* How many cycles per second we are running at. */
37static cycles_t cycles_per_sec __write_once;
38
39cycles_t get_clock_rate(void)
40{
41	return cycles_per_sec;
42}
43
44#if CHIP_HAS_SPLIT_CYCLE()
45cycles_t get_cycles(void)
46{
47	unsigned int high = __insn_mfspr(SPR_CYCLE_HIGH);
48	unsigned int low = __insn_mfspr(SPR_CYCLE_LOW);
49	unsigned int high2 = __insn_mfspr(SPR_CYCLE_HIGH);
50
51	while (unlikely(high != high2)) {
52		low = __insn_mfspr(SPR_CYCLE_LOW);
53		high = high2;
54		high2 = __insn_mfspr(SPR_CYCLE_HIGH);
55	}
56
57	return (((cycles_t)high) << 32) | low;
58}
59#endif
60
61/*
62 * We use a relatively small shift value so that sched_clock()
63 * won't wrap around very often.
64 */
65#define SCHED_CLOCK_SHIFT 10
66
67static unsigned long sched_clock_mult __write_once;
68
69static cycles_t clocksource_get_cycles(struct clocksource *cs)
70{
71	return get_cycles();
72}
73
74static struct clocksource cycle_counter_cs = {
75	.name = "cycle counter",
76	.rating = 300,
77	.read = clocksource_get_cycles,
78	.mask = CLOCKSOURCE_MASK(64),
79	.shift = 22,   /* typical value, e.g. x86 tsc uses this */
80	.flags = CLOCK_SOURCE_IS_CONTINUOUS,
81};
82
83/*
84 * Called very early from setup_arch() to set cycles_per_sec.
85 * We initialize it early so we can use it to set up loops_per_jiffy.
86 */
87void __init setup_clock(void)
88{
89	cycles_per_sec = hv_sysconf(HV_SYSCONF_CPU_SPEED);
90	sched_clock_mult =
91		clocksource_hz2mult(cycles_per_sec, SCHED_CLOCK_SHIFT);
92	cycle_counter_cs.mult =
93		clocksource_hz2mult(cycles_per_sec, cycle_counter_cs.shift);
94}
95
96void __init calibrate_delay(void)
97{
98	loops_per_jiffy = get_clock_rate() / HZ;
99	pr_info("Clock rate yields %lu.%02lu BogoMIPS (lpj=%lu)\n",
100		loops_per_jiffy/(500000/HZ),
101		(loops_per_jiffy/(5000/HZ)) % 100, loops_per_jiffy);
102}
103
104/* Called fairly late in init/main.c, but before we go smp. */
105void __init time_init(void)
106{
107	/* Initialize and register the clock source. */
108	clocksource_register(&cycle_counter_cs);
109
110	/* Start up the tile-timer interrupt source on the boot cpu. */
111	setup_tile_timer();
112}
113
114
115/*
116 * Define the tile timer clock event device.  The timer is driven by
117 * the TILE_TIMER_CONTROL register, which consists of a 31-bit down
118 * counter, plus bit 31, which signifies that the counter has wrapped
119 * from zero to (2**31) - 1.  The INT_TILE_TIMER interrupt will be
120 * raised as long as bit 31 is set.
121 *
122 * The TILE_MINSEC value represents the largest range of real-time
123 * we can possibly cover with the timer, based on MAX_TICK combined
124 * with the slowest reasonable clock rate we might run at.
125 */
126
127#define MAX_TICK 0x7fffffff   /* we have 31 bits of countdown timer */
128#define TILE_MINSEC 5         /* timer covers no more than 5 seconds */
129
130static int tile_timer_set_next_event(unsigned long ticks,
131				     struct clock_event_device *evt)
132{
133	BUG_ON(ticks > MAX_TICK);
134	__insn_mtspr(SPR_TILE_TIMER_CONTROL, ticks);
135	raw_local_irq_unmask_now(INT_TILE_TIMER);
136	return 0;
137}
138
139/*
140 * Whenever anyone tries to change modes, we just mask interrupts
141 * and wait for the next event to get set.
142 */
143static void tile_timer_set_mode(enum clock_event_mode mode,
144				struct clock_event_device *evt)
145{
146	raw_local_irq_mask_now(INT_TILE_TIMER);
147}
148
149/*
150 * Set min_delta_ns to 1 microsecond, since it takes about
151 * that long to fire the interrupt.
152 */
153static DEFINE_PER_CPU(struct clock_event_device, tile_timer) = {
154	.name = "tile timer",
155	.features = CLOCK_EVT_FEAT_ONESHOT,
156	.min_delta_ns = 1000,
157	.rating = 100,
158	.irq = -1,
159	.set_next_event = tile_timer_set_next_event,
160	.set_mode = tile_timer_set_mode,
161};
162
163void __cpuinit setup_tile_timer(void)
164{
165	struct clock_event_device *evt = &__get_cpu_var(tile_timer);
166
167	/* Fill in fields that are speed-specific. */
168	clockevents_calc_mult_shift(evt, cycles_per_sec, TILE_MINSEC);
169	evt->max_delta_ns = clockevent_delta2ns(MAX_TICK, evt);
170
171	/* Mark as being for this cpu only. */
172	evt->cpumask = cpumask_of(smp_processor_id());
173
174	/* Start out with timer not firing. */
175	raw_local_irq_mask_now(INT_TILE_TIMER);
176
177	/* Register tile timer. */
178	clockevents_register_device(evt);
179}
180
181/* Called from the interrupt vector. */
182void do_timer_interrupt(struct pt_regs *regs, int fault_num)
183{
184	struct pt_regs *old_regs = set_irq_regs(regs);
185	struct clock_event_device *evt = &__get_cpu_var(tile_timer);
186
187	/*
188	 * Mask the timer interrupt here, since we are a oneshot timer
189	 * and there are now by definition no events pending.
190	 */
191	raw_local_irq_mask(INT_TILE_TIMER);
192
193	/* Track time spent here in an interrupt context */
194	irq_enter();
195
196	/* Track interrupt count. */
197	__get_cpu_var(irq_stat).irq_timer_count++;
198
199	/* Call the generic timer handler */
200	evt->event_handler(evt);
201
202	/*
203	 * Track time spent against the current process again and
204	 * process any softirqs if they are waiting.
205	 */
206	irq_exit();
207
208	set_irq_regs(old_regs);
209}
210
211/*
212 * Scheduler clock - returns current time in nanosec units.
213 * Note that with LOCKDEP, this is called during lockdep_init(), and
214 * we will claim that sched_clock() is zero for a little while, until
215 * we run setup_clock(), above.
216 */
217unsigned long long sched_clock(void)
218{
219	return clocksource_cyc2ns(get_cycles(),
220				  sched_clock_mult, SCHED_CLOCK_SHIFT);
221}
222
223int setup_profiling_timer(unsigned int multiplier)
224{
225	return -EINVAL;
226}
227