blob: eb23e6ab114d0e5f248be22b8fc9c8ae92a0762a [file] [log] [blame]
wdenk074cff02004-02-24 00:16:43 +00001/*
2 * (C) Copyright 2004
3 * DAVE Srl
4 * http://www.dave-tech.it
5 * http://www.wawnet.biz
6 * mailto:info@wawnet.biz
7 *
8 * See file CREDITS for list of people who contributed to this
9 * project.
10 *
11 * This program is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License as
13 * published by the Free Software Foundation; either version 2 of
14 * the License, or (at your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
24 * MA 02111-1307 USA
25 */
26
27#include <common.h>
28#include <asm/hardware.h>
29
wdenk074cff02004-02-24 00:16:43 +000030/* we always count down the max. */
31#define TIMER_LOAD_VAL 0xffff
32
33/* macro to read the 16 bit timer */
34#define READ_TIMER (TCNTO1 & 0xffff)
35
36#ifdef CONFIG_USE_IRQ
37#error CONFIG_USE_IRQ NOT supported
wdenk074cff02004-02-24 00:16:43 +000038#endif
39
wdenk074cff02004-02-24 00:16:43 +000040static ulong timestamp;
41static ulong lastdec;
42
43int interrupt_init (void)
44{
45 TCFG0 = 0x000000E9;
46 TCFG1 = 0x00000004;
47 TCON = 0x00000900;
48 TCNTB1 = TIMER_LOAD_VAL;
49 TCMPB1 = 0;
50 TCON = 0x00000B00;
51 TCON = 0x00000900;
52
53
54 lastdec = TCNTB1 = TIMER_LOAD_VAL;
55 timestamp = 0;
56 return 0;
57}
58
59/*
60 * timer without interrupts
61 */
62
63void reset_timer (void)
64{
65 reset_timer_masked ();
66}
67
68ulong get_timer (ulong base)
69{
70 return get_timer_masked () - base;
71}
72
73void set_timer (ulong t)
74{
75 timestamp = t;
76}
77
78void udelay (unsigned long usec)
79{
80 ulong tmo;
81
82 tmo = usec / 1000;
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020083 tmo *= CONFIG_SYS_HZ;
wdenk074cff02004-02-24 00:16:43 +000084 tmo /= 8;
85
86 tmo += get_timer (0);
87
88 while (get_timer_masked () < tmo)
89 /*NOP*/;
90}
91
92void reset_timer_masked (void)
93{
94 /* reset time */
95 lastdec = READ_TIMER;
96 timestamp = 0;
97}
98
99ulong get_timer_masked (void)
100{
101 ulong now = READ_TIMER;
102
103 if (lastdec >= now) {
104 /* normal mode */
105 timestamp += lastdec - now;
106 } else {
107 /* we have an overflow ... */
108 timestamp += lastdec + TIMER_LOAD_VAL - now;
109 }
110 lastdec = now;
111
112 return timestamp;
113}
114
115void udelay_masked (unsigned long usec)
116{
117 ulong tmo;
wdenk101e8df2005-04-04 12:08:28 +0000118 ulong endtime;
119 signed long diff;
wdenk074cff02004-02-24 00:16:43 +0000120
wdenk101e8df2005-04-04 12:08:28 +0000121 if (usec >= 1000) {
122 tmo = usec / 1000;
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200123 tmo *= CONFIG_SYS_HZ;
wdenk101e8df2005-04-04 12:08:28 +0000124 tmo /= 8;
125 } else {
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200126 tmo = usec * CONFIG_SYS_HZ;
wdenk101e8df2005-04-04 12:08:28 +0000127 tmo /= (1000*8);
128 }
wdenk074cff02004-02-24 00:16:43 +0000129
wdenk101e8df2005-04-04 12:08:28 +0000130 endtime = get_timer(0) + tmo;
wdenk074cff02004-02-24 00:16:43 +0000131
wdenk101e8df2005-04-04 12:08:28 +0000132 do {
133 ulong now = get_timer_masked ();
134 diff = endtime - now;
135 } while (diff >= 0);
wdenk074cff02004-02-24 00:16:43 +0000136}