ZealOS/src/Kernel/KDate.CC

//See $LK,"::/Doc/TimeDate.DD"$

U16 month_start_days[12]		= {0, 31, 59, 90, 120, 151, 181, 212, 243, 273, 304, 334};
U16 month_start_days_leap[12]	= {0, 31, 60, 91, 121, 152, 182, 213, 244, 274, 305, 335};

I64 YearStartDate(I64 year)
{//32-bit day since AD 0, given year number.
	I64 y1 = year - 1, yd4000 = y1 / 4000, yd400 = y1 / 400, yd100 = y1 / 100, yd4 = y1 / 4;

	return year * 365 + yd4 - yd100 + yd400 - yd4000;
}

CDate Struct2Date(CDateStruct *_ds)
{//Convert CDateStruct to CDate.
	CDate cdt;
	I64   i1, i2;

	i1 = YearStartDate(_ds->year);
	i2 = YearStartDate(_ds->year + 1);
	if (i2 - i1 == 365)
		i1 += month_start_days[_ds->mon - 1];
	else
		i1 += month_start_days_leap[_ds->mon - 1];
	cdt.date = i1 + _ds->day_of_mon - 1;
	cdt.time = (_ds->sec10000 + 100 * (_ds->sec100 + 100 * (_ds->sec + 60 * (_ds->min + 60 * _ds->hour))))
				<< 21 / (15 * 15 * 3 * 625);
	return cdt;
}

I64 DayOfWeek(I64 i)
{//Day of week, given 32-bit day since AD 0.
	i += CDATE_BASE_DAY_OF_WEEK;
	if (i >= 0)
		return i % 7;
	else
		return 6 - (6 - i) % 7;
}

U0 Date2Struct(CDateStruct *_ds, CDate cdt)
{//Convert CDate to CDateStruct.
	I64 i, k, date = cdt.date;

	_ds->day_of_week = DayOfWeek(date);
	_ds->year = (date + 1) * 100000 / CDATE_YEAR_DAYS_INT;
	i = YearStartDate(_ds->year);

	while (i > date)
	{
		_ds->year--;
		i = YearStartDate(_ds->year);
	}
	date -= i;
	if (YearStartDate(_ds->year + 1) - i == 365)
	{
		k = 0;
		while (date >= month_start_days[k + 1] && k < 11)
			k++;
		date -= month_start_days[k];
	}
	else
	{
		k = 0;
		while (date >= month_start_days_leap[k + 1] && k < 11)
			k++;
		date -= month_start_days_leap[k];
	}
	_ds->mon = k + 1;
	_ds->day_of_mon = date + 1;
	k = (625 * 15 * 15 * 3 * cdt.time) >> 21 + 1;
	_ds->sec10000	= ModU64(&k, 100);
	_ds->sec100		= ModU64(&k, 100);
	_ds->sec		= ModU64(&k, 60);
	_ds->min		= ModU64(&k, 60);
	_ds->hour		= k;
}

I64 FirstDayOfMon(I64 i)
{//First day of month, given 32-bit day since AD 0.
	CDateStruct	ds;
	CDate		cdt = 0;

	cdt.date = i;
	Date2Struct(&ds, cdt);
	ds.day_of_mon = 1;
	cdt = Struct2Date(&ds);
	return cdt.date;
}

I64 LastDayOfMon(I64 i)
{//Last day of month, given 32-bit day since AD 0.
	CDateStruct	ds;
	CDate		cdt = 0;

	cdt.date = i;
	Date2Struct(&ds, cdt);
	ds.mon++;
	if (ds.mon == 13)
	{
		ds.mon = 0;
		ds.year++;
	}
	ds.day_of_mon = 1;
	cdt = Struct2Date(&ds);
	return cdt.date - 1;
}

I64 FirstDayOfYear(I64 i)
{//First day of year, given 32-bit day since AD 0.
	CDateStruct	ds;
	CDate		cdt = 0;

	cdt.date = i;
	Date2Struct(&ds, cdt);
	ds.day_of_mon = 1;
	ds.mon = 1;
	cdt = Struct2Date(&ds);
	return cdt.date;
}

I64 LastDayOfYear(I64 i)
{//Last day of year, given 32-bit day since AD 0.
	CDateStruct	ds;
	CDate		cdt = 0;

	cdt.date = i;
	Date2Struct(&ds, cdt);
	ds.day_of_mon = 1;
	ds.mon = 1;
	ds.year++;
	cdt = Struct2Date(&ds);
	return cdt.date - 1;
}

U8 CMOSRegRead(I64 register)
{//Read val from CMOS register. See $LK,"CMOS Registers",A="MN:CMOSR_SEC"$.
	OutU8(CMOS_SEL, register);
	return InU8(CMOS_DATA);
}

U0 CMOSRegWrite(I64 register, I64 val)
{//Write val to CMOS register. See $LK,"CMOS Registers",A="MN:CMOSR_SEC"$.
	OutU8(CMOS_SEL, register);
	OutU8(CMOS_DATA, val);
}

Bool CMOSIsBcd()
{//Check of CMOS is in binary-coded decimal mode.
// Ex: 15:32:44 == 0x15:0x32:0x44 (not good). We use $LK,"Bcd2Binary",A="MN:Bcd2Binary"$() to convert.
	return !(CMOSRegRead(CMOSR_STATUS_B) & CMOSF_BINARY);
}

I64 Bcd2Binary(U64 b)
{
	I64 i, res = 0;
	for (i = 0; i < 16; i++)
	{
		res = res * 10 + b >> 60;
		b <<= 4;
	}
	return res;
}

U0 NowDateTimeStruct(CDateStruct *_ds)
{
	I64 i;
	U8 *b = _ds;

	MemSet(_ds, 0, sizeof(CDateStruct));
	PUSHFD
	CLI
	while (LBts(&sys_semas[SEMA_SYS_DATE], 0))
		PAUSE

	do
	{
		while (CMOSRegRead(CMOSR_STATUS_A) & CMOSF_UPDATING)
			PAUSE

		b[2] = CMOSRegRead(CMOSR_SEC);
		b[3] = CMOSRegRead(CMOSR_MIN);
		b[4] = CMOSRegRead(CMOSR_HOUR);
		b[5] = CMOSRegRead(CMOSR_DAY_OF_WEEK);
		b[6] = CMOSRegRead(CMOSR_DAY_OF_MONTH);
		b[7] = CMOSRegRead(CMOSR_MONTH);
		b[8] = CMOSRegRead(CMOSR_YEAR);

	}
	while (CMOSRegRead(CMOSR_STATUS_A) & CMOSF_UPDATING);

	LBtr(&sys_semas[SEMA_SYS_DATE], 0);
	POPFD
	if (CMOSIsBcd)
		for (i = 2; i < 9; i++)
			b[i] = Bcd2Binary(b[i]);

	if (_ds->year > 255)		_ds->year = 255;
	_ds->year += 2000;

	if (_ds->mon > 12)			_ds->mon			= 12;
	if (_ds->day_of_mon > 31)	_ds->day_of_mon		= 31;
	if (_ds->day_of_week > 6)	_ds->day_of_week	= 6;
	if (_ds->hour > 23) 		_ds->hour			= 23;
	if (_ds->min > 59)			_ds->min			= 59;
	if (_ds->sec > 59)			_ds->sec			= 59;
}

CDate Now()
{//Current datetime.
	CDateStruct ds;

	NowDateTimeStruct(&ds);
	return Struct2Date(&ds)-local_time_offset;
}

U0 TimeSet(CDateStruct *ds)
{//Set CMOS time from user crafted $LK,"CDateStruct",A="MN:CDateStruct"$.
//$BK,1$Make sure to use hex as decimals if BCD mode.$BK,0$ Check using $LK,"CMOSIsBcd",A="MN:CMOSIsBcd"$().
//Ex: if bcd mode and we want 12/30, 10:45:15 -- 0x12/0x30, 0x10:0x45:0x15.
//Pass year as double digit number (obviously 20XX is too big for a U8).
	U8 *b = ds;

	PUSHFD
	CLI
	while (LBts(&sys_semas[SEMA_SYS_DATE], 0))
		PAUSE

	while (CMOSRegRead(CMOSR_STATUS_A) & CMOSF_UPDATING)
		PAUSE

	CMOSRegWrite(CMOSR_SEC,				b[2]);
	CMOSRegWrite(CMOSR_MIN,				b[3]);
	CMOSRegWrite(CMOSR_HOUR,			b[4]);
	CMOSRegWrite(CMOSR_DAY_OF_WEEK,		b[5]);
	CMOSRegWrite(CMOSR_DAY_OF_MONTH,	b[6]);
	CMOSRegWrite(CMOSR_MONTH,			b[7]);
	CMOSRegWrite(CMOSR_YEAR,			b[8]);

	LBtr(&sys_semas[SEMA_SYS_DATE], 0);
	POPFD
}