2 * This file is part of the libpayload project.
4 * Copyright (C) 2008 Advanced Micro Devices, Inc.
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 #include <libpayload.h>
32 #include <arch/rdtsc.h>
42 #define TICKS_PER_SEC (cpu_khz * 1000)
43 #define TICKS_PER_USEC (cpu_khz / 1000)
45 static void update_clock(void)
47 u64 delta = rdtsc() - clock.ticks;
52 secs = (int) (delta / TICKS_PER_SEC);
54 delta -= (secs * TICKS_PER_SEC);
55 clock.usecs += (int) (delta / TICKS_PER_USEC);
57 if (clock.usecs > 1000000) {
58 clock.usecs -= 1000000;
65 static unsigned int day_of_year(int mon, int day, int year)
67 static u8 mdays[12] = { 31, 28, 31, 30, 31, 30,
68 31, 31, 30, 31, 30, 31 };
72 for(i = 0; i < mon; i++) {
75 if (i == 1 && (year % 4))
82 static void gettimeofday_init(void)
88 clock.ticks = rdtsc();
90 /* Calculate the number of days in the year so far */
91 days = day_of_year(tm.tm_mon, tm.tm_mday, tm.tm_year + 1900);
93 delta = tm.tm_year - 70;
95 days += (delta * 365);
97 /* Figure leap years */
100 days += (delta - 2) / 4;
102 clock.secs = (days * 86400) + (tm.tm_hour * 3600) +
103 (tm.tm_min * 60) + tm.tm_sec;
106 static void gettimeofday_init(void)
108 /* Record the number of ticks */
109 clock.ticks = rdtsc();
113 int gettimeofday(struct timeval *tv, void *tz)
115 /* Call the gtod init when we need it - this keeps
116 the code from being included in the binary if we don't
125 tv->tv_sec = clock.secs;
126 tv->tv_usec = clock.usecs;