rtc.c 1.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071
  1. /* RTC (CMOS) date/time read. */
  2. #include "rtc.h"
  3. #define CMOS_ADDR 0x70
  4. #define CMOS_DATA 0x71
  5. static inline unsigned char cmos_read(unsigned char reg)
  6. {
  7. unsigned char v;
  8. /* Bit 7 on 0x70 disables NMI during access. */
  9. __asm__ volatile ("outb %b1, %w0" : : "Nd"(CMOS_ADDR), "a"((unsigned char)(reg | 0x80)));
  10. __asm__ volatile ("inb %w1, %0" : "=a"(v) : "Nd"(CMOS_DATA));
  11. return v;
  12. }
  13. static unsigned int bcd_to_bin(unsigned char bcd)
  14. {
  15. return (unsigned int)((bcd >> 4) * 10 + (bcd & 0x0F));
  16. }
  17. void rtc_read_datetime(char *buf)
  18. {
  19. unsigned char sec, min, hour, day, month, year;
  20. unsigned int s, m, h, d, mo, y;
  21. /* Wait for RTC update to finish. Timeout to avoid hang. */
  22. {
  23. unsigned int n = 0;
  24. while ((cmos_read(0x0A) & 0x80) && ++n < 10000)
  25. ;
  26. }
  27. sec = cmos_read(0x00);
  28. min = cmos_read(0x02);
  29. hour = cmos_read(0x04);
  30. day = cmos_read(0x07);
  31. month = cmos_read(0x08);
  32. year = cmos_read(0x09);
  33. s = bcd_to_bin(sec);
  34. m = bcd_to_bin(min);
  35. h = bcd_to_bin(hour);
  36. d = bcd_to_bin(day);
  37. mo = bcd_to_bin(month);
  38. y = bcd_to_bin(year);
  39. y += 2000;
  40. if (y < 2000)
  41. y += 100;
  42. buf[0] = (char)('0' + (y / 1000));
  43. buf[1] = (char)('0' + ((y / 100) % 10));
  44. buf[2] = (char)('0' + ((y / 10) % 10));
  45. buf[3] = (char)('0' + (y % 10));
  46. buf[4] = '-';
  47. buf[5] = (char)('0' + (mo / 10));
  48. buf[6] = (char)('0' + (mo % 10));
  49. buf[7] = '-';
  50. buf[8] = (char)('0' + (d / 10));
  51. buf[9] = (char)('0' + (d % 10));
  52. buf[10] = ' ';
  53. buf[11] = (char)('0' + (h / 10));
  54. buf[12] = (char)('0' + (h % 10));
  55. buf[13] = ':';
  56. buf[14] = (char)('0' + (m / 10));
  57. buf[15] = (char)('0' + (m % 10));
  58. buf[16] = ':';
  59. buf[17] = (char)('0' + (s / 10));
  60. buf[18] = (char)('0' + (s % 10));
  61. buf[19] = '\0';
  62. }