FHSS: Implemented destination channel change in TX handle callback

Author: Jarkko Paso

source/Service_Libs/fhss/fhss_ws.c

@@ -34,6 +34,7 @@
 
 static int fhss_ws_handle_state_set(fhss_structure_t *fhss_structure, fhss_states fhss_state, uint16_t pan_id)
 {
+    (void) fhss_state;
     (void) pan_id;
     //TODO: Remove hard coded channel function
     fhss_structure->ws->channel_function = WS_TR51CF;
@@ -43,7 +44,7 @@ static int fhss_ws_handle_state_set(fhss_structure_t *fhss_structure, fhss_state
 
 static void fhss_ws_superframe_callback(fhss_structure_t *fhss_structure)
 {
-
+    (void) fhss_structure;
 }
 
 static void fhss_ws_update_channel_callback(fhss_structure_t *fhss_structure)
@@ -65,18 +66,50 @@ static void fhss_ws_update_channel_callback(fhss_structure_t *fhss_structure)
         //TODO: Callback to get channel schedule from application
     }
 #ifdef FHSS_CHANNEL_DEBUG
-    tr_info("%"PRIu32" UC %u", fhss_structure->platform_functions.fhss_get_timestamp(fhss_structure->fhss_api), next_channel);
+    tr_info("%"PRIu32" UC %u %u", fhss_structure->platform_functions.fhss_get_timestamp(fhss_structure->fhss_api), next_channel, fhss_structure->ws->slot);
 #endif /*FHSS_CHANNEL_DEBUG*/
     fhss_structure->callbacks.change_channel(fhss_structure->fhss_api, next_channel);
 }
 
 static int fhss_ws_tx_handle_callback(const fhss_api_t *api, bool is_broadcast_addr, uint8_t *destination_address, int frame_type, uint16_t frame_length, uint8_t phy_header_length, uint8_t phy_tail_length)
 {
+    (void) is_broadcast_addr;
+    (void) frame_type;
+    (void) frame_length;
+    (void) phy_header_length;
+    (void) phy_tail_length;
+    fhss_structure_t *fhss_structure = fhss_get_object_with_api(api);
+    if (!fhss_structure) {
+        return -1;
+    }
+    if (fhss_structure->fhss_state == FHSS_SYNCHRONIZED) {
+        int32_t tx_channel;
+        //TODO: Compute destination slot using neighbour table
+        uint16_t destination_slot = fhss_structure->ws->slot;
+        if (fhss_structure->ws->channel_function == WS_TR51CF) {
+            tx_channel = tr51_get_uc_channel_index(destination_slot, destination_address, fhss_structure->number_of_channels);
+        } else if(fhss_structure->ws->channel_function == WS_DH1CF) {
+            tx_channel = dh1cf_get_uc_channel_index(destination_slot, destination_address, fhss_structure->number_of_channels);
+        } else if (fhss_structure->ws->channel_function == WS_VENDOR_DEF_CF) {
+
+        }
+#ifdef FHSS_CHANNEL_DEBUG
+        tr_debug("TX channel: %u %u", tx_channel, destination_slot+1);
+#endif /*FHSS_CHANNEL_DEBUG*/
+        fhss_structure->callbacks.change_channel(fhss_structure->fhss_api, tx_channel);
+    }
     return 0;
 }
 
 static bool fhss_ws_check_tx_conditions_callback(const fhss_api_t *api, bool is_broadcast_addr, uint8_t handle, int frame_type, uint16_t frame_length, uint8_t phy_header_length, uint8_t phy_tail_length)
 {
+    (void) api;
+    (void) is_broadcast_addr;
+    (void) handle;
+    (void) frame_type;
+    (void) frame_length;
+    (void) phy_header_length;
+    (void) phy_tail_length;
     return true;
 }