freebsd-nq/usr.bin/doscmd/timer.c
Thomas Gellekum f7448f4297 Move update of BIOS variable at 0x6c (time counter) completely to timer.c.
Suggested by:	Igor Serikov <bt@turtle.pangeatech.com>
2001-08-14 11:54:37 +00:00

68 lines
1.4 KiB
C

/*
** No copyright?!
**
** $FreeBSD$
*/
#include "doscmd.h"
static void
int08(regcontext_t *REGS)
{
*(u_long *)&BIOSDATA[0x6c] += 1; /* ticks since midnight */
while (*(u_long *)&BIOSDATA[0x6c] >= 24*60*6*182) {
*(u_long *)&BIOSDATA[0x6c] -= 24*60*6*182;
BIOSDATA[0x70]++; /* # times past mn */
}
softint(0x1c);
}
static void
int1c(regcontext_t *REGS)
{
}
unsigned char timer;
static u_char
inb_timer(int port)
{
return (--timer);
}
void
timer_init(void)
{
u_long vec;
struct itimerval itv;
struct timeval tv;
time_t tv_sec;
struct timezone tz;
struct tm tm;
vec = insert_hardint_trampoline();
ivec[0x08] = vec;
register_callback(vec, int08, "int 08");
vec = insert_softint_trampoline();
ivec[0x1c] = vec;
register_callback(vec, int1c, "int 1c");
define_input_port_handler(0x42, inb_timer);
define_input_port_handler(0x40, inb_timer);
/* Initialize time counter BIOS variable. */
gettimeofday(&tv, &tz);
tv_sec = tv.tv_sec;
tm = *localtime(&tv_sec);
*(u_long *)&BIOSDATA[0x6c] =
(((tm.tm_hour * 60 + tm.tm_min) * 60) + tm.tm_sec) * 182 / 10;
itv.it_interval.tv_sec = 0;
itv.it_interval.tv_usec = 54925; /* 1193182/65536 times per second */
itv.it_value.tv_sec = 0;
itv.it_value.tv_usec = 54925; /* 1193182/65536 times per second */
if (! timer_disable)
setitimer(ITIMER_REAL, &itv, 0);
}