1 files changed, 220 insertions, 0 deletions

diff --git a/arch/tile/kernel/time.c b/arch/tile/kernel/time.c
new file mode 100644
index 00000000000..47500a324e3
--- /dev/null
+++ b/arch/tile/kernel/time.c
@@ -0,0 +1,220 @@
+/*
+ * Copyright 2010 Tilera Corporation. All Rights Reserved.
+ *
+ *   This program is free software; you can redistribute it and/or
+ *   modify it under the terms of the GNU General Public License
+ *   as published by the Free Software Foundation, version 2.
+ *
+ *   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, GOOD TITLE or
+ *   NON INFRINGEMENT.  See the GNU General Public License for
+ *   more details.
+ *
+ * Support the cycle counter clocksource and tile timer clock event device.
+ */
+
+#include <linux/time.h>
+#include <linux/timex.h>
+#include <linux/clocksource.h>
+#include <linux/clockchips.h>
+#include <linux/hardirq.h>
+#include <linux/sched.h>
+#include <linux/smp.h>
+#include <linux/delay.h>
+#include <asm/irq_regs.h>
+#include <hv/hypervisor.h>
+#include <arch/interrupts.h>
+#include <arch/spr_def.h>
+
+
+/*
+ * Define the cycle counter clock source.
+ */
+
+/* How many cycles per second we are running at. */
+static cycles_t cycles_per_sec __write_once;
+
+/*
+ * We set up shift and multiply values with a minsec of five seconds,
+ * since our timer counter counts down 31 bits at a frequency of
+ * no less than 500 MHz.  See @minsec for clocks_calc_mult_shift().
+ * We could use a different value for the 64-bit free-running
+ * cycle counter, but we use the same one for consistency, and since
+ * we will be reasonably precise with this value anyway.
+ */
+#define TILE_MINSEC 5
+
+cycles_t get_clock_rate()
+{
+        return cycles_per_sec;
+}
+
+#if CHIP_HAS_SPLIT_CYCLE()
+cycles_t get_cycles()
+{
+        unsigned int high = __insn_mfspr(SPR_CYCLE_HIGH);
+        unsigned int low = __insn_mfspr(SPR_CYCLE_LOW);
+        unsigned int high2 = __insn_mfspr(SPR_CYCLE_HIGH);
+
+        while (unlikely(high != high2)) {
+                low = __insn_mfspr(SPR_CYCLE_LOW);
+                high = high2;
+                high2 = __insn_mfspr(SPR_CYCLE_HIGH);
+        }
+
+        return (((cycles_t)high) << 32) | low;
+}
+#endif
+
+cycles_t clocksource_get_cycles(struct clocksource *cs)
+{
+        return get_cycles();
+}
+
+static struct clocksource cycle_counter_cs = {
+        .name = "cycle counter",
+        .rating = 300,
+        .read = clocksource_get_cycles,
+        .mask = CLOCKSOURCE_MASK(64),
+        .flags = CLOCK_SOURCE_IS_CONTINUOUS,
+};
+
+/*
+ * Called very early from setup_arch() to set cycles_per_sec.
+ * We initialize it early so we can use it to set up loops_per_jiffy.
+ */
+void __init setup_clock(void)
+{
+        cycles_per_sec = hv_sysconf(HV_SYSCONF_CPU_SPEED);
+        clocksource_calc_mult_shift(&cycle_counter_cs, cycles_per_sec,
+                                    TILE_MINSEC);
+}
+
+void __init calibrate_delay(void)
+{
+        loops_per_jiffy = get_clock_rate() / HZ;
+        pr_info("Clock rate yields %lu.%02lu BogoMIPS (lpj=%lu)\n",
+                loops_per_jiffy/(500000/HZ),
+                (loops_per_jiffy/(5000/HZ)) % 100, loops_per_jiffy);
+}
+
+/* Called fairly late in init/main.c, but before we go smp. */
+void __init time_init(void)
+{
+        /* Initialize and register the clock source. */
+        clocksource_register(&cycle_counter_cs);
+
+        /* Start up the tile-timer interrupt source on the boot cpu. */
+        setup_tile_timer();
+}
+
+
+/*
+ * Define the tile timer clock event device.  The timer is driven by
+ * the TILE_TIMER_CONTROL register, which consists of a 31-bit down
+ * counter, plus bit 31, which signifies that the counter has wrapped
+ * from zero to (2**31) - 1.  The INT_TILE_TIMER interrupt will be
+ * raised as long as bit 31 is set.
+ */
+
+#define MAX_TICK 0x7fffffff   /* we have 31 bits of countdown timer */
+
+static int tile_timer_set_next_event(unsigned long ticks,
+                                     struct clock_event_device *evt)
+{
+        BUG_ON(ticks > MAX_TICK);
+        __insn_mtspr(SPR_TILE_TIMER_CONTROL, ticks);
+        raw_local_irq_unmask_now(INT_TILE_TIMER);
+        return 0;
+}
+
+/*
+ * Whenever anyone tries to change modes, we just mask interrupts
+ * and wait for the next event to get set.
+ */
+static void tile_timer_set_mode(enum clock_event_mode mode,
+                                struct clock_event_device *evt)
+{
+        raw_local_irq_mask_now(INT_TILE_TIMER);
+}
+
+/*
+ * Set min_delta_ns to 1 microsecond, since it takes about
+ * that long to fire the interrupt.
+ */
+static DEFINE_PER_CPU(struct clock_event_device, tile_timer) = {
+        .name = "tile timer",
+        .features = CLOCK_EVT_FEAT_ONESHOT,
+        .min_delta_ns = 1000,
+        .rating = 100,
+        .irq = -1,
+        .set_next_event = tile_timer_set_next_event,
+        .set_mode = tile_timer_set_mode,
+};
+
+void __cpuinit setup_tile_timer(void)
+{
+        struct clock_event_device *evt = &__get_cpu_var(tile_timer);
+
+        /* Fill in fields that are speed-specific. */
+        clockevents_calc_mult_shift(evt, cycles_per_sec, TILE_MINSEC);
+        evt->max_delta_ns = clockevent_delta2ns(MAX_TICK, evt);
+
+        /* Mark as being for this cpu only. */
+        evt->cpumask = cpumask_of(smp_processor_id());
+
+        /* Start out with timer not firing. */
+        raw_local_irq_mask_now(INT_TILE_TIMER);
+
+        /* Register tile timer. */
+        clockevents_register_device(evt);
+}
+
+/* Called from the interrupt vector. */
+void do_timer_interrupt(struct pt_regs *regs, int fault_num)
+{
+        struct pt_regs *old_regs = set_irq_regs(regs);
+        struct clock_event_device *evt = &__get_cpu_var(tile_timer);
+
+        /*
+         * Mask the timer interrupt here, since we are a oneshot timer
+         * and there are now by definition no events pending.
+         */
+        raw_local_irq_mask(INT_TILE_TIMER);
+
+        /* Track time spent here in an interrupt context */
+        irq_enter();
+
+        /* Track interrupt count. */
+        __get_cpu_var(irq_stat).irq_timer_count++;
+
+        /* Call the generic timer handler */
+        evt->event_handler(evt);
+
+        /*
+         * Track time spent against the current process again and
+         * process any softirqs if they are waiting.
+         */
+        irq_exit();
+
+        set_irq_regs(old_regs);
+}
+
+/*
+ * Scheduler clock - returns current time in nanosec units.
+ * Note that with LOCKDEP, this is called during lockdep_init(), and
+ * we will claim that sched_clock() is zero for a little while, until
+ * we run setup_clock(), above.
+ */
+unsigned long long sched_clock(void)
+{
+        return clocksource_cyc2ns(get_cycles(),
+                                  cycle_counter_cs.mult,
+                                  cycle_counter_cs.shift);
+}
+
+int setup_profiling_timer(unsigned int multiplier)
+{
+        return -EINVAL;
+}