From 1935439f863a43986ce386c830f4824d10c4cc18 Mon Sep 17 00:00:00 2001 From: Alexey Zaytsev Date: Sun, 2 Mar 2008 05:19:29 +0300 Subject: fix the rdtsc namimg --- src/arch/i386/drivers/timer_rdtsc.c | 91 ++++++++++++++++++++++++++++++++++++ src/arch/i386/drivers/timer_rtdsc.c | 91 ------------------------------------ src/arch/i386/include/bits/errfile.h | 2 +- src/config.h | 2 +- src/core/config.c | 4 +- 5 files changed, 95 insertions(+), 95 deletions(-) create mode 100644 src/arch/i386/drivers/timer_rdtsc.c delete mode 100644 src/arch/i386/drivers/timer_rtdsc.c (limited to 'src') diff --git a/src/arch/i386/drivers/timer_rdtsc.c b/src/arch/i386/drivers/timer_rdtsc.c new file mode 100644 index 000000000..57b8826c7 --- /dev/null +++ b/src/arch/i386/drivers/timer_rdtsc.c @@ -0,0 +1,91 @@ + +#include +#include +#include +#include +#include +#include +#include + + +#define rdtsc(low,high) \ + __asm__ __volatile__("rdtsc" : "=a" (low), "=d" (high)) + +#define rdtscll(val) \ + __asm__ __volatile__ ("rdtsc" : "=A" (val)) + +static unsigned long long calibrate_tsc(void) +{ + uint32_t startlow, starthigh; + uint32_t endlow, endhigh; + + rdtsc(startlow,starthigh); + i386_timer2_udelay(USECS_IN_MSEC/2); + rdtsc(endlow,endhigh); + + /* 64-bit subtract - gcc just messes up with long longs */ + /* XXX ORLY? Check it. */ + __asm__("subl %2,%0\n\t" + "sbbl %3,%1" + :"=a" (endlow), "=d" (endhigh) + :"g" (startlow), "g" (starthigh), + "0" (endlow), "1" (endhigh)); + + /* Error: ECPUTOOFAST */ + if (endhigh) + goto bad_ctc; + + endlow *= MSECS_IN_SEC*2; + return endlow; + + /* + * The CTC wasn't reliable: we got a hit on the very first read, + * or the CPU was so fast/slow that the quotient wouldn't fit in + * 32 bits.. + */ +bad_ctc: + return 0; +} +static uint32_t clocks_per_second = 0; + +static tick_t rdtsc_currticks(void) +{ + uint32_t clocks_high, clocks_low; + uint32_t currticks; + + /* Read the Time Stamp Counter */ + rdtsc(clocks_low, clocks_high); + + /* currticks = clocks / clocks_per_tick; */ + __asm__("divl %1" + :"=a" (currticks) + :"r" (clocks_per_second/USECS_IN_SEC), "0" (clocks_low), "d" (clocks_high)); + + return currticks; +} + +static int rdtsc_ts_init(void) +{ + + struct cpuinfo_x86 cpu_info; + + get_cpuinfo(&cpu_info); + if (cpu_info.features & X86_FEATURE_TSC) { + clocks_per_second = calibrate_tsc(); + if (clocks_per_second) { + DBG("RDTSC ticksource installed. CPU running at %ld Mhz\n", + clocks_per_second/(1000*1000)); + return 0; + } + } + + DBG("RDTSC ticksource not available on this machine.\n"); + return -ENODEV; +} + +struct timer rdtsc_ts __timer (01) = { + .init = rdtsc_ts_init, + .udelay = generic_currticks_udelay, + .currticks = rdtsc_currticks, +}; + diff --git a/src/arch/i386/drivers/timer_rtdsc.c b/src/arch/i386/drivers/timer_rtdsc.c deleted file mode 100644 index 336e3e6fc..000000000 --- a/src/arch/i386/drivers/timer_rtdsc.c +++ /dev/null @@ -1,91 +0,0 @@ - -#include -#include -#include -#include -#include -#include -#include - - -#define rdtsc(low,high) \ - __asm__ __volatile__("rdtsc" : "=a" (low), "=d" (high)) - -#define rdtscll(val) \ - __asm__ __volatile__ ("rdtsc" : "=A" (val)) - -static unsigned long long calibrate_tsc(void) -{ - uint32_t startlow, starthigh; - uint32_t endlow, endhigh; - - rdtsc(startlow,starthigh); - i386_timer2_udelay(USECS_IN_MSEC/2); - rdtsc(endlow,endhigh); - - /* 64-bit subtract - gcc just messes up with long longs */ - /* XXX ORLY? Check it. */ - __asm__("subl %2,%0\n\t" - "sbbl %3,%1" - :"=a" (endlow), "=d" (endhigh) - :"g" (startlow), "g" (starthigh), - "0" (endlow), "1" (endhigh)); - - /* Error: ECPUTOOFAST */ - if (endhigh) - goto bad_ctc; - - endlow *= MSECS_IN_SEC*2; - return endlow; - - /* - * The CTC wasn't reliable: we got a hit on the very first read, - * or the CPU was so fast/slow that the quotient wouldn't fit in - * 32 bits.. - */ -bad_ctc: - return 0; -} -static uint32_t clocks_per_second = 0; - -static tick_t rtdsc_currticks(void) -{ - uint32_t clocks_high, clocks_low; - uint32_t currticks; - - /* Read the Time Stamp Counter */ - rdtsc(clocks_low, clocks_high); - - /* currticks = clocks / clocks_per_tick; */ - __asm__("divl %1" - :"=a" (currticks) - :"r" (clocks_per_second/USECS_IN_SEC), "0" (clocks_low), "d" (clocks_high)); - - return currticks; -} - -static int rtdsc_ts_init(void) -{ - - struct cpuinfo_x86 cpu_info; - - get_cpuinfo(&cpu_info); - if (cpu_info.features & X86_FEATURE_TSC) { - clocks_per_second = calibrate_tsc(); - if (clocks_per_second) { - DBG("RTDSC Ticksource installed. CPU running at %ld Mhz\n", - clocks_per_second/(1000*1000)); - return 0; - } - } - - DBG("RTDSC timer not available on this machine.\n"); - return -ENODEV; -} - -struct timer rtdsc_ts __timer (01) = { - .init = rtdsc_ts_init, - .udelay = generic_currticks_udelay, - .currticks = rtdsc_currticks, -}; - diff --git a/src/arch/i386/include/bits/errfile.h b/src/arch/i386/include/bits/errfile.h index ce58eefd0..0f1402148 100644 --- a/src/arch/i386/include/bits/errfile.h +++ b/src/arch/i386/include/bits/errfile.h @@ -26,7 +26,7 @@ #define ERRFILE_undionly ( ERRFILE_ARCH | ERRFILE_NET | 0x00030000 ) #define ERRFILE_undirom ( ERRFILE_ARCH | ERRFILE_NET | 0x00040000 ) -#define ERRFILE_timer_rtdsc ( ERRFILE_ARCH | ERRFILE_DRIVER | 0x00000000 ) +#define ERRFILE_timer_rdtsc ( ERRFILE_ARCH | ERRFILE_DRIVER | 0x00000000 ) #define ERRFILE_timer_bios ( ERRFILE_ARCH | ERRFILE_DRIVER | 0x00010000 ) /** @} */ diff --git a/src/config.h b/src/config.h index af0df1b69..4aac654a2 100644 --- a/src/config.h +++ b/src/config.h @@ -24,7 +24,7 @@ #undef CONSOLE_PC_KBD /* Direct access to PC keyboard */ #define TIMER_BIOS -#define TIMER_RTDSC +#define TIMER_RDTSC /* @END general.h */ diff --git a/src/core/config.c b/src/core/config.c index f3e17b62e..94fd0b82c 100644 --- a/src/core/config.c +++ b/src/core/config.c @@ -82,8 +82,8 @@ REQUIRE_OBJECT ( syslog ); REQUIRE_OBJECT ( timer_bios ); #endif -#ifdef TIMER_RTDSC -REQUIRE_OBJECT ( timer_rtdsc ); +#ifdef TIMER_RDTSC +REQUIRE_OBJECT ( timer_rdtsc ); #endif /* * Drag in all requested protocols -- cgit v1.2.3-55-g7522