FHSS: fixed tr51 channel table size

Author: Jarkko Paso

source/Service_Libs/fhss/channel_functions.c

@@ -42,7 +42,7 @@
 static uint32_t global_seed = 1;
 
 
-static uint16_t tr51_calc_nearest_prime_number(uint16_t start_value)
+uint16_t tr51_calc_nearest_prime_number(uint16_t start_value)
 {
     if (start_value < 2) {
         return 0;

source/Service_Libs/fhss/channel_functions.h

@@ -17,6 +17,8 @@
 #ifndef CHANNEL_FUNC_H_
 #define CHANNEL_FUNC_H_
 
+uint16_t tr51_calc_nearest_prime_number(uint16_t start_value);
+
 /**
  * @brief Initialize channel table for TR51 channel function.
  * @param channel_table Channel table to be initialized.

source/Service_Libs/fhss/fhss_ws.c

@@ -114,7 +114,7 @@ static int fhss_ws_manage_channel_table_allocation(fhss_structure_t *fhss_struct
 {
     // Must allocate channel table for TR51
     if (!fhss_structure->ws->tr51_channel_table && !fhss_structure->ws->tr51_output_table) {
-        fhss_structure->ws->tr51_channel_table = ns_dyn_mem_alloc(sizeof(int16_t)*channel_count);
+        fhss_structure->ws->tr51_channel_table = ns_dyn_mem_alloc(sizeof(int16_t)*tr51_calc_nearest_prime_number(channel_count));
         if (!fhss_structure->ws->tr51_channel_table) {
             return -1;
         }