X-Git-Url: https://git.librecmc.org/?a=blobdiff_plain;f=arch%2Fsh%2Flib%2Ftime.c;h=fb317f95d550085d0476451e03b52e6d628eeed3;hb=4d9f7a014da15d5988f97911ec9532e75831e76b;hp=c70baedbf1cac8e87f70b0019ce51b35c7c58a7e;hpb=1902692aa0b2dcbb9351172be03c57d1e82447e4;p=oweals%2Fu-boot.git diff --git a/arch/sh/lib/time.c b/arch/sh/lib/time.c index c70baedbf1..fb317f95d5 100644 --- a/arch/sh/lib/time.c +++ b/arch/sh/lib/time.c @@ -1,145 +1,38 @@ +// SPDX-License-Identifier: GPL-2.0+ /* * (C) Copyright 2009 * Jean-Christophe PLAGNIOL-VILLARD * - * (C) Copyright 2007-2010 + * (C) Copyright 2007-2012 * Nobobuhiro Iwamatsu * * (C) Copyright 2003 * Wolfgang Denk, DENX Software Engineering, wd@denx.de. - * - * See file CREDITS for list of people who contributed to this - * project. - * - * 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, write to the Free Software - * Foundation, Inc., 59 Temple Place, Suite 330, Boston, - * MA 02111-1307 USA */ #include -#include #include -#include #include -#define TMU_MAX_COUNTER (~0UL) - -static ulong timer_freq; -static unsigned long last_tcnt; -static unsigned long long overflow_ticks; - -static inline unsigned long long tick_to_time(unsigned long long tick) -{ - tick *= CONFIG_SYS_HZ; - do_div(tick, timer_freq); - - return tick; -} - -static inline unsigned long long usec_to_tick(unsigned long long usec) -{ - usec *= timer_freq; - do_div(usec, 1000000); +#if defined(CONFIG_CPU_SH3) +#define TSTR 0x2 +#define TCR0 0xc +#endif /* CONFIG_CPU_SH3 */ - return usec; -} +#if defined(CONFIG_CPU_SH4) || defined(CONFIG_ARCH_RMOBILE) +#define TSTR 0x4 +#define TCR0 0x10 +#endif /* CONFIG_CPU_SH4 */ -static void tmu_timer_start (unsigned int timer) -{ - if (timer > 2) - return; - writeb(readb(TSTR) | (1 << timer), TSTR); -} +#define TCR_TPSC 0x07 +#define TSTR_STR0 BIT(0) -static void tmu_timer_stop (unsigned int timer) +int timer_init(void) { - if (timer > 2) - return; - writeb(readb(TSTR) & ~(1 << timer), TSTR); -} - -int timer_init (void) -{ - /* Divide clock by CONFIG_SYS_TMU_CLK_DIV */ - u16 bit = 0; - - switch (CONFIG_SYS_TMU_CLK_DIV) { - case 1024: - bit = 4; - break; - case 256: - bit = 3; - break; - case 64: - bit = 2; - break; - case 16: - bit = 1; - break; - case 4: - default: - break; - } - writew(readw(TCR0) | bit, TCR0); - - /* Calc clock rate */ - timer_freq = get_tmu0_clk_rate() >> ((bit + 1) * 2); - - tmu_timer_stop(0); - tmu_timer_start(0); - - last_tcnt = 0; - overflow_ticks = 0; + writew(readw(TMU_BASE + TCR0) & ~TCR_TPSC, TMU_BASE + TCR0); + writeb(readb(TMU_BASE + TSTR) & ~TSTR_STR0, TMU_BASE + TSTR); + writeb(readb(TMU_BASE + TSTR) | TSTR_STR0, TMU_BASE + TSTR); return 0; } -unsigned long long get_ticks (void) -{ - unsigned long tcnt = 0 - readl(TCNT0); - unsigned long ticks; - - if (last_tcnt > tcnt) { /* overflow */ - overflow_ticks++; - ticks = (0xffffffff - last_tcnt) + tcnt; - } else { - ticks = tcnt; - } - last_tcnt = tcnt; - - return (overflow_ticks << 32) | tcnt; -} - -void __udelay (unsigned long usec) -{ - unsigned long long tmp; - ulong tmo; - - tmo = usec_to_tick(usec); - tmp = get_ticks() + tmo; /* get current timestamp */ - - while (get_ticks() < tmp) /* loop till event */ - /*NOP*/; -} - -unsigned long get_timer (unsigned long base) -{ - /* return msec */ - return tick_to_time(get_ticks()) - base; -} - -unsigned long get_tbclk (void) -{ - return timer_freq; -}