Aren/toaruos
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Merge pull request #115 from Saruta/master

Browse Source 
Improve cmos reading
This commit is contained in:
Kevin Lange 2016-01-27 11:51:47 -08:00
commit f71d3bd0b3
1 changed files with 54 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

68
kernel/devices/cmos.c
View File

@ -18,17 +18,36 @@
* 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(0x70, index);
values[index] = inportb(0x71);
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.
*
@ -43,8 +62,8 @@ get_date(
uint16_t values[128]; /* CMOS dump */
cmos_dump(values);
*month = from_bcd(values[8]);
*day = from_bcd(values[7]);
*month = from_bcd(values[CMOS_MONTH]);
*day = from_bcd(values[CMOS_DAY]);
}
/**
@ -63,9 +82,9 @@ get_time(
uint16_t values[128]; /* CMOS dump */
cmos_dump(values);
*hours = from_bcd(values[4]);
*minutes = from_bcd(values[2]);
*seconds = from_bcd(values[0]);
*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) {
@ -127,16 +146,37 @@ 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[9]) - 1) +
secs_of_month(from_bcd(values[8]) - 1, from_bcd(values[9])) +
(from_bcd(values[7]) - 1) * 86400 +
(from_bcd(values[4])) * 3600 +
(from_bcd(values[2])) * 60 +
from_bcd(values[0]) +
0;
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;
}