--- qemu/roms/seabios/src/clock.c 2018/04/24 17:36:47 1.1 +++ qemu/roms/seabios/src/clock.c 2018/04/24 18:36:38 1.1.1.4 @@ -1,6 +1,6 @@ // 16bit code to handle system clocks. // -// Copyright (C) 2008 Kevin O'Connor +// Copyright (C) 2008-2010 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. @@ -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,15 +54,12 @@ * 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; static void -calibrate_tsc() +calibrate_tsc(void) { // Setup "timer2" u8 orig = inb(PORT_PS2_CTRLB); @@ -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(); } @@ -150,7 +147,7 @@ calc_future_tsc_usec(u32 usecs) ****************************************************************/ static int -rtc_updating() +rtc_updating(void) { // This function checks to see if the update-in-progress bit // is set in CMOS Status Register A. If not, it returns 0. @@ -158,22 +155,23 @@ rtc_updating() // 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 -pit_setup() +pit_setup(void) { // timer0: binary count, 16bit count, mode 2 outb(PM_SEL_TIMER0|PM_ACCESS_WORD|PM_MODE2|PM_CNT_BINARY, PORT_PIT_MODE); @@ -183,7 +181,7 @@ pit_setup() } static void -init_rtc() +init_rtc(void) { outb_cmos(0x26, CMOS_STATUS_A); // 32,768Khz src, 976.5625us updates u8 regB = inb_cmos(CMOS_STATUS_B); @@ -199,7 +197,7 @@ bcd2bin(u8 val) } void -timer_setup() +timer_setup(void) { dprintf(3, "init timer\n"); calibrate_tsc(); @@ -215,8 +213,8 @@ timer_setup() SET_BDA(timer_counter, ticks); SET_BDA(timer_rollover, 0); - enable_hwirq(0, entry_08); - enable_hwirq(8, entry_70); + enable_hwirq(0, FUNC16(entry_08)); + enable_hwirq(8, FUNC16(entry_70)); } @@ -224,10 +222,40 @@ timer_setup() * 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; @@ -435,7 +463,7 @@ handle_1a(struct bregs *regs) // INT 08h System Timer ISR Entry Point void VISIBLE16 -handle_08() +handle_08(void) { debug_isr(DEBUG_ISR_08); @@ -452,7 +480,7 @@ handle_08() SET_BDA(timer_counter, counter); - usb_check_key(); + usb_check_event(); // chain to user timer tick INT #0x1c u32 eax=0, flags; @@ -467,7 +495,7 @@ handle_08() ****************************************************************/ void -useRTC() +useRTC(void) { u16 ebda_seg = get_ebda_seg(); int count = GET_EBDA2(ebda_seg, RTCusers); @@ -480,7 +508,7 @@ useRTC() } void -releaseRTC() +releaseRTC(void) { u16 ebda_seg = get_ebda_seg(); int count = GET_EBDA2(ebda_seg, RTCusers); @@ -507,7 +535,7 @@ set_usertimer(u32 usecs, u16 seg, u16 of } static void -clear_usertimer() +clear_usertimer(void) { if (!(GET_BDA(rtc_wait_flag) & RWS_WAIT_PENDING)) return; @@ -576,7 +604,7 @@ handle_1583(struct bregs *regs) // int70h: IRQ8 - CMOS RTC void VISIBLE16 -handle_70() +handle_70(void) { debug_isr(DEBUG_ISR_70);