c5c7128a02
git-svn-id: https://svn.code.sf.net/p/freedos/svn/kernel/trunk@623 6ac86273-5f31-0410-b378-82cca8765d1b
102 lines
3.5 KiB
C
102 lines
3.5 KiB
C
/****************************************************************/
|
|
/* */
|
|
/* initclk.c */
|
|
/* */
|
|
/* System Clock Driver - initialization */
|
|
/* */
|
|
/* Copyright (c) 1995 */
|
|
/* Pasquale J. Villani */
|
|
/* All Rights Reserved */
|
|
/* */
|
|
/* This file is part of DOS-C. */
|
|
/* */
|
|
/* DOS-C is free software; you can redistribute it and/or */
|
|
/* modify it under the terms of the GNU General Public License */
|
|
/* as published by the Free Software Foundation; either version */
|
|
/* 2, or (at your option) any later version. */
|
|
/* */
|
|
/* DOS-C is distributed in the hope that it will be useful, but */
|
|
/* WITHOUT ANY WARRANTY; without even the implied warranty of */
|
|
/* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See */
|
|
/* the GNU General Public License for more details. */
|
|
/* */
|
|
/* You should have received a copy of the GNU General Public */
|
|
/* License along with DOS-C; see the file COPYING. If not, */
|
|
/* write to the Free Software Foundation, 675 Mass Ave, */
|
|
/* Cambridge, MA 02139, USA. */
|
|
/****************************************************************/
|
|
|
|
#include "portab.h"
|
|
#include "init-mod.h"
|
|
|
|
#ifdef VERSION_STRINGS
|
|
static char *RcsId =
|
|
"$Id$";
|
|
#endif
|
|
|
|
/* */
|
|
/* WARNING - THIS DRIVER IS NON-PORTABLE!!!! */
|
|
/* */
|
|
|
|
STATIC int InitByteToBcd(int x)
|
|
{
|
|
return ((x / 10) << 4) | (x % 10);
|
|
}
|
|
|
|
STATIC int InitBcdToByte(int x)
|
|
{
|
|
return ((x >> 4) & 0xf) * 10 + (x & 0xf);
|
|
}
|
|
|
|
STATIC void InitDayToBcd(BYTE * x, unsigned mon, unsigned day, unsigned yr)
|
|
{
|
|
x[1] = InitByteToBcd(mon);
|
|
x[0] = InitByteToBcd(day);
|
|
x[3] = InitByteToBcd(yr / 100);
|
|
x[2] = InitByteToBcd(yr % 100);
|
|
}
|
|
|
|
void Init_clk_driver(void)
|
|
{
|
|
iregs regsT, regsD, dosregs;
|
|
|
|
regsT.a.b.h = 0x02;
|
|
regsT.d.x = regsT.c.x = 0;
|
|
regsT.flags = 0;
|
|
init_call_intr(0x1a, ®sT);
|
|
|
|
if ((regsT.flags & 0x0001) || (regsT.c.x == 0 && regsT.d.x == 0))
|
|
{
|
|
goto error; /* error */
|
|
}
|
|
|
|
regsD.a.b.h = 0x04;
|
|
regsD.d.x = regsD.c.x = 0;
|
|
regsD.flags = 0;
|
|
init_call_intr(0x1a, ®sD);
|
|
|
|
if ((regsD.flags & 0x0001) || regsD.c.x == 0 || regsD.d.x == 0)
|
|
{
|
|
goto error;
|
|
}
|
|
|
|
/* DosSetDate */
|
|
dosregs.a.b.h = 0x2b;
|
|
dosregs.c.x = 100 * InitBcdToByte(regsD.c.b.h) +
|
|
InitBcdToByte(regsD.c.b.l);
|
|
dosregs.d.b.h = InitBcdToByte(regsD.d.b.h); /* month */
|
|
dosregs.d.b.l = InitBcdToByte(regsD.d.b.l); /* day */
|
|
init_call_intr(0x21, &dosregs);
|
|
|
|
/* DosSetTime */
|
|
dosregs.a.b.h = 0x2d;
|
|
dosregs.c.b.l = InitBcdToByte(regsT.c.b.l); /* minutes */
|
|
dosregs.c.b.h = InitBcdToByte(regsT.c.b.h); /* hours */
|
|
dosregs.d.b.h = InitBcdToByte(regsT.d.b.h); /*seconds */
|
|
dosregs.d.b.l = 0;
|
|
init_call_intr(0x21, &dosregs);
|
|
|
|
error:;
|
|
|
|
}
|