diff options
author | Jeff Johnston <jjohnstn@redhat.com> | 2011-12-15 22:58:40 +0000 |
---|---|---|
committer | Jeff Johnston <jjohnstn@redhat.com> | 2011-12-15 22:58:40 +0000 |
commit | 8e0346d1372ed32d2c5f559e083f3bd60b281c3a (patch) | |
tree | b72116c382df57f2e7396b58d32370b731535712 /libgloss/sparc_leon/gettimeofday.c | |
parent | e74758408e50f8980de0d73f5b3721efbd698df9 (diff) | |
download | newlib-8e0346d1372ed32d2c5f559e083f3bd60b281c3a.zip newlib-8e0346d1372ed32d2c5f559e083f3bd60b281c3a.tar.gz newlib-8e0346d1372ed32d2c5f559e083f3bd60b281c3a.tar.bz2 |
2011-12-15 Konrad Eisele <konrad@gaisler.com>
* configure.in: Add SPARC LEON support.
* configure: Regenerated.
* sparc_leon/asm-leon/amba.h, sparc_leon/asm-leon/asmmacro.h,
sparc_leon/asm-leon/clock.h, sparc_leon/asm-leon/contextswitch.h,
sparc_leon/asm-leon/elfmacro.h, sparc_leon/asm-leon/head.h,
sparc_leon/asm-leon/irq.h, sparc_leon/asm-leon/jiffies.h,
sparc_leon/asm-leon/lambapp.h, sparc_leon/asm-leon/lambapp_devs.h,
sparc_leon/asm-leon/leon.h, sparc_leon/asm-leon/leon3.h,
sparc_leon/asm-leon/leonbare_debug.h, sparc_leon/asm-leon/leonbare_kernel.h,
sparc_leon/asm-leon/leonbare_kernel_queue.h, sparc_leon/asm-leon/leoncompat.h,
sparc_leon/asm-leon/leondbg.h, sparc_leon/asm-leon/leonstack.h,
sparc_leon/asm-leon/liblocks.h, sparc_leon/asm-leon/linkage.h,
sparc_leon/asm-leon/param.h, sparc_leon/asm-leon/queue.h,
sparc_leon/asm-leon/spinlock.h, sparc_leon/asm-leon/stack.h,
sparc_leon/asm-leon/time.h, sparc_leon/asm-leon/timer.h,
sparc_leon/asm-leon/types.h, sparc_leon/asm-leon/winmacros.h:
New file.
* sparc_leon/Makefile.in, sparc_leon/_exit.c,
sparc_leon/amba.c, sparc_leon/amba_dbg.c,
sparc_leon/amba_driver.c, sparc_leon/amba_scan.c,
sparc_leon/asm-leon, sparc_leon/bdinit.S,
sparc_leon/busscan.S, sparc_leon/cacheA.S,
sparc_leon/catch_interrupt.c, sparc_leon/catch_interrupt_mvt.c,
sparc_leon/catch_interrupt_pending.c, sparc_leon/catch_interrupt_svt.c,
sparc_leon/configure.in,
sparc_leon/console.c, sparc_leon/console_dbg.c,
sparc_leon/console_init.c, sparc_leon/contextswitch.c,
sparc_leon/contextswitch_asm.S, sparc_leon/crt0.S,
sparc_leon/crti.S, sparc_leon/crtn.S,
sparc_leon/etrap.S, sparc_leon/etrap_fast.S,
sparc_leon/fpu.S, sparc_leon/gettimeofday.c,
sparc_leon/initcalls.c, sparc_leon/io.c,
sparc_leon/irqinstall.S, sparc_leon/irqtrap.S,
sparc_leon/irqtrap_fast.S, sparc_leon/jiffies.c,
sparc_leon/kernel.c, sparc_leon/kernel_context.S,
sparc_leon/kernel_debug.c, sparc_leon/kernel_debug_var.c,
sparc_leon/kernel_mm.c, sparc_leon/kernel_mutex.c,
sparc_leon/kernel_queue.c, sparc_leon/kernel_sched.c,
sparc_leon/kernel_thread.c, sparc_leon/lcpuinit.S,
sparc_leon/locore.S, sparc_leon/locore_atexit.c,
sparc_leon/locore_clean.S, sparc_leon/locore_mvt.S,
sparc_leon/locore_mvt_reset.S, sparc_leon/locore_svt.S,
sparc_leon/locore_svt_reset.S, sparc_leon/locore_svtdisp.S,
sparc_leon/locore_var.S, sparc_leon/locore_var_svt.S,
sparc_leon/mmu_asm.S, sparc_leon/mutex.c,
sparc_leon/nocache.S, sparc_leon/pnpinit.c,
sparc_leon/pnpinit_malloc.c, sparc_leon/pnpinit_simple.c,
sparc_leon/regwin.S, sparc_leon/regwin_patch.c,
sparc_leon/regwin_slow.S, sparc_leon/regwinflush.S,
sparc_leon/rtc.c, sparc_leon/rtrap.S,
sparc_leon/rtrap_fast.S, sparc_leon/stop.S,
sparc_leon/timer.c, sparc_leon/times.c:
New file
* sparc_leon/configure: Regenerate
Diffstat (limited to 'libgloss/sparc_leon/gettimeofday.c')
-rw-r--r-- | libgloss/sparc_leon/gettimeofday.c | 272 |
1 files changed, 272 insertions, 0 deletions
diff --git a/libgloss/sparc_leon/gettimeofday.c b/libgloss/sparc_leon/gettimeofday.c new file mode 100644 index 0000000..088184c --- /dev/null +++ b/libgloss/sparc_leon/gettimeofday.c @@ -0,0 +1,272 @@ +/* + * Copyright (c) 2011 Aeroflex Gaisler + * + * BSD license: + * + * Permission is hereby granted, free of charge, to any person obtaining a copy + * of this software and associated documentation files (the "Software"), to deal + * in the Software without restriction, including without limitation the rights + * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell + * copies of the Software, and to permit persons to whom the Software is + * furnished to do so, subject to the following conditions: + * + * The above copyright notice and this permission notice shall be included in + * all copies or substantial portions of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR + * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, + * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL + * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER + * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, + * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN + * THE SOFTWARE. + */ + + +#include <sys/types.h> +#include <sys/time.h> +#include <sys/errno.h> +#include <asm-leon/elfmacro.h> +#include <asm-leon/leon.h> +#include <asm-leon/irq.h> +#include <asm-leon/jiffies.h> +#include <asm-leon/param.h> +#include <asm-leon/leoncompat.h> + +static __inline__ unsigned long do_gettimeoffset (); + + +extern int *rtc; + +unsigned long wall_jiffies = INITIAL_JIFFIES; +unsigned long tick_nsec = TICK_NSEC; +unsigned long tick_usec = TICK_NSEC / 1000; +unsigned long seperateirq = 1; +unsigned long noalarm = 1; +unsigned long force_noalarm = 0; +unsigned long nodotimer = 0; +int leonbare_hz = HZ; + + +void settimer (); +inline void +do_timer (struct leonbare_pt_regs *regs) +{ + unsigned long ticks; + jiffies_64++; + ticks = jiffies - wall_jiffies; + if (ticks) + { + wall_jiffies += ticks; + do + { + ticks--; + xtime.tv_nsec += tick_nsec; + if (xtime.tv_nsec >= 1000000000) + { + xtime.tv_nsec -= 1000000000; + xtime.tv_sec++; + } + } + while (ticks); + } + settimer (); +} + +int +leonbare_alarm (int irq, void *arg, struct leonbare_pt_regs *regs) +{ + settimer (); +} + +extern clock_t (*clock_custom) (void); +clock_t +leonbare_clock_custom () +{ + int hz = leonbare_hz ? leonbare_hz : HZ; + return (clock_t) ((jiffies * (CLOCK_TICK_RATE / hz)) + do_gettimeoffset ()); +} + + +tickerhandler ticker_callback = 0; +int +leonbare_tick (int irq, void *arg, struct leonbare_pt_regs *regs) +{ + unsigned int ctrl; + if (!seperateirq) + { + /* only leon3 comes here */ + if (!noalarm) + { + ctrl = LEON3_GpTimer_Regs->e[1].ctrl; + if (ctrl & LEON3_GPTIMER_IP) + { + leonbare_alarm (irq, arg, regs); + LEON3_GpTimer_Regs->e[1].ctrl = ctrl & ~LEON3_GPTIMER_IP; + } + } + ctrl = LEON3_GpTimer_Regs->e[0].ctrl; + if (!(ctrl & LEON3_GPTIMER_IP)) + { + return 0; + } + LEON3_GpTimer_Regs->e[0].ctrl = ctrl & ~LEON3_GPTIMER_IP; + } + + if (!nodotimer) + { + do_timer (regs); + } + if (ticker_callback) + { + ticker_callback (regs); + } + return 0; +} + +static struct irqaction irqact1 = { (irqhandler) leonbare_tick, 0, 0, 0 }; +static struct irqaction irqact2 = { (irqhandler) leonbare_alarm, 0, 0, 0 }; + +void +leonbare_init_ticks () +{ + int i, irq1 = 0, irq2 = 0; + int hz = leonbare_hz ? leonbare_hz : HZ; + amba_apb_device dev[1]; + + //--------------------- + switch (LEONCOMPAT_VERSION) + { + case 3: + default: + amba_init (); + if (LEON3_GpTimer_Regs && LEON3_IrqCtrl_Regs) + { + if ((LEON3_GpTimer_Regs->config & LEON3_GPTIMER_CONFIG_TIMERMASK) >= + 2 && force_noalarm == 0) + noalarm = 0; + if (!(LEON3_GpTimer_Regs->config & LEON3_GPTIMER_CONFIG_SEPERATE)) + seperateirq = 0; + LEON3_GpTimer_Regs->e[0].val = 0; + LEON3_GpTimer_Regs->e[0].rld = (((CLOCK_TICK_RATE / hz) - 1)); + LEON3_GpTimer_Regs->e[0].ctrl = 0; + LEON3_GpTimer_Regs->e[0].ctrl = + LEON3_GPTIMER_EN | + LEON3_GPTIMER_RL | LEON3_GPTIMER_LD | LEON3_GPTIMER_IRQEN; + irq1 = LEON3_GpTimer_Irq; + irq2 = LEON3_GpTimer_Irq + 1; + } + break; + } + //--------------------- + + if (irq1) + { + clock_custom = leonbare_clock_custom; + chained_catch_interrupt (irq1, &irqact1); + leonbare_enable_irq (irq1); + } + if (irq2 && (!noalarm) && seperateirq) + { + chained_catch_interrupt (irq2, &irqact2); + leonbare_enable_irq (irq2); + } +} + + +//''''''''''''''''''''''''''''''''''''''''''''''''''''''''''' + +static __inline__ unsigned long +do_gettimeoffset () +{ + unsigned long usec = 0; + //--------------------- + switch (LEONCOMPAT_VERSION) + { + case 3: + default: + usec = ((LEON3_GpTimer_Regs->e[0].rld & 0x7fffff) - + (LEON3_GpTimer_Regs->e[0].val & 0x7fffff)); + break; + } + //--------------------- + return usec; +} + +/* get usec (timeval) resolution, + * could use nsec (timespec) because pthread use it (todo) */ +void +do_gettimeofday (struct timeval *tv) +{ + + unsigned long flags; + unsigned long seq; + unsigned long usec, sec; + + do + { + unsigned long lost; + seq = jiffies; + + usec = do_gettimeoffset (); + lost = jiffies - wall_jiffies; + + if (unlikely (lost)) + { + usec += lost * tick_usec; + } + + sec = xtime.tv_sec; + usec += (xtime.tv_nsec / 1000); + } + while (seq != jiffies); + + while (usec >= 1000000) + { + usec -= 1000000; + sec++; + } + + tv->tv_sec = sec; + tv->tv_usec = usec; +} + +int +gettimeofday (struct timeval *__p, void *__tz) +{ + do_gettimeofday (__p); + return 0; +} + +//''''''''''''''''''''''''''''''''''''''''''''''''''''''''''' + +static int +do_settimeofday (struct timespec *tv) +{ + time_t sec = tv->tv_sec; + long nsec = tv->tv_nsec; + + if ((unsigned long) nsec >= NSEC_PER_SEC) + return EINVAL; + + /* + * This is revolting. We need to set "xtime" correctly. However, the + * value in this location is the value at the most recent update of + * wall time. Discover what correction gettimeofday() would have + * made, and then undo it! + */ + nsec -= 1000 * (do_gettimeoffset () + + (jiffies - wall_jiffies) * (USEC_PER_SEC / HZ)); + + set_normalized_timespec (&xtime, sec, nsec); + return 0; +} + +int +settimeofday (const struct timeval *tv, const struct timezone *tz) +{ + struct timespec ts; + ts.tv_sec = tv->tv_sec; + ts.tv_nsec = tv->tv_usec * NSEC_PER_USEC; + return do_settimeofday (&ts); +} |