FHSS: WS FHSS enable implemented

Author: Jarkko Paso

source/Service_Libs/fhss/fhss_ws.c

@@ -20,6 +20,7 @@
 #include "fhss_config.h"
 #include "fhss.h"
 #include "fhss_common.h"
+#include "channel_list.h"
 #include "channel_functions.h"
 #include "fhss_ws.h"
 #include "fhss_mac_interface.h"
@@ -34,7 +35,23 @@
 
 fhss_structure_t *fhss_ws_enable(fhss_api_t *fhss_api, const fhss_ws_configuration_t *fhss_configuration, const fhss_timer_t *fhss_timer)
 {
-    return NULL;
+    if (!fhss_api || !fhss_configuration || !fhss_timer) {
+        tr_err("Invalid FHSS enable configuration");
+        return NULL;
+    }
+    int channel_count = channel_list_count_channels(fhss_configuration->channel_mask);
+    if (channel_count <= 0) {
+        // There must be at least one configured channel in channel list
+        return NULL;
+    }
+    fhss_structure_t *fhss_struct = fhss_allocate_instance(fhss_api, fhss_timer);
+    if (!fhss_struct) {
+        return NULL;
+    }
+    fhss_struct->fhss_conf.fhss_ws_configuration = *fhss_configuration;
+    fhss_struct->number_of_channels = channel_count;
+
+    return fhss_struct;
 }
 
 static uint32_t fhss_ws_get_sf_timeout_callback(fhss_structure_t *fhss_structure)