wireless/src/sl_rsi_utility.c

/***************************************************************************/ /**
 * @file
 * @brief
 *******************************************************************************
 * # License
 * <b>Copyright 2024 Silicon Laboratories Inc. www.silabs.com</b>
 *******************************************************************************
 *
 * SPDX-License-Identifier: Zlib
 *
 * The licensor of this software is Silicon Laboratories Inc.
 *
 * This software is provided 'as-is', without any express or implied
 * warranty. In no event will the authors be held liable for any damages
 * arising from the use of this software.
 *
 * Permission is granted to anyone to use this software for any purpose,
 * including commercial applications, and to alter it and redistribute it
 * freely, subject to the following restrictions:
 *
 * 1. The origin of this software must not be misrepresented; you must not
 *    claim that you wrote the original software. If you use this software
 *    in a product, an acknowledgment in the product documentation would be
 *    appreciated but is not required.
 * 2. Altered source versions must be plainly marked as such, and must not be
 *    misrepresented as being the original software.
 * 3. This notice may not be removed or altered from any source distribution.
 *
 ******************************************************************************/
#include "sl_si91x_protocol_types.h"
#include "sl_si91x_constants.h"
#include "sl_si91x_driver.h"
#include "sl_wifi_constants.h"
#include "sl_wifi_credentials.h"
#include "sl_status.h"
#include "sl_constants.h"
#include "sl_wifi_types.h"
#include "sl_rsi_utility.h"
#include "cmsis_os2.h" // CMSIS RTOS2
#include "sl_si91x_types.h"
#include "sl_si91x_core_utilities.h"
#ifdef SLI_SI91X_OFFLOAD_NETWORK_STACK
#include "sl_si91x_socket_constants.h"
#include "sl_si91x_socket_utility.h"
#endif
#include "em_core.h"
#include <string.h>
#include "assert.h"

/******************************************************
 *               Macro Declarations
 ******************************************************/
// Macro to check the status and return it if it's not SL_STATUS_OK
#define VERIFY_STATUS(s)   \
  do {                     \
    if (s != SL_STATUS_OK) \
      return s;            \
  } while (0)

// WLAN Management Frame Sub-Type
#define SLI_WIFI_FRAME_SUBTYPE_MASK       0xf0 // WLAN Management Frame Sub-Type Mask
#define SLI_WIFI_FRAME_SUBTYPE_PROBE_RESP 0x50 // WLAN Management Frame Sub-Type Probe Response Frame
#define SLI_WIFI_FRAME_SUBTYPE_BEACON     0x80 // WLAN Management Frame Sub-Type Beacon Frame
#define SLI_WIFI_MINIMUM_FRAME_LENGTH     36   // Minimum Frame Length of WLAN Management Frame
#define SLI_WIFI_HARDWARE_ADDRESS_LENGTH  6    // Hardware Address Length

// WLAN Information Element Type
#define SLI_WLAN_TAG_SSID            0   // WLAN Information Element Type SSID
#define SLI_WLAN_TAG_RSN             48  // WLAN Robust Security Network Information Element
#define SLI_WLAN_TAG_VENDOR_SPECIFIC 221 // WLAN Vendor Specific Information Element

// Authentication key Management Type
#define SLI_AUTH_KEY_MGMT_UNSPEC_802_1X   0x000FAC01 // Unspecified Authentication key Management Type
#define SLI_AUTH_KEY_MGMT_PSK_OVER_802_1X 0x000FAC02 // PSK Authentication key Management Type
#define SLI_AUTH_KEY_MGMT_802_1X_SHA256   0x000FAC05 // SHA256 Authentication key Management Type
#define SLI_AUTH_KEY_MGMT_PSK_SHA256      0x000FAC06 // PSK SHA256 Authentication key Management Type
#define SLI_AUTH_KEY_MGMT_SAE             0x000FAC08 // SAE Authentication key Management Type
#define SLI_AUTH_KEY_MGMT_FT_SAE          0x000FAC09 // FT_SAE Authentication key Management Type

// Authentication key Management Type Flags
#define SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA           0x00000001 // WPA AKM Type
#define SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA2          0x00000002 // WPA2 AKM Type
#define SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA_PSK       0x00000004 // WPA_PSK AKM Type
#define SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA2_PSK      0x00000008 // WPA2_PSK AKM Type
#define SLI_WLAN_AUTH_KEY_MGMT_TYPE_SAE           0x00010000 // SAE AKM Type
#define SLI_WLAN_AUTH_KEY_MGMT_TYPE_FT_SAE        0x00100000 // FT_SAE AKM Type
#define SLI_WLAN_AUTH_KEY_MGMT_TYPE_802_1X_SHA256 0x00020000 // SHA256 AKM Type
#define SLI_WLAN_AUTH_KEY_MGMT_TYPE_PSK_SHA256    0x00040000 // PSK_SHA256 AKM Type

/// Task register ID to save firmware status
#define SLI_FW_STATUS_STORAGE_INVALID_INDEX 0xFF // Invalid index for firmware status storage

/******************************************************
 *               Local Type Declarations
 ******************************************************/
// WLAN Frame
typedef struct {
  uint8_t fc[2];                                   // Frame Control
  uint8_t duration[2];                             // Duration
  uint8_t da[SLI_WIFI_HARDWARE_ADDRESS_LENGTH];    // Destination Address
  uint8_t sa[SLI_WIFI_HARDWARE_ADDRESS_LENGTH];    // Source Address
  uint8_t bssid[SLI_WIFI_HARDWARE_ADDRESS_LENGTH]; // BSS Id
  uint8_t sc[2];                                   // Sequence Control Id
  uint8_t timestamp[8];                            // Time Stamp
  uint8_t bi[2];                                   // Beacon Interval
  uint8_t ci[2];                                   // Capability Information
  uint8_t tagged_info[];                           // Variable Information Elememt
} sli_wifi_data_frame_t;

// WLAN Information Element
typedef struct {
  uint8_t tag;         // Information Element Tag Id
  uint8_t data_length; // Information Element Data Length
  uint8_t data[];      // Information Element Data
} sli_wifi_data_tagged_info_t;

// Cipher suite
typedef struct {
  uint8_t cs_oui[3]; // Cipher Suite OUI
  uint8_t cs_type;   // Cipher Suite Type
} sli_wlan_cipher_suite_t;

// WLAN Robust Security Network Information Element
typedef struct {
  uint8_t version[2];          // RSN Version
  sli_wlan_cipher_suite_t gcs; // Group cipher suite
  uint8_t pcsc[2];             // Pairwise cipher suite count
  uint8_t pcsl[];              // Pairwise cipher suite list
} sli_wlan_rsn_element_t;

// WLAN Vendor Specific Information Element
typedef struct {
  uint8_t oui[3];              // Vendor OUI
  uint8_t vs_oui;              // Vendor specific OUI
  uint8_t type;                // WPA Information Element
  uint8_t wpa_version[2];      // WPA Version
  sli_wlan_cipher_suite_t mcs; // Multicast Cipher Suite
  uint8_t ucsc;                // Unicast Cipher Suite List Count
  uint8_t ucsl[];              // Unicast Cipher Suite List
} sli_wlan_vendor_specific_element_t;

// Scan Information
typedef struct sli_scan_info_s {
  struct sli_scan_info_s *next;
  uint8_t channel;                                 ///< Channel number of the AP
  uint8_t security_mode;                           ///< Security mode of the AP
  uint8_t rssi;                                    ///< RSSI value of the AP
  uint8_t network_type;                            ///< AP network type
  uint8_t ssid[34];                                ///< SSID of the AP
  uint8_t bssid[SLI_WIFI_HARDWARE_ADDRESS_LENGTH]; ///< BSSID of the AP
} sli_scan_info_t;

/******************************************************
 *               Variable Declarations
 ******************************************************/
osThreadId_t si91x_thread           = 0;
osThreadId_t si91x_event_thread     = 0;
osEventFlagsId_t si91x_events       = 0;
osEventFlagsId_t si91x_bus_events   = 0;
osEventFlagsId_t si91x_async_events = 0;
osMutexId_t malloc_free_mutex       = 0;

#ifdef SL_SI91X_SIDE_BAND_CRYPTO
osMutexId_t side_band_crypto_mutex = 0;
#endif

sli_si91x_command_queue_t cmd_queues[SI91X_CMD_MAX];
sl_si91x_buffer_queue_t sli_tx_data_queue;

static bool sli_si91x_packet_status = 0;

extern bool device_initialized;

// Declaration of external functions
extern void si91x_bus_thread(void *args);
extern void si91x_event_handler_thread(void *args);
sl_status_t sl_si91x_host_power_cycle(void);
void convert_performance_profile_to_power_save_command(sl_si91x_performance_profile_t profile,
                                                       sl_si91x_power_save_request_t *power_save_request);
extern sl_status_t sl_create_generic_rx_packet_from_params(sli_si91x_queue_packet_t **queue_packet,
                                                           sl_wifi_buffer_t **packet_buffer,
                                                           uint16_t packet_id,
                                                           uint8_t flags,
                                                           void *sdk_context,
                                                           uint16_t frame_status);
void sl_debug_log(const char *format, ...);

extern sli_si91x_performance_profile_t performance_profile;

// NOTE: Boolean value determines whether firmware automatically closes the TCP socket in case of receiving termination from remote node or not.
static bool tcp_auto_close_enabled;

// This value will be used in connect request/ AP configurations to set the TX power of the module
static sl_wifi_max_tx_power_t wifi_max_tx_power = {
  .scan_tx_power = 0x1f, //Default power value set to max value supported in dBm
  .join_tx_power = 0x1f, //Default power value set to max value supported in dBm
};

static sl_wifi_rate_t saved_wifi_data_rate = SL_WIFI_AUTO_RATE;

static sl_wifi_ap_configuration_t ap_configuration;

static bool is_card_ready_required = true;

sl_si91x_performance_profile_t current_performance_profile = HIGH_PERFORMANCE;

static sl_si91x_boot_configuration_t saved_boot_configuration = { 0 };

static sl_si91x_coex_mode_t coex_mode = 0;

static sli_scan_info_t *scan_info_database = NULL;

/******************************************************
 *             Internal Function Declarations
 ******************************************************/
sl_status_t sli_fw_status_storage_index_init(void)
{
  sl_status_t status = SL_STATUS_OK;

  // Declare a variable to store the current interrupt state
  CORE_DECLARE_IRQ_STATE;

  // Enter a critical section by disabling interrupts
  // This ensures that the following operations are executed atomically
  CORE_ENTER_CRITICAL();
#ifdef SL_CATALOG_KERNEL_PRESENT
  // Check if the code is running in a thread context & task register index is invalid
  if (osThreadGetId() != NULL && sli_fw_status_storage_index == SLI_FW_STATUS_STORAGE_INVALID_INDEX) {
    // Create a new task register id
    status = sli_osTaskRegisterNew(&sli_fw_status_storage_index);
    VERIFY_STATUS_AND_RETURN(status);
  }
#endif
  CORE_EXIT_CRITICAL();
  return status;
}

// Function to update a existing entry or create new entry for scan results database
static sli_scan_info_t *sli_update_or_create_scan_info_element(const sli_scan_info_t *info)
{
  sli_scan_info_t *element = NULL;

  element = scan_info_database;
  while (NULL != element) {
    if (0 == memcmp(info->bssid, element->bssid, SLI_WIFI_HARDWARE_ADDRESS_LENGTH)) {
      element->channel       = element->channel;
      element->security_mode = element->security_mode;
      element->rssi          = element->rssi;
      element->network_type  = element->network_type;
      memcpy(element->ssid, info->ssid, 34);
      break;
    }
    element = element->next;
  }

  if (NULL == element) {
    element = malloc(sizeof(sli_scan_info_t));
    memcpy(element, info, sizeof(sli_scan_info_t));
    element->next = NULL;
    return element;
  }

  return NULL;
}

// Function to store a given scan info element in scan results database
static void sli_store_scan_info_element(sli_scan_info_t *info)
{
  sli_scan_info_t *element = NULL;
  sli_scan_info_t *head    = NULL;
  sli_scan_info_t *tail    = NULL;

  if (NULL == info) {
    return;
  }

  element = sli_update_or_create_scan_info_element(info);
  if (NULL == element) {
    return;
  }

  if (NULL == scan_info_database) {
    scan_info_database = element;
    return;
  }

  tail = scan_info_database;
  while (NULL != tail) {
    if (element->rssi < tail->rssi) {
      element->next = tail;
      if (NULL == head) {
        scan_info_database = element;
      } else {
        head->next = element;
      }
      break;
    }

    head = tail;
    tail = tail->next;

    if (NULL == tail) {
      head->next = element;
    }
  }

  return;
}

// Function to identify Authentication Key Management Type
static uint32_t sli_get_key_management_info(const sli_wlan_cipher_suite_t *akms, const uint16_t akmsc)
{
  uint32_t key_mgmt = 0;
  uint32_t oui_type;

  if (NULL == akms) {
    return 0;
  }

  for (int i = 0; i < akmsc; i++) {
    oui_type = ((akms[i].cs_oui[0] << 24) | (akms[i].cs_oui[1] << 16) | (akms[i].cs_oui[2] << 8) | akms[0].cs_type);

    switch (oui_type) {
      case SLI_AUTH_KEY_MGMT_UNSPEC_802_1X:
        key_mgmt |= SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA | SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA2;
        break;
      case SLI_AUTH_KEY_MGMT_PSK_OVER_802_1X:
        key_mgmt |= SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA_PSK | SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA2_PSK;
        break;
      case SLI_AUTH_KEY_MGMT_802_1X_SHA256:
        key_mgmt |= SLI_WLAN_AUTH_KEY_MGMT_TYPE_802_1X_SHA256;
        break;
      case SLI_AUTH_KEY_MGMT_PSK_SHA256:
        key_mgmt |= SLI_WLAN_AUTH_KEY_MGMT_TYPE_PSK_SHA256;
        break;
      case SLI_AUTH_KEY_MGMT_SAE:
        key_mgmt |= SLI_WLAN_AUTH_KEY_MGMT_TYPE_SAE;
        break;
      case SLI_AUTH_KEY_MGMT_FT_SAE:
        key_mgmt |= SLI_WLAN_AUTH_KEY_MGMT_TYPE_FT_SAE;
        break;
      default:
        break;
    }
  }
  return key_mgmt;
}

// Helper function to process RSN element
static void process_rsn_element(const sli_wifi_data_tagged_info_t *info, sli_scan_info_t *scan_info)
{
  scan_info->security_mode            = SL_WIFI_WPA2_ENTERPRISE;
  sli_wlan_rsn_element_t *rsn         = (sli_wlan_rsn_element_t *)info->data;
  uint16_t pcsc                       = (uint16_t)(rsn->pcsc[0] | (rsn->pcsc[1] << 8));
  uint8_t *akmslc                     = (rsn->pcsl + (pcsc * sizeof(sli_wlan_cipher_suite_t)));
  uint16_t akmsc                      = (uint16_t)(akmslc[0] | (akmslc[1] << 8));
  const sli_wlan_cipher_suite_t *akms = (sli_wlan_cipher_suite_t *)(akmslc + 2);
  uint8_t wlan_gcs_oui[3]             = { 0x00, 0x0F, 0xAC };

  SL_DEBUG_LOG("RSN OUI %02x:%02x:%02x.\n", rsn->gcs.cs_oui[0], rsn->gcs.cs_oui[1], rsn->gcs.cs_oui[2]);
  SL_DEBUG_LOG("Pairwise cipher suite count: %u.\n", pcsc);

  if (!memcmp(rsn->gcs.cs_oui, wlan_gcs_oui, 3)) {
    scan_info->security_mode = SL_WIFI_WPA2;
    uint32_t key = sli_get_key_management_info((const sli_wlan_cipher_suite_t *)akms, (const uint16_t)akmsc);

    if (akms[0].cs_type == 1) {
      scan_info->security_mode = SL_WIFI_WPA2_ENTERPRISE;
    }

    if (key & SLI_WLAN_AUTH_KEY_MGMT_TYPE_802_1X_SHA256) {
      scan_info->security_mode = SL_WIFI_WPA3_ENTERPRISE;
      if ((key & SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA) || (key & SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA2)) {
        scan_info->security_mode = SL_WIFI_WPA3_TRANSITION_ENTERPRISE;
      }
    }

    if (key & SLI_WLAN_AUTH_KEY_MGMT_TYPE_SAE) {
      scan_info->security_mode = SL_WIFI_WPA3;
      if ((key & SLI_WLAN_AUTH_KEY_MGMT_TYPE_PSK_SHA256) || (key & SLI_WLAN_AUTH_KEY_MGMT_TYPE_WPA2_PSK)) {
        scan_info->security_mode = SL_WIFI_WPA3_TRANSITION;
      }
    }
  }
}

// Helper function to process Vendor Specific element
static void process_vendor_specific_element(const sli_wifi_data_tagged_info_t *info, sli_scan_info_t *scan_info)
{
  sli_wlan_vendor_specific_element_t *vendor = (sli_wlan_vendor_specific_element_t *)info->data;
  uint8_t wlan_oui[3]                        = { 0x00, 0x50, 0xF2 };

  if ((!memcmp(vendor->oui, wlan_oui, 3)) && (vendor->vs_oui == 0x01)
      && ((scan_info->security_mode == SL_WIFI_OPEN) || (scan_info->security_mode == SL_WIFI_WEP))) {
    scan_info->security_mode            = SL_WIFI_WPA;
    uint8_t *list_count                 = (vendor->ucsl + (sizeof(sli_wlan_cipher_suite_t) * vendor->ucsc));
    uint16_t akmsc                      = (uint16_t)(list_count[0] | (list_count[1] << 8));
    const sli_wlan_cipher_suite_t *akms = (sli_wlan_cipher_suite_t *)(list_count + 2);

    if ((0 != akmsc) && (akms[akmsc - 1].cs_type == 1)) {
      scan_info->security_mode = SL_WIFI_WPA_ENTERPRISE;
    }
  }
}

// Function to parse Information elements in WiFi Beacon or Probe response frames
static void sli_process_tag_info(const sli_wifi_data_tagged_info_t *info, sli_scan_info_t *scan_info)
{
  switch (info->tag) {
    case SLI_WLAN_TAG_SSID:
      memcpy(scan_info->ssid, info->data, info->data_length);
      scan_info->ssid[info->data_length] = 0;
      break;

    case SLI_WLAN_TAG_RSN:
      process_rsn_element(info, scan_info);
      break;

    case SLI_WLAN_TAG_VENDOR_SPECIFIC:
      process_vendor_specific_element(info, scan_info);
      break;

    default:
      break;
  }

  return;
}

// Function to identify expected scan result based on filter
static bool sli_filter_scan_info(const sli_scan_info_t *scan_info,
                                 const sl_wifi_extended_scan_result_parameters_t *extended_scan_parameters)
{
  if (NULL == scan_info) {
    return false;
  }

  if ((NULL != extended_scan_parameters->channel_filter)
      && (*(extended_scan_parameters->channel_filter) != scan_info->channel)) {
    return false;
  }

  if ((NULL != extended_scan_parameters->security_mode_filter)
      && (*(extended_scan_parameters->security_mode_filter) != scan_info->security_mode)) {
    return false;
  }

  if ((NULL != extended_scan_parameters->rssi_filter)
      && (*(extended_scan_parameters->rssi_filter) <= scan_info->rssi)) {
    return false;
  }

  if ((NULL != extended_scan_parameters->network_type_filter)
      && (*(extended_scan_parameters->network_type_filter) != scan_info->network_type)) {
    return false;
  }

  return true;
}

/******************************************************
 *            Internal Function Declarations
 ******************************************************/
// Function to Parse the Beacon and Probe response Frames
void sli_handle_wifi_beacon(sl_si91x_packet_t *packet)
{
  uint8_t subtype                   = 0;
  uint16_t recv_freq                = 0;
  sli_wifi_data_frame_t *wifi_frame = (sli_wifi_data_frame_t *)packet->data;
  sli_scan_info_t scan_info         = { 0 };
  uint16_t ies_length               = 0;

  recv_freq         = packet->desc[9];
  recv_freq         = (recv_freq << 8) | packet->desc[8];
  scan_info.rssi    = (~packet->desc[10]);
  scan_info.channel = packet->desc[11];

  // Check for ESS bit and TBSS status bit in capability info
  // 1 in ESS bit indicates that the transmitter is an AP
  if (1 == (wifi_frame->ci[0] & 0x03)) {
    scan_info.network_type = 1;
  } else {
    scan_info.network_type = 0;
  }

  if (wifi_frame->ci[0] & 0x08) {
    scan_info.security_mode = SL_WIFI_WEP;
  } else {
    scan_info.security_mode = SL_WIFI_OPEN;
  }

  subtype = wifi_frame->fc[0] & SLI_WIFI_FRAME_SUBTYPE_MASK;
  switch (subtype) {
    case SLI_WIFI_FRAME_SUBTYPE_PROBE_RESP:
    case SLI_WIFI_FRAME_SUBTYPE_BEACON: {
      if (packet->length <= SLI_WIFI_MINIMUM_FRAME_LENGTH) {
        return;
      }
      ies_length = packet->length - SLI_WIFI_MINIMUM_FRAME_LENGTH;

      memcpy(scan_info.bssid, wifi_frame->bssid, SLI_WIFI_HARDWARE_ADDRESS_LENGTH);

      sli_wifi_data_tagged_info_t *info = (sli_wifi_data_tagged_info_t *)wifi_frame->tagged_info;
      while (0 != ies_length) {
        sli_process_tag_info(info, &scan_info);
        ies_length -= (sizeof(sli_wifi_data_tagged_info_t) + info->data_length);
        info = (sli_wifi_data_tagged_info_t *)&(info->data[info->data_length]);

        if (ies_length <= sizeof(sli_wifi_data_tagged_info_t)) {
          ies_length = 0;
        }
      }

      sli_store_scan_info_element(&scan_info);
    } break;
    default:
      return;
  }

  return;
}

// Function to get all or filtered scan results from scan result database
sl_status_t sli_wifi_get_stored_scan_results(sl_wifi_interface_t interface,
                                             sl_wifi_extended_scan_result_parameters_t *extended_scan_parameters)
{
  UNUSED_PARAMETER(interface);
  if (NULL == extended_scan_parameters) {
    return SL_STATUS_INVALID_PARAMETER;
  }

  sl_wifi_extended_scan_result_t *scan_results = extended_scan_parameters->scan_results;
  uint16_t *result_count                       = extended_scan_parameters->result_count;
  uint16_t length                              = extended_scan_parameters->array_length;
  sli_scan_info_t *scan_info                   = scan_info_database;

  if ((NULL == scan_results) || (NULL == result_count) || (0 == length)) {
    return SL_STATUS_INVALID_PARAMETER;
  }
  *result_count = 0;

  while ((0 != length) && (NULL != scan_info)) {
    if (true == sli_filter_scan_info(scan_info, extended_scan_parameters)) {
      scan_results[*result_count].rf_channel    = scan_info->channel;
      scan_results[*result_count].security_mode = scan_info->security_mode;
      scan_results[*result_count].rssi          = scan_info->rssi;
      scan_results[*result_count].network_type  = scan_info->network_type;
      memcpy(scan_results[*result_count].bssid, scan_info->bssid, SLI_WIFI_HARDWARE_ADDRESS_LENGTH);
      memcpy(scan_results[*result_count].ssid, scan_info->ssid, 34);
      (*result_count)++;
      length--;
    }
    scan_info = scan_info->next;
  }

  return SL_STATUS_OK;
}

// Function to Clean up all the scan results in scan result database
void sli_wifi_flush_scan_results_database(void)
{
  sli_scan_info_t *scan_info = scan_info_database;
  sli_scan_info_t *node      = NULL;

  while (NULL != scan_info) {
    node      = scan_info;
    scan_info = scan_info->next;
    free(node);
  }
  scan_info_database = NULL;

  return;
}

/******************************************************
 *               Function Declarations
 ******************************************************/
void save_wifi_current_performance_profile(const sl_wifi_performance_profile_t *profile)
{
  SL_ASSERT(profile != NULL);
  memcpy(&performance_profile.wifi_performance_profile, profile, sizeof(sl_wifi_performance_profile_t));

  performance_profile.coex_mode = get_coex_mode();
}

// Get the current Wi-Fi performance profile
void get_wifi_current_performance_profile(sl_wifi_performance_profile_t *profile)
{
  SL_ASSERT(profile != NULL);
  memcpy(profile, &performance_profile.wifi_performance_profile, sizeof(sl_wifi_performance_profile_t));
}

// Get the coexistence performance profile based on the current coexistence mode
void get_coex_performance_profile(sl_si91x_performance_profile_t *profile)
{
  SL_ASSERT(profile != NULL);
  uint8_t mode_decision          = 0;
  sl_si91x_coex_mode_t coex_mode = performance_profile.coex_mode;
  if (coex_mode == SL_SI91X_WLAN_ONLY_MODE) { // Treat SL_SI91X_WLAN_ONLY_MODE as SL_SI91X_WLAN_MODE
    coex_mode = SL_SI91X_WLAN_MODE;
  }
  // Determine the mode decision based on the coexistence mode
  switch (coex_mode) {
    case SL_SI91X_WLAN_MODE: {
      // Wi-Fi only mode
      mode_decision = (uint8_t)((performance_profile.wifi_performance_profile.profile << 4)
                                | (performance_profile.wifi_performance_profile.profile));
    } break;
    case SL_SI91X_BLUETOOTH_MODE:
    case SL_SI91X_BLE_MODE:
    case SL_SI91X_DUAL_MODE: {
      // Bluetooth only or dual-mode (BT + Wi-Fi) mode
      mode_decision = (uint8_t)((performance_profile.bt_performance_profile.profile << 4)
                                | (performance_profile.bt_performance_profile.profile));
    } break;
    case SL_SI91X_WLAN_BLUETOOTH_MODE:
    case SL_SI91X_WLAN_DUAL_MODE:
    case SL_SI91X_WLAN_BLE_MODE: {
      // Wi-Fi + Bluetooth mode
      mode_decision = (uint8_t)((performance_profile.wifi_performance_profile.profile << 4)
                                | (performance_profile.bt_performance_profile.profile));
    } break;
    default:
      break;
  }

  // Determine the performance profile based on the mode decision
  switch (mode_decision) {
    case 0x00:
    case 0x01:
    case 0x02:
    case 0x03:
    case 0x04:
    case 0x10:
    case 0x20:
    case 0x30:
    case 0x40: {
      *profile = HIGH_PERFORMANCE; // High performance mode
    } break;
    case 0x11:
    case 0x12:
    case 0x31:
    case 0x13:
    case 0x14:
    case 0x41: {
      *profile = ASSOCIATED_POWER_SAVE; // Power save mode
    } break;
    case 0x22:
    case 0x21:
    case 0x32:
    case 0x23:
    case 0x42:
    case 0x24: {
      *profile = ASSOCIATED_POWER_SAVE_LOW_LATENCY; // Low latency power save mode
    } break;
    case 0x33: {
      *profile = DEEP_SLEEP_WITHOUT_RAM_RETENTION; // Power save mode
    } break;
    case 0x44: {
      *profile = DEEP_SLEEP_WITH_RAM_RETENTION; // Power save mode with RAM retention
    } break;
    default: {
      // Do nothing
    } break;
  }
  return;
}

void reset_coex_current_performance_profile(void)
{
  memset(&performance_profile, 0, sizeof(sli_si91x_performance_profile_t));
}

void save_boot_configuration(const sl_si91x_boot_configuration_t *boot_configuration)
{
  memcpy(&saved_boot_configuration, boot_configuration, sizeof(sl_si91x_boot_configuration_t));
}

void get_saved_boot_configuration(sl_si91x_boot_configuration_t *boot_configuration)
{
  memcpy(boot_configuration, &saved_boot_configuration, sizeof(sl_si91x_boot_configuration_t));
}

void save_bt_current_performance_profile(const sl_bt_performance_profile_t *profile)
{
  SL_ASSERT(profile != NULL);
  memcpy(&performance_profile.bt_performance_profile, profile, sizeof(sl_bt_performance_profile_t));
}

void get_bt_current_performance_profile(sl_bt_performance_profile_t *profile)
{
  SL_ASSERT(profile != NULL);
  memcpy(profile, &performance_profile.bt_performance_profile, sizeof(sl_bt_performance_profile_t));
}

void save_tcp_auto_close_choice(bool is_tcp_auto_close_enabled)
{
  tcp_auto_close_enabled = is_tcp_auto_close_enabled;
}

bool is_tcp_auto_close_enabled()
{
  return tcp_auto_close_enabled;
}

void save_max_tx_power(uint8_t max_scan_tx_power, uint8_t max_join_tx_power)
{
  wifi_max_tx_power.scan_tx_power = max_scan_tx_power;
  wifi_max_tx_power.join_tx_power = max_join_tx_power;
}

sl_wifi_max_tx_power_t get_max_tx_power()
{
  return wifi_max_tx_power;
}

void reset_max_tx_power()
{
  wifi_max_tx_power.scan_tx_power = 0x1f;
  wifi_max_tx_power.join_tx_power = 0x1f;
}

void set_card_ready_required(bool card_ready_required)
{
  is_card_ready_required = card_ready_required;
}

bool get_card_ready_required()
{
  return is_card_ready_required;
}

void save_coex_mode(sl_si91x_coex_mode_t mode)
{
  coex_mode = mode;
}

sl_si91x_coex_mode_t get_coex_mode(void)
{
  return coex_mode;
}

sl_status_t convert_si91x_wifi_client_info(sl_wifi_client_info_response_t *client_info_response,
                                           const sl_si91x_client_info_response *sl_si91x_client_info_response)
{

  SL_WIFI_ARGS_CHECK_NULL_POINTER(sl_si91x_client_info_response);
  SL_WIFI_ARGS_CHECK_NULL_POINTER(client_info_response);

  client_info_response->client_count =
    (uint8_t)(sl_si91x_client_info_response->sta_count[0] | sl_si91x_client_info_response->sta_count[1] << 8);

  for (uint8_t station_index = 0; station_index < client_info_response->client_count; station_index++) {
    const uint8_t *si91x_ip_address;
    uint8_t *sl_ip_address;

    sl_wifi_client_info_t *sl_client_info            = &client_info_response->client_info[station_index];
    const sl_si91x_station_info_t *si91x_client_info = &sl_si91x_client_info_response->sta_info[station_index];

    uint8_t ip_address_size = (uint8_t)(si91x_client_info->ip_version[0] | si91x_client_info->ip_version[1] << 8);

    si91x_ip_address = ip_address_size == SL_IPV4_ADDRESS_LENGTH ? si91x_client_info->ip_address.ipv4_address
                                                                 : si91x_client_info->ip_address.ipv6_address;
    sl_ip_address    = ip_address_size == SL_IPV4_ADDRESS_LENGTH ? sl_client_info->ip_address.ip.v4.bytes
                                                                 : sl_client_info->ip_address.ip.v6.bytes;

    sl_client_info->ip_address.type = ip_address_size == SL_IPV4_ADDRESS_LENGTH ? SL_IPV4 : SL_IPV6;

    memcpy(&sl_client_info->mac_adddress, si91x_client_info->mac, sizeof(sl_mac_address_t));
    memcpy(sl_ip_address, si91x_ip_address, ip_address_size);
  }

  return SL_STATUS_OK;
}

sl_wifi_event_t convert_si91x_event_to_sl_wifi_event(rsi_wlan_cmd_response_t command, uint16_t frame_status)
{
  // Define a constant indicating a fail indication event
  const sl_wifi_event_t fail_indication = (frame_status != RSI_SUCCESS) ? SL_WIFI_EVENT_FAIL_INDICATION : 0;

  // Switch-case to map SI91x events to SL Wi-Fi events
  switch (command) {
    case RSI_WLAN_RSP_BG_SCAN:
    case RSI_WLAN_RSP_SCAN:
      return SL_WIFI_SCAN_RESULT_EVENT | fail_indication;
    case RSI_WLAN_RSP_JOIN:
      return SL_WIFI_JOIN_EVENT | fail_indication;
    case RSI_WLAN_RSP_GET_STATS:
      if (frame_status != RSI_SUCCESS) {
        return SL_WIFI_STATS_RESPONSE_EVENTS | fail_indication;
      }
      return SL_WIFI_STATS_EVENT;
    case RSI_WLAN_RSP_RX_STATS:
      if (frame_status != RSI_SUCCESS) {
        return SL_WIFI_STATS_RESPONSE_EVENTS | fail_indication;
      }
      return SL_WIFI_STATS_ASYNC_EVENT;
    case RSI_WLAN_RATE_RSP_STATS:
      if (frame_status != RSI_SUCCESS) {
        return SL_WIFI_STATS_RESPONSE_EVENTS | fail_indication;
      }
      return SL_WIFI_STATS_TEST_MODE_EVENT;
    case RSI_WLAN_RSP_EXT_STATS:
      if (frame_status != RSI_SUCCESS) {
        return SL_WIFI_STATS_RESPONSE_EVENTS | fail_indication;
      }
      return SL_WIFI_STATS_ADVANCE_EVENT;
    case RSI_WLAN_RSP_MODULE_STATE:
      if (frame_status != RSI_SUCCESS) {
        return SL_WIFI_STATS_RESPONSE_EVENTS | fail_indication;
      }
      return SL_WIFI_STATS_MODULE_STATE_EVENT;
    case RSI_WLAN_RSP_HTTP_OTAF:
      return SL_WIFI_HTTP_OTA_FW_UPDATE_EVENT | fail_indication;
    case RSI_WLAN_RSP_CLIENT_CONNECTED:
      return SL_WIFI_CLIENT_CONNECTED_EVENT | fail_indication;
    case RSI_WLAN_RSP_CLIENT_DISCONNECTED:
      return SL_WIFI_CLIENT_DISCONNECTED_EVENT | fail_indication;
    case RSI_WLAN_RSP_TWT_ASYNC:
      if (frame_status == RSI_SUCCESS) {
        return SL_WIFI_TWT_RESPONSE_EVENT;
      } else {
        return SL_WIFI_TWT_RESPONSE_EVENT | (frame_status << 16);
      }
    case RSI_WLAN_RSP_TRANSCEIVER_TX_DATA_STATUS:
      return SL_WIFI_TRANSCEIVER_TX_DATA_STATUS_CB | fail_indication;
    case SL_SI91X_WIFI_RX_DOT11_DATA:
      return SL_WIFI_TRANSCEIVER_RX_DATA_RECEIVE_CB | fail_indication;
    default:
      return SL_WIFI_INVALID_EVENT;
  }
}

sl_status_t save_sl_wifi_rate(sl_wifi_rate_t transfer_rate)
{
  // Check if the provided transfer rate is valid
  if (transfer_rate == SL_WIFI_RATE_INVALID) {
    return SL_STATUS_INVALID_CONFIGURATION;
  }

  saved_wifi_data_rate = transfer_rate;

  return SL_STATUS_OK;
}

sl_status_t get_saved_sl_wifi_rate(sl_wifi_rate_t *transfer_rate)
{
  SL_WIFI_ARGS_CHECK_NULL_POINTER(transfer_rate);

  *transfer_rate = saved_wifi_data_rate;
  return SL_STATUS_OK;
}

void reset_sl_wifi_rate()
{
  saved_wifi_data_rate = 0;
}

sl_status_t save_ap_configuration(const sl_wifi_ap_configuration_t *wifi_ap_configuration)
{
  // Check if the input pointer is valid
  SL_WIFI_ARGS_CHECK_NULL_POINTER(wifi_ap_configuration);
  ap_configuration = *wifi_ap_configuration;

  return SL_STATUS_OK;
}

sl_status_t get_saved_ap_configuration(sl_wifi_ap_configuration_t *wifi_ap_configuration)
{
  SL_WIFI_ARGS_CHECK_NULL_POINTER(wifi_ap_configuration);
  *wifi_ap_configuration = ap_configuration;

  return SL_STATUS_OK;
}

void reset_ap_configuration()
{
  // Initialize the ap_configuration structure with zeros
  ap_configuration = (sl_wifi_ap_configuration_t){ 0 };
}

sl_status_t get_rate_protocol_and_data_rate(const uint8_t data_rate,
                                            sl_wifi_rate_protocol_t *rate_protocol,
                                            sl_wifi_rate_t *mask)
{
  // Map the provided data_rate to a rate_protocol and set the mask accordingly
  switch (data_rate) {
    case SL_WIFI_AUTO_RATE: {
      *rate_protocol = SL_WIFI_RATE_PROTOCOL_AUTO;
      break;
    }
    case SL_WIFI_RATE_11B_1:
    case SL_WIFI_RATE_11B_2:
    case SL_WIFI_RATE_11B_5_5:
    case SL_WIFI_RATE_11B_11: {
      *rate_protocol = SL_WIFI_RATE_PROTOCOL_B_ONLY;
      break;
    }
    case SL_WIFI_RATE_11G_6:
    case SL_WIFI_RATE_11G_9:
    case SL_WIFI_RATE_11G_12:
    case SL_WIFI_RATE_11G_18:
    case SL_WIFI_RATE_11G_24:
    case SL_WIFI_RATE_11G_36:
    case SL_WIFI_RATE_11G_48:
    case SL_WIFI_RATE_11G_54: {
      *rate_protocol = SL_WIFI_RATE_PROTOCOL_G_ONLY;
      break;
    }
    case SL_WIFI_RATE_11N_MCS0:
    case SL_WIFI_RATE_11N_MCS1:
    case SL_WIFI_RATE_11N_MCS2:
    case SL_WIFI_RATE_11N_MCS3:
    case SL_WIFI_RATE_11N_MCS4:
    case SL_WIFI_RATE_11N_MCS5:
    case SL_WIFI_RATE_11N_MCS6:
    case SL_WIFI_RATE_11N_MCS7: {
      *rate_protocol = SL_WIFI_RATE_PROTOCOL_N_ONLY;
      break;
    }
    case SL_WIFI_RATE_11AX_MCS0:
    case SL_WIFI_RATE_11AX_MCS1:
    case SL_WIFI_RATE_11AX_MCS2:
    case SL_WIFI_RATE_11AX_MCS3:
    case SL_WIFI_RATE_11AX_MCS4:
    case SL_WIFI_RATE_11AX_MCS5:
    case SL_WIFI_RATE_11AX_MCS6:
    case SL_WIFI_RATE_11AX_MCS7: {
      *rate_protocol = SL_WIFI_RATE_PROTOCOL_AX_ONLY;
      break;
    }
    default: {
      return SL_STATUS_INVALID_CONFIGURATION;
    }
  }

  *mask = data_rate;

  return SL_STATUS_OK;
}

void convert_performance_profile_to_power_save_command(sl_si91x_performance_profile_t profile,
                                                       sl_si91x_power_save_request_t *power_save_request)
{
  SL_ASSERT(power_save_request != NULL);
  if (performance_profile.wifi_performance_profile.monitor_interval) {
    power_save_request->monitor_interval = performance_profile.wifi_performance_profile.monitor_interval;
  } else {
    power_save_request->monitor_interval = DEFAULT_MONITOR_INTERVAL;
  }

  power_save_request->ulp_mode_enable   = SL_ULP_WITH_RAM_RETENTION;
  power_save_request->dtim_aligned_type = performance_profile.wifi_performance_profile.dtim_aligned_type;
  power_save_request->num_of_dtim_skip  = performance_profile.wifi_performance_profile.num_of_dtim_skip;
  power_save_request->listen_interval   = performance_profile.wifi_performance_profile.listen_interval;
  power_save_request->psp_type          = SL_MAX_PSP;

  // Depending on the specified performance profile, configure the power_save_request structure
  switch (profile) {
    case HIGH_PERFORMANCE: {
      // For HIGH_PERFORMANCE profile, reset all fields in the power_save_request structure to zero
      memset(power_save_request, 0, sizeof(sl_si91x_power_save_request_t));
      break;
    }

    case ASSOCIATED_POWER_SAVE: {
#ifdef SLI_SI91X_MCU_INTERFACE
      power_save_request->power_mode = SL_CONNECTED_M4_BASED_PS;
#else
      power_save_request->power_mode = SL_CONNECTED_GPIO_BASED_PS;
#endif
      break;
    }

    case ASSOCIATED_POWER_SAVE_LOW_LATENCY: {
#ifdef SLI_SI91X_MCU_INTERFACE
      power_save_request->power_mode = SL_CONNECTED_M4_BASED_PS;
#else
      power_save_request->power_mode = SL_CONNECTED_GPIO_BASED_PS;
#endif
      power_save_request->psp_type = SL_FAST_PSP;
      break;
    }

    case DEEP_SLEEP_WITHOUT_RAM_RETENTION: {
#ifdef SLI_SI91X_MCU_INTERFACE
      power_save_request->power_mode = SL_M4_BASED_DEEP_SLEEP;
#else
      power_save_request->power_mode = SL_GPIO_BASED_DEEP_SLEEP;
#endif
      power_save_request->ulp_mode_enable = SL_ULP_WITHOUT_RAM_RET_RETENTION;
      break;
    }

    case DEEP_SLEEP_WITH_RAM_RETENTION: {
#ifdef SLI_SI91X_MCU_INTERFACE
      power_save_request->power_mode = SL_M4_BASED_DEEP_SLEEP;
#else
      power_save_request->power_mode = SL_GPIO_BASED_DEEP_SLEEP;
#endif
      break;
    }
    default: {
      // Do nothing
    } break;
  }

  return;
}

//In Access point mode NWP only supports No Encryption, TKIP and CCMP encryptions.
sl_status_t convert_sl_wifi_to_sl_si91x_encryption(sl_wifi_encryption_t encryption_mode, uint8_t *encryption_request)
{
  switch (encryption_mode) {
    case SL_WIFI_NO_ENCRYPTION:
      *encryption_request = SL_SI91X_NO_ENCRYPTION;
      break;
    case SL_WIFI_TKIP_ENCRYPTION:
      *encryption_request = SL_SI91X_TKIP_ENCRYPTION;
      break;
    case SL_WIFI_CCMP_ENCRYPTION:
    case SL_WIFI_DEFAULT_ENCRYPTION:
      *encryption_request = SL_SI91X_CCMP_ENCRYPTION;
      break;
    default:
      return SL_STATUS_NOT_SUPPORTED;
  }

  return SL_STATUS_OK;
}

sl_status_t sl_si91x_platform_init(void)
{
  sl_status_t status = SL_STATUS_OK;

  // Initialize the command queues
  memset(cmd_queues, 0, sizeof(cmd_queues));

  // Create event flags
  if (NULL == si91x_events) {
    si91x_events = osEventFlagsNew(NULL);
  }

  if (NULL == si91x_bus_events) {
    si91x_bus_events = osEventFlagsNew(NULL);
  }

  if (NULL == si91x_async_events) {
    si91x_async_events = osEventFlagsNew(NULL);
  }

  // Create and start SI91X bus thread
  if (NULL == si91x_thread) {
    const osThreadAttr_t attr = {

      .name       = "si91x_bus",
      .priority   = osPriorityRealtime,
      .stack_mem  = 0,
      .stack_size = 1636,
      .cb_mem     = 0,
      .cb_size    = 0,
      .attr_bits  = 0u,
      .tz_module  = 0u,
    };
    si91x_thread = osThreadNew(si91x_bus_thread, NULL, &attr);
  }

  // Create and start SI91X event handler thread
  if (NULL == si91x_event_thread) {
    const osThreadAttr_t attr = {
      .name       = "si91x_event",
      .priority   = osPriorityRealtime1,
      .stack_mem  = 0,
      .stack_size = SL_SI91X_EVENT_HANDLER_STACK_SIZE,
      .cb_mem     = 0,
      .cb_size    = 0,
      .attr_bits  = 0u,
      .tz_module  = 0u,
    };
    si91x_event_thread = osThreadNew(si91x_event_handler_thread, NULL, &attr);
  }

  // Initialize command queues and associated mutexes
  for (int i = 0; i < SI91X_CMD_MAX; i++) {
    cmd_queues[i].tx_queue.head    = NULL;
    cmd_queues[i].tx_queue.tail    = NULL;
    cmd_queues[i].rx_queue.head    = NULL;
    cmd_queues[i].rx_queue.tail    = NULL;
    cmd_queues[i].event_queue.head = NULL;
    cmd_queues[i].event_queue.tail = NULL;
    cmd_queues[i].mutex            = osMutexNew(NULL);
    cmd_queues[i].flag             = (1 << i);
  }

  // Create malloc/free mutex
  if (malloc_free_mutex == NULL) {
    malloc_free_mutex = osMutexNew(NULL);
  }

#ifdef SL_SI91X_SIDE_BAND_CRYPTO
  // Create side_band_crypto_mutex mutex
  side_band_crypto_mutex = osMutexNew(NULL);
#endif

  return status;
}

sl_status_t sl_si91x_platform_deinit(void)
{

  // Deallocate all threads, mutexes and event handlers

  // Terminate SI91X bus thread
  if (NULL != si91x_thread) {
    // Signal the thread to terminate
    osEventFlagsSet(si91x_bus_events, SL_SI91X_TERMINATE_BUS_THREAD_EVENT);

    // Wait for thread termination acknowledgment
    osStatus_t stat = osEventFlagsWait(si91x_events, SL_SI91X_TERMINATE_BUS_THREAD_EVENT_ACK, osFlagsWaitAny, 5000);
    if (stat == osErrorTimeout) {
      // Return timeout if acknowledgment is not received
      return SL_STATUS_TIMEOUT;
    }

    si91x_thread = NULL;
  }

  // Terminate SI91X event handler thread
  if (NULL != si91x_event_thread) {
    osThreadTerminate(si91x_event_thread);
    si91x_event_thread = NULL;
  }

  // Delete event flags
  if (NULL != si91x_events) {
    osEventFlagsDelete(si91x_events);
    si91x_events = NULL;
  }

  if (NULL != si91x_bus_events) {
    osEventFlagsDelete(si91x_bus_events);
    si91x_bus_events = NULL;
  }

  if (NULL != si91x_async_events) {
    osEventFlagsDelete(si91x_async_events);
    si91x_async_events = NULL;
  }

  // Delete command queue mutexes
  for (int i = 0; i < SI91X_CMD_MAX; i++) {
    osMutexDelete(cmd_queues[i].mutex);
    cmd_queues[i].mutex = NULL;
  }

  // Delete malloc/free mutex
  osMutexDelete(malloc_free_mutex);
  malloc_free_mutex = NULL;
  return SL_STATUS_OK;
}

sl_si91x_host_timestamp_t sl_si91x_host_get_timestamp(void)
{
  return osKernelGetTickCount();
}

// Calculate elapsed time from the given starting timestamp
sl_si91x_host_timestamp_t sl_si91x_host_elapsed_time(uint32_t starting_timestamp)
{
  uint32_t current_tickcount = osKernelGetTickCount();

  // Check if the tick count has overflow or not.
  if (current_tickcount >= starting_timestamp) {
    return (current_tickcount - starting_timestamp);
  } else {
    return ((0xFFFFFFFF - starting_timestamp) + current_tickcount);
  }
}

// Delay execution for a specified number of milliseconds using an OS-level delay
void sl_si91x_host_delay_ms(uint32_t delay_milliseconds)
{
  osDelay(delay_milliseconds);
}

void sli_si91x_set_event(uint32_t event_mask)
{
  osEventFlagsSet(si91x_events, event_mask);
}

void sl_si91x_host_set_bus_event(uint32_t event_mask)
{
  osEventFlagsSet(si91x_bus_events, event_mask);
}

sl_status_t sli_si91x_add_to_queue(sl_si91x_buffer_queue_t *queue, sl_wifi_buffer_t *buffer)
{
  sli_si91x_append_to_buffer_queue(queue, buffer);
  return SL_STATUS_OK;
}

sl_status_t sli_si91x_remove_from_queue(sl_si91x_buffer_queue_t *queue, sl_wifi_buffer_t **buffer)
{
  return sli_si91x_pop_from_buffer_queue(queue, buffer);
}

sl_status_t sli_si91x_flush_all_tx_wifi_queues(uint16_t frame_status)
{
  // free all TX queues except BT
  for (int queue_id = 0; queue_id < SI91X_CMD_MAX; queue_id++) {
    if (queue_id == SI91X_BT_CMD) {
      continue;
    }
    sli_si91x_flush_queue_based_on_type(&cmd_queues[queue_id],
                                        SL_SI91X_RESPONSE_FLAG(queue_id),
                                        frame_status,
                                        NULL,
                                        NULL);
  }
  return SL_STATUS_OK;
}

sl_status_t sli_si91x_flush_generic_data_queues(sl_si91x_buffer_queue_t *tx_data_queue)
{
  sl_wifi_buffer_t *current_packet = NULL;
  sl_wifi_buffer_t *next_packet    = NULL;

  // Validate input
  if (tx_data_queue == NULL) {
    return SL_STATUS_FAIL;
  }

  // Prevent race conditions
  CORE_irqState_t state = CORE_EnterAtomic();

  // Free all packets in the queue
  current_packet = tx_data_queue->head;
  while (current_packet != NULL) {
    next_packet = (sl_wifi_buffer_t *)current_packet->node.node;
    sl_si91x_host_free_buffer(current_packet);
    current_packet = next_packet;
  }

  // Reset the queue
  tx_data_queue->head = NULL;
  tx_data_queue->tail = NULL;

  // Clear pending TX status
  tx_generic_socket_data_queues_status &= ~(SL_SI91X_GENERIC_DATA_TX_PENDING_EVENT);

  CORE_ExitAtomic(state);

  return SL_STATUS_OK;
}

sl_status_t sli_si91x_flush_queue_based_on_type(sli_si91x_command_queue_t *queue,
                                                uint32_t event_mask,
                                                uint16_t frame_status,
                                                sl_si91x_compare_function_t compare_function,
                                                void *user_data)
{
  sl_wifi_buffer_t *current_packet     = NULL;
  sl_wifi_buffer_t *next_packet        = NULL;
  sli_si91x_queue_packet_t *queue_node = NULL;
  sl_wifi_buffer_t *previous_packet    = NULL;
  sl_status_t status                   = SL_STATUS_FAIL;

  // Enter atomic section to prevent race conditions
  CORE_irqState_t state = CORE_EnterAtomic();

  // Check if the queue is not the BT command queue and has a command in flight
  if ((queue != &cmd_queues[SI91X_BT_CMD]) && (queue->command_in_flight == true)) {
    // Create a generic RX packet
    status = sl_create_generic_rx_packet_from_params(&queue_node,
                                                     &current_packet,
                                                     queue->packet_id,
                                                     queue->flags,
                                                     queue->sdk_context,
                                                     frame_status);
    if (status != SL_STATUS_OK) {
      CORE_ExitAtomic(state);
      return status; // Exit if packet creation fails
    }
    sl_wifi_buffer_t *dummy_packet_buffer = NULL;

    // Allocate buffer for the dummy packet
    status = sl_si91x_host_allocate_buffer(&dummy_packet_buffer,
                                           SL_WIFI_RX_FRAME_BUFFER,
                                           sizeof(sl_si91x_packet_t),
                                           SL_WIFI_ALLOCATE_COMMAND_BUFFER_WAIT_TIME);
    if (status != SL_STATUS_OK) {
      CORE_ExitAtomic(state);
      sl_si91x_host_free_buffer(current_packet); // Free current_packet on failure
      return status;                             // Exit if buffer allocation fails
    }

    // Get the dummy packet data from the allocated buffer
    sl_si91x_packet_t *dummy_packet = sl_si91x_host_get_buffer_data(dummy_packet_buffer, 0, NULL);
    queue_node->host_packet         = dummy_packet_buffer; // Link dummy packet to the node
    dummy_packet->desc[2]           = (uint8_t)queue->frame_type;
    dummy_packet->desc[3]           = (uint8_t)((0xFF00 & queue->frame_type) >> 8);

    if (!compare_function || compare_function(queue_node->host_packet, user_data)) {

      if (!(queue->flags & SI91X_PACKET_RESPONSE_PACKET)) {
        sl_si91x_host_free_buffer(dummy_packet_buffer);
      }
      // Check if the packet in the queue is synchronous or asynchronous response
      if (sl_si91x_host_elapsed_time(queue->command_tickcount) <= (queue->command_timeout)) {
        // Add the packet to the response queue and set the event
        sli_si91x_add_to_queue(&queue->rx_queue, current_packet);
        sli_si91x_set_event(event_mask);
      } else {
        // no user thread is waiting for the response so flush the packet
        sl_si91x_host_free_buffer(current_packet);
        sl_si91x_host_free_buffer(dummy_packet_buffer);
      }
      tx_command_queues_command_in_flight_status &= ~(event_mask);

      // Reset command trace for the queue
      queue->command_in_flight = false;
      queue->frame_type        = 0;
      queue->flag              = 0;
      queue->command_tickcount = 0;
      queue->command_timeout   = 0;
    }
  }

  // Start with the head of the TX queue
  current_packet = queue->tx_queue.head;

  // Iterate through all packets in the TX queue
  while (current_packet != NULL) {
    // Get the associated queue node
    queue_node = sl_si91x_host_get_buffer_data(current_packet, 0, NULL);
    if (queue_node == NULL) {
      CORE_ExitAtomic(state);
      return SL_STATUS_NOT_AVAILABLE; // Exit if queue node retrieval fails
    }

    if (!compare_function || compare_function(queue_node->host_packet, user_data) == false) {
      previous_packet = current_packet;
      current_packet  = (sl_wifi_buffer_t *)current_packet->node.node;
      continue;
    }

    // Save the next packet in the queue
    next_packet = (sl_wifi_buffer_t *)current_packet->node.node;

    // Check if the packet in the TX queue is synchronous or asynchronous
    if (queue_node->flags & SI91X_PACKET_RESPONSE_STATUS) {
      // Update the frame_status and other details
      queue_node->frame_status  = frame_status;
      current_packet->node.node = NULL;

      // Check if the TX packet is not expecting a response, then free the host packet
      if (!(queue_node->flags & SI91X_PACKET_RESPONSE_PACKET)) {
        if (queue_node->host_packet != NULL) {
          sl_si91x_host_free_buffer(queue_node->host_packet);
          queue_node->host_packet = NULL;
        }
      }

      // Check if the packet in the queue is synchronous or asynchronous response
      if (sl_si91x_host_elapsed_time(queue_node->command_tickcount) <= (queue_node->command_timeout)) {
        // Add the packet to the response queue and set the event
        sli_si91x_add_to_queue(&queue->rx_queue, current_packet);
        sli_si91x_set_event(event_mask);
      } else {
        // no user thread is waiting for the response so flush the packet
        if ((queue_node->flags & SI91X_PACKET_RESPONSE_PACKET) == SI91X_PACKET_RESPONSE_PACKET) {
          sl_si91x_host_free_buffer(queue_node->host_packet);
        }
        sl_si91x_host_free_buffer(current_packet);
      }
    } else {
      // Handle asynchronous packets by freeing them
      sl_si91x_host_free_buffer(current_packet);
    }

    // Update the head of the queue if the current packet is the head
    if (current_packet == queue->tx_queue.head) {
      queue->tx_queue.head = next_packet;
    }

    // Update the tail of the queue if the current packet is the tail
    if (current_packet == queue->tx_queue.tail) {
      queue->tx_queue.tail = previous_packet;
    }

    // Move to the next packet
    previous_packet = current_packet;
    current_packet  = next_packet;
  }

  // Check if the queue is empty and update tx_command_queues_status
  if (queue->tx_queue.head == NULL) {
    // Clear the tail pointer of the TX queue
    queue->tx_queue.tail = NULL;
    tx_command_queues_status &= ~(event_mask);
  }

  // Exit atomic section
  CORE_ExitAtomic(state);

  // Return SL_STATUS_OK indicating the operation was successful
  return SL_STATUS_OK;
}

#ifdef SLI_SI91X_OFFLOAD_NETWORK_STACK
sl_status_t sli_si91x_flush_all_socket_command_queues(uint16_t frame_status, uint8_t vap_id)
{
  sl_status_t status;

  // Loop through all sockets
  for (int index = 0; index < NUMBER_OF_SOCKETS; index++) {
    // Check if the socket exists and matches the required VAP ID
    if ((sli_si91x_sockets[index] != NULL) && (sli_si91x_sockets[index]->vap_id == vap_id)) {
      // Flush the command queues for the current socket based on queue type
      status = sli_si91x_flush_socket_command_queues_based_on_queue_type(index, frame_status);
      // If flushing fails, return the error status immediately
      if (status != SL_STATUS_OK) {
        return status;
      }
    }
  }
  // Return SL_STATUS_OK if all sockets were processed successfully
  return SL_STATUS_OK;
}

sl_status_t sli_si91x_flush_socket_command_queues_based_on_queue_type(uint8_t index, uint16_t frame_status)
{
  sl_wifi_buffer_t *current_packet     = NULL;
  sl_wifi_buffer_t *next_packet        = NULL;
  sli_si91x_queue_packet_t *queue_node = NULL;

  // Retrieve the socket using the provided index
  sli_si91x_socket_t *socket = get_si91x_socket(index);

  if (socket == NULL) {
    return SL_STATUS_FAIL;
  }

  // Enter atomic state to prevent race conditions
  CORE_irqState_t state = CORE_EnterAtomic();

  // Check if there is a command currently in flight
  if ((socket->command_queue.command_in_flight) && ((socket->command_queue.flags) & SI91X_PACKET_RESPONSE_STATUS)) {
    // Create a generic RX packet from the current command parameters
    sl_status_t status = sl_create_generic_rx_packet_from_params(&queue_node,
                                                                 &current_packet,
                                                                 socket->command_queue.packet_id,
                                                                 socket->command_queue.flags,
                                                                 socket->command_queue.sdk_context,
                                                                 frame_status);
    // If packet creation fails, exit atomic state and return the error status
    if (status != SL_STATUS_OK) {
      CORE_ExitAtomic(state);
      return status;
    }

    // Handle packets that expect a response
    if (queue_node->flags & SI91X_PACKET_RESPONSE_PACKET) {
      sl_wifi_buffer_t *host_packet = NULL;
      uint16_t length               = 0;
      if (socket->command_queue.frame_type == RSI_WLAN_RSP_SOCKET_CLOSE) {
        length = sizeof(sl_si91x_packet_t) + sizeof(sl_si91x_socket_close_response_t);
      } else {
        length = sizeof(sl_si91x_packet_t);
      }
      // Allocate a buffer for the host packet
      status = sl_si91x_host_allocate_buffer(&host_packet,
                                             SL_WIFI_RX_FRAME_BUFFER,
                                             length,
                                             SL_WIFI_ALLOCATE_COMMAND_BUFFER_WAIT_TIME);
      // If buffer allocation fails, log an error, trigger a breakpoint, and return
      if (status != SL_STATUS_OK) {
        SL_DEBUG_LOG("\r\n HEAP EXHAUSTED DURING ALLOCATION \r\n");
        BREAKPOINT();
      }

      // Populate the packet descriptor with frame status
      sl_si91x_packet_t *si91x_packet = (sl_si91x_packet_t *)sl_si91x_host_get_buffer_data(host_packet, 0, NULL);
      si91x_packet->desc[12]          = (uint8_t)(frame_status & 0x00FF);
      si91x_packet->desc[13]          = (uint8_t)((frame_status & 0xFF00) >> 8);
      queue_node->host_packet         = host_packet;
      host_packet->id                 = current_packet->id;
      if (socket->command_queue.frame_type == RSI_WLAN_RSP_SOCKET_CLOSE) {
        si91x_packet->desc[12]   = 0;
        si91x_packet->desc[13]   = 0;
        queue_node->frame_status = SL_STATUS_OK;
        sl_si91x_socket_close_response_t *socket_close_response =
          (sl_si91x_socket_close_response_t *)si91x_packet->data;
        socket_close_response->socket_id   = (uint16_t)socket->id;
        socket_close_response->port_number = socket->local_address.sin6_port;
      }
    }

    // Add the packet to the appropriate queue and set the event
    if (sl_si91x_host_elapsed_time(socket->command_queue.command_tickcount) <= socket->command_queue.command_timeout) {
      if (socket->command_queue.frame_type == RSI_WLAN_RSP_SOCKET_READ_DATA) {
        sli_si91x_add_to_queue(&socket->rx_data_queue, queue_node->host_packet);
      } else {
        sli_si91x_add_to_queue(&socket->command_queue.rx_queue, current_packet);
      }
      sli_si91x_set_socket_event((1 << socket->index));
    } else {
      // no user thread is waiting for the response so flush the packet
      if (queue_node->flags & SI91X_PACKET_RESPONSE_PACKET) {
        sl_si91x_host_free_buffer(queue_node->host_packet);
      }
      sl_si91x_host_free_buffer(current_packet);
    }
    tx_socket_command_command_in_flight_queues_status |= (1 << socket->index);
    // Reset command trace fields in the queue
    socket->command_queue.command_in_flight = false;
    socket->command_queue.command_tickcount = 0;
    socket->command_queue.command_timeout   = 0;
    socket->command_queue.frame_type        = 0;
  }

  // Start processing the TX queue
  current_packet = socket->command_queue.tx_queue.head;

  // Iterate through all packets in the command queue
  while (current_packet != NULL) {
    // Retrieve the queue node from the current packet
    queue_node = sl_si91x_host_get_buffer_data(current_packet, 0, NULL);
    if (queue_node == NULL) {
      // If queue node is NULL, exit atomic state and return error status
      CORE_ExitAtomic(state);
      return SL_STATUS_NOT_AVAILABLE;
    }

    // Assign next_packet to the next node in the list
    next_packet = (sl_wifi_buffer_t *)current_packet->node.node;

    // Check if the packet in the TX queue is synchronous or asynchronous
    if (queue_node->flags & SI91X_PACKET_RESPONSE_STATUS) {
      // Update the frame_status and other details for synchronous packets
      queue_node->frame_status  = frame_status;
      current_packet->node.node = NULL;
      int32_t frame_type        = sli_get_socket_command_from_host_packet(queue_node->host_packet);
      // Check if the TX packet is not expecting a response, then free the host packet
      if (!(queue_node->flags & SI91X_PACKET_RESPONSE_PACKET)) {
        if (queue_node->host_packet != NULL) {
          sl_si91x_host_free_buffer(queue_node->host_packet);
          queue_node->host_packet = NULL;
        }
      }

      // Add to response queue and raise event based on frame type
      if (sl_si91x_host_elapsed_time(queue_node->command_tickcount) <= queue_node->command_timeout) {
        if (frame_type == RSI_WLAN_RSP_SOCKET_CLOSE) {
          sl_si91x_host_free_buffer(queue_node->host_packet);
          sl_wifi_buffer_t *host_packet = NULL;
          // Allocate a buffer for the host packet
          sl_status_t status =
            sl_si91x_host_allocate_buffer(&host_packet,
                                          SL_WIFI_RX_FRAME_BUFFER,
                                          sizeof(sl_si91x_packet_t) + sizeof(sl_si91x_socket_close_response_t),
                                          SL_WIFI_ALLOCATE_COMMAND_BUFFER_WAIT_TIME);
          // If buffer allocation fails, log an error, trigger a breakpoint, and return
          if (status != SL_STATUS_OK) {
            SL_DEBUG_LOG("\r\n HEAP EXHAUSTED DURING ALLOCATION \r\n");
            BREAKPOINT();
          }
          queue_node->host_packet  = host_packet;
          queue_node->frame_status = SL_STATUS_OK;
          sl_si91x_packet_t *si91x_packet =
            (sl_si91x_packet_t *)sl_si91x_host_get_buffer_data(queue_node->host_packet, 0, NULL);
          si91x_packet->desc[12] = 0;
          si91x_packet->desc[13] = 0;
          sl_si91x_socket_close_response_t *socket_close_response =
            (sl_si91x_socket_close_response_t *)si91x_packet->data;
          socket_close_response->socket_id   = (uint16_t)socket->id;
          socket_close_response->port_number = socket->local_address.sin6_port;
        }
        if (frame_type == RSI_WLAN_RSP_SOCKET_READ_DATA) {
          sl_si91x_packet_t *si91x_packet =
            (sl_si91x_packet_t *)sl_si91x_host_get_buffer_data(queue_node->host_packet, 0, NULL);
          if (si91x_packet != NULL) {
            si91x_packet->desc[12] = (uint8_t)(frame_status & 0x00FF);
            si91x_packet->desc[13] = (uint8_t)((frame_status & 0xFF00) >> 8);
            sli_si91x_add_to_queue(&socket->rx_data_queue, queue_node->host_packet);
          }
        } else {
          sli_si91x_add_to_queue(&socket->command_queue.rx_queue, current_packet);
        }

        sli_si91x_set_socket_event((1 << socket->index));
      } else {
        // no user thread is waiting for the response so flush the packet
        if ((queue_node->flags & SI91X_PACKET_RESPONSE_PACKET) == SI91X_PACKET_RESPONSE_PACKET) {
          sl_si91x_host_free_buffer(queue_node->host_packet);
        }
        sl_si91x_host_free_buffer(current_packet);
      }
    } else {
      // Handle asynchronous packets by freeing the buffer
      sl_si91x_host_free_buffer(current_packet);
    }

    // Move to the next packet in the queue
    current_packet = next_packet;
  }

  // Clear the head and tail pointers of the TX queue
  socket->command_queue.tx_queue.head = NULL;
  socket->command_queue.tx_queue.tail = NULL;
  // Clear the socket command queue status
  tx_socket_command_queues_status &= ~(1 << socket->index);

  // Exit atomic state
  CORE_ExitAtomic(state);
  // Return successful status
  return SL_STATUS_OK;
}
sl_status_t sli_si91x_flush_all_socket_data_queues(uint8_t vap_id)
{
  sl_status_t status;

  // Loop through all sockets
  for (int index = 0; index < NUMBER_OF_SOCKETS; index++) {
    // Retrieve the socket using the provided index
    const sli_si91x_socket_t *socket = sli_si91x_sockets[index];

    // Check if the socket exists and matches the required VAP ID
    if ((socket != NULL) && (socket->vap_id == vap_id)) {
      // Flush the data queues for the current socket based on queue type
      status = sli_si91x_flush_socket_data_queues_based_on_queue_type(index);
      // If flushing fails, return the error status immediately
      if (status != SL_STATUS_OK) {
        return status;
      }
    }
  }
  // Return SL_STATUS_OK if all sockets were processed successfully
  return SL_STATUS_OK;
}

sl_status_t sli_si91x_flush_socket_data_queues_based_on_queue_type(uint8_t index)
{
  sl_wifi_buffer_t *current_packet = NULL;
  sl_wifi_buffer_t *next_packet    = NULL;

  // Retrieve the socket using the provided index
  sli_si91x_socket_t *socket = get_si91x_socket(index);

  if (socket == NULL) {
    return SL_STATUS_FAIL;
  }

  // Enter atomic section to prevent race conditions
  CORE_irqState_t state = CORE_EnterAtomic();

  // Start with the head of the TX data queue
  current_packet = socket->tx_data_queue.head;

  // Iterate through all packets in the queue
  while (current_packet != NULL) {
    // Save the next packet in the queue
    next_packet = (sl_wifi_buffer_t *)current_packet->node.node;

    // Free the current packet using the provided free function
    sl_si91x_host_free_buffer(current_packet);

    // Move to the next packet
    current_packet = next_packet;
  }

  // Clear the head and tail pointers of the queue to indicate it is empty
  socket->tx_data_queue.head = NULL;
  socket->tx_data_queue.tail = NULL;

  // Clear the socket data queue status
  tx_socket_data_queues_status &= ~(1 << socket->index);

  // Exit atomic section
  CORE_ExitAtomic(state);

  // Return SL_STATUS_OK indicating the operation was successful
  return SL_STATUS_OK;
}

#endif

uint32_t sl_si91x_host_queue_status(sl_si91x_buffer_queue_t *queue)
{
  return queue->head != NULL;
}

uint32_t sli_si91x_wait_for_event(uint32_t event_mask, uint32_t timeout)
{
  uint32_t result = osEventFlagsWait(si91x_events, event_mask, osFlagsWaitAny, timeout);

  if (result == (uint32_t)osErrorTimeout || result == (uint32_t)osErrorResource) {
    return 0;
  }
  return result;
}

uint32_t si91x_host_wait_for_bus_event(uint32_t event_mask, uint32_t timeout)
{
  uint32_t result = osEventFlagsWait(si91x_bus_events, event_mask, osFlagsWaitAny, timeout);

  if (result == (uint32_t)osErrorTimeout || result == (uint32_t)osErrorResource) {
    return 0;
  }
  return result;
}

uint32_t sli_si91x_clear_event(uint32_t event_mask)
{
  uint32_t result = osEventFlagsClear(si91x_events, event_mask);
  if (result == (uint32_t)osErrorResource) {
    return 0;
  }
  return result;
}

sl_status_t sli_si91x_send_power_save_request(const sl_wifi_performance_profile_t *wifi_profile,
                                              const sl_bt_performance_profile_t *bt_profile)
{
  sl_status_t status;
  sl_si91x_power_save_request_t power_save_request          = { 0 };
  sl_si91x_performance_profile_t selected_coex_profile_mode = { 0 };
  // Disable power save mode by setting it to HIGH_PERFORMANCE profile
  status = sl_si91x_driver_send_command(RSI_COMMON_REQ_PWRMODE,
                                        SI91X_COMMON_CMD,
                                        &power_save_request,
                                        sizeof(sl_si91x_power_save_request_t),
                                        SL_SI91X_WAIT_FOR_COMMAND_SUCCESS,
                                        NULL,
                                        NULL);
  VERIFY_STATUS_AND_RETURN(status);

  if (NULL != wifi_profile) {
    // Save the new Wi-Fi profile
    save_wifi_current_performance_profile(wifi_profile);
  }

  if (NULL != bt_profile) {
    // Save the new BT/BLE profile
    save_bt_current_performance_profile(bt_profile);
  }

  // get the updated coex profile
  get_coex_performance_profile(&selected_coex_profile_mode);

  // If the requested performance profile is HIGH_PERFORMANCE, no need to send the request to firmware
  if (selected_coex_profile_mode == HIGH_PERFORMANCE) {
    return SL_STATUS_OK;
  }

  // Convert the performance profile to a power save request.
  convert_performance_profile_to_power_save_command(selected_coex_profile_mode, &power_save_request);

  status = sl_si91x_driver_send_command(RSI_COMMON_REQ_PWRMODE,
                                        SI91X_COMMON_CMD,
                                        &power_save_request,
                                        sizeof(sl_si91x_power_save_request_t),
                                        SL_SI91X_WAIT_FOR_RESPONSE(3000),
                                        NULL,
                                        NULL);
  VERIFY_STATUS_AND_RETURN(status);
  return status;
}

sl_status_t sl_si91x_host_power_cycle(void)
{
  sl_si91x_host_hold_in_reset();
  sl_si91x_host_delay_ms(100);

  sl_si91x_host_release_from_reset();
  sl_si91x_host_delay_ms(100);

  return SL_STATUS_OK;
}

void print_80211_packet(const uint8_t *packet, uint32_t packet_length, uint16_t max_payload_length)
{
  uint32_t dump_bytes    = 0;
  uint32_t header_length = MAC80211_HDR_MIN_LEN;

  header_length += (packet[0] & BIT(7)) ? 2 : 0;                           /* 2 bytes QoS control */
  header_length += ((packet[1] & BIT(0)) && (packet[1] & BIT(1))) ? 6 : 0; /* 6 byte Addr4 */

  sl_debug_log("%02x %02x | ", packet[0], packet[1]); /* FC */
  sl_debug_log("%02x %02x | ", packet[2], packet[3]); /* Dur */
  sl_debug_log("%02x:%02x:%02x:%02x:%02x:%02x | ",
               packet[4],
               packet[5],
               packet[6],
               packet[7],
               packet[8],
               packet[9]); /* Addr1/RA */
  sl_debug_log("%02x:%02x:%02x:%02x:%02x:%02x | ",
               packet[10],
               packet[11],
               packet[12],
               packet[13],
               packet[14],
               packet[15]); /* Addr2/NWP */
  sl_debug_log("%02x:%02x:%02x:%02x:%02x:%02x | ",
               packet[16],
               packet[17],
               packet[18],
               packet[19],
               packet[20],
               packet[21]);                             /* Addr3/DA */
  sl_debug_log("%02x %02x | ", packet[22], packet[23]); /* Seq control */
  if ((packet[1] & BIT(0)) && (packet[1] & BIT(1))) {   /* Addr4 */
    sl_debug_log("%02x:%02x:%02x:%02x:%02x:%02x | ",
                 packet[24],
                 packet[25],
                 packet[26],
                 packet[27],
                 packet[28],
                 packet[29]);
  }
  if (packet[0] & BIT(7)) {
    sl_debug_log("%02x %02x | ", packet[30], packet[31]); /* QoS control */
  }

  // Determine number of payload bytes to print
  dump_bytes = packet_length - header_length;
  dump_bytes = max_payload_length > dump_bytes ? dump_bytes : max_payload_length;

  for (uint32_t i = header_length; i < header_length + dump_bytes; i++) {
    sl_debug_log("%02x ", packet[i]);
  }

  sl_debug_log("|\r\n");
}

sli_si91x_command_queue_t *sli_si91x_get_command_queue(sl_si91x_command_type_t type)
{
  switch (type) {
    case SI91X_WLAN_CMD:
      return &cmd_queues[SI91X_WLAN_CMD];
    case SI91X_NETWORK_CMD:
      return &cmd_queues[SI91X_NETWORK_CMD];
    case SI91X_BT_CMD:
      return &cmd_queues[SI91X_BT_CMD];
    case SI91X_SOCKET_CMD:
      return &cmd_queues[SI91X_SOCKET_CMD];

    case SI91X_COMMON_CMD:
    default:
      return &cmd_queues[SI91X_COMMON_CMD];
  }
}

uint8_t sli_lmac_crc8_c(uint8_t crc8_din, uint8_t crc8_state, uint8_t end)
{
  uint8_t din[8];
  uint8_t state[8];
  uint8_t state_c[8];
  uint8_t crc8_out;

  din[0] = ((crc8_din & BIT(7)) >> 7);
  din[1] = ((crc8_din & BIT(6)) >> 6);
  din[2] = ((crc8_din & BIT(5)) >> 5);
  din[3] = ((crc8_din & BIT(4)) >> 4);
  din[4] = ((crc8_din & BIT(3)) >> 3);
  din[5] = ((crc8_din & BIT(2)) >> 2);
  din[6] = ((crc8_din & BIT(1)) >> 1);
  din[7] = ((crc8_din & BIT(0)) >> 0);

  state[0] = ((crc8_state & BIT(0)) >> 0);
  state[1] = ((crc8_state & BIT(1)) >> 1);
  state[2] = ((crc8_state & BIT(2)) >> 2);
  state[3] = ((crc8_state & BIT(3)) >> 3);
  state[4] = ((crc8_state & BIT(4)) >> 4);
  state[5] = ((crc8_state & BIT(5)) >> 5);
  state[6] = ((crc8_state & BIT(6)) >> 6);
  state[7] = ((crc8_state & BIT(7)) >> 7);

  state_c[7] = (state[7] ^ din[7]) ^ (state[6] ^ din[6]) ^ (state[5] ^ din[5]);

  state_c[6] = (state[6] ^ din[6]) ^ (state[5] ^ din[5]) ^ (state[4] ^ din[4]);

  state_c[5] = (state[5] ^ din[5]) ^ (state[4] ^ din[4]) ^ (state[3] ^ din[3]);

  state_c[4] = (state[4] ^ din[4]) ^ (state[3] ^ din[3]) ^ (state[2] ^ din[2]);

  state_c[3] = (state[1] ^ din[1]) ^ (state[2] ^ din[2]) ^ (state[3] ^ din[3]) ^ (state[7] ^ din[7]);

  state_c[2] = (state[0] ^ din[0]) ^ (state[1] ^ din[1]) ^ (state[2] ^ din[2]) ^ (state[6] ^ din[6]);

  state_c[1] = (state[0] ^ din[0]) ^ (state[1] ^ din[1]) ^ (state[6] ^ din[6]);

  state_c[0] = (state[0] ^ din[0]) ^ (state[7] ^ din[7]) ^ (state[6] ^ din[6]);
  if (!end) {
    crc8_out = (uint8_t)(((state_c[0] & BIT(0)) << 0) | ((state_c[1] & BIT(0)) << 1) | ((state_c[2] & BIT(0)) << 2)
                         | ((state_c[3] & BIT(0)) << 3) | ((state_c[4] & BIT(0)) << 4) | ((state_c[5] & BIT(0)) << 5)
                         | ((state_c[6] & BIT(0)) << 6) | ((state_c[7] & BIT(0)) << 7));
  } else {
    crc8_out = (uint8_t)(((state_c[7] & BIT(0)) << 0) | ((state_c[6] & BIT(0)) << 1) | ((state_c[5] & BIT(0)) << 2)
                         | ((state_c[4] & BIT(0)) << 3) | ((state_c[3] & BIT(0)) << 4) | ((state_c[2] & BIT(0)) << 5));

    crc8_out = ~crc8_out;
    crc8_out &= 0x3f;
  }
  return crc8_out;
}

uint8_t sli_multicast_mac_hash(const uint8_t *mac)
{
  uint8_t crc = 0xff;
  for (uint8_t i = 0; i < 6; i++) {
    crc = sli_lmac_crc8_c(mac[i], crc, ((i == 5) ? 1 : 0));
  }
  return crc;
}

/* Function to get the current status of the NVM command progress
Returns true if an NVM command is in progress, false otherwise*/
bool sli_si91x_get_flash_command_status()
{
  return sli_si91x_packet_status;
}

void sli_si91x_update_flash_command_status(bool flag)
{
  sli_si91x_packet_status = flag;
}

/*  This function is used to update the power manager to see whether the device is ready for sleep or not.
 True indicates ready for sleep, and false indicates not ready for sleep.*/
bool sli_si91x_is_sdk_ok_to_sleep()
{
  return ((!sli_si91x_get_flash_command_status()) && (sl_si91x_is_device_initialized()));
}

bool sl_si91x_is_device_initialized(void)
{
  return device_initialized;
}

sl_status_t sli_si91x_remove_buffer_from_queue_by_comparator(sl_si91x_buffer_queue_t *queue,
                                                             const void *user_data,
                                                             sli_si91x_wifi_buffer_comparator comparator,
                                                             sl_wifi_buffer_t **buffer)
{
  // Check if the queue is empty
  if (queue->head == NULL) {
    assert(queue->tail == NULL);
    return SL_STATUS_EMPTY;
  }

  CORE_irqState_t state            = CORE_EnterAtomic();
  sl_wifi_buffer_t *current_buffer = queue->head;
  sl_wifi_buffer_t *prev_buffer    = NULL;

  // Iterate through the queue to find a matching buffer based on the comparator function
  while (current_buffer != NULL) {
    // Skip to the next buffer if this one doesn't match
    if (!comparator(current_buffer, user_data)) {
      prev_buffer    = current_buffer;
      current_buffer = (sl_wifi_buffer_t *)current_buffer->node.node;
      continue;
    }

    // Buffer matches, proceed to remove it
    *buffer = current_buffer;

    if (current_buffer == queue->head) {
      // Removing the head of the queue
      queue->head = (sl_wifi_buffer_t *)current_buffer->node.node;
      if (queue->head == NULL) {
        queue->tail = NULL; // Queue is now empty
      }
    } else if (current_buffer == queue->tail) {
      // Removing the tail of the queue
      queue->tail            = prev_buffer;
      prev_buffer->node.node = NULL;
    } else {
      // Removing a buffer from the middle
      prev_buffer->node.node = current_buffer->node.node;
    }

    CORE_ExitAtomic(state);
    return SL_STATUS_OK;
  }

  // No matching buffer was found
  CORE_ExitAtomic(state);
  return SL_STATUS_NOT_FOUND;
}

sl_status_t sl_si91x_host_get_credentials(sl_wifi_credential_id_t id, uint8_t type, sl_wifi_credential_t *cred)
{
  uint32_t credential_length = sizeof(sl_wifi_credential_t) - offsetof(sl_wifi_credential_t, pmk);
  sl_status_t status         = sl_wifi_get_credential(id, &cred->type, &cred->pmk, &credential_length);
  VERIFY_STATUS_AND_RETURN(status);

  if (type == SL_WIFI_PSK_CREDENTIAL) {
    if ((cred->type == SL_WIFI_PSK_CREDENTIAL) || (cred->type == SL_WIFI_PMK_CREDENTIAL)) {
      return SL_STATUS_OK;
    } else {
      return SL_STATUS_FAIL;
    }
  } else if (type != cred->type) {
    return SL_STATUS_FAIL;
  }

  return SL_STATUS_OK;
}