toaruos/kernel/devices/cmos.c

195 lines
3.8 KiB
C

/* vim: tabstop=4 shiftwidth=4 noexpandtab
* This file is part of ToaruOS and is released under the terms
* of the NCSA / University of Illinois License - see LICENSE.md
* Copyright (C) 2011-2018 K. Lange
*
* CMOS Driver
*
*/
#include <kernel/system.h>
/* CMOS values are stored like so:
* Say it's 8:42 AM, then the values are stored as:
* 0x08, 0x42... why this was a good idea, I have no
* clue, but that's how it usually is.
*
* This function will convert between this "BCD" format
* and regular decimal integers. */
#define from_bcd(val) ((val / 16) * 10 + (val & 0xf))
#define CMOS_ADDRESS 0x70
#define CMOS_DATA 0x71
enum
{
CMOS_SECOND = 0,
CMOS_MINUTE = 2,
CMOS_HOUR = 4,
CMOS_DAY = 7,
CMOS_MONTH = 8,
CMOS_YEAR = 9
};
void
cmos_dump(
uint16_t * values
) {
uint16_t index;
for (index = 0; index < 128; ++index) {
outportb(CMOS_ADDRESS, index);
values[index] = inportb(CMOS_DATA);
}
}
int is_update_in_progress(void)
{
outportb(CMOS_ADDRESS, 0x0a);
return inportb(CMOS_DATA) & 0x80;
}
/**
* Get the current month and day.
*
* @param month Pointer to a short to store the month
* @param day Pointer to a short to store the day
*/
void
get_date(
uint16_t * month,
uint16_t * day
) {
uint16_t values[128]; /* CMOS dump */
cmos_dump(values);
*month = from_bcd(values[CMOS_MONTH]);
*day = from_bcd(values[CMOS_DAY]);
}
/**
* Get the current time.
*
* @param hours Pointer to a short to store the current hour (/24)
* @param minutes Pointer to a short to store the current minute
* @param seconds Pointer to a short to store the current second
*/
void
get_time(
uint16_t * hours,
uint16_t * minutes,
uint16_t * seconds
) {
uint16_t values[128]; /* CMOS dump */
cmos_dump(values);
*hours = from_bcd(values[CMOS_HOUR]);
*minutes = from_bcd(values[CMOS_MINUTE]);
*seconds = from_bcd(values[CMOS_SECOND]);
}
uint32_t secs_of_years(int years) {
uint32_t days = 0;
years += 2000;
while (years > 1969) {
days += 365;
if (years % 4 == 0) {
if (years % 100 == 0) {
if (years % 400 == 0) {
days++;
}
} else {
days++;
}
}
years--;
}
return days * 86400;
}
uint32_t secs_of_month(int months, int year) {
year += 2000;
uint32_t days = 0;
switch(months) {
case 11:
days += 30;
case 10:
days += 31;
case 9:
days += 30;
case 8:
days += 31;
case 7:
days += 31;
case 6:
days += 30;
case 5:
days += 31;
case 4:
days += 30;
case 3:
days += 31;
case 2:
days += 28;
if ((year % 4 == 0) && ((year % 100 != 0) || (year % 400 == 0))) {
days++;
}
case 1:
days += 31;
default:
break;
}
return days * 86400;
}
uint32_t boot_time = 0;
uint32_t read_cmos(void) {
uint16_t values[128];
uint16_t old_values[128];
while (is_update_in_progress())
;
cmos_dump(values);
do
{
memcpy(old_values, values, 128);
while (is_update_in_progress())
;
cmos_dump(values);
} while ((old_values[CMOS_SECOND] != values[CMOS_SECOND]) ||
(old_values[CMOS_MINUTE] != values[CMOS_MINUTE]) ||
(old_values[CMOS_HOUR] != values[CMOS_HOUR]) ||
(old_values[CMOS_DAY] != values[CMOS_DAY]) ||
(old_values[CMOS_MONTH] != values[CMOS_MONTH]) ||
(old_values[CMOS_YEAR] != values[CMOS_YEAR]));
/* Math Time */
uint32_t time =
secs_of_years(from_bcd(values[CMOS_YEAR]) - 1) +
secs_of_month(from_bcd(values[CMOS_MONTH]) - 1,
from_bcd(values[CMOS_YEAR])) +
(from_bcd(values[CMOS_DAY]) - 1) * 86400 +
(from_bcd(values[CMOS_HOUR])) * 3600 +
(from_bcd(values[CMOS_MINUTE])) * 60 +
from_bcd(values[CMOS_SECOND]) + 0;
return time;
}
int gettimeofday(struct timeval * t, void *z) {
t->tv_sec = boot_time + timer_ticks + timer_drift;
t->tv_usec = timer_subticks * 1000;
return 0;
}
uint32_t now(void) {
struct timeval t;
gettimeofday(&t, NULL);
return t.tv_sec;
}