Introduce the new timer subsystem.
[people/mdeck/gpxe.git] / src / core / timer.c
1 /*
2  * core/timer.c
3  *
4  * Copyright (C) 2007 Alexey Zaytsev <alexey.zaytsev@gmail.com>
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License as
8  * published by the Free Software Foundation; either version 2 of the
9  * License, or any later version.
10  *
11  * This program is distributed in the hope that it will be useful, but
12  * WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software
18  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19  */
20
21 #include <stddef.h>
22 #include <assert.h>
23 #include <gpxe/init.h>
24 #include <gpxe/timer.h>
25 #include <stdio.h>
26
27 static struct timer ts_table[0]
28         __table_start ( struct timer, timers );
29 static struct timer ts_table_end[0]
30         __table_end ( struct timer, timers );
31
32
33 static struct timer *used_ts = NULL;
34
35 /*
36  * This function may be used in custom timer driver.
37  *
38  * This udelay implementation works well if you've got a
39  * fast currticks().
40  */
41 void generic_currticks_udelay(unsigned int usecs)
42 {
43         tick_t t;
44
45         t = currticks();
46         while (t + usecs > currticks())
47                 ; /* xxx: Relax the cpu some way. */
48 }
49
50
51 static void timer_init(void)
52 {
53         struct timer *ts;
54
55         for (ts = ts_table; ts < ts_table_end; ts++) {
56                 if (ts->init && !ts->init()) {
57                         used_ts = ts;
58                         break;
59                 }
60         }
61
62         if (!used_ts) {
63                 printf("No timer available. This should never happen. Expect gPXE to die soon.\n");
64                 /* Panic */
65         }
66
67 }
68
69 struct init_fn ts_init_fn __init_fn ( INIT_NORMAL ) = {
70         .initialise = timer_init,
71 };
72
73 /* Functions for public use. */
74
75 tick_t currticks(void)
76 {
77         tick_t ct;
78         assert(used_ts);
79
80         ct = used_ts->currticks();
81         DBG("currticks: %ld seconds and %06ld microseconds\n", ct/USECS_IN_SEC, ct%USECS_IN_SEC);
82
83         return ct;
84 }
85
86 void udelay(unsigned int usecs)
87 {
88         used_ts->udelay(usecs);
89 }
90
91 void mdelay(unsigned int msecs)
92 {
93         while(msecs--)
94                 used_ts->udelay(USECS_IN_MSEC);
95 }
96
97 unsigned int sleep(unsigned int secs)
98 {
99         while (secs--)
100                 mdelay(MSECS_IN_SEC);
101
102         return 0;
103 }
104