root / proj / src / rtc.c @ 258
History | View | Annotate | Download (2.74 KB)
| 1 | 234 | up20180655 | #include "rtc.h" |
|---|---|---|---|
| 2 | #include "rtc_macros.h" |
||
| 3 | |||
| 4 | #include <lcom/lcf.h> |
||
| 5 | |||
| 6 | #include "utils.h" |
||
| 7 | #include "errors.h" |
||
| 8 | |||
| 9 | int (subscribe_rtc_interrupt)(uint8_t interrupt_bit, int *interrupt_id) { |
||
| 10 | if (interrupt_id == NULL) return NULL_PTR; |
||
| 11 | *interrupt_id = interrupt_bit; |
||
| 12 | if (sys_irqsetpolicy(KBC_IRQ, IRQ_REENABLE | IRQ_EXCLUSIVE, interrupt_id)) return SBCR_ERROR; |
||
| 13 | return SUCCESS;
|
||
| 14 | } |
||
| 15 | |||
| 16 | int (rtc_read_register)(uint32_t reg, uint8_t *data) {
|
||
| 17 | if (sys_outb(RTC_ADDR_REG, reg)) return WRITE_ERROR; |
||
| 18 | |||
| 19 | if (util_sys_inb(RTC_DATA_REG, data)) return READ_ERROR; |
||
| 20 | |||
| 21 | return SUCCESS;
|
||
| 22 | } |
||
| 23 | |||
| 24 | int (rtc_write_register)(uint32_t reg, uint8_t data) {
|
||
| 25 | if (sys_outb(RTC_ADDR_REG, reg)) return WRITE_ERROR; |
||
| 26 | |||
| 27 | if (sys_outb(RTC_DATA_REG, data)) return WRITE_ERROR; |
||
| 28 | |||
| 29 | return SUCCESS;
|
||
| 30 | } |
||
| 31 | |||
| 32 | int (rtc_check_update)(void) { |
||
| 33 | uint8_t data; |
||
| 34 | int r;
|
||
| 35 | |||
| 36 | if ((r = rtc_read_register(RTC_REG_A, &data))) return r; |
||
| 37 | |||
| 38 | return (data & UIP) != 0; |
||
| 39 | } |
||
| 40 | |||
| 41 | int (rtc_set_updates)(int on) { |
||
| 42 | uint8_t data; |
||
| 43 | int r;
|
||
| 44 | if (on) {
|
||
| 45 | if ((r = rtc_read_register(RTC_REG_B, &data))) return r; |
||
| 46 | |||
| 47 | data &= ~SET; |
||
| 48 | |||
| 49 | if ((r = rtc_write_register(RTC_REG_B, data))) return r; |
||
| 50 | |||
| 51 | } else {
|
||
| 52 | while (rtc_check_update());
|
||
| 53 | |||
| 54 | if ((r = rtc_read_register(RTC_REG_B, &data))) return r; |
||
| 55 | |||
| 56 | data |= SET; |
||
| 57 | |||
| 58 | if ((r = rtc_write_register(RTC_REG_B, data))) return r; |
||
| 59 | } |
||
| 60 | return SUCCESS;
|
||
| 61 | } |
||
| 62 | |||
| 63 | int (rtc_read_time)(uint8_t *time) {
|
||
| 64 | |||
| 65 | int r;
|
||
| 66 | //if ((r = rtc_set_updates(false))) return r;
|
||
| 67 | while (rtc_check_update());
|
||
| 68 | |||
| 69 | uint8_t hour, min, sec; |
||
| 70 | |||
| 71 | if ((r = rtc_read_register(RTC_SEC, &sec))) return r; |
||
| 72 | if ((r = rtc_read_register(RTC_MIN, &min))) return r; |
||
| 73 | if ((r = rtc_read_register(RTC_HOUR, &hour))) return r; |
||
| 74 | |||
| 75 | //if ((r = rtc_set_updates(true))) return r;
|
||
| 76 | |||
| 77 | time[0] = BCD_FIRST(sec)*10 + BCD_SECOND(sec); |
||
| 78 | time[1] = BCD_FIRST(min)*10 + BCD_SECOND(min); |
||
| 79 | time[2] = BCD_FIRST(hour)*10 + BCD_SECOND(hour); |
||
| 80 | |||
| 81 | return SUCCESS;
|
||
| 82 | } |
||
| 83 | |||
| 84 | int (rtc_read_date)(uint8_t *date) {
|
||
| 85 | int r;
|
||
| 86 | //if ((r = rtc_set_updates(false))) return r;
|
||
| 87 | while (rtc_check_update());
|
||
| 88 | |||
| 89 | uint8_t year, month, day, weekday; |
||
| 90 | |||
| 91 | if ((r = rtc_read_register(RTC_WEEK_DAY, &weekday))) return r; |
||
| 92 | if ((r = rtc_read_register(RTC_MONTH_DAY, &day))) return r; |
||
| 93 | if ((r = rtc_read_register(RTC_MONTH, &month))) return r; |
||
| 94 | if ((r = rtc_read_register(RTC_YEAR, &year))) return r; |
||
| 95 | |||
| 96 | //if ((r = rtc_set_updates(true))) return r;
|
||
| 97 | |||
| 98 | date[0] = weekday;
|
||
| 99 | date[1] = BCD_FIRST(day)*10 + BCD_SECOND(day); |
||
| 100 | date[2] = BCD_FIRST(month)*10 + BCD_SECOND(month); |
||
| 101 | date[3] = BCD_FIRST(year)*10 + BCD_SECOND(year); |
||
| 102 | |||
| 103 | return SUCCESS;
|
||
| 104 | } |