Fixed FHSS UFSI calculation unit tests

Author: Jarkko Paso

test/nanostack/unittest/service_libs/fhss_ws/test_fhss_ws.c

@@ -648,13 +648,36 @@ bool test_fhss_ws_synch_state_set_callback()
     return true;
 }
 
+static void test_reset_synch_info(uint8_t *synch_info)
+{
+    memset(synch_info, 0, 100);
+    synch_info[0] = 0x05;
+    synch_info[1] = 0x15;
+    synch_info[2] = 0x02;
+    synch_info[3] = 0x00;
+    synch_info[4] = 0x00;
+    synch_info[5] = 0x00;
+    synch_info[6] = 0x00;
+    synch_info[7] = 0x05;
+    synch_info[8] = 0x15;
+    synch_info[9] = 0x01;
+    synch_info[10] = 0x04;
+    synch_info[11] = 0x00;
+    synch_info[12] = 0x00;
+    synch_info[13] = 0x00;
+    synch_info[14] = 0x00;
+    synch_info[15] = 0x3f;
+}
+
 bool test_fhss_ws_write_synch_info_callback()
 {
     fhss_api_t *api = test_generate_fhss_api();
     fhss_common_stub.fhss_struct.ws->fhss_configuration.ws_uc_channel_function = WS_TR51CF;
     fhss_common_stub.fhss_struct.rx_channel = 0;
     fhss_common_stub.fhss_struct.ws->unicast_timer_running = true;
-    uint8_t synch_info[100] = {0x05, 0x15, 0x02, 0x00, 0x00, 0x00, 0x00, 0x05, 0x15, 0x01, 0x04, 0x00, 0x00, 0x00, 0x00, 0x3f};
+    uint8_t synch_info[100];
+    test_reset_synch_info(synch_info);
+
     // Test when FHSS struct not found
     disable_fhss_struct();
     if (fhss_common_stub.fhss_struct.fhss_api->write_synch_info(api, synch_info, sizeof(synch_info), DEFAULT_FRAME_TYPE, DEFAULT_TX_TIME) != -1) {
@@ -671,6 +694,7 @@ bool test_fhss_ws_write_synch_info_callback()
     }
     fhss_platform_stub.remaining_slots_value = 100000;
     fhss_callbacks_stub.uint32_value = 1000000;
+    fhss_common_stub.fhss_struct.ws->next_uc_timeout = fhss_callbacks_stub.uint32_value + fhss_platform_stub.remaining_slots_value;
     /* Test the UFSI field in synch info
      * slot:           |               0(200ms)        |               1(200ms)        |               2(200ms)        |               3(200ms)        |
      *                 |                      ufsi(597ms) -> 1001599                                                  |
@@ -680,8 +704,10 @@ bool test_fhss_ws_write_synch_info_callback()
             || (test_ufsi(&synch_info[11], 1001599) != true)) {
         return false;
     }
+    test_reset_synch_info(synch_info);
     // Test when timestamp overflows
     fhss_callbacks_stub.uint32_value = 4294960000;
+    fhss_common_stub.fhss_struct.ws->next_uc_timeout = fhss_callbacks_stub.uint32_value + fhss_platform_stub.remaining_slots_value;
     /* Test the UFSI field in synch info
      * slot:           |               0(200ms)        |               1(200ms)        |               2(200ms)        |               3(200ms)        |
      *                 |                      ufsi(597ms) -> 1001599                                                  |
@@ -691,7 +717,33 @@ bool test_fhss_ws_write_synch_info_callback()
             || (test_ufsi(&synch_info[11], 1001599) != true)) {
         return false;
     }
-
+    test_reset_synch_info(synch_info);
+    // Test when TX time has passed
+    fhss_callbacks_stub.uint32_value = 1000000;
+    fhss_common_stub.fhss_struct.ws->next_uc_timeout = fhss_callbacks_stub.uint32_value + fhss_platform_stub.remaining_slots_value;
+    /* Test the UFSI field in synch info
+     * slot:           |               0(200ms)        |               1(200ms)        |               2(200ms)        |               3(200ms)        |
+     *                 |                      ufsi(500ms) -> 838860
+     * timestamps:                                                 TX at 995000us|written at 1000000us|
+     */
+    if ((fhss_common_stub.fhss_struct.fhss_api->write_synch_info(api, synch_info, sizeof(synch_info), DEFAULT_FRAME_TYPE, fhss_callbacks_stub.uint32_value - 5000) != 0)
+            || (test_ufsi(&synch_info[11], 838860) != true)) {
+        return false;
+    }
+    test_reset_synch_info(synch_info);
+    // Test when interrupt is delayed
+    fhss_platform_stub.remaining_slots_value = 0;
+    fhss_callbacks_stub.uint32_value = 1000000;
+    fhss_common_stub.fhss_struct.ws->next_uc_timeout = fhss_callbacks_stub.uint32_value - 5000;
+    /* Test the UFSI field in synch info
+     * slot:           |               0(200ms)        |               1(200ms)        |               2(200ms)        |               3(200ms)        |
+     *                 |                      ufsi(597ms) -> 1001599
+     * timestamps:                                                                                  written at 1000000us|TX at 1005000us|
+     */
+    if ((fhss_common_stub.fhss_struct.fhss_api->write_synch_info(api, synch_info, sizeof(synch_info), DEFAULT_FRAME_TYPE, fhss_callbacks_stub.uint32_value + 7000) != 0)
+            || (test_ufsi(&synch_info[11], 1026765) != true)) {
+        return false;
+    }
     // Test when IE element not found
     memset(synch_info, 0, sizeof(synch_info));
     if (fhss_common_stub.fhss_struct.fhss_api->write_synch_info(api, synch_info, sizeof(synch_info), DEFAULT_FRAME_TYPE, DEFAULT_TX_TIME) != 0) {