Changeset a8a0d43 in mainline for uspace/drv/time/cmos-rtc/cmos-rtc.c

Timestamp:

2012-04-14T18:08:21Z (12 years ago)

Author:

Maurizio Lombardi <m.lombardi85@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

80d3f846

Parents:

cf72943

Message:

rtc: inhibit updates, write the cmos registers and then restore normal working conditions

File:

• uspace/drv/time/cmos-rtc/cmos-rtc.c (modified) (6 diffs)

uspace/drv/time/cmos-rtc/cmos-rtc.c

@@ -91 +91 @@
 static int rtc_dev_remove(ddf_dev_t *dev);
 static int rtc_tm_sanity_check(struct tm *t);
+static void rtc_register_write(rtc_t *rtc, int reg, int data);
 
 
@@ -247 +248 @@
 }
 
-/* XXX */
-#if 0
 /** Write a register to the CMOS memory
  *
@@ -261 +260 @@
         pio_write_8(rtc->port + 1, data);
 }
-
-#endif
-
-/* XXX */
 
 /** Check if an update is in progress
@@ -373 +368 @@
 rtc_time_set(ddf_fun_t *fun, struct tm *t)
 {
-        int rc;
+        int  rc;
         bool bcd_mode;
+        int  reg_b;
+        int  reg_a;
         rtc_t *rtc = RTC_FROM_FNODE(fun);
 
@@ -381 +378 @@
                 return rc;
 
-        t->tm_mon++; /* Must start from 1, not from 0 */
+        t->tm_mon++; /* counts from 1, not from 0 */
 
         fibril_mutex_lock(&rtc->mutex);
 
+        reg_b = rtc_register_read(rtc, RTC_STATUS_B);
+
         /* Check if the rtc is working in bcd mode */
-        bcd_mode = !(rtc_register_read(rtc, RTC_STATUS_B) & RTC_MASK_BCD);
+        bcd_mode = !(reg_b & RTC_MASK_BCD);
         if (bcd_mode) {
                 /* Convert the tm struct fields in BCD mode */
@@ -397 +396 @@
         }
 
-        /* XXX Inhibit updates */
+        /* Inhibit updates */
+        rtc_register_write(rtc, RTC_STATUS_B, reg_b | RTC_MASK_INH);
+
+        /* Write current time to RTC */
+        rtc_register_write(rtc, RTC_SEC, t->tm_sec);
+        rtc_register_write(rtc, RTC_MIN, t->tm_min);
+        rtc_register_write(rtc, RTC_HOUR, t->tm_hour);
+        rtc_register_write(rtc, RTC_DAY, t->tm_mday);
+        rtc_register_write(rtc, RTC_MON, t->tm_mon);
+        rtc_register_write(rtc, RTC_YEAR, t->tm_year);
+
+        /* Stop the clock */
+        reg_a = rtc_register_read(rtc, RTC_STATUS_A);
+        rtc_register_write(rtc, RTC_STATUS_A, RTC_MASK_CLK_STOP | reg_a);
+        
+        /* Enable updates */
+        rtc_register_write(rtc, RTC_STATUS_B, reg_b);
+        rtc_register_write(rtc, RTC_STATUS_A, reg_a);
 
         fibril_mutex_unlock(&rtc->mutex);