cmos.c

См. документацию.

 
#include "common.h"
#include "io/ports.h"
#include "drv/cmos.h"
 
// FIXME: We need this?
#define CURRENT_YEAR        2022    // Change this each year!
 
int32_t century_register = 0x00;     // Set by ACPI table parsing code if possible
 
unsigned char cmos_second;
unsigned char cmos_minute;
unsigned char cmos_hour;
unsigned char cmos_day;
unsigned char cmos_month;
unsigned short cmos_year;
unsigned char cmos_century;
 
unsigned char last_second;
unsigned char last_minute;
unsigned char last_hour;
unsigned char last_day;
unsigned char last_month;
unsigned char last_year;
unsigned char last_century;
unsigned char registerB;
 
enum {
    cmos_address = 0x70,
    cmos_data    = 0x71
};
 
int32_t get_update_in_progress_flag() {
    outb(cmos_address, 0x0A);
    return (inb(cmos_data) & 0x80);
}
 
unsigned char get_RTC_register(int32_t reg) {
    outb(cmos_address, reg);
    return inb(cmos_data);
}
 
void read_rtc() {
    while (get_update_in_progress_flag());          // Make sure an update isn't in progress
 
    cmos_second = get_RTC_register(0x00);
    cmos_minute = get_RTC_register(0x02);
    cmos_hour = get_RTC_register(0x04);
    cmos_day = get_RTC_register(0x07);
    cmos_month = get_RTC_register(0x08);
    cmos_year = get_RTC_register(0x09);
 
    if(century_register != 0) {
        cmos_century = get_RTC_register(century_register);
    }
 
    do {
        last_second = cmos_second;
        last_minute = cmos_minute;
        last_hour = cmos_hour;
        last_day = cmos_day;
        last_month = cmos_month;
        last_year = cmos_year;
        last_century = cmos_century;
 
        while (get_update_in_progress_flag());       // Make sure an update isn't in progress
 
        cmos_second = get_RTC_register(0x00);
        cmos_minute = get_RTC_register(0x02);
        cmos_hour = get_RTC_register(0x04);
        cmos_day = get_RTC_register(0x07);
        cmos_month = get_RTC_register(0x08);
        cmos_year = get_RTC_register(0x09);
        if(century_register != 0) {
            cmos_century = get_RTC_register(century_register);
        }
    } while( (last_second != cmos_second) || (last_minute != cmos_minute) || (last_hour != cmos_hour) ||
           (last_day != cmos_day) || (last_month != cmos_month) || (last_year != cmos_year) ||
           (last_century != cmos_century) );
 
    registerB = get_RTC_register(0x0B);
 
    // Convert BCD to binary values if necessary
 
    if (!(registerB & 0x04)) {
        cmos_second = (cmos_second & 0x0F) + ((cmos_second / 16) * 10);
        cmos_minute = (cmos_minute & 0x0F) + ((cmos_minute / 16) * 10);
        cmos_hour = ( (cmos_hour & 0x0F) + (((cmos_hour & 0x70) / 16) * 10) ) | (cmos_hour & 0x80);
        cmos_day = (cmos_day & 0x0F) + ((cmos_day / 16) * 10);
        cmos_month = (cmos_month & 0x0F) + ((cmos_month / 16) * 10);
        cmos_year = (cmos_year & 0x0F) + ((cmos_year / 16) * 10);
        if(century_register != 0) {
            cmos_century = (cmos_century & 0x0F) + ((cmos_century / 16) * 10);
        }
    }
 
    // Convert 12-hour clock to 24-hour clock if necessary
 
    if (!(registerB & 0x02) && (cmos_hour & 0x80)) {
        cmos_hour = ((cmos_hour & 0x7F) + 12) % 24;
    }
 
    // Calculate the full (4-digit) year
 
    if(century_register != 0) {
        cmos_year += cmos_century * 100;
    } else {
        cmos_year += (CURRENT_YEAR / 100) * 100;
        if(cmos_year < CURRENT_YEAR) cmos_year += 100;
    }
}
 
int isleap(int year) {
    return year % 4 == 0 && (year % 100 != 0 || year % 400 == 0);
}
 
sayori_time_t get_time() {
    read_rtc();
    struct sayori_time time = {
        cmos_second, cmos_minute, cmos_hour, cmos_day, cmos_month, cmos_year, cmos_century
    };
    return time;
}