--- qemu/roms/seabios/src/clock.c 2018/04/24 17:51:54 1.1.1.2 +++ qemu/roms/seabios/src/clock.c 2018/04/24 18:27:21 1.1.1.3 @@ -12,7 +12,7 @@ #include "pic.h" // eoi_pic1 #include "bregs.h" // struct bregs #include "biosvar.h" // GET_GLOBAL -#include "usb-hid.h" // usb_check_key +#include "usb-hid.h" // usb_check_event // RTC register flags #define RTC_A_UIP 0x80 @@ -54,9 +54,6 @@ * TSC timer ****************************************************************/ -#define PIT_TICK_RATE 1193180 // Underlying HZ of PIT -#define PIT_TICK_INTERVAL 65536 // Default interval for 18.2Hz timer -#define TICKS_PER_DAY (u32)((u64)60*60*24*PIT_TICK_RATE / PIT_TICK_INTERVAL) #define CALIBRATE_COUNT 0x800 // Approx 1.7ms u32 cpu_khz VAR16VISIBLE; @@ -97,7 +94,7 @@ tscdelay(u64 diff) { u64 start = rdtscll(); u64 end = start + diff; - while (!check_time(end)) + while (!check_tsc(end)) cpu_relax(); } @@ -106,7 +103,7 @@ tscsleep(u64 diff) { u64 start = rdtscll(); u64 end = start + diff; - while (!check_time(end)) + while (!check_tsc(end)) yield(); } @@ -158,18 +155,19 @@ rtc_updating(void) // to 0, and will return 0 if such a transition occurs. A -1 // is returned only after timing out. The maximum period // that this bit should be set is constrained to (1984+244) - // useconds, so we wait for 3 msec max. + // useconds, but we wait for longer just to be sure. if ((inb_cmos(CMOS_STATUS_A) & RTC_A_UIP) == 0) return 0; - u64 end = calc_future_tsc(3); - do { + u64 end = calc_future_tsc(15); + for (;;) { if ((inb_cmos(CMOS_STATUS_A) & RTC_A_UIP) == 0) return 0; - } while (!check_time(end)); - - // update-in-progress never transitioned to 0 - return -1; + if (check_tsc(end)) + // update-in-progress never transitioned to 0 + return -1; + yield(); + } } static void @@ -224,10 +222,40 @@ timer_setup(void) * Standard clock functions ****************************************************************/ +#define TICKS_PER_DAY (u32)((u64)60*60*24*PIT_TICK_RATE / PIT_TICK_INTERVAL) + +// Calculate the timer value at 'count' number of full timer ticks in +// the future. +u32 +calc_future_timer_ticks(u32 count) +{ + return (GET_BDA(timer_counter) + count + 1) % TICKS_PER_DAY; +} + +// Return the timer value that is 'msecs' time in the future. +u32 +calc_future_timer(u32 msecs) +{ + if (!msecs) + return GET_BDA(timer_counter); + u32 kticks = DIV_ROUND_UP((u64)(msecs * PIT_TICK_RATE), PIT_TICK_INTERVAL); + u32 ticks = DIV_ROUND_UP(kticks, 1000); + return calc_future_timer_ticks(ticks); +} + +// Check if the given timer value has passed. +int +check_timer(u32 end) +{ + return (((GET_BDA(timer_counter) + TICKS_PER_DAY - end) % TICKS_PER_DAY) + < (TICKS_PER_DAY/2)); +} + // get current clock count static void handle_1a00(struct bregs *regs) { + yield(); u32 ticks = GET_BDA(timer_counter); regs->cx = ticks >> 16; regs->dx = ticks; @@ -452,7 +480,7 @@ handle_08(void) SET_BDA(timer_counter, counter); - usb_check_key(); + usb_check_event(); // chain to user timer tick INT #0x1c u32 eax=0, flags;