Merge branch 'master' of /home/wd/git/u-boot/custodians
[platform/kernel/u-boot.git] / lib_sh / time.c
1 /*
2  * (C) Copyright 2009
3  * Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
4  *
5  * (C) Copyright 2007-2008
6  * Nobobuhiro Iwamatsu <iwamatsu@nigauri.org>
7  *
8  * (C) Copyright 2003
9  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
10  *
11  * See file CREDITS for list of people who contributed to this
12  * project.
13  *
14  * This program is free software; you can redistribute it and/or
15  * modify it under the terms of the GNU General Public License as
16  * published by the Free Software Foundation; either version 2 of
17  * the License, or (at your option) any later version.
18  *
19  * This program is distributed in the hope that it will be useful,
20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
22  * GNU General Public License for more details.
23  *
24  * You should have received a copy of the GNU General Public License
25  * along with this program; if not, write to the Free Software
26  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
27  * MA 02111-1307 USA
28  */
29
30 #include <common.h>
31 #include <div64.h>
32 #include <asm/processor.h>
33 #include <asm/clk.h>
34 #include <asm/io.h>
35
36 #define TMU_MAX_COUNTER (~0UL)
37
38 static ulong timer_freq;
39
40 static inline unsigned long long tick_to_time(unsigned long long tick)
41 {
42         tick *= CONFIG_SYS_HZ;
43         do_div(tick, timer_freq);
44
45         return tick;
46 }
47
48 static inline unsigned long long usec_to_tick(unsigned long long usec)
49 {
50         usec *= timer_freq;
51         do_div(usec, 1000000);
52
53         return usec;
54 }
55
56 static void tmu_timer_start (unsigned int timer)
57 {
58         if (timer > 2)
59                 return;
60         writeb(readb(TSTR) | (1 << timer), TSTR);
61 }
62
63 static void tmu_timer_stop (unsigned int timer)
64 {
65         if (timer > 2)
66                 return;
67         writeb(readb(TSTR) & ~(1 << timer), TSTR);
68 }
69
70 int timer_init (void)
71 {
72         /* Divide clock by CONFIG_SYS_TMU_CLK_DIV */
73         u16 bit = 0;
74
75         switch (CONFIG_SYS_TMU_CLK_DIV) {
76         case 1024:
77                 bit = 4;
78                 break;
79         case 256:
80                 bit = 3;
81                 break;
82         case 64:
83                 bit = 2;
84                 break;
85         case 16:
86                 bit = 1;
87                 break;
88         case 4:
89         default:
90                 break;
91         }
92         writew(readw(TCR0) | bit, TCR0);
93
94         /* Calc clock rate */
95         timer_freq = get_tmu0_clk_rate() >> ((bit + 1) * 2);
96
97         tmu_timer_stop(0);
98         tmu_timer_start(0);
99
100         return 0;
101 }
102
103 unsigned long long get_ticks (void)
104 {
105         return 0 - readl(TCNT0);
106 }
107
108 void udelay (unsigned long usec)
109 {
110         unsigned long long tmp;
111         ulong tmo;
112
113         tmo = usec_to_tick(usec);
114         tmp = get_ticks() + tmo;        /* get current timestamp */
115
116         while (get_ticks() < tmp)       /* loop till event */
117                  /*NOP*/;
118 }
119
120 unsigned long get_timer (unsigned long base)
121 {
122         /* return msec */
123         return tick_to_time(get_ticks()) - base;
124 }
125
126 void set_timer (unsigned long t)
127 {
128         writel((0 - t), TCNT0);
129 }
130
131 void reset_timer (void)
132 {
133         tmu_timer_stop(0);
134         set_timer (0);
135         tmu_timer_start(0);
136 }
137
138 unsigned long get_tbclk (void)
139 {
140         return timer_freq;
141 }