/** @file moal_cfg80211_util.c * * @brief This file contains the functions for CFG80211 vendor. * * * Copyright 2015-2022 NXP * * This software file (the File) is distributed by NXP * under the terms of the GNU General Public License Version 2, June 1991 * (the License). You may use, redistribute and/or modify the File in * accordance with the terms and conditions of the License, a copy of which * is available by writing to the Free Software Foundation, Inc., * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt. * * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE * ARE EXPRESSLY DISCLAIMED. The License provides additional details about * this warranty disclaimer. * */ #include "moal_cfg80211_util.h" #include "moal_cfg80211.h" /******************************************************** * Local Variables ********************************************************/ /******************************************************** * Global Variables ********************************************************/ /******************************************************** * Local Functions ********************************************************/ /******************************************************** * Global Functions ********************************************************/ #if KERNEL_VERSION(3, 14, 0) <= CFG80211_VERSION_CODE /**nxp vendor command and event*/ #define MRVL_VENDOR_ID 0x005043 /** vendor events */ static const struct nl80211_vendor_cmd_info vendor_events[] = { { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_hang, }, /*event_id 0*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_fw_dump_done, }, /*event_id 1*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_rssi_monitor, }, /*event_id 0x1501*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_set_key_mgmt_offload, }, /*event_id 0x10001*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_fw_roam_success, }, /*event_id 0x10002*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_cloud_keep_alive, }, /*event_id 0x10003*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_dfs_radar_detected, }, /*event_id 0x10004*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_dfs_cac_started, }, /*event_id 0x10005*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_dfs_cac_finished, }, /*event_id 0x10006*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_dfs_cac_aborted, }, /*event_id 0x10007*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_dfs_nop_finished, }, /*event_id 0x10008*/ { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_wifi_logger_ring_buffer_data, }, { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_wifi_logger_alert, }, { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_packet_fate_monitor, }, { .vendor_id = MRVL_VENDOR_ID, .subcmd = event_wake_reason_report, }, /**add vendor event here*/ }; /**nxp vendor policies*/ #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE static const struct nla_policy woal_ll_stat_policy[ATTR_LL_STATS_MAX + 1] = { [ATTR_LL_STATS_MPDU_SIZE_THRESHOLD] = {.type = NLA_U32}, [ATTR_LL_STATS_AGGRESSIVE_STATS_GATHERING] = {.type = NLA_U32}, [ATTR_LL_STATS_CLEAR_REQ_MASK] = {.type = NLA_U32}, [ATTR_LL_STATS_STOP_REQ] = {.type = NLA_U8}}; static const struct nla_policy woal_logger_policy[ATTR_WIFI_LOGGER_MAX + 1] = { [ATTR_WIFI_LOGGER_RING_ID] = {.type = NLA_STRING}, [ATTR_WIFI_LOGGER_VERBOSE_LEVEL] = {.type = NLA_U32}, [ATTR_WIFI_LOGGER_FLAGS] = {.type = NLA_U32}, [ATTR_WIFI_LOGGER_MIN_DATA_SIZE] = {.type = NLA_U32}, [ATTR_WIFI_LOGGER_MAX_INTERVAL_SEC] = {.type = NLA_U32}}; static const struct nla_policy woal_attr_policy[ATTR_WIFI_MAX + 1] = { [ATTR_CHANNELS_BAND] = {.type = NLA_U32}, [ATTR_SCAN_MAC_OUI_SET] = {.type = NLA_STRING, .len = 3}, [ATTR_NODFS_VALUE] = {.type = NLA_U32}, [ATTR_GET_CONCURRENCY_MATRIX_SET_SIZE_MAX] = {.type = NLA_U32}, }; // clang-format off static const struct nla_policy woal_nd_offload_policy[ATTR_ND_OFFLOAD_MAX + 1] = { [ATTR_ND_OFFLOAD_CONTROL] = {.type = NLA_U8}, }; // clang-format on static const struct nla_policy woal_rssi_monitor_policy[ATTR_RSSI_MONITOR_MAX + 1] = { [ATTR_RSSI_MONITOR_CONTROL] = {.type = NLA_U32}, [ATTR_RSSI_MONITOR_MIN_RSSI] = {.type = NLA_S8}, [ATTR_RSSI_MONITOR_MAX_RSSI] = {.type = NLA_S8}, }; static const struct nla_policy woal_packet_filter_policy[ATTR_PACKET_FILTER_MAX + 1] = { [ATTR_PACKET_FILTER_TOTAL_LENGTH] = {.type = NLA_U32}, [ATTR_PACKET_FILTER_PROGRAM] = {.type = NLA_STRING}, }; // clang-format off static const struct nla_policy woal_fw_roaming_policy[MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_MAX + 1] = { [MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_CONTROL] = {.type = NLA_U32}, [MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_CONFIG_BSSID] = { .type = NLA_BINARY}, [MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_CONFIG_SSID] = { .type = NLA_BINARY}, }; // clang-format on static const struct nla_policy woal_keep_alive_policy[MKEEP_ALIVE_ATTRIBUTE_MAX + 1] = { [MKEEP_ALIVE_ATTRIBUTE_ID] = {.type = NLA_U8}, [MKEEP_ALIVE_ATTRIBUTE_ETHER_TYPE] = {.type = NLA_U16}, [MKEEP_ALIVE_ATTRIBUTE_IP_PKT] = {.type = NLA_BINARY}, [MKEEP_ALIVE_ATTRIBUTE_IP_PKT_LEN] = {.type = NLA_U16}, [MKEEP_ALIVE_ATTRIBUTE_SRC_MAC_ADDR] = {.type = NLA_STRING, .len = ETH_ALEN}, [MKEEP_ALIVE_ATTRIBUTE_DST_MAC_ADDR] = {.type = NLA_STRING, .len = ETH_ALEN}, [MKEEP_ALIVE_ATTRIBUTE_PERIOD_MSEC] = {.type = NLA_U32}, [MKEEP_ALIVE_ATTRIBUTE_RETRY_INTERVAL] = {.type = NLA_U32}, [MKEEP_ALIVE_ATTRIBUTE_RETRY_CNT] = {.type = NLA_U8}, }; #endif /** * @brief get the event id of the events array * * @param event vendor event * * @return index of events array */ static int woal_get_event_id(int event) { int i = 0; for (i = 0; i < (int)ARRAY_SIZE(vendor_events); i++) { if ((int)vendor_events[i].subcmd == event) return i; } return event_max; } /** * @brief send vendor event to kernel * * @param priv A pointer to moal_private * @param event vendor event * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ int woal_cfg80211_vendor_event(moal_private *priv, int event, t_u8 *data, int len) { struct wiphy *wiphy = NULL; struct sk_buff *skb = NULL; int event_id = 0; t_u8 *pos = NULL; int ret = 0; ENTER(); if (!priv || !priv->wdev || !priv->wdev->wiphy) { LEAVE(); return ret; } wiphy = priv->wdev->wiphy; PRINTM(MEVENT, "vendor event :0x%x\n", event); event_id = woal_get_event_id(event); if (event_max == event_id) { PRINTM(MERROR, "Not find this event %d\n", event_id); ret = 1; LEAVE(); return ret; } /**allocate skb*/ #if KERNEL_VERSION(4, 1, 0) <= CFG80211_VERSION_CODE skb = cfg80211_vendor_event_alloc(wiphy, priv->wdev, len, event_id, GFP_ATOMIC); #else skb = cfg80211_vendor_event_alloc(wiphy, len, event_id, GFP_ATOMIC); #endif if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor event\n"); ret = 1; LEAVE(); return ret; } pos = skb_put(skb, len); moal_memcpy_ext(priv->phandle, pos, data, len, len); /**send event*/ cfg80211_vendor_event(skb, GFP_ATOMIC); LEAVE(); return ret; } #if KERNEL_VERSION(3, 14, 0) <= CFG80211_VERSION_CODE /** * @brief send fw dump complete event to vendorhal * * @param priv A pointer to moal_private * * @return N/A */ void woal_cfg80211_vendor_event_fw_dump(moal_private *priv) { PRINTM(MEVENT, "wlan: Notify FW dump complete event\n"); woal_cfg80211_vendor_event(priv, event_fw_dump_done, CUS_EVT_FW_DUMP, strlen(CUS_EVT_FW_DUMP)); } #endif /** * @brief send dfs vendor event to kernel * * @param priv A pointer to moal_private * @param event dfs vendor event * @param chandef a pointer to struct cfg80211_chan_def * * @return N/A */ void woal_cfg80211_dfs_vendor_event(moal_private *priv, int event, struct cfg80211_chan_def *chandef) { dfs_event evt; ENTER(); if (!chandef) { LEAVE(); return; } memset(&evt, 0, sizeof(dfs_event)); evt.freq = chandef->chan->center_freq; evt.chan_width = chandef->width; evt.cf1 = chandef->center_freq1; evt.cf2 = chandef->center_freq2; switch (chandef->width) { case NL80211_CHAN_WIDTH_20_NOHT: evt.ht_enabled = 0; break; case NL80211_CHAN_WIDTH_20: evt.ht_enabled = 1; break; case NL80211_CHAN_WIDTH_40: evt.ht_enabled = 1; if (chandef->center_freq1 < chandef->chan->center_freq) evt.chan_offset = -1; else evt.chan_offset = 1; break; case NL80211_CHAN_WIDTH_80: case NL80211_CHAN_WIDTH_80P80: case NL80211_CHAN_WIDTH_160: evt.ht_enabled = 1; break; default: break; } woal_cfg80211_vendor_event(priv, event, (t_u8 *)&evt, sizeof(dfs_event)); LEAVE(); } /** * @brief vendor command to set drvdbg * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_set_drvdbg(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { #ifdef DEBUG_LEVEL1 struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); struct sk_buff *skb = NULL; t_u8 *pos = NULL; #endif int ret = 1; ENTER(); #ifdef DEBUG_LEVEL1 /**handle this sub command*/ DBG_HEXDUMP(MCMD_D, "Vendor drvdbg", (t_u8 *)data, data_len); if (data_len) { /* Get the driver debug bit masks from user */ drvdbg = *((t_u32 *)data); PRINTM(MIOCTL, "new drvdbg %x\n", drvdbg); /* Set the driver debug bit masks into mlan */ if (woal_set_drvdbg(priv, drvdbg)) { PRINTM(MERROR, "Set drvdbg failed!\n"); ret = 1; } } /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, sizeof(drvdbg)); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = 1; LEAVE(); return ret; } pos = skb_put(skb, sizeof(drvdbg)); moal_memcpy_ext(priv->phandle, pos, &drvdbg, sizeof(drvdbg), sizeof(drvdbg)); ret = cfg80211_vendor_cmd_reply(skb); #endif LEAVE(); return ret; } /** * @brief process one channel in bucket * * @param priv A pointer to moal_private struct * * @param channel a pointer to channel * * @return 0: success other: fail */ static mlan_status woal_band_to_valid_channels(moal_private *priv, wifi_band w_band, int channel[], t_u32 *nchannel) { int band = 0; struct ieee80211_supported_band *sband; struct ieee80211_channel *ch; int i = 0; t_u8 cnt = 0; int *ch_ptr = channel; for (band = 0; band < IEEE80211_NUM_BANDS; band++) { if (!priv->wdev->wiphy->bands[band]) continue; if ((band == IEEE80211_BAND_2GHZ) && !(w_band & WIFI_BAND_BG)) continue; if ((band == IEEE80211_BAND_5GHZ) && !((w_band & WIFI_BAND_A) || (w_band & WIFI_BAND_A_DFS))) continue; sband = priv->wdev->wiphy->bands[band]; for (i = 0; (i < sband->n_channels); i++) { ch = &sband->channels[i]; if (ch->flags & IEEE80211_CHAN_DISABLED) { PRINTM(MERROR, "Skip DISABLED channel %d\n", ch->center_freq); continue; } if (band == IEEE80211_BAND_5GHZ) { if (((ch->flags & IEEE80211_CHAN_RADAR) && !(w_band & WIFI_BAND_A_DFS)) || (!(ch->flags & IEEE80211_CHAN_RADAR) && !(w_band & WIFI_BAND_A))) continue; } if (cnt >= *nchannel) { PRINTM(MERROR, "cnt=%d is exceed %d, cur ch=%d %dMHz\n", cnt, *nchannel, ch->hw_value, ch->center_freq); break; } *ch_ptr = ch->center_freq; ch_ptr++; cnt++; } } PRINTM(MCMND, "w_band=%d cnt=%d\n", w_band, cnt); *nchannel = cnt; return MLAN_STATUS_SUCCESS; } /** * @brief GSCAN subcmd - enable full scan results * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * * @param data a pointer to data * @param data_len data length * * @return 0: success other: fail */ static int woal_cfg80211_subcmd_get_valid_channels(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); struct nlattr *tb[ATTR_WIFI_MAX + 1]; t_u32 band = 0; int ch_out[MAX_CHANNEL_NUM]; t_u32 nchannel = 0; t_u32 mem_needed = 0; struct sk_buff *skb = NULL; int err = 0; ENTER(); PRINTM(MCMND, "Enter %s()\n", __func__); err = nla_parse(tb, ATTR_WIFI_MAX, data, len, NULL #if KERNEL_VERSION(4, 12, 0) <= CFG80211_VERSION_CODE , NULL #endif ); if (err) { PRINTM(MERROR, "%s: nla_parse fail\n", __func__); err = -EFAULT; goto done; } if (!tb[ATTR_CHANNELS_BAND]) { PRINTM(MERROR, "%s: null attr: tb[ATTR_GET_CH]=%p\n", __func__, tb[ATTR_CHANNELS_BAND]); err = -EINVAL; goto done; } band = nla_get_u32(tb[ATTR_CHANNELS_BAND]); if (band > WIFI_BAND_MAX) { PRINTM(MERROR, "%s: invalid band=%d\n", __func__, band); err = -EINVAL; goto done; } memset(ch_out, 0x00, sizeof(ch_out)); nchannel = MAX_CHANNEL_NUM; if (woal_band_to_valid_channels(priv, band, ch_out, &nchannel) != MLAN_STATUS_SUCCESS) { PRINTM(MERROR, "get_channel_list: woal_band_to_valid_channels fail\n"); return -EFAULT; } mem_needed = nla_total_size(nchannel * sizeof(ch_out[0])) + nla_total_size(sizeof(nchannel)) + VENDOR_REPLY_OVERHEAD; /* Alloc the SKB for vendor_event */ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); if (unlikely(!skb)) { PRINTM(MERROR, "skb alloc failed"); err = -ENOMEM; goto done; } if (nla_put_u32(skb, ATTR_NUM_CHANNELS, nchannel) || nla_put(skb, ATTR_CHANNEL_LIST, nchannel * sizeof(ch_out[0]), ch_out)) { PRINTM(MERROR, "nla_put failed!\n"); kfree_skb(skb); err = -ENOMEM; goto done; } err = cfg80211_vendor_cmd_reply(skb); if (err) { PRINTM(MERROR, "Vendor Command reply failed ret:%d\n", err); goto done; } done: LEAVE(); return err; } /** * @brief vendor command to get driver version * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_drv_version(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); struct sk_buff *skb = NULL; t_u32 reply_len = 0; int ret = 0; t_u32 drv_len = 0; char drv_version[MLAN_MAX_VER_STR_LEN] = {0}; char *pos; ENTER(); moal_memcpy_ext(priv->phandle, drv_version, &priv->phandle->driver_version, MLAN_MAX_VER_STR_LEN, MLAN_MAX_VER_STR_LEN); drv_len = strlen(drv_version); pos = strstr(drv_version, "%s"); /* remove 3 char "-%s" in driver_version string */ if (pos != NULL) moal_memcpy_ext(priv->phandle, pos, pos + 3, strlen(pos) - 3, strlen(pos)); reply_len = strlen(drv_version) + 1; drv_len -= 3; drv_version[drv_len] = '\0'; /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, reply_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = -ENOMEM; goto done; } nla_put(skb, MRVL_WLAN_VENDOR_ATTR_NAME, reply_len, (t_u8 *)drv_version); ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief vendor command to get firmware version * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_fw_version(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); struct sk_buff *skb = NULL; t_u32 reply_len = 0; char end_c = '\0'; int ret = 0; char fw_ver[32] = {0}; union { t_u32 l; t_u8 c[4]; } ver; ENTER(); ver.l = priv->phandle->fw_release_number; snprintf(fw_ver, sizeof(fw_ver), "%u.%u.%u.p%u%c", ver.c[2], ver.c[1], ver.c[0], ver.c[3], end_c); reply_len = strlen(fw_ver) + 1; /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, reply_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = -ENOMEM; goto done; } nla_put(skb, MRVL_WLAN_VENDOR_ATTR_NAME, reply_len, (t_u8 *)fw_ver); ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief vendor command to get firmware memory dump * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_fw_dump(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct net_device *dev = NULL; moal_private *priv = NULL; moal_handle *handle = NULL; int ret = MLAN_STATUS_SUCCESS; int length = 0; struct sk_buff *skb = NULL; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); handle = priv->phandle; if (handle) { memset(handle->firmware_dump_file, 0, sizeof(handle->firmware_dump_file)); } length = sizeof(handle->firmware_dump_file); skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, length); if (!skb) { PRINTM(MERROR, "Failed to allocate memory for skb\n"); ret = -ENOMEM; goto done; } nla_put(skb, ATTR_FW_DUMP_PATH, sizeof(handle->firmware_dump_file), handle->firmware_dump_file); ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief vendor command to get driver memory dump * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_drv_dump(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct net_device *dev = NULL; moal_private *priv = NULL; moal_handle *handle = NULL; int ret = MLAN_STATUS_SUCCESS; int length = 0; char driver_dump_file[128]; struct sk_buff *skb = NULL; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); handle = priv->phandle; memset(driver_dump_file, 0, sizeof(driver_dump_file)); sprintf(driver_dump_file, "/proc/mwlan/"); if (handle->handle_idx) sprintf(driver_dump_file, "drv_dump%d", handle->handle_idx); else sprintf(driver_dump_file, "drv_dump"); PRINTM(MMSG, "driver dump file is %s\n", driver_dump_file); length = sizeof(driver_dump_file); skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, length); if (!skb) { PRINTM(MERROR, "Failed to allocate memory for skb\n"); ret = -ENOMEM; goto done; } if (nla_put_string(skb, ATTR_DRV_DUMP_PATH, driver_dump_file)) { PRINTM(MERROR, "nla_put failed!\n"); kfree_skb(skb); ret = -ENOMEM; goto done; } ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief vendor command to get supported feature set * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_supp_feature_set(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct sk_buff *skb = NULL; struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); mlan_fw_info fw_info; t_u32 reply_len = 0; int ret = 0; t_u32 supp_feature_set = 0; ENTER(); supp_feature_set = WLAN_FEATURE_INFRA #if defined(UAP_SUPPORT) && defined(STA_SUPPORT) | WLAN_FEATURE_AP_STA #endif | WLAN_FEATURE_LINK_LAYER_STATS | WLAN_FEATURE_LOGGER | WLAN_FEATURE_RSSI_MONITOR | WLAN_FEATURE_CONFIG_NDO | WLAN_FEATURE_SCAN_RAND | WLAN_FEATURE_MKEEP_ALIVE | WLAN_FEATURE_PNO; memset(&fw_info, 0, sizeof(mlan_fw_info)); if (MLAN_STATUS_SUCCESS != woal_request_get_fw_info(priv, MOAL_IOCTL_WAIT, &fw_info)) { PRINTM(MERROR, "Fail to get fw info\n"); ret = -EFAULT; goto done; } if (fw_info.fw_bands & BAND_A) supp_feature_set |= WLAN_FEATURE_INFRA_5G; if (fw_info.fw_roaming_support) supp_feature_set |= WLAN_FEATURE_CONTROL_ROAMING; priv->phandle->wifi_hal_flag = MTRUE; reply_len = sizeof(supp_feature_set); /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, reply_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = -ENOMEM; goto done; } if (nla_put_u32(skb, ATTR_FEATURE_SET, supp_feature_set)) { PRINTM(MERROR, "nla_put failed!\n"); kfree_skb(skb); ret = -ENOMEM; goto done; } ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief vendor command to set country code * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_set_country_code(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct sk_buff *skb = NULL; t_u32 reply_len = 0; int ret = 0, rem, type; const struct nlattr *iter; char country[COUNTRY_CODE_LEN] = {0}; ENTER(); nla_for_each_attr (iter, data, data_len, rem) { type = nla_type(iter); switch (type) { case ATTR_COUNTRY_CODE: strncpy(country, nla_data(iter), MIN((int)sizeof(country) - 1, nla_len(iter))); break; default: PRINTM(MERROR, "Unknown type: %d\n", type); return ret; } } if (!moal_extflg_isset((moal_handle *)woal_get_wiphy_priv(wiphy), EXT_DISABLE_REGD_BY_DRIVER)) regulatory_hint(wiphy, country); /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, reply_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = -ENOMEM; goto done; } ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief vendor command to get supported feature set * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_wifi_logger_supp_feature_set( struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct sk_buff *skb = NULL; t_u32 reply_len = 0; int ret = 0; t_u32 supp_feature_set = 0; ENTER(); supp_feature_set = WIFI_LOGGER_CONNECT_EVENT_SUPPORTED; reply_len = sizeof(supp_feature_set); /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, reply_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = -ENOMEM; goto done; } if (nla_put_u32(skb, ATTR_WIFI_LOGGER_FEATURE_SET, supp_feature_set)) { PRINTM(MERROR, "nla_put failed!\n"); kfree_skb(skb); ret = -ENOMEM; goto done; } ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief get ring status * * @param priv A pointer to moal_private struct * @param ring_id ring buffer id * @param status a pointer to wifi_ring_buffer_status * * @return void */ static void woal_get_ring_status(moal_private *priv, int ring_id, wifi_ring_buffer_status *status) { int id = 0; wifi_ring_buffer *ring; ENTER(); for (id = 0; id < RING_ID_MAX; id++) { ring = (wifi_ring_buffer *)priv->rings[id]; if (ring && VALID_RING(ring->ring_id) && ring_id == ring->ring_id) { moal_memcpy(priv->phandle, status->name, ring->name, sizeof(status->name) - 1); status->ring_id = ring->ring_id; status->ring_buffer_byte_size = ring->ring_size; status->written_bytes = ring->ctrl.written_bytes; status->written_records = ring->ctrl.written_records; status->read_bytes = ring->ctrl.read_bytes; status->verbose_level = ring->log_level; PRINTM(MINFO, "%s, name: %s, ring_id: %d, ring_size : %d, written_bytes: %d, written_records: %d, read_bytes: %d\n", __func__, status->name, status->ring_id, status->ring_buffer_byte_size, status->written_bytes, status->written_records, status->read_bytes); break; } } LEAVE(); } /** * @brief vendor command to get ring buffer status * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_ring_buff_status(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); struct sk_buff *skb = NULL; t_u32 reply_len = 0; t_u8 ringIdx, ring_cnt = 0; int ret = 0; wifi_ring_buffer_status status[RING_ID_MAX]; wifi_ring_buffer_status ring_status; ENTER(); reply_len = RING_ID_MAX * sizeof(wifi_ring_buffer_status) + sizeof(t_u32); /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, reply_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = -ENOMEM; goto done; } /* should sync with HAL side to decide payload layout. * just ring buffer status or ring buffer num + ring buffer status * currently only have ring buffer status */ for (ringIdx = 0; ringIdx < RING_ID_MAX; ringIdx++) { memset(&ring_status, 0, sizeof(wifi_ring_buffer_status)); woal_get_ring_status(priv, ringIdx, &ring_status); moal_memcpy_ext(priv->phandle, &status[ring_cnt++], &ring_status, sizeof(wifi_ring_buffer_status), sizeof(wifi_ring_buffer_status)); } if (nla_put_u32(skb, ATTR_NUM_RINGS, ring_cnt) || nla_put(skb, ATTR_RING_BUFFER_STATUS, sizeof(wifi_ring_buffer_status) * ring_cnt, status)) { PRINTM(MERROR, "nla_put failed!\n"); kfree_skb(skb); ret = -ENOMEM; goto done; } ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief return ring_id based on ring_name * * @param priv A pointer to moal_private struct * @param ring_name A pointer to ring_name * * @return An invalid ring id for failure or valid ring id on success. */ int woal_get_ring_id_by_name(moal_private *priv, char *ring_name) { int id; wifi_ring_buffer *ring; ENTER(); for (id = 0; id < RING_ID_MAX; id++) { ring = (wifi_ring_buffer *)priv->rings[id]; if (ring && !strncmp(ring->name, ring_name, sizeof(ring->name) - 1)) break; } LEAVE(); return id; } /** * @brief start logger * * @param priv A pointer to moal_private struct * @param ring_name string ring_name * @param log_level log level to record * @param flags reserved * @param time_intval interval to report log to HAL * @param threshold buffer threshold to report log to HAL * * @return 0: success 1: fail */ int woal_start_logging(moal_private *priv, char *ring_name, int log_level, int flags, int time_intval, int threshold) { int ret = 0; int ring_id; wifi_ring_buffer *ring_buffer; unsigned long lock_flags; ENTER(); ring_id = woal_get_ring_id_by_name(priv, ring_name); if (!VALID_RING(ring_id)) { ret = -EINVAL; goto done; } PRINTM(MCMND, "%s , log_level : %d, time_intval : %d, threshod %d Bytes\n", __func__, log_level, time_intval, threshold); ring_buffer = (wifi_ring_buffer *)priv->rings[ring_id]; if (!ring_buffer || ring_buffer->state == RING_STOP) { PRINTM(MERROR, "Ring is stopped!\n"); ret = -EAGAIN; goto done; } spin_lock_irqsave(&ring_buffer->lock, lock_flags); ring_buffer->log_level = log_level; ring_buffer->threshold = threshold; if (log_level == 0) ring_buffer->state = RING_SUSPEND; else ring_buffer->state = RING_ACTIVE; ring_buffer->interval = msecs_to_jiffies(time_intval * MSEC_PER_SEC); spin_unlock_irqrestore(&ring_buffer->lock, lock_flags); if (log_level == 0) { cancel_delayed_work_sync(&ring_buffer->work); } else { if (ring_buffer->interval) schedule_delayed_work(&ring_buffer->work, ring_buffer->interval); } done: LEAVE(); return ret; } /** * @brief vendor command to start logging * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_start_logging(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int ret = 0, rem, type; char ring_name[RING_NAME_MAX] = {0}; int log_level = 0, flags = 0, time_intval = 0, threshold = 0; const struct nlattr *iter; struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); ENTER(); nla_for_each_attr (iter, data, len, rem) { type = nla_type(iter); switch (type) { case ATTR_WIFI_LOGGER_RING_ID: strncpy(ring_name, nla_data(iter), MIN(sizeof(ring_name) - 1, nla_len(iter))); break; case ATTR_WIFI_LOGGER_VERBOSE_LEVEL: log_level = nla_get_u32(iter); break; case ATTR_WIFI_LOGGER_FLAGS: flags = nla_get_u32(iter); break; case ATTR_WIFI_LOGGER_MAX_INTERVAL_SEC: time_intval = nla_get_u32(iter); break; case ATTR_WIFI_LOGGER_MIN_DATA_SIZE: threshold = nla_get_u32(iter); break; default: PRINTM(MERROR, "Unknown type: %d\n", type); ret = -EINVAL; goto done; } } ret = woal_start_logging(priv, ring_name, log_level, flags, time_intval, threshold); if (ret < 0) PRINTM(MERROR, "Start_logging is failed ret: %d\n", ret); done: LEAVE(); return ret; } /** * @brief get log data in ring buffer * * @param priv A pointer to moal_private struct * @param ring_name ring name string * * @return 0: success 1: fail */ static int woal_trigger_get_ring_data(moal_private *priv, char *ring_name) { int ret = 0; int ring_id; wifi_ring_buffer *ring_buffer; ENTER(); ring_id = woal_get_ring_id_by_name(priv, ring_name); if (!VALID_RING(ring_id)) { PRINTM(MERROR, "invalid ring_id\n"); ret = -EINVAL; goto done; } ring_buffer = (wifi_ring_buffer *)priv->rings[ring_id]; if (!ring_buffer) { PRINTM(MERROR, "invalid ring_buffer\n"); ret = -EINVAL; goto done; } if (ring_buffer->interval) cancel_delayed_work_sync(&ring_buffer->work); schedule_delayed_work(&ring_buffer->work, 0); done: LEAVE(); return ret; } /** * @brief vendor command to get ring buffer data * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_ring_data(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int ret = 0, rem, type; char ring_name[RING_NAME_MAX] = {0}; const struct nlattr *iter; struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); ENTER(); nla_for_each_attr (iter, data, len, rem) { type = nla_type(iter); switch (type) { case ATTR_WIFI_LOGGER_RING_ID: strncpy(ring_name, nla_data(iter), MIN(sizeof(ring_name) - 1, nla_len(iter))); break; default: PRINTM(MERROR, "Unknown type: %d\n", type); ret = -EINVAL; goto done; } } ret = woal_trigger_get_ring_data(priv, ring_name); if (ret < 0) PRINTM(MERROR, "trigger_get_data failed ret:%d\n", ret); done: LEAVE(); return ret; } /** * @brief ring reset * * @param priv A pointer to moal_private struct * @param ring A pointer to wifi_ring_buffer * * @return void */ static void woal_ring_reset(wifi_ring_buffer *ring) { ENTER(); ring->wp = 0; ring->rp = 0; memset(&(ring->ctrl), 0x00, sizeof(ring->ctrl)); memset(ring->ring_buf, 0, ring->ring_size); LEAVE(); } /** * @brief get ring buffer entry * * @param ring A pointer to wifi_ring_buffer struct * @param offset entry offset * * @return A pointer to wifi_ring_buffer_entry struct */ static wifi_ring_buffer_entry *woal_get_ring_entry(wifi_ring_buffer *ring, t_u32 offset) { wifi_ring_buffer_entry *entry = (wifi_ring_buffer_entry *)(ring->ring_buf + offset); ENTER(); if (!entry->entry_size) return (wifi_ring_buffer_entry *)ring->ring_buf; LEAVE(); return entry; } /** * @brief get next ring buffer entry * * @param ring A pointer to wifi_ring_buffer struct * @param offset next entry offset * * @return offset of next entry */ static t_u32 woal_get_ring_next_entry(wifi_ring_buffer *ring, t_u32 offset) { wifi_ring_buffer_entry *entry = (wifi_ring_buffer_entry *)(ring->ring_buf + offset); wifi_ring_buffer_entry *next_entry = NULL; ENTER(); if (!entry->entry_size) { entry = (wifi_ring_buffer_entry *)ring->ring_buf; LEAVE(); return ENTRY_LENGTH(entry); } if ((offset + ENTRY_LENGTH(entry)) >= ring->ring_size) { /* move to head */ LEAVE(); return 0; } next_entry = (wifi_ring_buffer_entry *)(ring->ring_buf + offset + ENTRY_LENGTH(entry)); if (!next_entry->entry_size) { /* move to head */ LEAVE(); return 0; } LEAVE(); return offset + ENTRY_LENGTH(entry); } /** * @brief prepare log data to send to HAL * * @param priv A pointer to moal_private struct * @param ring_id ring ID * @param data A pointer to data buffer * @param buf_len log data length * * @return data length */ int woal_ring_pull_data(moal_private *priv, int ring_id, void *data, t_s32 buf_len) { t_s32 r_len = 0; wifi_ring_buffer *ring; wifi_ring_buffer_entry *hdr; t_s32 buf_left = buf_len; ENTER(); ring = (wifi_ring_buffer *)priv->rings[ring_id]; /* get a fresh pending length */ while (buf_left > 0) { hdr = woal_get_ring_entry(ring, ring->rp); if (buf_left < ENTRY_LENGTH(hdr)) break; moal_memcpy_ext(priv->phandle, data, hdr, ENTRY_LENGTH(hdr), buf_left); r_len += ENTRY_LENGTH(hdr); data += ENTRY_LENGTH(hdr); buf_left -= ENTRY_LENGTH(hdr); ring->ctrl.read_bytes += ENTRY_LENGTH(hdr); if (!buf_left) { ring->rp += ENTRY_LENGTH(hdr); break; } ring->rp = woal_get_ring_next_entry(ring, ring->rp); } PRINTM(MDATA, "Ring pull data: [wp=%d rp=%d] r_len=%d buf_len=%d\n", ring->wp, ring->rp, r_len, buf_len); LEAVE(); return r_len; } /** * @brief send vendor event to kernel * * @param priv A pointer to moal_private * @param event vendor event * @param data a pointer to data * @param len data length * @param ring_status A pointer to wifi_ring_buffer status struct * * @return 0: success 1: fail */ int woal_ring_buffer_data_vendor_event(moal_private *priv, int ring_id, t_u8 *data, int len, wifi_ring_buffer_status *ring_status) { struct wiphy *wiphy = NULL; struct sk_buff *skb = NULL; int event_id = 0; int ret = 0; ENTER(); if (!priv || !priv->wdev || !priv->wdev->wiphy) { PRINTM(MERROR, "priv is null\n"); ret = -EINVAL; goto done; } wiphy = priv->wdev->wiphy; PRINTM(MEVENT, "%s ring_id:%d\n", __func__, ring_id); event_id = woal_get_event_id(event_wifi_logger_ring_buffer_data); if (event_max == event_id) { PRINTM(MERROR, "Not find this event %d\n", event_id); ret = -EINVAL; goto done; } /**allocate skb*/ #if KERNEL_VERSION(4, 1, 0) <= CFG80211_VERSION_CODE skb = cfg80211_vendor_event_alloc(wiphy, priv->wdev, len + sizeof(wifi_ring_buffer_status), event_id, GFP_ATOMIC); #else skb = cfg80211_vendor_event_alloc(wiphy, len + sizeof(wifi_ring_buffer_status), event_id, GFP_ATOMIC); #endif if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor event\n"); ret = -ENOMEM; goto done; } nla_put(skb, ATTR_RING_BUFFER_STATUS, sizeof(wifi_ring_buffer_status), ring_status); DBG_HEXDUMP(MEVT_D, "ring_buffer_data", data, len); nla_put(skb, ATTR_RING_BUFFER, len, data); /**send event*/ cfg80211_vendor_event(skb, GFP_ATOMIC); done: LEAVE(); return ret; } /** * @brief send log data to HAL * * @param priv A pointer to moal_private struct * @param ring_id ring ID * @param data A pointer to data buffer * @param len log data length * @param ring_status A pointer to wifi_ring_buffer status struct * * @return void */ static void woal_ring_data_send(moal_private *priv, int ring_id, const void *data, const t_u32 len, wifi_ring_buffer_status *ring_status) { struct net_device *ndev = priv->netdev; ENTER(); if (!ndev) goto done; woal_ring_buffer_data_vendor_event(priv, ring_id, (t_u8 *)data, len, ring_status); done: LEAVE(); } /** * @brief main thread to send log data * * @param work A pointer to work_struct struct * * @return void */ void woal_ring_poll_worker(struct work_struct *work) { struct delayed_work *d_work = to_delayed_work(work); wifi_ring_buffer *ring_info = container_of(d_work, wifi_ring_buffer, work); moal_private *priv = ring_info->priv; int ringid = ring_info->ring_id; wifi_ring_buffer_status ring_status; void *buf = NULL; wifi_ring_buffer_entry *hdr; t_s32 buflen, rlen; unsigned long flags; ENTER(); if (ring_info->state != RING_ACTIVE) { PRINTM(MERROR, "Ring is not active!\n"); goto exit; } buf = kmalloc(ring_info->ring_size, GFP_KERNEL); if (!buf) { PRINTM(MERROR, "Fail to allocate buffer for poll work\n"); goto exit; } spin_lock_irqsave(&ring_info->lock, flags); memset(&ring_status, 0, sizeof(ring_status)); woal_get_ring_status(priv, ringid, &ring_status); PRINTM(MDATA, "Ring work: ringid %d write %d, read %d, size %d\n", ringid, ring_status.written_bytes, ring_status.read_bytes, ring_status.ring_buffer_byte_size); if (ring_status.written_bytes > ring_status.read_bytes) { buflen = ring_status.written_bytes - ring_status.read_bytes; if (buflen > ring_info->ring_size) { PRINTM(MERROR, "Pending data bigger than ring size\n"); spin_unlock_irqrestore(&ring_info->lock, flags); goto exit; } } else { spin_unlock_irqrestore(&ring_info->lock, flags); PRINTM(MINFO, "No new records\n"); goto exit; } rlen = woal_ring_pull_data(priv, ringid, buf, buflen); spin_unlock_irqrestore(&ring_info->lock, flags); hdr = (wifi_ring_buffer_entry *)buf; while (rlen > 0) { ring_status.read_bytes += ENTRY_LENGTH(hdr); woal_ring_data_send(priv, ringid, hdr, ENTRY_LENGTH(hdr), &ring_status); rlen -= ENTRY_LENGTH(hdr); hdr = (wifi_ring_buffer_entry *)((void *)hdr + ENTRY_LENGTH(hdr)); } exit: kfree(buf); if (ring_info->interval) schedule_delayed_work(&ring_info->work, ring_info->interval); LEAVE(); } /** * @brief add log data to ring buffer * * @param priv A pointer to moal_private struct * @param ring_id ring ID * @param hdr A pointer to wifi_ring_buffer_entry struct * @param data A pointer to data buffer * * @return 0: success -1: fail */ int woal_ring_push_data(moal_private *priv, int ring_id, wifi_ring_buffer_entry *hdr, void *data) { unsigned long flags; t_u32 w_len; wifi_ring_buffer *ring; wifi_ring_buffer_entry *w_entry; int ret = 0; ENTER(); ring = (wifi_ring_buffer *)priv->rings[ring_id]; if (!ring || ring->state != RING_ACTIVE) { PRINTM(MERROR, "Ring is not active\n"); ret = -EINVAL; goto done; } w_len = ENTRY_LENGTH(hdr); if (w_len > ring->ring_size) { PRINTM(MERROR, "event size too big =%d\n", w_len); ret = -EINVAL; goto done; } spin_lock_irqsave(&ring->lock, flags); PRINTM(MDATA, "Ring push data: rp=%d wp=%d, w_len=%d\n", ring->rp, ring->wp, w_len); /* prep the space */ do { if (ring->rp == ring->wp) { if (ring->ctrl.read_bytes == ring->ctrl.written_bytes) { if (ring->wp) woal_ring_reset(ring); break; } else { /* full, we should drop one entry */ w_entry = (wifi_ring_buffer_entry *)(ring->ring_buf + ring->rp); ring->rp = woal_get_ring_next_entry(ring, ring->rp); ring->ctrl.written_bytes -= ENTRY_LENGTH(w_entry); memset((u8 *)w_entry, 0, ENTRY_LENGTH(w_entry)); ring->ctrl.written_records--; continue; } } if (ring->rp < ring->wp) { if (ring->ring_size - ring->wp >= w_len) { break; } else if (ring->ring_size - ring->wp < w_len) { if (ring->rp == 0) { /** drop one entry */ w_entry = (wifi_ring_buffer_entry *)(ring->ring_buf + ring->rp); ring->rp = woal_get_ring_next_entry( ring, ring->rp); ring->ctrl.written_bytes -= ENTRY_LENGTH(w_entry); memset((u8 *)w_entry, 0, ENTRY_LENGTH(w_entry)); ring->ctrl.written_records--; } ring->wp = 0; continue; } } if (ring->rp > ring->wp) { if (ring->rp - ring->wp < w_len) { /** drop one entry */ w_entry = (wifi_ring_buffer_entry *)(ring->ring_buf + ring->rp); ring->rp = woal_get_ring_next_entry(ring, ring->rp); ring->ctrl.written_bytes -= ENTRY_LENGTH(w_entry); memset((u8 *)w_entry, 0, ENTRY_LENGTH(w_entry)); ring->ctrl.written_records--; continue; } else { break; } } } while (1); if ((ring->wp + w_len) > ring->ring_size || (ring->ctrl.written_bytes + w_len) > ring->ring_size) { PRINTM(MERROR, "Ring push buffer overflow: rp=%d wp=%d, write_bytes=%d\n", ring->rp, ring->wp, ring->ctrl.written_bytes); goto done; } w_entry = (wifi_ring_buffer_entry *)(ring->ring_buf + ring->wp); /* header */ moal_memcpy_ext(priv->phandle, w_entry, hdr, RING_ENTRY_SIZE, ENTRY_LENGTH(w_entry)); /* payload */ moal_memcpy_ext(priv->phandle, (char *)w_entry + RING_ENTRY_SIZE, data, w_entry->entry_size, w_entry->entry_size); /* update write pointer */ ring->wp += w_len; /* update statistics */ ring->ctrl.written_records++; ring->ctrl.written_bytes += w_len; spin_unlock_irqrestore(&ring->lock, flags); PRINTM(MDATA, "Ring push data: wp=%d rp=%d write_bytes=%d, read_bytes=%d\n", ring->wp, ring->rp, ring->ctrl.written_bytes, ring->ctrl.read_bytes); /* if the current pending size is bigger than threshold */ if (ring->threshold && (READ_AVAIL_SPACE(ring) >= ring->threshold)) { PRINTM(MDATA, "Ring threshold reached\n"); if (ring->interval) cancel_delayed_work_sync(&ring->work); schedule_delayed_work(&ring->work, 0); } done: LEAVE(); return ret; } /** * @brief This function will init wifi logger ring buffer * * @param priv A pointer to moal_private structure * @param ring_buff A pointer to wifi_ring_buffer structure * @param ringIdx Ring buffer ID * @param name Ring buffer name * @param ring_sz Ring buffer size * * @return 0 - success */ static int woal_init_ring_buffer_internal(moal_private *priv, void **ring, t_u16 ringIdx, t_u8 *name, t_u32 ring_sz) { unsigned long flags; wifi_ring_buffer *ring_buff; ENTER(); *ring = vmalloc(sizeof(wifi_ring_buffer)); if (!unlikely(*ring)) { PRINTM(MERROR, "WiFi Logger: ring alloc failed\n"); goto done; } memset(*ring, 0, sizeof(wifi_ring_buffer)); ring_buff = (wifi_ring_buffer *)*ring; ring_buff->ring_buf = vmalloc(ring_sz); if (!unlikely(ring_buff->ring_buf)) { PRINTM(MERROR, "WiFi Logger: ring buffer data alloc failed\n"); vfree(ring_buff); *ring = NULL; goto done; } memset(ring_buff->ring_buf, 0, ring_sz); spin_lock_init(&ring_buff->lock); spin_lock_irqsave(&ring_buff->lock, flags); ring_buff->rp = ring_buff->wp = 0; INIT_DELAYED_WORK(&ring_buff->work, woal_ring_poll_worker); moal_memcpy_ext(priv->phandle, ring_buff->name, name, strlen(name), RING_NAME_MAX - 1); ring_buff->name[RING_NAME_MAX - 1] = 0; ring_buff->ring_id = ringIdx; ring_buff->ring_size = ring_sz; ring_buff->state = RING_SUSPEND; ring_buff->threshold = ring_buff->ring_size / 2; ring_buff->priv = priv; spin_unlock_irqrestore(&ring_buff->lock, flags); done: LEAVE(); return 0; } /** * @brief init each ring in moal_private * * @param priv A pointer to moal_private struct * * @return data length */ static int woal_init_ring_buffer(moal_private *priv) { ENTER(); woal_init_ring_buffer_internal(priv, &priv->rings[VERBOSE_RING_ID], VERBOSE_RING_ID, VERBOSE_RING_NAME, DEFAULT_RING_BUFFER_SIZE); woal_init_ring_buffer_internal(priv, &priv->rings[EVENT_RING_ID], EVENT_RING_ID, EVENT_RING_NAME, DEFAULT_RING_BUFFER_SIZE); LEAVE(); return 0; } /** * @brief deinit each ring in moal_private * * @param priv A pointer to moal_private struct * * @return data length */ static int woal_deinit_ring_buffer(moal_private *priv) { int i; enum ring_state ring_state = RING_STOP; unsigned long lock_flags = 0; wifi_ring_buffer *ring_buff; ENTER(); for (i = 0; i < RING_ID_MAX; i++) { ring_buff = (wifi_ring_buffer *)priv->rings[i]; if (!ring_buff) continue; spin_lock_irqsave(&ring_buff->lock, lock_flags); ring_state = ring_buff->state; if (ring_state == RING_ACTIVE) { ring_buff->state = RING_STOP; ring_buff->interval = 0; } spin_unlock_irqrestore(&ring_buff->lock, lock_flags); if (ring_state == RING_ACTIVE) cancel_delayed_work_sync(&ring_buff->work); vfree(ring_buff->ring_buf); ring_buff->ring_buf = NULL; vfree(ring_buff); priv->rings[i] = NULL; } LEAVE(); return 0; } /** * @brief add log data to ring buffer * * @param priv A pointer to moal_private struct * @param ring_id ring ID * @param hdr A pointer to wifi_ring_buffer_entry struct * @param data A pointer to data buffer * * @return 0: success -1: fail */ int woal_ring_event_logger(moal_private *priv, int ring_id, pmlan_event pmevent) { t_u8 event_buf[100] = {0}; wifi_ring_buffer_driver_connectivity_event *connectivity_event; tlv_log *tlv; t_u8 *pos; wifi_ring_buffer_entry msg_hdr; wifi_ring_buffer *ring; ENTER(); ring = (wifi_ring_buffer *)priv->rings[ring_id]; if (!ring || ring->state != RING_ACTIVE) { PRINTM(MINFO, "Ring is not active\n"); goto done; } switch (pmevent->event_id) { case MLAN_EVENT_ID_DRV_ASSOC_SUCC_LOGGER: if (GET_BSS_ROLE(priv) == MLAN_BSS_ROLE_STA) { assoc_logger_data *pbss_desc = (assoc_logger_data *)pmevent->event_buf; memset(&msg_hdr, 0, sizeof(msg_hdr)); msg_hdr.flags |= RING_BUFFER_ENTRY_FLAGS_HAS_TIMESTAMP; msg_hdr.type = ENTRY_TYPE_CONNECT_EVENT; connectivity_event = (wifi_ring_buffer_driver_connectivity_event *) event_buf; connectivity_event->event = WIFI_EVENT_ASSOC_COMPLETE; pos = (t_u8 *)connectivity_event->tlvs; tlv = (tlv_log *)pos; tlv->tag = WIFI_TAG_VENDOR_SPECIFIC; tlv->length = MLAN_MAC_ADDR_LENGTH / 2; moal_memcpy_ext(priv->phandle, tlv->value, pbss_desc->oui, tlv->length, sizeof(event_buf) - (tlv->value - event_buf)); msg_hdr.entry_size += tlv->length + TLV_LOG_HEADER_LEN; pos = pos + tlv->length + TLV_LOG_HEADER_LEN; tlv = (tlv_log *)pos; tlv->tag = WIFI_TAG_BSSID; tlv->length = sizeof(pbss_desc->bssid); moal_memcpy_ext( priv->phandle, tlv->value, pbss_desc->bssid, sizeof(pbss_desc->bssid), sizeof(event_buf) - (tlv->value - event_buf)); msg_hdr.entry_size += tlv->length + TLV_LOG_HEADER_LEN; pos = pos + tlv->length + TLV_LOG_HEADER_LEN; tlv = (tlv_log *)pos; tlv->tag = WIFI_TAG_SSID; tlv->length = strlen(pbss_desc->ssid); moal_memcpy_ext(priv->phandle, tlv->value, pbss_desc->ssid, tlv->length, sizeof(event_buf) - (tlv->value - event_buf)); msg_hdr.entry_size += tlv->length + TLV_LOG_HEADER_LEN; pos = pos + tlv->length + TLV_LOG_HEADER_LEN; if (pbss_desc->rssi) { tlv = (tlv_log *)pos; tlv->tag = WIFI_TAG_RSSI; tlv->length = sizeof(pbss_desc->rssi); moal_memcpy_ext( priv->phandle, tlv->value, &pbss_desc->rssi, tlv->length, sizeof(event_buf) - (tlv->value - event_buf)); msg_hdr.entry_size += tlv->length + TLV_LOG_HEADER_LEN; pos = pos + tlv->length + TLV_LOG_HEADER_LEN; } if (pbss_desc->channel) { tlv = (tlv_log *)pos; tlv->tag = WIFI_TAG_CHANNEL; tlv->length = sizeof(pbss_desc->channel); moal_memcpy_ext( priv->phandle, tlv->value, &pbss_desc->channel, sizeof(pbss_desc->channel), sizeof(event_buf) - (tlv->value - event_buf)); msg_hdr.entry_size += tlv->length + TLV_LOG_HEADER_LEN; } msg_hdr.entry_size += sizeof(connectivity_event->event); DBG_HEXDUMP(MCMD_D, "connectivity_event", (t_u8 *)connectivity_event, msg_hdr.entry_size); woal_ring_push_data(priv, ring_id, &msg_hdr, connectivity_event); } break; case MLAN_EVENT_ID_DRV_ASSOC_FAILURE_LOGGER: if (GET_BSS_ROLE(priv) == MLAN_BSS_ROLE_STA) { int status_code = *(int *)pmevent->event_buf; memset(&msg_hdr, 0, sizeof(msg_hdr)); msg_hdr.flags |= RING_BUFFER_ENTRY_FLAGS_HAS_TIMESTAMP; msg_hdr.type = ENTRY_TYPE_CONNECT_EVENT; connectivity_event = (wifi_ring_buffer_driver_connectivity_event *) event_buf; connectivity_event->event = WIFI_EVENT_ASSOC_COMPLETE; pos = (t_u8 *)connectivity_event->tlvs; tlv = (tlv_log *)pos; tlv->tag = WIFI_TAG_STATUS; tlv->length = sizeof(status_code); moal_memcpy_ext(priv->phandle, tlv->value, &status_code, sizeof(status_code), sizeof(event_buf) - (tlv->value - event_buf)); msg_hdr.entry_size += tlv->length + 4; msg_hdr.entry_size += sizeof(connectivity_event->event); woal_ring_push_data(priv, ring_id, &msg_hdr, connectivity_event); } break; case MLAN_EVENT_ID_DRV_DISCONNECT_LOGGER: if (GET_BSS_ROLE(priv) == MLAN_BSS_ROLE_STA) { t_u16 reason_code = *(t_u16 *)pmevent->event_buf; memset(&msg_hdr, 0, sizeof(msg_hdr)); msg_hdr.flags |= RING_BUFFER_ENTRY_FLAGS_HAS_TIMESTAMP; msg_hdr.type = ENTRY_TYPE_CONNECT_EVENT; connectivity_event = (wifi_ring_buffer_driver_connectivity_event *) event_buf; connectivity_event->event = WIFI_EVENT_ASSOC_COMPLETE; pos = (t_u8 *)connectivity_event->tlvs; tlv = (tlv_log *)pos; tlv->tag = WIFI_TAG_REASON_CODE; tlv->length = sizeof(reason_code); moal_memcpy_ext(priv->phandle, tlv->value, &reason_code, sizeof(reason_code), sizeof(event_buf) - (tlv->value - event_buf)); msg_hdr.entry_size += tlv->length + 4; msg_hdr.entry_size += sizeof(connectivity_event->event); woal_ring_push_data(priv, ring_id, &msg_hdr, connectivity_event); } break; default: break; } done: LEAVE(); return 0; } /** * @brief send vendor event to kernel * * @param priv A pointer to moal_private struct * @param wake_reason wake_reason * * @return 0: success 1: fail */ int woal_wake_reason_vendor_event(moal_private *priv, mlan_ds_hs_wakeup_reason wake_reason) { struct wiphy *wiphy = NULL; struct sk_buff *skb = NULL; int event_id = 0; int ret = 0; ENTER(); if (!priv || !priv->wdev || !priv->wdev->wiphy) { PRINTM(MERROR, "priv is null\n"); ret = -EINVAL; goto done; } wiphy = priv->wdev->wiphy; event_id = woal_get_event_id(event_wake_reason_report); if (event_max == event_id) { PRINTM(MERROR, "Not find this event %d\n", event_id); ret = MLAN_STATUS_FAILURE; goto done; } /**allocate skb*/ #if KERNEL_VERSION(4, 1, 0) <= CFG80211_VERSION_CODE skb = cfg80211_vendor_event_alloc(wiphy, priv->wdev, sizeof(wake_reason.hs_wakeup_reason), event_id, GFP_ATOMIC); #else skb = cfg80211_vendor_event_alloc(wiphy, sizeof(wake_reason.hs_wakeup_reason), event_id, GFP_ATOMIC); #endif if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor event\n"); ret = -ENOMEM; goto done; } PRINTM(MINFO, "wake_reason.hs_wakeup_reason = %d\n", wake_reason.hs_wakeup_reason); nla_put_u16(skb, ATTR_WAKE_REASON_STAT, wake_reason.hs_wakeup_reason); /**send event*/ cfg80211_vendor_event(skb, GFP_ATOMIC); done: PRINTM(MINFO, "wake reason vendor event ret %d\n", ret); LEAVE(); return ret; } /** * @brief log wake reason * * @param priv A pointer to moal_private struct * @param wake_reason wake_reason * * @return 0: success -1: fail */ int woal_wake_reason_logger(moal_private *priv, mlan_ds_hs_wakeup_reason wake_reason) { int ret = 0; ENTER(); ret = woal_wake_reason_vendor_event(priv, wake_reason); LEAVE(); return ret; } /** * @brief vendor command to start packet fate monitor * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_start_packet_fate_monitor(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct sk_buff *skb = NULL; t_u32 reply_len = 0; int ret = 0; /* TODO: Tune pkt fate monitor for TP, Disabling it for now */ // struct net_device *dev = wdev->netdev; // moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); ENTER(); /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, reply_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = -ENOMEM; goto done; } /* TODO: Tune pkt fate monitor for TP, Disabling it for now */ // priv->pkt_fate_monitor_enable = MTRUE; ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief send vendor event to kernel * * @param priv A pointer to moal_private struct * @param pkt_type tx or rx * @param fate packet fate * @param payload_type type of payload * @param drv_ts_usec driver time in usec * @param fw_ts_usec firmware time in usec * @param data frame data * @param len frame data len * * @return 0: success 1: fail */ int woal_packet_fate_vendor_event(moal_private *priv, packet_fate_packet_type pkt_type, t_u8 fate, frame_type payload_type, t_u32 drv_ts_usec, t_u32 fw_ts_usec, t_u8 *data, t_u32 len) { struct wiphy *wiphy = NULL; struct sk_buff *skb = NULL; int event_id = 0; int ret = 0; PACKET_FATE_REPORT fate_report; ENTER(); if (!priv || !priv->wdev || !priv->wdev->wiphy) { PRINTM(MERROR, "priv is null\n"); ret = -EINVAL; goto done; } wiphy = priv->wdev->wiphy; event_id = woal_get_event_id(event_packet_fate_monitor); if (event_max == event_id) { PRINTM(MERROR, "Not find this event %d\n", event_id); ret = MLAN_STATUS_FAILURE; goto done; } /**allocate skb*/ #if KERNEL_VERSION(4, 1, 0) <= CFG80211_VERSION_CODE skb = cfg80211_vendor_event_alloc(wiphy, priv->wdev, len + sizeof(PACKET_FATE_REPORT), event_id, GFP_ATOMIC); #else skb = cfg80211_vendor_event_alloc( wiphy, len + sizeof(PACKET_FATE_REPORT), event_id, GFP_ATOMIC); #endif if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor event\n"); ret = -ENOMEM; goto done; } memset(&fate_report, 0, sizeof(PACKET_FATE_REPORT)); if (pkt_type == PACKET_TYPE_TX) { fate_report.u.tx_report_i.fate = fate; fate_report.u.tx_report_i.frame_inf.payload_type = payload_type; fate_report.u.tx_report_i.frame_inf.driver_timestamp_usec = drv_ts_usec; fate_report.u.tx_report_i.frame_inf.firmware_timestamp_usec = fw_ts_usec; fate_report.u.tx_report_i.frame_inf.frame_len = len; nla_put(skb, ATTR_PACKET_FATE_TX, sizeof(PACKET_FATE_REPORT), &fate_report); } else { fate_report.u.rx_report_i.fate = fate; fate_report.u.rx_report_i.frame_inf.payload_type = payload_type; fate_report.u.rx_report_i.frame_inf.driver_timestamp_usec = drv_ts_usec; fate_report.u.rx_report_i.frame_inf.firmware_timestamp_usec = fw_ts_usec; fate_report.u.rx_report_i.frame_inf.frame_len = len; nla_put(skb, ATTR_PACKET_FATE_RX, sizeof(PACKET_FATE_REPORT), &fate_report); } DBG_HEXDUMP(MCMD_D, "fate_report", (t_u8 *)&fate_report, sizeof(PACKET_FATE_REPORT)); nla_put(skb, ATTR_PACKET_FATE_DATA, len, data); DBG_HEXDUMP(MCMD_D, "packet_fate_data", data, len); /**send event*/ cfg80211_vendor_event(skb, GFP_ATOMIC); done: PRINTM(MINFO, "packet fate vendor event ret %d\n", ret); LEAVE(); return ret; } /** * @brief log packet fate * * @param priv A pointer to moal_private struct * @param pkt_type tx or rx * @param fate packet fate * @param payload_type type of payload * @param drv_ts_usec driver time in usec * @param fw_ts_usec firmware time in usec * @param data frame data * @param len frame data len * * @return 0: success -1: fail */ int woal_packet_fate_monitor(moal_private *priv, packet_fate_packet_type pkt_type, t_u8 fate, frame_type payload_type, t_u32 drv_ts_usec, t_u32 fw_ts_usec, t_u8 *data, t_u32 len) { int ret = 0; ENTER(); if (priv->pkt_fate_monitor_enable) ret = woal_packet_fate_vendor_event(priv, pkt_type, fate, payload_type, drv_ts_usec, fw_ts_usec, data, len); PRINTM(MINFO, "packet fate monitor ret %d\n", ret); LEAVE(); return ret; } /** * @brief init packet_filter in moal_private * * @param priv A pointer to moal_private struct * * @return 0: success -1: fail */ static int woal_init_packet_filter(moal_private *priv) { int ret = 0; packet_filter *pkt_filter = NULL; ENTER(); pkt_filter = vmalloc(sizeof(packet_filter)); if (!unlikely(pkt_filter)) { PRINTM(MERROR, "WiFi Logger: packet_filter alloc failed\n"); ret = -ENOMEM; goto done; } memset(pkt_filter, 0, sizeof(packet_filter)); spin_lock_init(&pkt_filter->lock); pkt_filter->packet_filter_max_len = PACKET_FILTER_MAX_LEN; pkt_filter->packet_filter_len = 0; pkt_filter->packet_filter_version = APF_VERSION; pkt_filter->state = PACKET_FILTER_STATE_STOP; priv->packet_filter = pkt_filter; done: LEAVE(); return ret; } /** * @brief deinit packet_filter in moal_private * * @param priv A pointer to moal_private struct * * @return 0: success -1: fail */ static int woal_deinit_packet_filter(moal_private *priv) { int ret = 0; packet_filter *pkt_filter = NULL; unsigned long flags; ENTER(); pkt_filter = priv->packet_filter; if (!unlikely(pkt_filter)) goto done; spin_lock_irqsave(&pkt_filter->lock, flags); pkt_filter->state = PACKET_FILTER_STATE_INIT; spin_unlock_irqrestore(&pkt_filter->lock, flags); vfree(pkt_filter); priv->packet_filter = NULL; done: LEAVE(); return ret; } /** * @brief vendor command to set packet filter * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_set_packet_filter(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); int ret = 0, rem, type; const struct nlattr *iter; packet_filter *pkt_filter = NULL; t_u32 packet_filter_len = 0; unsigned long flags; ENTER(); pkt_filter = priv->packet_filter; if (!unlikely(pkt_filter) || pkt_filter->state == PACKET_FILTER_STATE_INIT) { PRINTM(MERROR, "packet_filter not init\n"); ret = -EINVAL; goto done; } nla_for_each_attr (iter, data, len, rem) { type = nla_type(iter); switch (type) { case ATTR_PACKET_FILTER_TOTAL_LENGTH: packet_filter_len = nla_get_u32(iter); if (packet_filter_len > pkt_filter->packet_filter_max_len) { PRINTM(MERROR, "packet_filter_len exceed max\n"); ret = -EINVAL; goto done; } break; case ATTR_PACKET_FILTER_PROGRAM: spin_lock_irqsave(&pkt_filter->lock, flags); strncpy(pkt_filter->packet_filter_program, nla_data(iter), MIN(packet_filter_len, nla_len(iter))); pkt_filter->packet_filter_len = MIN(packet_filter_len, nla_len(iter)); pkt_filter->state = PACKET_FILTER_STATE_START; spin_unlock_irqrestore(&pkt_filter->lock, flags); DBG_HEXDUMP(MDAT_D, "packet_filter_program", pkt_filter->packet_filter_program, pkt_filter->packet_filter_len); break; default: PRINTM(MERROR, "Unknown type: %d\n", type); ret = -EINVAL; goto done; } } if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * @brief vendor command to get packet filter capability * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_get_packet_filter_capability( struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); struct sk_buff *skb = NULL; t_u32 reply_len = 0; int ret = 0; packet_filter *pkt_filter; ENTER(); pkt_filter = priv->packet_filter; if (!unlikely(pkt_filter)) { PRINTM(MERROR, "packet_filter not init\n"); ret = -EINVAL; goto done; } reply_len = sizeof(pkt_filter->packet_filter_version) + sizeof(pkt_filter->packet_filter_max_len); /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, reply_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = -ENOMEM; goto done; } if (nla_put_u32(skb, ATTR_PACKET_FILTER_VERSION, pkt_filter->packet_filter_version) || nla_put_u32(skb, ATTR_PACKET_FILTER_MAX_LEN, pkt_filter->packet_filter_max_len)) { PRINTM(MERROR, "nla_put failed!\n"); kfree_skb(skb); ret = -ENOMEM; goto done; } ret = cfg80211_vendor_cmd_reply(skb); if (ret) PRINTM(MERROR, "Vendor command reply failed ret = %d\n", ret); done: LEAVE(); return ret; } /** * Runs a packet filtering program over a packet. * * @param program the program bytecode. * @param program_len the length of {@code apf_program} in bytes. * @param packet the packet bytes, starting from the 802.3 header and not * including any CRC bytes at the end. * @param packet_len the length of {@code packet} in bytes. * @param filter_age the number of seconds since the filter was programmed. * * @return non-zero if packet should be passed to AP, zero if * packet should be dropped. */ int process_packet(const t_u8 *program, t_u32 program_len, const t_u8 *packet, t_u32 packet_len, t_u32 filter_age) { /* Program counter */ t_u32 pc = 0; /* Memory slot values. */ t_u32 mem[MEM_ITEMS] = {}; /* Register values. */ t_u32 reg[2] = {}; /* Number of instructions remaining to execute. This is done to make * sure there is upper bound on execution time. It should never be hit * and is only for safety. Initialize to the number of bytes in the * program which is an * upper bound on the number of instructions in the program. */ t_u32 instructions_left = program_len; t_u8 bytecode; t_u32 opcode; t_u32 reg_num; t_u32 len_field; t_u32 imm_len; t_u32 end_offs; t_u32 val = 0; t_u32 last_pkt_offs; t_u32 imm = 0; int32_t sign_imm = 0; t_u32 offs = 0; t_u32 i; t_u32 load_size; /* Is offset within program bounds? */ #define WITHIN_PROGRAM_BOUNDS(p) (ENFORCE_UNSIGNED(p) && (p) < program_len) /* Is offset within packet bounds? */ #define WITHIN_PACKET_BOUNDS(p) (ENFORCE_UNSIGNED(p) && (p) < packet_len) /* Verify an internal condition and accept packet if it fails. */ #define ASSERT_RETURN(c) \ do { \ if (!(c)) \ return PASS_PKT; \ } while (0) /* If not within program bounds, Accept the packet */ #define ASSERT_WITHIN_PROGRAM_BOUNDS(p) ASSERT_RETURN(WITHIN_PROGRAM_BOUNDS(p)) /* If not within packet bounds, Accept the packet */ #define ASSERT_WITHIN_PKT_BOUNDS(p) ASSERT_RETURN(WITHIN_PACKET_BOUNDS(p)) /* If not within program or not ahead of program counter, Accept the packet */ #define ASSERT_FORWARD_WITHIN_PROGRAM(p) \ ASSERT_RETURN(WITHIN_PROGRAM_BOUNDS(p) && (p) >= pc) /* Fill in pre-filled memory slot values. */ mem[MEM_OFFSET_PKT_SIZE] = packet_len; mem[MEM_OFFSET_FILTER_AGE] = filter_age; ASSERT_WITHIN_PKT_BOUNDS(APF_FRAME_HEADER_SIZE); /* Only populate if IP version is IPv4. */ if ((packet[APF_FRAME_HEADER_SIZE] & 0xf0) == 0x40) { mem[MEM_OFFSET_IPV4_HEADER_SIZE] = (packet[APF_FRAME_HEADER_SIZE] & 15) * 4; } do { if (pc == program_len) return PASS_PKT; else if (pc == (program_len + 1)) return DROP_PKT; ASSERT_WITHIN_PROGRAM_BOUNDS(pc); bytecode = program[pc++]; opcode = GET_OPCODE(bytecode); reg_num = GET_REGISTER(bytecode); /* All instructions have immediate fields, so load them now. */ len_field = GET_IMM_LENGTH(bytecode); imm = 0; sign_imm = 0; #define REG (reg[reg_num]) #define OTHER_REG (reg[reg_num ^ 1]) if (len_field) { imm_len = 1 << (len_field - 1); ASSERT_FORWARD_WITHIN_PROGRAM(pc + imm_len - 1); for (i = 0; i < imm_len; i++) imm = (imm << 8) | program[pc++]; /* Sign extend imm into signed_imm. */ sign_imm = imm << ((4 - imm_len) * 8); sign_imm >>= (4 - imm_len) * 8; } switch (opcode) { case NXP_LDB_OPCODE: case NXP_LDH_OPCODE: case NXP_LDW_OPCODE: case NXP_LDBX_OPCODE: case NXP_LDHX_OPCODE: case NXP_LDWX_OPCODE: { offs = imm; if (opcode >= NXP_LDBX_OPCODE) { /* Note: this can overflow and actually decrease * offs. */ offs += reg[1]; } ASSERT_WITHIN_PKT_BOUNDS(offs); switch (opcode) { case NXP_LDB_OPCODE: case NXP_LDBX_OPCODE: load_size = 1; break; case NXP_LDH_OPCODE: case NXP_LDHX_OPCODE: load_size = 2; break; case NXP_LDW_OPCODE: case NXP_LDWX_OPCODE: load_size = 4; break; /* Immediately enclosing switch statement * guarantees * opcode cannot be any other value. */ } end_offs = offs + (load_size - 1); /* Catch overflow/wrap-around. */ ASSERT_RETURN(end_offs >= offs); ASSERT_WITHIN_PKT_BOUNDS(end_offs); val = 0; while (load_size--) val = (val << 8) | packet[offs++]; REG = val; break; } case NXP_JMP_OPCODE: /* This can jump backwards. Infinite looping prevented * by instructions_remaining. */ pc += imm; break; case NXP_JEQ_OPCODE: case NXP_JNE_OPCODE: case NXP_JGT_OPCODE: case NXP_JLT_OPCODE: case NXP_JSET_OPCODE: case NXP_JNEBS_OPCODE: { /* Load second immediate field. */ t_u32 cmp_imm = 0; if (reg_num == 1) { cmp_imm = reg[1]; } else if (len_field != 0) { t_u32 cmp_imm_len = 1 << (len_field - 1); ASSERT_FORWARD_WITHIN_PROGRAM(pc + cmp_imm_len - 1); for (i = 0; i < cmp_imm_len; i++) cmp_imm = (cmp_imm << 8) | program[pc++]; } switch (opcode) { case NXP_JEQ_OPCODE: if (reg[0] == cmp_imm) pc += imm; break; case NXP_JNE_OPCODE: if (reg[0] != cmp_imm) pc += imm; break; case NXP_JGT_OPCODE: if (reg[0] > cmp_imm) pc += imm; break; case NXP_JLT_OPCODE: if (reg[0] < cmp_imm) pc += imm; break; case NXP_JSET_OPCODE: if (reg[0] & cmp_imm) pc += imm; break; case NXP_JNEBS_OPCODE: { /* cmp_imm is size in bytes of data to compare. * pc is offset of program bytes to compare. * imm is jump target offset. * REG is offset of packet bytes to compare. */ ASSERT_FORWARD_WITHIN_PROGRAM(pc + cmp_imm - 1); ASSERT_WITHIN_PKT_BOUNDS(REG); last_pkt_offs = REG + cmp_imm - 1; ASSERT_RETURN(last_pkt_offs >= REG); ASSERT_WITHIN_PKT_BOUNDS(last_pkt_offs); if (memcmp(program + pc, packet + REG, cmp_imm)) pc += imm; /* skip past comparison bytes */ pc += cmp_imm; break; } } break; } case NXP_ADD_OPCODE: reg[0] += reg_num ? reg[1] : imm; break; case NXP_MUL_OPCODE: reg[0] *= reg_num ? reg[1] : imm; break; case NXP_DIV_OPCODE: { const t_u32 div_operand = reg_num ? reg[1] : imm; ASSERT_RETURN(div_operand); reg[0] /= div_operand; break; } case NXP_AND_OPCODE: reg[0] &= reg_num ? reg[1] : imm; break; case NXP_OR_OPCODE: reg[0] |= reg_num ? reg[1] : imm; break; case NXP_SH_OPCODE: { const int32_t shift_val = reg_num ? (int32_t)reg[1] : sign_imm; if (shift_val > 0) reg[0] <<= shift_val; else reg[0] >>= -shift_val; break; } case NXP_LI_OPCODE: REG = sign_imm; break; case NXP_EXT_OPCODE: if ( /* If LDM_EXT_OPCODE is 0 and imm is compared with it, a compiler error will * result, * instead just enforce that imm is unsigned (so it's always greater or equal to * 0). */ #if NXP_LDM_EXT_OPCODE == 0 ENFORCE_UNSIGNED(imm) && #else imm >= NXP_LDM_EXT_OPCODE && #endif imm < (NXP_LDM_EXT_OPCODE + MEM_ITEMS)) { REG = mem[imm - NXP_LDM_EXT_OPCODE]; } else if (imm >= NXP_STM_EXT_OPCODE && imm < (NXP_STM_EXT_OPCODE + MEM_ITEMS)) { mem[imm - NXP_STM_EXT_OPCODE] = REG; } else switch (imm) { case NXP_NOT_EXT_OPCODE: REG = ~REG; break; case NXP_NEG_EXT_OPCODE: REG = -REG; break; case NXP_SWAP_EXT_OPCODE: { t_u32 tmp = REG; REG = OTHER_REG; OTHER_REG = tmp; break; } case NXP_MOV_EXT_OPCODE: REG = OTHER_REG; break; /* Unknown extended opcode */ default: /* Bail out */ return PASS_PKT; } break; /* Unknown opcode */ default: /* Bail out */ return PASS_PKT; } } while (instructions_left--); return PASS_PKT; } /** * @brief filter packet * * @param priv A pointer to moal_private struct * @param data packet data * @param len packet len * @param filter_age filter age * @return non-zero if packet should be passed to AP, zero if * packet should be dropped. */ int woal_filter_packet(moal_private *priv, t_u8 *data, t_u32 len, t_u32 filter_age) { packet_filter *pkt_filter = NULL; int ret = PASS_PKT; unsigned long flags; ENTER(); pkt_filter = priv->packet_filter; if (!unlikely(pkt_filter)) { PRINTM(MINFO, "packet_filter not init\n"); goto done; } if (pkt_filter->state != PACKET_FILTER_STATE_START) goto done; DBG_HEXDUMP(MDAT_D, "packet_filter_program", pkt_filter->packet_filter_program, pkt_filter->packet_filter_len); DBG_HEXDUMP(MDAT_D, "packet_filter_data", data, len); spin_lock_irqsave(&pkt_filter->lock, flags); ret = process_packet(pkt_filter->packet_filter_program, pkt_filter->packet_filter_len, data, len, filter_age); spin_unlock_irqrestore(&pkt_filter->lock, flags); done: PRINTM(MINFO, "packet filter ret %d\n", ret); LEAVE(); return ret; } /** * @brief init wifi hal * * @param priv A pointer to moal_private struct * * @return 0: success 1: fail */ int woal_init_wifi_hal(moal_private *priv) { ENTER(); woal_init_ring_buffer(priv); priv->pkt_fate_monitor_enable = MFALSE; woal_init_packet_filter(priv); LEAVE(); return 0; } /** * @brief deinit wifi hal * * @param priv A pointer to moal_private struct * * @return 0: success 1: fail */ int woal_deinit_wifi_hal(moal_private *priv) { ENTER(); woal_deinit_ring_buffer(priv); priv->pkt_fate_monitor_enable = MFALSE; woal_deinit_packet_filter(priv); LEAVE(); return 0; } /** * @brief vendor command to get link layer statistic * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_link_statistic_get(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { struct net_device *dev = wdev->netdev; moal_private *priv = (moal_private *)woal_get_netdev_priv(dev); struct sk_buff *skb = NULL; mlan_ioctl_req *req = NULL; mlan_ds_get_info *info = NULL; mlan_status status = MLAN_STATUS_SUCCESS; wifi_radio_stat *radio_stat = NULL; wifi_radio_stat *radio_stat_tmp = NULL; wifi_iface_stat *iface_stat = NULL; t_u32 num_radio = 0, iface_stat_len = 0, radio_stat_len = 0; int err = -1, length = 0, i; char *ioctl_link_stats_buf = NULL; t_u64 cur_time = 0; t_u64 inter_msec = 0; t_u64 max_msec = (t_u64)24 * (t_u64)24 * (t_u64)3600 * (t_u64)1000; moal_handle *handle = priv->phandle; /* Allocate an IOCTL request buffer */ req = woal_alloc_mlan_ioctl_req(sizeof(t_u32) + BUF_MAXLEN); if (req == NULL) { PRINTM(MERROR, "Could not allocate mlan ioctl request!\n"); return -ENOMEM; } /* Fill request buffer */ info = (mlan_ds_get_info *)req->pbuf; info->sub_command = MLAN_OID_LINK_STATS; req->req_id = MLAN_IOCTL_GET_INFO; req->action = MLAN_ACT_GET; /* Send IOCTL request to MLAN */ status = woal_request_ioctl(priv, req, MOAL_IOCTL_WAIT); if (status != MLAN_STATUS_SUCCESS) { PRINTM(MERROR, "get link layer statistic fail\n"); goto done; } ioctl_link_stats_buf = info->param.link_statistic; num_radio = *((t_u32 *)info->param.link_statistic); radio_stat = (wifi_radio_stat *)(info->param.link_statistic + sizeof(num_radio)); radio_stat_len = num_radio * sizeof(wifi_radio_stat); /* Re-write on_time/tx_time/rx_time/on_time_scan from moal handle */ PRINTM(MINFO, "handle->on_time=%llu\n", handle->on_time); if (handle->on_time) { moal_get_boot_ktime(handle, &cur_time); inter_msec = moal_do_div(cur_time - handle->on_time, 1000000); PRINTM(MINFO, "cur_time=%llu inter_msec=%llu max_msec=%llu\n", cur_time, inter_msec, max_msec); /* When we report the time up, u32 is not big enough(represent * max 49days) and might out of range, make the max value to * 24days. */ if (inter_msec > max_msec) { PRINTM(MMSG, "Out of range, set inter_msec=%llu to max_msec=%llu\n", inter_msec, max_msec); inter_msec = max_msec; } } PRINTM(MINFO, "handle->tx_time=%llu\n", handle->tx_time); PRINTM(MINFO, "handle->rx_time=%llu\n", handle->rx_time); PRINTM(MINFO, "handle->scan_time=%llu\n", handle->scan_time); radio_stat_tmp = radio_stat; for (i = 0; i < num_radio; i++) { radio_stat_tmp->on_time = (t_u32)inter_msec; radio_stat_tmp->tx_time = (t_u32)moal_do_div(handle->tx_time, 1000); radio_stat_tmp->rx_time = (t_u32)moal_do_div(handle->rx_time, 1000); radio_stat_tmp->on_time_scan = (t_u32)moal_do_div(handle->scan_time, 1000); radio_stat_tmp++; } iface_stat = (wifi_iface_stat *)(info->param.link_statistic + sizeof(num_radio) + radio_stat_len); iface_stat_len = sizeof(wifi_iface_stat); /* could get peer info with separate cmd */ for (i = 0; i < iface_stat->num_peers; i++) { /* no need copy, just increase iface_stat length*/ iface_stat_len += sizeof(wifi_peer_info) + sizeof(wifi_rate_stat) * iface_stat->peer_info[i].num_rate; } /* Here the length doesn't contain addition 2 attribute header length */ length = NLA_HDRLEN * 2 + sizeof(num_radio) + radio_stat_len + iface_stat_len; /* Alloc the SKB for vendor_event */ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, length); if (unlikely(!skb)) { PRINTM(MERROR, "skb alloc failed\n"); goto done; } if (nla_put_u32(skb, ATTR_LL_STATS_NUM_RADIO, num_radio) || nla_put(skb, ATTR_LL_STATS_RADIO, radio_stat_len, radio_stat) || nla_put(skb, ATTR_LL_STATS_IFACE, iface_stat_len, iface_stat)) { PRINTM(MERROR, "nla_put failed!\n"); kfree_skb(skb); goto done; } PRINTM(MDAT_D, "%s: <<< Start DUMP\n", __func__); PRINTM(MDAT_D, "sizeof(wifi_radio_stat)=%zu\n", sizeof(wifi_radio_stat)); DBG_HEXDUMP(MDAT_D, "radio_stat", (t_u8 *)radio_stat, radio_stat_len); PRINTM(MDAT_D, "sizeof(wifi_channel_stat)=%zu\n", sizeof(wifi_channel_stat)); DBG_HEXDUMP(MDAT_D, "iface_stat", (t_u8 *)iface_stat, iface_stat_len); PRINTM(MDAT_D, "num_radio=%d\n", num_radio); radio_stat_tmp = radio_stat; for (i = 0; i < num_radio; i++) { PRINTM(MDAT_D, "--radio_stat[%d]--\n", i); PRINTM(MDAT_D, "radio=%d\n", radio_stat_tmp->radio); PRINTM(MDAT_D, "on_time=%d\n", radio_stat_tmp->on_time); PRINTM(MDAT_D, "tx_time=%d\n", radio_stat_tmp->tx_time); PRINTM(MDAT_D, "reserved0=%d\n", radio_stat_tmp->reserved0); PRINTM(MDAT_D, "rx_time=%d\n", radio_stat_tmp->rx_time); PRINTM(MDAT_D, "on_time_scan=%d\n", radio_stat_tmp->on_time_scan); PRINTM(MDAT_D, "on_time_nbd=%d\n", radio_stat_tmp->on_time_nbd); PRINTM(MDAT_D, "on_time_gscan=%d\n", radio_stat_tmp->on_time_gscan); PRINTM(MDAT_D, "on_time_roam_scan=%d\n", radio_stat_tmp->on_time_roam_scan); PRINTM(MDAT_D, "on_time_pno_scan=%d\n", radio_stat_tmp->on_time_pno_scan); PRINTM(MDAT_D, "on_time_hs20=%d\n", radio_stat_tmp->on_time_hs20); PRINTM(MDAT_D, "num_channels=%d\n", radio_stat_tmp->num_channels); radio_stat_tmp++; } PRINTM(MDAT_D, "%s: >>> End DUMP\n", __func__); err = cfg80211_vendor_cmd_reply(skb); if (unlikely(err)) PRINTM(MERROR, "Vendor Command reply failed ret:%d\n", err); done: if (status != MLAN_STATUS_PENDING) kfree(req); return err; } /** * @brief API to trigger the link layer statistics collection. * Unless his API is invoked - link layer statistics will not be collected. * Radio statistics (once started) do not stop or get reset unless * wifi_clear_link_stats is invoked, Interface statistics (once started) * reset and start afresh after each connection. * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_link_statistic_set(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { moal_private *priv = (moal_private *)woal_get_netdev_priv(wdev->netdev); struct nlattr *tb[ATTR_LL_STATS_MAX + 1]; wifi_link_layer_params ll_params; mlan_ioctl_req *req = NULL; mlan_ds_get_info *info = NULL; mlan_status status = MLAN_STATUS_SUCCESS; int err = 0; err = nla_parse(tb, ATTR_LL_STATS_MAX, data, len, NULL #if KERNEL_VERSION(4, 12, 0) <= CFG80211_VERSION_CODE , NULL #endif ); if (err) return err; if (!tb[ATTR_LL_STATS_MPDU_SIZE_THRESHOLD] || !tb[ATTR_LL_STATS_AGGRESSIVE_STATS_GATHERING]) return -EINVAL; ll_params.mpdu_size_threshold = nla_get_u32(tb[ATTR_LL_STATS_MPDU_SIZE_THRESHOLD]); ll_params.aggressive_statistics_gathering = nla_get_u32(tb[ATTR_LL_STATS_AGGRESSIVE_STATS_GATHERING]); PRINTM(MEVENT, "link layer params mpdu_size_threshold = 0x%x, aggressive_statistics_gathering = 0x%x\n", ll_params.mpdu_size_threshold, ll_params.aggressive_statistics_gathering); /* Allocate an IOCTL request buffer */ req = woal_alloc_mlan_ioctl_req(sizeof(t_u32) + sizeof(mlan_ds_get_info)); if (req == NULL) { PRINTM(MERROR, "Could not allocate mlan ioctl request!\n"); return -ENOMEM; } /* Fill request buffer */ info = (mlan_ds_get_info *)req->pbuf; info->sub_command = MLAN_OID_LINK_STATS; req->req_id = MLAN_IOCTL_GET_INFO; req->action = MLAN_ACT_SET; /* Configure parameter to firmware */ moal_memcpy_ext(priv->phandle, info->param.link_statistic, &ll_params, sizeof(ll_params), sizeof(mlan_ds_get_info) - sizeof(t_u32)); /* Send IOCTL request to MLAN */ status = woal_request_ioctl(priv, req, MOAL_IOCTL_WAIT); if (status == MLAN_STATUS_SUCCESS) PRINTM(MMSG, "enable link layer statistic successfully\n"); if (status != MLAN_STATUS_PENDING) kfree(req); return 0; } /** * @brief clear function should download command to fimrware, * so that firmware could cleanup per peer statistic number * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_link_statistic_clr(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { moal_private *priv = (moal_private *)woal_get_netdev_priv(wdev->netdev); struct nlattr *tb[ATTR_LL_STATS_MAX + 1]; mlan_ioctl_req *req = NULL; mlan_ds_get_info *info = NULL; mlan_status status = MLAN_STATUS_SUCCESS; u32 stats_clear_req_mask = 0x0, stats_clear_rsp_mask = 0x0; u8 stop_req = 0x0, stop_rsp = 0x0; struct sk_buff *skb = NULL; int err = 0, length = 0; err = nla_parse(tb, ATTR_LL_STATS_MAX, data, len, NULL #if KERNEL_VERSION(4, 12, 0) <= CFG80211_VERSION_CODE , NULL #endif ); if (err) return err; if (!tb[ATTR_LL_STATS_CLEAR_REQ_MASK]) return -EINVAL; else stats_clear_req_mask = nla_get_u32(tb[ATTR_LL_STATS_CLEAR_REQ_MASK]); if (!tb[ATTR_LL_STATS_STOP_REQ]) return -EINVAL; else stop_req = nla_get_u8(tb[ATTR_LL_STATS_STOP_REQ]); PRINTM(MEVENT, "link layer clear stats_clear_req_mask = 0x%x, stop_req = 0x%x\n", stats_clear_req_mask, stop_req); /* Allocate an IOCTL request buffer */ req = woal_alloc_mlan_ioctl_req(sizeof(t_u32) + sizeof(mlan_ds_get_info)); if (req == NULL) { PRINTM(MERROR, "Could not allocate mlan ioctl request!\n"); return -ENOMEM; } /* Fill request buffer */ info = (mlan_ds_get_info *)req->pbuf; info->sub_command = MLAN_OID_LINK_STATS; req->req_id = MLAN_IOCTL_GET_INFO; req->action = MLAN_ACT_CLEAR; /* Send IOCTL request to MLAN */ status = woal_request_ioctl(priv, req, MOAL_IOCTL_WAIT); if (status == MLAN_STATUS_SUCCESS) PRINTM(MMSG, "disable link layer statistic successfully\n"); length = NLA_HDRLEN + sizeof(stats_clear_rsp_mask) + sizeof(stop_rsp); /* Alloc the SKB for vendor_event */ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, length); if (unlikely(!skb)) { PRINTM(MERROR, "skb alloc failed\n"); err = -EINVAL; goto exit; } /* clear api to reset statistics, stats_clear_rsp_mask identifies what * stats have been cleared stop_req = 1 will imply whether to stop the * statistics collection. stop_rsp = 1 will imply that stop_req was * honored and statistics collection was stopped. */ stats_clear_rsp_mask = WIFI_STATS_RADIO | WIFI_STATS_IFACE; stop_rsp = 1; if (nla_put_u32(skb, ATTR_LL_STATS_CLEAR_RSP_MASK, stats_clear_rsp_mask) || nla_put_u8(skb, ATTR_LL_STATS_STOP_RSP, stop_rsp)) { PRINTM(MERROR, "nla_put failed!\n"); kfree_skb(skb); err = -EINVAL; goto exit; } err = cfg80211_vendor_cmd_reply(skb); if (unlikely(err)) { PRINTM(MERROR, "Vendor Command reply failed ret:%d\n", err); goto exit; ; } exit: if (status != MLAN_STATUS_PENDING) kfree(req); return err; } #ifdef STA_CFG80211 #define RSSI_MONOTOR_START 1 #define RSSI_MONOTOR_STOP 0 /** * @brief vendor command to control rssi monitor * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_rssi_monitor(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { struct nlattr *tb[ATTR_RSSI_MONITOR_MAX + 1]; moal_private *priv = (moal_private *)woal_get_netdev_priv(wdev->netdev); u32 rssi_monitor_control = 0x0; s8 rssi_min = 0, rssi_max = 0; int err = 0; t_u8 *pos = NULL; struct sk_buff *skb = NULL; int ret = 0; ENTER(); if (!priv->media_connected) { ret = -EINVAL; goto done; } ret = nla_parse(tb, ATTR_RSSI_MONITOR_MAX, data, len, NULL #if KERNEL_VERSION(4, 12, 0) <= CFG80211_VERSION_CODE , NULL #endif ); if (ret) goto done; if (!tb[ATTR_RSSI_MONITOR_CONTROL]) { ret = -EINVAL; goto done; } rssi_monitor_control = nla_get_u32(tb[ATTR_RSSI_MONITOR_CONTROL]); if (rssi_monitor_control == RSSI_MONOTOR_START) { if ((!tb[ATTR_RSSI_MONITOR_MIN_RSSI]) || (!tb[ATTR_RSSI_MONITOR_MAX_RSSI])) { ret = -EINVAL; goto done; } rssi_min = nla_get_s8(tb[ATTR_RSSI_MONITOR_MIN_RSSI]); rssi_max = nla_get_s8(tb[ATTR_RSSI_MONITOR_MAX_RSSI]); PRINTM(MEVENT, "start rssi monitor rssi_min = %d, rssi_max= %d\n", rssi_min, rssi_max); /* set rssi low/high threshold */ priv->cqm_rssi_high_thold = rssi_max; priv->cqm_rssi_thold = rssi_min; priv->cqm_rssi_hyst = 4; if (MLAN_STATUS_SUCCESS != woal_set_rssi_threshold(priv, 0, MOAL_IOCTL_WAIT)) { PRINTM(MERROR, "set rssi threhold fail\n"); ret = -EFAULT; goto done; } } else if (rssi_monitor_control == RSSI_MONOTOR_STOP) { /* stop rssi monitor */ PRINTM(MEVENT, "stop rssi monitor\n"); /* set both rssi_thold/hyst to 0, will trigger subscribe event * clear */ priv->cqm_rssi_high_thold = 0; priv->cqm_rssi_thold = 0; priv->cqm_rssi_hyst = 0; if (MLAN_STATUS_SUCCESS != woal_set_rssi_threshold(priv, 0, MOAL_IOCTL_WAIT)) { PRINTM(MERROR, "set rssi threhold fail\n"); ret = -EFAULT; goto done; } } else { PRINTM(MERROR, "invalid rssi_monitor control request\n"); ret = -EINVAL; goto done; } /* Alloc the SKB for cmd reply */ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len); if (unlikely(!skb)) { PRINTM(MERROR, "skb alloc failed\n"); ret = -EINVAL; goto done; } pos = skb_put(skb, len); moal_memcpy_ext(priv->phandle, pos, data, len, len); err = cfg80211_vendor_cmd_reply(skb); if (unlikely(err)) { PRINTM(MERROR, "Vendor Command reply failed ret:%d\n", err); ret = err; } done: LEAVE(); return ret; } /** * @brief send rssi event to kernel * * @param priv A pointer to moal_private * @param rssi current rssi value * * @return N/A */ void woal_cfg80211_rssi_monitor_event(moal_private *priv, t_s16 rssi) { struct sk_buff *skb = NULL; t_s8 rssi_value = 0; ENTER(); skb = dev_alloc_skb(NLA_HDRLEN * 2 + ETH_ALEN + sizeof(t_s8)); if (!skb) goto done; /* convert t_s16 to t_s8*/ rssi_value = -abs(rssi); if (nla_put(skb, ATTR_RSSI_MONITOR_CUR_BSSID, ETH_ALEN, priv->conn_bssid) || nla_put_s8(skb, ATTR_RSSI_MONITOR_CUR_RSSI, rssi_value)) { PRINTM(MERROR, "nla_put failed!\n"); kfree(skb); goto done; } woal_cfg80211_vendor_event(priv, event_rssi_monitor, (t_u8 *)skb->data, skb->len); kfree(skb); done: LEAVE(); } #endif /** * @brief vendor command to key_mgmt_set_key * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success fail otherwise */ static int woal_cfg80211_subcmd_set_roaming_offload_key(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { moal_private *priv; struct net_device *dev; struct sk_buff *skb = NULL; t_u8 *pos = (t_u8 *)data; int ret = MLAN_STATUS_SUCCESS; ENTER(); if (data) DBG_HEXDUMP(MCMD_D, "Vendor pmk", (t_u8 *)data, data_len); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); if (!priv || !pos) { LEAVE(); return -EFAULT; } if (data_len > MLAN_MAX_KEY_LENGTH) { moal_memcpy_ext(priv->phandle, &priv->pmk.pmk_r0, pos, MLAN_MAX_KEY_LENGTH, MLAN_MAX_KEY_LENGTH); pos += MLAN_MAX_KEY_LENGTH; moal_memcpy_ext(priv->phandle, &priv->pmk.pmk_r0_name, pos, data_len - MLAN_MAX_KEY_LENGTH, MLAN_MAX_PMKR0_NAME_LENGTH); } else { moal_memcpy_ext(priv->phandle, &priv->pmk.pmk, data, data_len, MLAN_MAX_KEY_LENGTH); } priv->pmk_saved = MTRUE; /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, data_len); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); LEAVE(); return -EFAULT; } pos = skb_put(skb, data_len); moal_memcpy_ext(priv->phandle, pos, data, data_len, data_len); ret = cfg80211_vendor_cmd_reply(skb); LEAVE(); return ret; } /** * @brief vendor command to supplicant to update AP info * * @param priv A pointer to moal_private * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ int woal_roam_ap_info(moal_private *priv, t_u8 *data, int len) { struct wiphy *wiphy = priv->wdev->wiphy; struct sk_buff *skb = NULL; int ret = MLAN_STATUS_SUCCESS; key_info *pkey = NULL; apinfo *pinfo = NULL; apinfo *req_tlv = NULL; MrvlIEtypesHeader_t *tlv = NULL; t_u16 tlv_type = 0, tlv_len = 0, tlv_buf_left = 0; int event_id = 0; t_u8 authorized = 1; ENTER(); event_id = woal_get_event_id(event_fw_roam_success); if (event_max == event_id) { PRINTM(MERROR, "Not find this event %d\n", event_id); ret = 1; LEAVE(); return ret; } /**allocate skb*/ #if KERNEL_VERSION(4, 1, 0) <= CFG80211_VERSION_CODE skb = cfg80211_vendor_event_alloc(wiphy, priv->wdev, len + 50, #else skb = cfg80211_vendor_event_alloc(wiphy, len + 50, #endif event_id, GFP_ATOMIC); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor event\n"); ret = 1; LEAVE(); return ret; } nla_put(skb, MRVL_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID, MLAN_MAC_ADDR_LENGTH, (t_u8 *)data); nla_put(skb, MRVL_WLAN_VENDOR_ATTR_ROAM_AUTH_AUTHORIZED, sizeof(authorized), &authorized); tlv = (MrvlIEtypesHeader_t *)(data + MLAN_MAC_ADDR_LENGTH); tlv_buf_left = len - MLAN_MAC_ADDR_LENGTH; while (tlv_buf_left >= sizeof(MrvlIEtypesHeader_t)) { tlv_type = woal_le16_to_cpu(tlv->type); tlv_len = woal_le16_to_cpu(tlv->len); if (tlv_buf_left < (tlv_len + sizeof(MrvlIEtypesHeader_t))) { PRINTM(MERROR, "Error processing firmware roam success TLVs, bytes left < TLV length\n"); break; } switch (tlv_type) { case TLV_TYPE_APINFO: pinfo = (apinfo *)tlv; nla_put(skb, MRVL_WLAN_VENDOR_ATTR_ROAM_AUTH_RESP_IE, pinfo->header.len, pinfo->rsp_ie); break; case TLV_TYPE_ASSOC_REQ_IE: req_tlv = (apinfo *)tlv; nla_put(skb, MRVL_WLAN_VENDOR_ATTR_ROAM_AUTH_REQ_IE, req_tlv->header.len, req_tlv->rsp_ie); break; case TLV_TYPE_KEYINFO: pkey = (key_info *)tlv; nla_put(skb, MRVL_WLAN_VENDOR_ATTR_ROAM_AUTH_KEY_REPLAY_CTR, MLAN_REPLAY_CTR_LEN, pkey->key.replay_ctr); nla_put(skb, MRVL_WLAN_VENDOR_ATTR_ROAM_AUTH_PTK_KCK, MLAN_KCK_LEN, pkey->key.kck); nla_put(skb, MRVL_WLAN_VENDOR_ATTR_ROAM_AUTH_PTK_KEK, MLAN_KEK_LEN, pkey->key.kek); break; default: break; } tlv_buf_left -= tlv_len + sizeof(MrvlIEtypesHeader_t); tlv = (MrvlIEtypesHeader_t *)((t_u8 *)tlv + tlv_len + sizeof(MrvlIEtypesHeader_t)); } /**send event*/ cfg80211_vendor_event(skb, GFP_ATOMIC); LEAVE(); return ret; } /** * @brief vendor command to get fw roaming capability * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success fail otherwise */ static int woal_cfg80211_subcmd_get_roaming_capability(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int ret = MLAN_STATUS_SUCCESS; wifi_roaming_capabilities capa; struct sk_buff *skb = NULL; int err = 0; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } capa.max_blacklist_size = MAX_AP_LIST; capa.max_whitelist_size = MAX_SSID_NUM; /* Alloc the SKB for vendor_event */ skb = cfg80211_vendor_cmd_alloc_reply_skb( wiphy, sizeof(wifi_roaming_capabilities) + 50); if (unlikely(!skb)) { PRINTM(MERROR, "skb alloc failed\n"); goto done; } /* Push the data to the skb */ nla_put(skb, MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_CAPA, sizeof(wifi_roaming_capabilities), (t_u8 *)&capa); err = cfg80211_vendor_cmd_reply(skb); if (unlikely(err)) PRINTM(MERROR, "Vendor Command reply failed ret:%d\n", err); done: LEAVE(); return ret; } /** * @brief vendor command to enable/disable fw roaming * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success fail otherwise */ static int woal_cfg80211_subcmd_fw_roaming_enable(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { moal_private *priv; struct net_device *dev; int ret = MLAN_STATUS_SUCCESS; struct sk_buff *skb = NULL; const struct nlattr *iter; int type, rem, err; t_u32 fw_roaming_enable = 0; #ifdef STA_CFG80211 #if KERNEL_VERSION(3, 14, 0) <= CFG80211_VERSION_CODE t_u8 enable = 0; #endif #endif ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); if (!priv || !priv->phandle) { LEAVE(); return -EFAULT; } nla_for_each_attr (iter, data, len, rem) { type = nla_type(iter); switch (type) { case MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_CONTROL: fw_roaming_enable = nla_get_u32(iter); break; default: PRINTM(MERROR, "Unknown type: %d\n", type); ret = -EINVAL; goto done; } } PRINTM(MMSG, "FW roaming set enable=%d from wifi hal.\n", fw_roaming_enable); ret = woal_enable_fw_roaming(priv, fw_roaming_enable); /* Alloc the SKB for vendor_event */ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, sizeof(t_u32) + 50); if (unlikely(!skb)) { PRINTM(MERROR, "skb alloc failed\n"); goto done; } nla_put(skb, MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_CONTROL, sizeof(t_u32), &fw_roaming_enable); err = cfg80211_vendor_cmd_reply(skb); if (unlikely(err)) PRINTM(MERROR, "Vendor Command reply failed ret:%d\n", err); #ifdef STA_CFG80211 #if KERNEL_VERSION(3, 14, 0) <= CFG80211_VERSION_CODE if (!fw_roaming_enable) woal_cfg80211_vendor_event(priv, event_set_key_mgmt_offload, &enable, sizeof(enable)); #endif #endif done: LEAVE(); return ret; } /** * @brief vendor command to config blacklist and whitelist for fw roaming * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success fail otherwise */ static int woal_cfg80211_subcmd_fw_roaming_config(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { moal_private *priv; struct net_device *dev; int ret = MLAN_STATUS_SUCCESS; const struct nlattr *iter; int type, rem; woal_roam_offload_cfg *roam_offload_cfg = NULL; wifi_bssid_params blacklist; wifi_ssid_params whitelist; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); if (!priv || !priv->phandle) { LEAVE(); return -EFAULT; } memset((char *)&blacklist, 0, sizeof(wifi_bssid_params)); memset((char *)&whitelist, 0, sizeof(wifi_ssid_params)); nla_for_each_attr (iter, data, len, rem) { type = nla_type(iter); switch (type) { case MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_CONFIG_BSSID: moal_memcpy_ext(priv->phandle, (t_u8 *)&blacklist, nla_data(iter), nla_len(iter), sizeof(wifi_bssid_params)); break; case MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_CONFIG_SSID: moal_memcpy_ext(priv->phandle, (t_u8 *)&whitelist, nla_data(iter), nla_len(iter), sizeof(wifi_ssid_params)); break; default: PRINTM(MERROR, "Unknown type: %d\n", type); ret = -EINVAL; goto done; } } if (moal_extflg_isset(priv->phandle, EXT_ROAMOFFLOAD_IN_HS)) { /*save blacklist and whitelist in driver*/ priv->phandle->fw_roam_params.black_list.ap_num = blacklist.num_bssid; moal_memcpy_ext( priv->phandle, (t_u8 *)priv->phandle->fw_roam_params.black_list.ap_mac, (t_u8 *)blacklist.mac_addr, sizeof(wifi_bssid_params) - sizeof(blacklist.num_bssid), sizeof(mlan_ds_misc_roam_offload_aplist) - sizeof(priv->phandle->fw_roam_params.black_list .ap_num)); priv->phandle->fw_roam_params.ssid_list.ssid_num = whitelist.num_ssid; moal_memcpy_ext( priv->phandle, (t_u8 *)priv->phandle->fw_roam_params.ssid_list.ssids, (t_u8 *)whitelist.whitelist_ssid, sizeof(wifi_ssid_params) - sizeof(whitelist.num_ssid), MAX_SSID_NUM * sizeof(mlan_802_11_ssid)); } else { roam_offload_cfg = (woal_roam_offload_cfg *)kmalloc( sizeof(woal_roam_offload_cfg), GFP_KERNEL); if (!roam_offload_cfg) { PRINTM(MERROR, "kmalloc failed!\n"); ret = -ENOMEM; goto done; } /*download parameters directly to fw*/ memset((char *)roam_offload_cfg, 0, sizeof(woal_roam_offload_cfg)); roam_offload_cfg->black_list.ap_num = blacklist.num_bssid; moal_memcpy_ext(priv->phandle, (t_u8 *)&roam_offload_cfg->black_list.ap_mac, (t_u8 *)blacklist.mac_addr, sizeof(wifi_bssid_params) - sizeof(blacklist.num_bssid), sizeof(mlan_ds_misc_roam_offload_aplist) - sizeof(priv->phandle->fw_roam_params .black_list.ap_num)); roam_offload_cfg->ssid_list.ssid_num = whitelist.num_ssid; moal_memcpy_ext(priv->phandle, (t_u8 *)&roam_offload_cfg->ssid_list.ssids, (t_u8 *)whitelist.whitelist_ssid, sizeof(wifi_ssid_params) - sizeof(whitelist.num_ssid), MAX_SSID_NUM * sizeof(mlan_802_11_ssid)); if (woal_config_fw_roaming(priv, ROAM_OFFLOAD_PARAM_CFG, roam_offload_cfg)) { PRINTM(MERROR, "%s: config fw roaming failed \n", __func__); ret = -EFAULT; } } done: if (roam_offload_cfg) kfree(roam_offload_cfg); LEAVE(); return ret; } /** * @brief vendor command to enable/disable 11k * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param data_len data length * * @return 0: success <0: fail */ static int woal_cfg80211_subcmd_11k_cfg(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct net_device *dev = NULL; moal_private *priv = NULL; mlan_ioctl_req *req = NULL; struct nlattr *tb_vendor[ATTR_ND_OFFLOAD_MAX + 1]; int ret = 0; int status = MLAN_STATUS_SUCCESS; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); nla_parse(tb_vendor, ATTR_ND_OFFLOAD_MAX, (struct nlattr *)data, data_len, NULL #if KERNEL_VERSION(4, 12, 0) <= CFG80211_VERSION_CODE , NULL #endif ); if (!tb_vendor[ATTR_ND_OFFLOAD_CONTROL]) { PRINTM(MINFO, "%s: ATTR_ND_OFFLOAD not found\n", __func__); ret = -EFAULT; goto done; } done: if (status != MLAN_STATUS_PENDING) kfree(req); LEAVE(); return ret; } /** * @brief vendor command to set scan mac oui * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param data_len data length * * @return 0: success <0: fail */ static int woal_cfg80211_subcmd_set_scan_mac_oui(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct net_device *dev = NULL; moal_private *priv = NULL; struct nlattr *tb_vendor[ATTR_WIFI_MAX + 1]; t_u8 mac_oui[3]; int ret = MLAN_STATUS_SUCCESS; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); nla_parse(tb_vendor, ATTR_WIFI_MAX, (struct nlattr *)data, data_len, NULL #if KERNEL_VERSION(4, 12, 0) <= CFG80211_VERSION_CODE , NULL #endif ); if (!tb_vendor[ATTR_SCAN_MAC_OUI_SET]) { PRINTM(MINFO, "%s: ATTR_SCAN_MAC_OUI_SET not found\n", __func__); ret = -EFAULT; goto done; } moal_memcpy_ext(priv->phandle, mac_oui, nla_data(tb_vendor[ATTR_SCAN_MAC_OUI_SET]), 3, 3); moal_memcpy_ext(priv->phandle, priv->random_mac, priv->current_addr, ETH_ALEN, MLAN_MAC_ADDR_LENGTH); moal_memcpy_ext(priv->phandle, priv->random_mac, mac_oui, 3, MLAN_MAC_ADDR_LENGTH); PRINTM(MCMND, "random_mac is " FULL_MACSTR "\n", FULL_MAC2STR(priv->random_mac)); done: LEAVE(); return ret; } /** * @brief vendor command to start keep alive * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success fail otherwise */ static int woal_cfg80211_subcmd_start_keep_alive(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { moal_private *priv; struct net_device *dev; int ret = MLAN_STATUS_SUCCESS; int type, rem; t_u8 mkeep_alive_id = 0; t_u16 ether_type = 0; t_u8 *ip_pkt = NULL; t_u16 ip_pkt_len = 0; t_u8 src_mac[ETH_ALEN]; t_u8 dst_mac[ETH_ALEN]; t_u32 period_msec = 0; t_u32 retry_interval = 0; t_u8 retry_cnt = 0; const struct nlattr *iter; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); if (!priv) { LEAVE(); return -EFAULT; } nla_for_each_attr (iter, data, len, rem) { type = nla_type(iter); switch (type) { case MKEEP_ALIVE_ATTRIBUTE_ID: mkeep_alive_id = nla_get_u8(iter); break; case MKEEP_ALIVE_ATTRIBUTE_ETHER_TYPE: ether_type = nla_get_u16(iter); break; case MKEEP_ALIVE_ATTRIBUTE_IP_PKT_LEN: ip_pkt_len = nla_get_u16(iter); if (ip_pkt_len > MKEEP_ALIVE_IP_PKT_MAX) { ret = -EINVAL; goto exit; } break; case MKEEP_ALIVE_ATTRIBUTE_IP_PKT: if (ip_pkt_len) { if (ip_pkt) { kfree(ip_pkt); ip_pkt = NULL; } ip_pkt = (u8 *)kzalloc(ip_pkt_len, GFP_ATOMIC); if (ip_pkt == NULL) { ret = -ENOMEM; PRINTM(MERROR, "Failed to allocate mem for ip packet\n"); goto exit; } moal_memcpy_ext(priv->phandle, ip_pkt, (u8 *)nla_data(iter), nla_len(iter), ip_pkt_len); } break; case MKEEP_ALIVE_ATTRIBUTE_SRC_MAC_ADDR: moal_memcpy_ext(priv->phandle, src_mac, nla_data(iter), nla_len(iter), ETH_ALEN); break; case MKEEP_ALIVE_ATTRIBUTE_DST_MAC_ADDR: moal_memcpy_ext(priv->phandle, dst_mac, nla_data(iter), nla_len(iter), ETH_ALEN); break; case MKEEP_ALIVE_ATTRIBUTE_PERIOD_MSEC: period_msec = nla_get_u32(iter); break; case MKEEP_ALIVE_ATTRIBUTE_RETRY_INTERVAL: retry_interval = nla_get_u32(iter); break; case MKEEP_ALIVE_ATTRIBUTE_RETRY_CNT: retry_cnt = nla_get_u8(iter); break; default: PRINTM(MERROR, "Unknown type: %d\n", type); ret = -EINVAL; goto exit; } } ret = woal_priv_save_cloud_keep_alive_params( priv, mkeep_alive_id, true, ether_type, ip_pkt, ip_pkt_len, src_mac, dst_mac, period_msec, retry_interval, retry_cnt); if (ret < 0) PRINTM(MERROR, "start_mkeep_alive is failed ret: %d\n", ret); exit: if (ip_pkt) kfree(ip_pkt); LEAVE(); return ret; } /** * @brief vendor command to stop keep alive * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success fail otherwise */ static int woal_cfg80211_subcmd_stop_keep_alive(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { moal_private *priv; struct net_device *dev; int ret = MLAN_STATUS_SUCCESS; int type, rem; t_u8 mkeep_alive_id = 0; const struct nlattr *iter; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); if (!priv) { LEAVE(); return -EFAULT; } nla_for_each_attr (iter, data, len, rem) { type = nla_type(iter); switch (type) { case MKEEP_ALIVE_ATTRIBUTE_ID: mkeep_alive_id = nla_get_u8(iter); break; default: PRINTM(MERROR, "Unknown type: %d\n", type); ret = -EINVAL; break; } } ret = woal_stop_mkeep_alive(priv, mkeep_alive_id, 0, NULL, NULL); if (ret < 0) PRINTM(MERROR, "stop_mkeep_alive is failed ret: %d\n", ret); LEAVE(); return ret; } /** * @brief Upload last keep alive packet to Host through vendor event * * @param priv Pointer to moal_private structure * @param mkeep_alive Pointer to mlan_ds_misc_keep_alive structure * @return 0: success fail otherwise */ int woal_mkeep_alive_vendor_event(moal_private *priv, mlan_ds_misc_keep_alive *mkeep_alive) { struct wiphy *wiphy = priv->wdev->wiphy; struct sk_buff *skb = NULL; int ret = MLAN_STATUS_SUCCESS; int event_id = 0; t_u16 len = 0; ENTER(); event_id = woal_get_event_id(event_cloud_keep_alive); if (event_max == event_id) { PRINTM(MERROR, "Not find this event %d\n", event_id); ret = MLAN_STATUS_FAILURE; goto done; } if (!mkeep_alive) { PRINTM(MERROR, "Parameter is NULL\n"); ret = MLAN_STATUS_FAILURE; goto done; } len = mkeep_alive->pkt_len; /**allocate skb*/ #if KERNEL_VERSION(4, 1, 0) <= CFG80211_VERSION_CODE skb = cfg80211_vendor_event_alloc(wiphy, priv->wdev, len + 50, #else skb = cfg80211_vendor_event_alloc(wiphy, len + 50, #endif event_id, GFP_ATOMIC); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor event\n"); ret = MLAN_STATUS_FAILURE; goto done; } nla_put(skb, MKEEP_ALIVE_ATTRIBUTE_IP_PKT_LEN, sizeof(t_u16), &len); nla_put(skb, MKEEP_ALIVE_ATTRIBUTE_IP_PKT, len, mkeep_alive->packet); /**send event*/ cfg80211_vendor_event(skb, GFP_ATOMIC); done: LEAVE(); return ret; } /** * @brief vendor command to set enable/disable dfs offload * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success 1: fail */ static int woal_cfg80211_subcmd_set_dfs_offload(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct sk_buff *skb = NULL; moal_handle *handle = (moal_handle *)woal_get_wiphy_priv(wiphy); int dfs_offload; int ret = 1; ENTER(); dfs_offload = moal_extflg_isset(handle, EXT_DFS_OFFLOAD); /** Allocate skb for cmd reply*/ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, sizeof(dfs_offload)); if (!skb) { PRINTM(MERROR, "allocate memory fail for vendor cmd\n"); ret = 1; LEAVE(); return ret; } nla_put(skb, MRVL_WLAN_VENDOR_ATTR_DFS, sizeof(t_u32), &dfs_offload); ret = cfg80211_vendor_cmd_reply(skb); LEAVE(); return ret; } #define CSI_DUMP_FILE_MAX 1200000 /** * @brief vendor command to set CSI params * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * @param csi_enable enable/disable CSI * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_set_csi(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len, int csi_enable) { struct net_device *dev = NULL; moal_private *priv = NULL; mlan_ioctl_req *req = NULL; mlan_ds_misc_cfg *cfg = NULL; struct nlattr *tb_vendor[ATTR_CSI_MAX + 1]; int ret = 0; int status = MLAN_STATUS_SUCCESS; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); req = woal_alloc_mlan_ioctl_req(sizeof(mlan_ds_misc_cfg)); if (req == NULL) { PRINTM(MERROR, "Could not allocate mlan ioctl request!\n"); ret = -EFAULT; goto done; } req->req_id = MLAN_IOCTL_MISC_CFG; cfg = (mlan_ds_misc_cfg *)req->pbuf; cfg->sub_command = MLAN_OID_MISC_CSI; priv->csi_enable = csi_enable; if (csi_enable == 1) { nla_parse(tb_vendor, ATTR_CSI_MAX, (struct nlattr *)data, len, NULL #if KERNEL_VERSION(4, 12, 0) <= CFG80211_VERSION_CODE , NULL #endif ); if (!tb_vendor[ATTR_CSI_CONFIG]) { ret = -EFAULT; goto done; } moal_memcpy_ext(priv->phandle, &cfg->param.csi_params, (mlan_ds_csi_params *)nla_data( tb_vendor[ATTR_CSI_CONFIG]), sizeof(mlan_ds_csi_params), sizeof(mlan_ds_csi_params)); moal_memcpy_ext(priv->phandle, &priv->csi_config, &cfg->param.csi_params, sizeof(mlan_ds_csi_params), sizeof(mlan_ds_csi_params)); if (tb_vendor[ATTR_CSI_DUMP_FORMAT]) priv->csi_dump_format = nla_get_u8(tb_vendor[ATTR_CSI_DUMP_FORMAT]); } else if (csi_enable == 0) { nla_parse(tb_vendor, ATTR_CSI_MAX, (struct nlattr *)data, len, NULL #if KERNEL_VERSION(4, 12, 0) <= CFG80211_VERSION_CODE , NULL #endif ); if (!tb_vendor[ATTR_PEER_MAC_ADDR]) { ret = -EFAULT; goto done; } memset(&cfg->param.csi_params, 0, sizeof(mlan_ds_csi_params)); moal_memcpy_ext(priv->phandle, cfg->param.csi_params.csi_filter[0].mac_addr, (t_u8 *)nla_data(tb_vendor[ATTR_PEER_MAC_ADDR]), MLAN_MAC_ADDR_LENGTH, MLAN_MAC_ADDR_LENGTH); } status = woal_request_ioctl(priv, req, MOAL_IOCTL_WAIT); if (status != MLAN_STATUS_SUCCESS) { ret = -EFAULT; goto done; } done: if (status != MLAN_STATUS_PENDING) kfree(req); LEAVE(); return ret; } /** * @brief vendor command to enable CSI * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_csi_enable(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int ret = 0; ENTER(); ret = woal_cfg80211_subcmd_set_csi(wiphy, wdev, data, len, 1); LEAVE(); return ret; } /** * @brief vendor command to disable CSI * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_csi_disable(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int ret = 0; ENTER(); ret = woal_cfg80211_subcmd_set_csi(wiphy, wdev, data, len, 0); LEAVE(); return ret; } /** * @brief vendor command to get CSI dump path * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_get_csi_dump_path(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int ret = 0; struct net_device *dev = NULL; moal_private *priv = NULL; struct sk_buff *skb = NULL; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, sizeof(priv->csi_dump_path)); if (unlikely(!skb)) { PRINTM(MERROR, "skb alloc failed\n"); ret = MLAN_STATUS_FAILURE; goto done; } /* Push the data to the skb */ nla_put(skb, ATTR_CSI_DUMP_PATH, sizeof(priv->csi_dump_path), (t_u8 *)priv->csi_dump_path); ret = cfg80211_vendor_cmd_reply(skb); if (unlikely(ret)) { PRINTM(MERROR, "Vendor Command reply failed ret:%d\n", ret); goto done; } done: LEAVE(); return ret; } /** * @brief vendor command to get CSI config * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_get_csi_config(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int ret = 0; struct net_device *dev = NULL; moal_private *priv = NULL; struct sk_buff *skb = NULL; ENTER(); if (!wdev || !wdev->netdev) { LEAVE(); return -EFAULT; } dev = wdev->netdev; priv = (moal_private *)woal_get_netdev_priv(dev); skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, sizeof(priv->csi_config)); if (unlikely(!skb)) { PRINTM(MERROR, "skb alloc failed\n"); ret = MLAN_STATUS_FAILURE; goto done; } /* Push the data to the skb */ nla_put(skb, ATTR_CSI_CONFIG, sizeof(mlan_ds_csi_params), (t_u8 *)&priv->csi_config); ret = cfg80211_vendor_cmd_reply(skb); if (unlikely(ret)) { PRINTM(MERROR, "Vendor Command reply failed ret:%d\n", ret); goto done; } done: LEAVE(); return ret; } /** * @brief vendor command to get CSI capability * * @param wiphy A pointer to wiphy struct * @param wdev A pointer to wireless_dev struct * @param data a pointer to data * @param len data length * * @return 0: success -1: fail */ static int woal_cfg80211_subcmd_get_csi_capa(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { ENTER(); LEAVE(); return 0; } /** * @brief Save CSI dump to file * * @param dir_name Directory name * @param file_name File name * @param buf Pointer to dump buffer * @param buf_len Length of buf * @param name Full path name of CSI dump * * @return 0: success -1: fail */ static mlan_status woal_save_csi_dump_to_file(char *dir_name, char *file_name, t_u8 *buf, int buf_len, t_u8 format, char *name) { mlan_status ret = MLAN_STATUS_SUCCESS; ENTER(); if (!dir_name || !file_name || !buf) { PRINTM(MERROR, "Can't save dump info to file\n"); ret = MLAN_STATUS_FAILURE; goto done; } done: LEAVE(); return ret; } /** * @brief vendor event to upload csi dump * * @param priv A pointer to moal_private * @param data a pointer to data * @param len data length * * @return mlan_status */ mlan_status woal_cfg80211_event_csi_dump(moal_private *priv, t_u8 *data, int len) { mlan_status ret = MLAN_STATUS_SUCCESS; char path_name[20]; char file_name[20]; ENTER(); DBG_HEXDUMP(MCMD_D, "CSI dump data", data, len); sprintf(path_name, "/data"); if (priv->csi_dump_format == 1) sprintf(file_name, "csi_dump.bin"); else sprintf(file_name, "csi_dump.txt"); priv->csi_dump_len += len; if (priv->csi_dump_len > CSI_DUMP_FILE_MAX) { PRINTM(MERROR, "Reached file maximum size. Not saving CSI records.\n"); goto done; } /* Save CSI dump to file */ ret = woal_save_csi_dump_to_file(path_name, file_name, data, len, priv->csi_dump_format, priv->csi_dump_path); if (ret != MLAN_STATUS_SUCCESS) { PRINTM(MERROR, "Failed to save CSI dump to file\n"); goto done; } done: LEAVE(); return ret; } // clang-format off static const struct wiphy_vendor_command vendor_commands[] = { { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_set_drvdbg, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_set_drvdbg, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_valid_channels, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_valid_channels, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_attr_policy, .maxattr = ATTR_WIFI_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_set_scan_mac_oui, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_set_scan_mac_oui, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_attr_policy, .maxattr = ATTR_WIFI_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_link_statistic_set, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_link_statistic_set, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_ll_stat_policy, .maxattr = ATTR_LL_STATS_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_link_statistic_get, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_link_statistic_get, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_link_statistic_clr, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_link_statistic_clr, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_ll_stat_policy, .maxattr = ATTR_LL_STATS_MAX, #endif }, #ifdef STA_CFG80211 { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_rssi_monitor, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_rssi_monitor, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_rssi_monitor_policy, .maxattr = ATTR_RSSI_MONITOR_MAX, #endif }, #endif { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_set_roaming_offload_key, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_set_roaming_offload_key, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_roaming_capability, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_roaming_capability, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_fw_roaming_enable, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_fw_roaming_enable, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_fw_roaming_policy, .maxattr = MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_fw_roaming_config, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_fw_roaming_config, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_fw_roaming_policy, .maxattr = MRVL_WLAN_VENDOR_ATTR_FW_ROAMING_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_start_keep_alive, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_start_keep_alive, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_keep_alive_policy, .maxattr = MKEEP_ALIVE_ATTRIBUTE_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_stop_keep_alive, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_stop_keep_alive, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_dfs_capability, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_set_dfs_offload, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_nd_offload }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_11k_cfg, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_nd_offload_policy, .maxattr = ATTR_ND_OFFLOAD_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_drv_version, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_drv_version, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_fw_version, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_fw_version, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_wifi_supp_feature_set, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_supp_feature_set, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_set_country_code, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_set_country_code, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_wifi_logger_supp_feature_set, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_wifi_logger_supp_feature_set, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_logger_policy, .maxattr = ATTR_WIFI_LOGGER_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_ring_buff_status, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV | WIPHY_VENDOR_CMD_NEED_RUNNING, .doit = woal_cfg80211_subcmd_get_ring_buff_status, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_logger_policy, .maxattr = ATTR_WIFI_LOGGER_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_start_logging, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV | WIPHY_VENDOR_CMD_NEED_RUNNING, .doit = woal_cfg80211_subcmd_start_logging, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_logger_policy, .maxattr = ATTR_WIFI_LOGGER_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_ring_buff_data, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV | WIPHY_VENDOR_CMD_NEED_RUNNING, .doit = woal_cfg80211_subcmd_get_ring_data, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_logger_policy, .maxattr = ATTR_WIFI_LOGGER_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_start_packet_fate_monitor, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV | WIPHY_VENDOR_CMD_NEED_RUNNING, .doit = woal_cfg80211_subcmd_start_packet_fate_monitor, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_fw_mem_dump, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV | WIPHY_VENDOR_CMD_NEED_RUNNING, .doit = woal_cfg80211_subcmd_get_fw_dump, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_drv_mem_dump, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV | WIPHY_VENDOR_CMD_NEED_RUNNING, .doit = woal_cfg80211_subcmd_get_drv_dump, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_set_packet_filter, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV | WIPHY_VENDOR_CMD_NEED_RUNNING, .doit = woal_cfg80211_subcmd_set_packet_filter, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = woal_packet_filter_policy, .maxattr = ATTR_PACKET_FILTER_MAX, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = sub_cmd_get_packet_filter_capability, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV | WIPHY_VENDOR_CMD_NEED_RUNNING, .doit = woal_cfg80211_subcmd_get_packet_filter_capability, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = subcmd_cfr_request, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_csi_enable, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = subcmd_cfr_cancel, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_csi_disable, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = subcmd_get_csi_dump_path, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_csi_dump_path, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = subcmd_get_csi_config, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_csi_config, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, { .info = { .vendor_id = MRVL_VENDOR_ID, .subcmd = subcmd_get_csi_capa, }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = woal_cfg80211_subcmd_get_csi_capa, #if KERNEL_VERSION(5, 3, 0) <= CFG80211_VERSION_CODE .policy = VENDOR_CMD_RAW_DATA, #endif }, }; // clang-format on /** * @brief register vendor commands and events * * @param wiphy A pointer to wiphy struct * * @return */ void woal_register_cfg80211_vendor_command(struct wiphy *wiphy) { ENTER(); wiphy->vendor_commands = vendor_commands; wiphy->n_vendor_commands = ARRAY_SIZE(vendor_commands); wiphy->vendor_events = vendor_events; wiphy->n_vendor_events = ARRAY_SIZE(vendor_events); LEAVE(); } #endif