[PATCH v2 19/29] nios2: Time keeping

Ley Foon Tan
2014-07-15T08:53:28Z

Add time keeping code for nios2.

Signed-off-by: Ley Foon Tan <lftan@altera.com>
---
arch/nios2/include/asm/delay.h | 92 +++++++++++++++++++++++++
arch/nios2/include/asm/timex.h | 27 ++++++++
arch/nios2/kernel/time.c | 150 +++++++++++++++++++++++++++++++++++++++++
3 files changed, 269 insertions(+)
create mode 100644 arch/nios2/include/asm/delay.h
create mode 100644 arch/nios2/include/asm/timex.h
create mode 100644 arch/nios2/kernel/time.c

diff --git a/arch/nios2/include/asm/delay.h b/arch/nios2/include/asm/delay.h
new file mode 100644
index 0000000..8070a09
--- /dev/null
+++ b/arch/nios2/include/asm/delay.h
@@ -0,0 +1,92 @@
+/*
+ * Copyright (C) 2004 Microtronix Datacom Ltd
+ *
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License. See the file "COPYING" in the main directory of this archive
+ * for more details.
+ */
+
+#ifndef _ASM_NIOS2_DELAY_H
+#define _ASM_NIOS2_DELAY_H
+
+#include <asm/param.h>
+
+static inline void __delay(unsigned long loops)
+{
+ int dummy;
+
+ __asm__ __volatile__(
+ "1:\n\t"
+ " beq %0,zero,2f\n\t"
+ " addi %0, %0, -1\n\t"
+ " br 1b\n\t"
+ "2:\n\t"
+ : "=r" (dummy) /* Need output for optimizer */
+ : "0" (loops)); /* %0 Input */
+}
+
+/*
+ * Note that 19 * 226 == 4294 ==~ 2^32 / 10^6, so
+ * loops = (4294 * usecs * loops_per_jiffy * HZ) / 2^32.
+ *
+ * The mul instruction gives us loops = (a * b) / 2^32.
+ * We choose a = usecs * 19 * HZ and b = loops_per_jiffy * 226
+ * because this lets us support a wide range of HZ and
+ * loops_per_jiffy values without either a or b overflowing 2^32.
+ * Thus we need usecs * HZ <= (2^32 - 1) / 19 = 226050910 and
+ * loops_per_jiffy <= (2^32 - 1) / 226 = 19004280
+ * (which corresponds to ~3800 bogomips at HZ = 100).
+ * -- paulus
+ */
+#define __MAX_UDELAY (226050910UL/HZ) /* maximum udelay argument */
+#define __MAX_NDELAY (4294967295UL/HZ) /* maximum ndelay argument */
+
+extern unsigned long loops_per_jiffy;
+
+static inline void __udelay(unsigned int x)
+{
+ unsigned int loops;
+
+ /*
+ * Note, if this is compiled with -mhw-mulx it will produce a "mulxuu"
+ * (at least in toolchain 145) so there is no need for inline
+ * assembly here anymore, which might in turn be emulated if unsupported
+ * by the design.
+ */
+ loops = (unsigned int)((((unsigned long long)(x) *
+ (unsigned long long)(loops_per_jiffy * 226))) >> 32);
+
+/*
+ __asm__("mulxuu %0,%1,%2" : "=r" (loops) :
+ "r" (x), "r" (loops_per_jiffy * 226));
+*/
+ __delay(loops);
+}
+
+static inline void __ndelay(unsigned int x)
+{
+ unsigned int loops;
+
+ /* see comment in __udelay */
+ loops = (unsigned int)((((unsigned long long)(x) *
+ (unsigned long long)(loops_per_jiffy * 5))) >> 32);
+
+/*
+ __asm__("mulxuu %0,%1,%2" : "=r" (loops) :
+ "r" (x), "r" (loops_per_jiffy * 5));
+*/
+ __delay(loops);
+}
+
+extern void __bad_udelay(void); /* deliberately undefined */
+extern void __bad_ndelay(void); /* deliberately undefined */
+
+#define udelay(n) (__builtin_constant_p(n) ? \
+ ((n) > __MAX_UDELAY ? __bad_udelay() : __udelay((n) * (19 * HZ))) : \
+ __udelay((n) * (19 * HZ)))
+
+#define ndelay(n) (__builtin_constant_p(n) ? \
+ ((n) > __MAX_NDELAY ? __bad_ndelay() : __ndelay((n) * HZ)) : \
+ __ndelay((n) * HZ))
+
+#endif /* _ASM_NIOS2_DELAY_H */
diff --git a/arch/nios2/include/asm/timex.h b/arch/nios2/include/asm/timex.h
new file mode 100644
index 0000000..524b47d
--- /dev/null
+++ b/arch/nios2/include/asm/timex.h
@@ -0,0 +1,27 @@
+/*
+ * Copyright (C) 2010 Thomas Chou <thomas@wytron.com.tw>
+ *
+ * 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; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * 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.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+
+#ifndef _ASM_NIOS2_TIMEX_H
+#define _ASM_NIOS2_TIMEX_H
+
+/* Supply dummy tick-rate. Real value will be read from devicetree */
+#define CLOCK_TICK_RATE (HZ * 100000UL)
+
+#include <asm-generic/timex.h>
+
+#endif
diff --git a/arch/nios2/kernel/time.c b/arch/nios2/kernel/time.c
new file mode 100644
index 0000000..111ade1
--- /dev/null
+++ b/arch/nios2/kernel/time.c
@@ -0,0 +1,150 @@
+/*
+ * Copyright (C) 2013 Altera Corporation
+ * Copyright (C) 2010 Tobias Klauser <tklauser@distanz.ch>
+ * Copyright (C) 2004 Microtronix Datacom Ltd.
+ *
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License. See the file "COPYING" in the main directory of this archive
+ * for more details.
+ */
+
+#include <linux/init.h>
+#include <linux/sched.h>
+#include <linux/interrupt.h>
+#include <linux/time.h>
+#include <linux/timex.h>
+#include <linux/profile.h>
+#include <linux/clocksource.h>
+#include <linux/of.h>
+#include <linux/of_address.h>
+#include <linux/of_irq.h>
+#include <linux/io.h>
+
+#define TICK_SIZE (tick_nsec / 1000)
+#define NIOS2_TIMER_PERIOD (timer_freq / HZ)
+
+#define ALTERA_TIMER_STATUS_REG 0
+#define ALTERA_TIMER_CONTROL_REG 4
+#define ALTERA_TIMER_PERIODL_REG 8
+#define ALTERA_TIMER_PERIODH_REG 12
+#define ALTERA_TIMER_SNAPL_REG 16
+#define ALTERA_TIMER_SNAPH_REG 20
+
+#define ALTERA_TIMER_CONTROL_ITO_MSK (0x1)
+#define ALTERA_TIMER_CONTROL_CONT_MSK (0x2)
+#define ALTERA_TIMER_CONTROL_START_MSK (0x4)
+#define ALTERA_TIMER_CONTROL_STOP_MSK (0x8)
+
+static u32 nios2_timer_count;
+static void __iomem *timer_membase;
+static u32 timer_freq;
+
+static inline unsigned long read_timersnapshot(void)
+{
+ unsigned long count;
+
+ writew(0, timer_membase + ALTERA_TIMER_SNAPL_REG);
+ count =
+ readw(timer_membase + ALTERA_TIMER_SNAPH_REG) << 16 |
+ readw(timer_membase + ALTERA_TIMER_SNAPL_REG);
+
+ return count;
+}
+
+static inline void write_timerperiod(unsigned long period)
+{
+ writew(period, timer_membase + ALTERA_TIMER_PERIODL_REG);
+ writew(period >> 16, timer_membase + ALTERA_TIMER_PERIODH_REG);
+}
+
+/*
+ * timer_interrupt() needs to keep up the real-time clock,
+ * as well as call the "xtime_update()" routine every clocktick
+ */
+irqreturn_t timer_interrupt(int irq, void *dummy)
+{
+ /* Clear the interrupt condition */
+ writew(0, timer_membase + ALTERA_TIMER_STATUS_REG);
+ nios2_timer_count += NIOS2_TIMER_PERIOD;
+
+ profile_tick(CPU_PROFILING);
+
+ xtime_update(1);
+
+ update_process_times(user_mode(get_irq_regs()));
+
+ return IRQ_HANDLED;
+}
+
+static cycle_t nios2_timer_read(struct clocksource *cs)
+{
+ unsigned long flags;
+ u32 cycles;
+ u32 tcn;
+
+ local_irq_save(flags);
+ tcn = NIOS2_TIMER_PERIOD - 1 - read_timersnapshot();
+ cycles = nios2_timer_count;
+ local_irq_restore(flags);
+
+ return cycles + tcn;
+}
+
+static struct clocksource nios2_timer = {
+ .name = "timer",
+ .rating = 250,
+ .read = nios2_timer_read,
+ .shift = 20,
+ .mask = CLOCKSOURCE_MASK(32),
+ .flags = CLOCK_SOURCE_IS_CONTINUOUS,
+};
+
+static struct irqaction nios2_timer_irq = {
+ .name = "timer",
+ .flags = IRQF_TIMER,
+ .handler = timer_interrupt,
+};
+
+static void __init nios2_time_init(struct device_node *timer)
+{
+ int irq;
+ unsigned int ctrl;
+
+ timer_membase = of_iomap(timer, 0);
+ if (!timer_membase)
+ panic("Unable to map timer resource\n");
+
+ if (of_property_read_u32(timer, "clock-frequency", &timer_freq))
+ panic("Unable to get timer clock frequency\n");
+
+ irq = irq_of_parse_and_map(timer, 0);
+ if (irq < 0)
+ panic("Unable to parse timer irq\n");
+
+ if (setup_irq(irq, &nios2_timer_irq))
+ panic("Unable to setup timer irq\n");
+
+ write_timerperiod(NIOS2_TIMER_PERIOD - 1);
+
+ /* clocksource initialize */
+ nios2_timer.mult = clocksource_hz2mult(timer_freq, nios2_timer.shift);
+ clocksource_register(&nios2_timer);
+
+ /* interrupt enable + continuous + start */
+ ctrl = ALTERA_TIMER_CONTROL_ITO_MSK | ALTERA_TIMER_CONTROL_CONT_MSK |
+ ALTERA_TIMER_CONTROL_START_MSK;
+ writew(ctrl, timer_membase + ALTERA_TIMER_CONTROL_REG);
+}
+
+void read_persistent_clock(struct timespec *ts)
+{
+ ts->tv_sec = mktime(2007, 1, 1, 0, 0, 0);
+ ts->tv_nsec = 0;
+}
+
+void __init time_init(void)
+{
+ clocksource_of_init();
+}
+
+CLOCKSOURCE_OF_DECLARE(nios2_timer, "altr,timer-1.0", nios2_time_init);
--
1.8.2.1