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
}