Added a new custom APDU (88h) for setting and retrieving datetime.

Signed-off-by: Pol Henarejos <pol.henarejos@cttc.es>

src/hsm/hsm2040.c

@@ -1605,6 +1605,21 @@ void led_off_all()
 #endif
 }
 
+void init_rtc() {
+    
+    rtc_init();
+    datetime_t dt = {
+            .year  = 2020,
+            .month = 1,
+            .day   = 1,
+            .dotw  = 3, // 0 is Sunday, so 5 is Friday
+            .hour  = 00,
+            .min   = 00,
+            .sec   = 00
+    };
+    rtc_set_datetime(&dt);
+}
+
 extern void neug_task();
 
 pico_unique_board_id_t unique_id;
@@ -1641,7 +1656,7 @@ int main(void)
     
     low_flash_init();
     
-    rtc_init();
+    init_rtc();
       
     while (1)
     {

src/hsm/sc_hsm.c

@@ -1717,6 +1717,20 @@ static int cmd_derive_asym() {
 static int cmd_datetime() {
     if (P1(apdu) != 0x0 || P2(apdu) != 0x0)
         return SW_INCORRECT_P1P2();
+    if (apdu.cmd_apdu_data_len == 0) {
+        datetime_t dt;
+        if (!rtc_get_datetime(&dt))
+            return SW_EXEC_ERROR();
+        res_APDU[res_APDU_size++] = dt.year >> 8;
+        res_APDU[res_APDU_size++] = dt.year & 0xff;
+        res_APDU[res_APDU_size++] = dt.month;
+        res_APDU[res_APDU_size++] = dt.day;
+        res_APDU[res_APDU_size++] = dt.dotw;
+        res_APDU[res_APDU_size++] = dt.hour;
+        res_APDU[res_APDU_size++] = dt.min;
+        res_APDU[res_APDU_size++] = dt.sec;
+    }
+    else {
         if (apdu.cmd_apdu_data_len != 8)
             return SW_WRONG_LENGTH();
         datetime_t dt;
@@ -1729,6 +1743,7 @@ static int cmd_datetime() {
         dt.sec = apdu.cmd_apdu_data[7];
         if (!rtc_set_datetime(&dt))
             return SW_WRONG_DATA();
+    }
     return SW_OK();
 }