1 files changed, 60 insertions, 0 deletions

diff --git a/firmware/common/timefuncs.c b/firmware/common/timefuncs.c
index 23444e2e43..e682454ce2 100644
--- a/firmware/common/timefuncs.c
+++ b/firmware/common/timefuncs.c
@@ -23,10 +23,28 @@
 #include "timefuncs.h"
 #include "debug.h"
 
+#ifndef SIMULATOR
 static struct tm tm;
+#endif
+
+bool valid_time(struct tm *tm)
+{
+    if (tm->tm_hour < 0 || tm->tm_hour > 23 ||
+        tm->tm_sec < 0 || tm->tm_sec > 59 || 
+        tm->tm_min < 0 || tm->tm_min > 59 ||
+        tm->tm_year < 100 || tm->tm_year > 199 ||
+        tm->tm_mon < 0 || tm->tm_mon > 11 ||
+        tm->tm_wday < 1 || tm->tm_wday > 7 ||
+        tm->tm_mday < 1 || tm->tm_mday > 31)
+        return false;
+    else
+        return true;
+}
+
 
 struct tm *get_time(void)
 {
+#ifndef SIMULATOR
 #ifdef HAVE_RTC
     char rtcbuf[8];
 
@@ -41,6 +59,8 @@ struct tm *get_time(void)
     tm.tm_mon = ((rtcbuf[6] & 0x10) >> 4) * 10 + (rtcbuf[6] & 0x0f) - 1;
     tm.tm_year = ((rtcbuf[7] & 0xf0) >> 4) * 10 + (rtcbuf[7] & 0x0f) + 100;
     tm.tm_wday = rtcbuf[4] & 0x07;
+    if(tm.tm_wday == 7)
+        tm.tm_wday = 0;
     tm.tm_yday = 0; /* Not implemented for now */
     tm.tm_isdst = -1; /* Not implemented for now */
 #else
@@ -55,4 +75,44 @@ struct tm *get_time(void)
     tm.tm_isdst = -1; /* Not implemented for now */
 #endif
     return &tm;
+#else
+    time_t now = time(NULL);
+    return localtime(&now);
+#endif
+}
+
+int set_time(struct tm *tm)
+{
+#ifdef HAVE_RTC
+    int rc;
+    int tmp;
+    
+    if (valid_time(tm))
+    {
+        rc = rtc_write(1, ((tm->tm_sec/10) << 4) | (tm->tm_sec%10));
+        rc |= rtc_write(2, ((tm->tm_min/10) << 4) | (tm->tm_min%10));
+        rc |= rtc_write(3, ((tm->tm_hour/10) << 4) | (tm->tm_hour%10));
+        tmp = tm->tm_wday;
+        if(tmp == 0)
+            tmp = 7;
+        rc |= rtc_write(4, tmp);
+        rc |= rtc_write(5, ((tm->tm_mday/10) << 4) | (tm->tm_mday%10));
+        rc |= rtc_write(6, (((tm->tm_mon+1)/10) << 4) | ((tm->tm_mon+1)%10));
+        rc |= rtc_write(7, (((tm->tm_year-100)/10) << 4) | ((tm->tm_year-100)%10));
+
+        rc |= rtc_write(8, 0x80); /* Out=1, calibration = 0 */
+
+        if(rc)
+            return -1;
+        else
+            return 0;
+    }
+    else
+    {
+        return -2;
+    }
+#else
+    (void)tm;
+    return 0;
+#endif
 }