qcacld-3.0: Add support of request peer stats info(part 1)
qcacld-2.0 to qcacld-3.0 propagation
FW has limitation to support old WMI_REQUEST_STATS_CMDID and
WMI_UPDATE_STATS_EVENTID interface on AP vDev. FW suggest to use new
WMI_REQUEST_PEER_STATS_INFO_CMDID and WMI_PEER_STATS_INFO_EVENTID to
get tx/rx rate.
This checkin is about WMA layer which process SME message to get peer
stats info and WMI event WMI_PEER_STATS_INFO_EVENTID which send from
firmware as response to WMI_REQUEST_PEER_STATS_INFO_CMDID. There are
also updates using old WMI_REQUEST_STATS_CMDID to get peer stats.
Change-Id: I964520dc44c112875434771154f55f4746298308
CRs-Fixed: 2046459
diff --git a/core/mac/inc/sir_api.h b/core/mac/inc/sir_api.h
index 444df78..fe26e95 100644
--- a/core/mac/inc/sir_api.h
+++ b/core/mac/inc/sir_api.h
@@ -3616,6 +3616,105 @@
uint32_t estLinkSpeed; /* Linkspeed from firmware */
} tSirLinkSpeedInfo, *tpSirLinkSpeedInfo;
+/**
+ * struct sir_peer_info_req - peer info request struct
+ * @peer_macaddr: MAC address
+ * @sessionid: vdev id
+ *
+ * peer info request message's struct
+ */
+struct sir_peer_info_req {
+ struct qdf_mac_addr peer_macaddr;
+ uint8_t sessionid;
+};
+
+/**
+ * struct sir_peer_info - peer information struct
+ * @peer_macaddr: MAC address
+ * @rssi: rssi
+ * @tx_rate: last tx rate
+ * @rx_rate: last rx rate
+ *
+ * a station's information
+ */
+struct sir_peer_info {
+ struct qdf_mac_addr peer_macaddr;
+ int8_t rssi;
+ uint32_t tx_rate;
+ uint32_t rx_rate;
+};
+
+/**
+ * struct sir_peer_info_resp - all peers information struct
+ * @count: peer's number
+ * @info: peer information
+ *
+ * all station's information
+ */
+struct sir_peer_info_resp {
+ uint8_t count;
+ struct sir_peer_info info[0];
+};
+
+/**
+ * struct sir_peer_info_ext_req - peer info request struct
+ * @peer_macaddr: MAC address
+ * @sessionid: vdev id
+ * @reset_after_request: fw reset statistics after query
+ *
+ * peer info request message's struct
+ */
+struct sir_peer_info_ext_req {
+ struct qdf_mac_addr peer_macaddr;
+ uint8_t sessionid;
+ uint8_t reset_after_request;
+};
+
+/**
+ * struct sir_peer_info_ext - peer info information struct
+ * (refer to station_info struct in Kernel)
+ * @peer_macaddr: MAC address
+ * @tx_packets: packets transmitted to this station
+ * @tx_bytes: bytes transmitted to this station
+ * @rx_packets: packets received from this station
+ * @rx_bytes: bytes received from this station
+ * @rx_retries: cumulative retry counts
+ * @tx_failed: number of failed transmissions
+ * @rssi: The signal strength
+ * @tx_rate: last used tx bitrate (kbps)
+ * @tx_rate_code: last tx rate code (last_tx_rate_code of wmi_peer_stats_info)
+ * @rx_rate: last used rx bitrate (kbps)
+ * @rx_rate_code: last rx rate code (last_rx_rate_code of wmi_peer_stats_info)
+ *
+ * a station's information
+ */
+struct sir_peer_info_ext {
+ struct qdf_mac_addr peer_macaddr;
+ uint32_t tx_packets;
+ uint64_t tx_bytes;
+ uint32_t rx_packets;
+ uint64_t rx_bytes;
+ uint32_t tx_retries;
+ uint32_t tx_failed;
+ int32_t rssi;
+ uint32_t tx_rate;
+ uint32_t tx_rate_code;
+ uint32_t rx_rate;
+ uint32_t rx_rate_code;
+};
+
+/**
+ * struct sir_peer_info_ext_resp - all peers' information struct
+ * @count: peer's number
+ * @info: peer information
+ *
+ * all station's information
+ */
+struct sir_peer_info_ext_resp {
+ uint8_t count;
+ struct sir_peer_info_ext info[0];
+};
+
typedef struct sSirAddPeriodicTxPtrn {
/* MAC Address for the adapter */
struct qdf_mac_addr mac_address;
diff --git a/core/mac/inc/wni_api.h b/core/mac/inc/wni_api.h
index 0f8f7c0..7c95510 100644
--- a/core/mac/inc/wni_api.h
+++ b/core/mac/inc/wni_api.h
@@ -185,6 +185,8 @@
eWNI_SME_DFS_CSAIE_TX_COMPLETE_IND, /* To indicate completion of CSA IE */
/* update in beacons/probe rsp */
eWNI_SME_STATS_EXT_EVENT,
+ eWNI_SME_GET_PEER_INFO_IND,
+ eWNI_SME_GET_PEER_INFO_EXT_IND,
eWNI_SME_CSA_OFFLOAD_EVENT,
eWNI_SME_UPDATE_ADDITIONAL_IES, /* indicates Additional IE from hdd to PE */
eWNI_SME_MODIFY_ADDITIONAL_IES, /* To indicate IE modify from hdd to PE */
diff --git a/core/mac/src/include/sir_params.h b/core/mac/src/include/sir_params.h
index e823b15..4aa9d01 100644
--- a/core/mac/src/include/sir_params.h
+++ b/core/mac/src/include/sir_params.h
@@ -646,6 +646,8 @@
#define SIR_HAL_HIDDEN_SSID_RESTART_RSP (SIR_HAL_ITC_MSG_TYPES_BEGIN + 379)
+#define SIR_HAL_GET_PEER_INFO (SIR_HAL_ITC_MSG_TYPES_BEGIN + 386)
+#define SIR_HAL_GET_PEER_INFO_EXT (SIR_HAL_ITC_MSG_TYPES_BEGIN + 387)
#define SIR_HAL_MSG_TYPES_END (SIR_HAL_MSG_TYPES_BEGIN + 0x1FF)
/* CFG message types */
diff --git a/core/wma/inc/wma.h b/core/wma/inc/wma.h
index ae3e636..1ff0697 100644
--- a/core/wma/inc/wma.h
+++ b/core/wma/inc/wma.h
@@ -1431,6 +1431,9 @@
uint8_t powersave_mode;
bool ptrn_match_enable_all_vdev;
void *pGetRssiReq;
+ bool get_one_peer_info;
+ bool get_sta_peer_info;
+ struct qdf_mac_addr peer_macaddr;
t_thermal_mgmt thermal_mgmt_info;
bool roam_offload_enabled;
/* Here ol_ini_info is used to store ini
diff --git a/core/wma/inc/wma_internal.h b/core/wma/inc/wma_internal.h
index a59f80d..35cd3b5 100644
--- a/core/wma/inc/wma_internal.h
+++ b/core/wma/inc/wma_internal.h
@@ -889,6 +889,34 @@
QDF_STATUS wma_process_dhcp_ind(tp_wma_handle wma_handle,
tAniDHCPInd *ta_dhcp_ind);
+QDF_STATUS wma_get_peer_info(WMA_HANDLE handle,
+ struct sir_peer_info_req *peer_info_req);
+
+/**
+ * wma_get_peer_info_ext() - get peer info
+ * @handle: wma interface
+ * @peer_info_req: get peer info request information
+ *
+ * This function will send WMI_REQUEST_PEER_STATS_INFO_CMDID to FW
+ *
+ * Return: 0 on success, otherwise error value
+ */
+QDF_STATUS wma_get_peer_info_ext(WMA_HANDLE handle,
+ struct sir_peer_info_ext_req *peer_info_req);
+
+/**
+ * wma_peer_info_event_handler() - Handler for WMI_PEER_STATS_INFO_EVENTID
+ * @handle: WMA global handle
+ * @cmd_param_info: Command event data
+ * @len: Length of cmd_param_info
+ *
+ * This function will handle WMI_PEER_STATS_INFO_EVENTID
+ *
+ * Return: 0 on success, error code otherwise
+ */
+int wma_peer_info_event_handler(void *handle, u_int8_t *cmd_param_info,
+ u_int32_t len);
+
int wma_profile_data_report_event_handler(void *handle, uint8_t *event_buf,
uint32_t len);
diff --git a/core/wma/inc/wma_types.h b/core/wma/inc/wma_types.h
index 5b32ad1..1e7e57e 100644
--- a/core/wma/inc/wma_types.h
+++ b/core/wma/inc/wma_types.h
@@ -380,6 +380,9 @@
#define WMA_DISASSOC_TX_COMP SIR_HAL_DISASSOC_TX_COMP
#define WMA_DEAUTH_TX_COMP SIR_HAL_DEAUTH_TX_COMP
+#define WMA_GET_PEER_INFO SIR_HAL_GET_PEER_INFO
+#define WMA_GET_PEER_INFO_EXT SIR_HAL_GET_PEER_INFO_EXT
+
#define WMA_MODEM_POWER_STATE_IND SIR_HAL_MODEM_POWER_STATE_IND
#ifdef WLAN_FEATURE_STATS_EXT
diff --git a/core/wma/src/wma_features.c b/core/wma/src/wma_features.c
index d8c36b4..a948532 100644
--- a/core/wma/src/wma_features.c
+++ b/core/wma/src/wma_features.c
@@ -724,6 +724,109 @@
return QDF_STATUS_SUCCESS;
}
+QDF_STATUS wma_get_peer_info(WMA_HANDLE handle,
+ struct sir_peer_info_req *peer_info_req)
+{
+ tp_wma_handle wma_handle = (tp_wma_handle)handle;
+ wmi_request_stats_cmd_fixed_param *cmd;
+ wmi_buf_t wmi_buf;
+ uint32_t len;
+ uint8_t *buf_ptr;
+
+ if (!wma_handle || !wma_handle->wmi_handle) {
+ WMA_LOGE("%s: WMA is closed, can not issue get rssi",
+ __func__);
+ return QDF_STATUS_E_INVAL;
+ }
+
+ len = sizeof(wmi_request_stats_cmd_fixed_param);
+ wmi_buf = wmi_buf_alloc(wma_handle->wmi_handle, len);
+ if (!wmi_buf) {
+ WMA_LOGE("%s: wmi_buf_alloc failed", __func__);
+ return QDF_STATUS_E_NOMEM;
+ }
+ buf_ptr = (uint8_t *)wmi_buf_data(wmi_buf);
+
+ cmd = (wmi_request_stats_cmd_fixed_param *)buf_ptr;
+ WMITLV_SET_HDR(&cmd->tlv_header,
+ WMITLV_TAG_STRUC_wmi_request_stats_cmd_fixed_param,
+ WMITLV_GET_STRUCT_TLVLEN(wmi_request_stats_cmd_fixed_param));
+
+ cmd->stats_id = WMI_REQUEST_PEER_STAT;
+ cmd->vdev_id = peer_info_req->sessionid;
+ wma_handle->get_sta_peer_info = true;
+
+ if (wmi_unified_cmd_send(wma_handle->wmi_handle, wmi_buf, len,
+ WMI_REQUEST_STATS_CMDID)) {
+ WMA_LOGE("Failed to send host stats request to fw");
+ wmi_buf_free(wmi_buf);
+ return QDF_STATUS_E_FAILURE;
+ }
+
+ qdf_mem_copy(&(wma_handle->peer_macaddr),
+ &(peer_info_req->peer_macaddr),
+ QDF_MAC_ADDR_SIZE);
+ return QDF_STATUS_SUCCESS;
+}
+
+QDF_STATUS wma_get_peer_info_ext(WMA_HANDLE handle,
+ struct sir_peer_info_ext_req *peer_info_req)
+{
+ tp_wma_handle wma_handle = (tp_wma_handle)handle;
+ wmi_request_peer_stats_info_cmd_fixed_param *cmd;
+ wmi_buf_t wmi_buf;
+ uint32_t len;
+ uint8_t *buf_ptr;
+
+ if (!wma_handle || !wma_handle->wmi_handle) {
+ WMA_LOGE("%s: WMA is closed, can not issue get rssi",
+ __func__);
+ return QDF_STATUS_E_INVAL;
+ }
+
+ WMA_LOGI("%s send WMI_REQUEST_PEER_STATS_INFO_CMDID", __func__);
+
+ len = sizeof(wmi_request_peer_stats_info_cmd_fixed_param);
+ wmi_buf = wmi_buf_alloc(wma_handle->wmi_handle, len);
+ if (!wmi_buf) {
+ WMA_LOGE("%s: wmi_buf_alloc failed", __func__);
+ return QDF_STATUS_E_NOMEM;
+ }
+ buf_ptr = (uint8_t *)wmi_buf_data(wmi_buf);
+
+ cmd = (wmi_request_peer_stats_info_cmd_fixed_param *)buf_ptr;
+ WMITLV_SET_HDR(&cmd->tlv_header,
+ WMITLV_TAG_STRUC_wmi_request_peer_stats_info_cmd_fixed_param,
+ WMITLV_GET_STRUCT_TLVLEN(
+ wmi_request_peer_stats_info_cmd_fixed_param));
+ cmd->vdev_id = peer_info_req->sessionid;
+ cmd->request_type = WMI_REQUEST_ONE_PEER_STATS_INFO;
+ wma_handle->get_one_peer_info = true;
+ WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_info_req->peer_macaddr.bytes,
+ &cmd->peer_macaddr);
+ cmd->reset_after_request = peer_info_req->reset_after_request;
+
+ if (wmi_unified_cmd_send(wma_handle->wmi_handle, wmi_buf, len,
+ WMI_REQUEST_PEER_STATS_INFO_CMDID)) {
+ WMA_LOGE("Failed to send peer stats request to fw");
+ wmi_buf_free(wmi_buf);
+ return QDF_STATUS_E_FAILURE;
+ }
+
+ WMA_LOGI("%s vdev_id %d, mac %pM, req_type %x, reset %x",
+ __func__,
+ cmd->vdev_id,
+ peer_info_req->peer_macaddr.bytes,
+ cmd->request_type,
+ cmd->reset_after_request);
+
+ qdf_mem_copy(&(wma_handle->peer_macaddr),
+ &(peer_info_req->peer_macaddr),
+ QDF_MAC_ADDR_SIZE);
+
+ return QDF_STATUS_SUCCESS;
+}
+
/**
* wma_add_beacon_filter() - Issue WMI command to set beacon filter
* @wma: wma handler
diff --git a/core/wma/src/wma_main.c b/core/wma/src/wma_main.c
index fa13b51..b731eed 100644
--- a/core/wma/src/wma_main.c
+++ b/core/wma/src/wma_main.c
@@ -2416,6 +2416,12 @@
wma_stats_event_handler,
WMA_RX_SERIALIZER_CTX);
+ /* register for peer info response event */
+ wmi_unified_register_event_handler(wma_handle->wmi_handle,
+ WMI_PEER_STATS_INFO_EVENTID,
+ wma_peer_info_event_handler,
+ WMA_RX_SERIALIZER_CTX);
+
#ifdef WLAN_POWER_DEBUGFS
/* register for Chip Power stats event */
wmi_unified_register_event_handler(wma_handle->wmi_handle,
@@ -6849,6 +6855,14 @@
(tDisableIntraBssFwd *) msg->bodyptr);
qdf_mem_free(msg->bodyptr);
break;
+ case WMA_GET_PEER_INFO:
+ wma_get_peer_info(wma_handle, msg->bodyptr);
+ qdf_mem_free(msg->bodyptr);
+ break;
+ case WMA_GET_PEER_INFO_EXT:
+ wma_get_peer_info_ext(wma_handle, msg->bodyptr);
+ qdf_mem_free(msg->bodyptr);
+ break;
case WMA_MODEM_POWER_STATE_IND:
wma_notify_modem_power_state(wma_handle,
(tSirModemPowerStateInd *) msg->bodyptr);
diff --git a/core/wma/src/wma_utils.c b/core/wma/src/wma_utils.c
index 910ae89..1f7e307 100644
--- a/core/wma/src/wma_utils.c
+++ b/core/wma/src/wma_utils.c
@@ -2703,6 +2703,111 @@
}
/**
+ * wma_handle_sta_peer_info() - handle peer information in
+ * peer stats
+ * @num_peer_stats: peer number
+ * @peer_stats: peer stats received from firmware
+ * @peer_macaddr: the specified mac address
+ * @sapaddr: sap mac address
+ *
+ * This function will send eWNI_SME_GET_PEER_INFO_IND
+ * to sme with stations' information
+ *
+ */
+static void wma_handle_sta_peer_info(uint32_t num_peer_stats,
+ wmi_peer_stats *peer_stats,
+ struct qdf_mac_addr peer_macaddr,
+ uint8_t *sapaddr)
+{
+ QDF_STATUS qdf_status;
+ wmi_mac_addr temp_addr;
+ struct sir_peer_info_resp *peer_info;
+ struct scheduler_msg sme_msg = {0};
+ uint32_t i;
+ uint32_t j = 0;
+
+ if (!qdf_is_macaddr_broadcast(&peer_macaddr)) {
+ WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_macaddr.bytes, &temp_addr);
+ for (i = 0; i < num_peer_stats; i++) {
+ if ((((temp_addr.mac_addr47to32) & 0x0000ffff) ==
+ ((peer_stats->peer_macaddr.mac_addr47to32) &
+ 0x0000ffff))
+ && (temp_addr.mac_addr31to0 ==
+ peer_stats->peer_macaddr.mac_addr31to0)) {
+
+ break;
+ }
+ peer_stats = peer_stats + 1;
+ }
+ peer_info = qdf_mem_malloc(sizeof(*peer_info) +
+ sizeof(peer_info->info[0]));
+ if (NULL == peer_info) {
+ WMA_LOGE("%s: Memory allocation failed.", __func__);
+ return;
+ }
+ if (i < num_peer_stats) {
+ peer_info->count = 1;
+ WMI_MAC_ADDR_TO_CHAR_ARRAY(&(peer_stats->peer_macaddr),
+ peer_info->info[0].peer_macaddr.bytes);
+ peer_info->info[0].rssi = peer_stats->peer_rssi;
+ peer_info->info[0].tx_rate = peer_stats->peer_tx_rate;
+ peer_info->info[0].rx_rate = peer_stats->peer_rx_rate;
+ WMA_LOGD("%s peer %pM rssi %d tx_rate %d rx_rate %d",
+ __func__,
+ peer_info->info[0].peer_macaddr.bytes,
+ peer_stats->peer_rssi,
+ peer_stats->peer_tx_rate,
+ peer_stats->peer_rx_rate);
+ } else {
+ WMA_LOGE("%s: no match mac address", __func__);
+ peer_info->count = 0;
+ }
+ } else {
+ peer_info = qdf_mem_malloc(sizeof(*peer_info) +
+ num_peer_stats * sizeof(peer_info->info[0]));
+ if (NULL == peer_info) {
+ WMA_LOGE("%s: Memory allocation failed.", __func__);
+ return;
+ }
+ peer_info->count = num_peer_stats;
+
+ for (i = 0; i < num_peer_stats; i++) {
+ WMI_MAC_ADDR_TO_CHAR_ARRAY(&(peer_stats->peer_macaddr),
+ peer_info->info[j].peer_macaddr.bytes);
+ peer_info->info[j].rssi = peer_stats->peer_rssi;
+ peer_info->info[j].tx_rate = peer_stats->peer_tx_rate;
+ peer_info->info[j].rx_rate = peer_stats->peer_rx_rate;
+ WMA_LOGD("%s peer %pM rssi %d tx_rate %d rx_rate %d",
+ __func__,
+ peer_info->info[j].peer_macaddr.bytes,
+ peer_stats->peer_rssi,
+ peer_stats->peer_tx_rate,
+ peer_stats->peer_rx_rate);
+ if (!qdf_mem_cmp(peer_info->info[j].peer_macaddr.bytes,
+ sapaddr, QDF_MAC_ADDR_SIZE)) {
+ peer_info->count = peer_info->count - 1;
+ } else {
+ j++;
+ }
+ peer_stats = peer_stats + 1;
+ }
+ WMA_LOGD("WDA send peer num %d", peer_info->count);
+ }
+
+ sme_msg.type = eWNI_SME_GET_PEER_INFO_IND;
+ sme_msg.bodyptr = peer_info;
+ sme_msg.bodyval = 0;
+
+ qdf_status = scheduler_post_msg(QDF_MODULE_ID_SME, &sme_msg);
+ if (!QDF_IS_STATUS_SUCCESS(qdf_status)) {
+ WMA_LOGE("%s: Fail to post get rssi msg", __func__);
+ qdf_mem_free(peer_info);
+ }
+
+ return;
+}
+
+/**
* wma_stats_event_handler() - stats event handler
* @handle: wma handle
* @cmd_param_info: data from event
@@ -2751,10 +2856,17 @@
}
if (event->num_peer_stats > 0) {
- for (i = 0; i < event->num_peer_stats; i++) {
- peer_stats = (wmi_peer_stats *) temp;
- wma_update_peer_stats(wma, peer_stats);
- temp += sizeof(wmi_peer_stats);
+ if (wma->get_sta_peer_info == true) {
+ wma_handle_sta_peer_info(event->num_peer_stats,
+ (wmi_peer_stats *)temp,
+ wma->peer_macaddr,
+ wma->myaddr);
+ } else {
+ for (i = 0; i < event->num_peer_stats; i++) {
+ peer_stats = (wmi_peer_stats *) temp;
+ wma_update_peer_stats(wma, peer_stats);
+ temp += sizeof(wmi_peer_stats);
+ }
}
}
@@ -2816,6 +2928,210 @@
}
/**
+ * wma_fill_peer_info() - fill SIR peer info from WMI peer info struct
+ * @wma: wma interface
+ * @stats_info: WMI peer info pointer
+ * @peer_info: SIR peer info pointer
+ *
+ * This function will fill SIR peer info from WMI peer info struct
+ *
+ * Return: None
+ */
+static void wma_fill_peer_info(tp_wma_handle wma,
+ wmi_peer_stats_info *stats_info,
+ struct sir_peer_info_ext *peer_info)
+{
+ peer_info->tx_packets = stats_info->tx_packets.low_32;
+ peer_info->tx_bytes = stats_info->tx_bytes.high_32;
+ peer_info->tx_bytes <<= 32;
+ peer_info->tx_bytes += stats_info->tx_bytes.low_32;
+ peer_info->rx_packets = stats_info->rx_packets.low_32;
+ peer_info->rx_bytes = stats_info->rx_bytes.high_32;
+ peer_info->rx_bytes <<= 32;
+ peer_info->rx_bytes += stats_info->rx_bytes.low_32;
+ peer_info->tx_retries = stats_info->tx_retries;
+ peer_info->tx_failed = stats_info->tx_failed;
+ peer_info->rssi = stats_info->peer_rssi;
+ peer_info->tx_rate = stats_info->last_tx_bitrate_kbps;
+ peer_info->tx_rate_code = stats_info->last_tx_rate_code;
+ peer_info->rx_rate = stats_info->last_rx_bitrate_kbps;
+ peer_info->rx_rate_code = stats_info->last_rx_rate_code;
+}
+
+/**
+ * wma_peer_info_ext_rsp() - process peer ext info ext
+ * @handle: wma interface
+ * @buf: wmi event buf pointer
+ *
+ * This function will send eWNI_SME_GET_PEER_INFO_EXT_IND to SME
+ *
+ * Return: 0 on success, error code otherwise
+ */
+static QDF_STATUS wma_peer_info_ext_rsp(tp_wma_handle wma, u_int8_t *buf)
+{
+ wmi_peer_stats_info_event_fixed_param *event;
+ wmi_peer_stats_info *stats_info;
+ struct sir_peer_info_ext_resp *resp;
+ struct sir_peer_info_ext *peer_info;
+ struct scheduler_msg sme_msg = {0};
+ int i, j = 0;
+ QDF_STATUS qdf_status;
+
+ event = (wmi_peer_stats_info_event_fixed_param *)buf;
+ stats_info = (wmi_peer_stats_info *)(buf +
+ sizeof(wmi_peer_stats_info_event_fixed_param));
+
+ if (wma->get_one_peer_info) {
+ resp = qdf_mem_malloc(sizeof(struct sir_peer_info_ext_resp) +
+ sizeof(resp->info[0]));
+ if (!resp) {
+ WMA_LOGE(FL("resp allocation failed."));
+ return QDF_STATUS_E_NOMEM;
+ }
+ resp->count = 0;
+ peer_info = &resp->info[0];
+ for (i = 0; i < event->num_peers; i++) {
+ WMI_MAC_ADDR_TO_CHAR_ARRAY(&stats_info->peer_macaddr,
+ peer_info->peer_macaddr.bytes);
+
+ if (!qdf_mem_cmp(peer_info->peer_macaddr.bytes,
+ wma->peer_macaddr.bytes,
+ QDF_MAC_ADDR_SIZE)) {
+ wma_fill_peer_info(wma, stats_info, peer_info);
+ resp->count++;
+ break;
+ }
+
+ stats_info = stats_info + 1;
+ }
+ } else {
+ resp = qdf_mem_malloc(sizeof(struct sir_peer_info_ext_resp) +
+ event->num_peers * sizeof(resp->info[0]));
+ if (!resp) {
+ WMA_LOGE(FL("resp allocation failed."));
+ return QDF_STATUS_E_NOMEM;
+ }
+ resp->count = event->num_peers;
+ for (i = 0; i < event->num_peers; i++) {
+ peer_info = &resp->info[j];
+ WMI_MAC_ADDR_TO_CHAR_ARRAY(&stats_info->peer_macaddr,
+ peer_info->peer_macaddr.bytes);
+
+ if (!qdf_mem_cmp(peer_info->peer_macaddr.bytes,
+ wma->myaddr, QDF_MAC_ADDR_SIZE)) {
+ resp->count = resp->count - 1;
+ } else {
+ wma_fill_peer_info(wma, stats_info, peer_info);
+ j++;
+ }
+ stats_info = stats_info + 1;
+ }
+ }
+
+ sme_msg.type = eWNI_SME_GET_PEER_INFO_EXT_IND;
+ sme_msg.bodyptr = resp;
+ sme_msg.bodyval = 0;
+
+ qdf_status = scheduler_post_msg(QDF_MODULE_ID_SME, &sme_msg);
+ if (!QDF_IS_STATUS_SUCCESS(qdf_status)) {
+ WMA_LOGE("%s: Fail to post get peer info msg", __func__);
+ qdf_mem_free(resp);
+ }
+
+ return qdf_status;
+}
+
+/**
+ * dump_peer_stats_info() - dump wmi peer info struct
+ * @event: wmi peer info fixed param pointer
+ * @peer_stats: wmi peer stats info pointer
+ *
+ * This function will dump wmi peer info struct
+ *
+ * Return: None
+ */
+static void dump_peer_stats_info(wmi_peer_stats_info_event_fixed_param *event,
+ wmi_peer_stats_info *peer_stats)
+{
+ int i;
+ wmi_peer_stats_info *stats = peer_stats;
+ u_int8_t mac[6];
+
+ WMA_LOGI("%s vdev_id %d, num_peers %d more_data %d",
+ __func__, event->vdev_id,
+ event->num_peers, event->more_data);
+
+ for (i = 0; i < event->num_peers; i++) {
+ WMI_MAC_ADDR_TO_CHAR_ARRAY(&stats->peer_macaddr, mac);
+ WMA_LOGI("%s mac %pM", __func__, mac);
+ WMA_LOGI("%s tx_bytes %d %d tx_packets %d %d",
+ __func__,
+ stats->tx_bytes.low_32,
+ stats->tx_bytes.high_32,
+ stats->tx_packets.low_32,
+ stats->tx_packets.high_32);
+ WMA_LOGI("%s rx_bytes %d %d rx_packets %d %d",
+ __func__,
+ stats->rx_bytes.low_32,
+ stats->rx_bytes.high_32,
+ stats->rx_packets.low_32,
+ stats->rx_packets.high_32);
+ WMA_LOGI("%s tx_retries %d tx_failed %d",
+ __func__, stats->tx_retries, stats->tx_failed);
+ WMA_LOGI("%s tx_rate_code %x rx_rate_code %x",
+ __func__,
+ stats->last_tx_rate_code,
+ stats->last_rx_rate_code);
+ WMA_LOGI("%s tx_rate %x rx_rate %x",
+ __func__,
+ stats->last_tx_bitrate_kbps,
+ stats->last_rx_bitrate_kbps);
+ WMA_LOGI("%s peer_rssi %d", __func__, stats->peer_rssi);
+ stats++;
+ }
+}
+
+int wma_peer_info_event_handler(void *handle, u_int8_t *cmd_param_info,
+ u_int32_t len)
+{
+ tp_wma_handle wma = (tp_wma_handle) handle;
+ WMI_PEER_STATS_INFO_EVENTID_param_tlvs *param_buf;
+ wmi_peer_stats_info_event_fixed_param *event;
+ u_int32_t buf_size;
+ u_int8_t *buf;
+
+ param_buf =
+ (WMI_PEER_STATS_INFO_EVENTID_param_tlvs *)cmd_param_info;
+ if (!param_buf) {
+ WMA_LOGA("%s: Invalid stats event", __func__);
+ return -EINVAL;
+ }
+
+ WMA_LOGI("%s Recv WMI_PEER_STATS_INFO_EVENTID", __func__);
+ event = param_buf->fixed_param;
+ buf_size = sizeof(wmi_peer_stats_info_event_fixed_param) +
+ sizeof(wmi_peer_stats_info) * event->num_peers;
+ buf = qdf_mem_malloc(buf_size);
+ if (!buf) {
+ WMA_LOGE("%s: Failed alloc memory for buf", __func__);
+ return -ENOMEM;
+ }
+
+ qdf_mem_copy(buf, param_buf->fixed_param,
+ sizeof(wmi_peer_stats_info_event_fixed_param));
+ qdf_mem_copy((buf + sizeof(wmi_peer_stats_info_event_fixed_param)),
+ param_buf->peer_stats_info,
+ sizeof(wmi_peer_stats_info) * event->num_peers);
+ WMA_LOGI("%s dump peer stats info", __func__);
+ dump_peer_stats_info(event, param_buf->peer_stats_info);
+
+ wma_peer_info_ext_rsp(wma, buf);
+ qdf_mem_free(buf);
+
+ return 0;
+}
+
+/**
* wma_send_link_speed() - send link speed to SME
* @link_speed: link speed
*
@@ -3315,6 +3631,7 @@
node->stats_rsp = NULL;
}
node->stats_rsp = pGetPEStatsRspParams;
+ wma_handle->get_sta_peer_info = false;
WMA_LOGD("stats_rsp allocated: %p, sta_id: %d, mask: %d, vdev_id: %d",
node->stats_rsp, node->stats_rsp->staId,
node->stats_rsp->statsMask, get_stats_param->sessionId);