qcacmn: Add wmi support to dump WDS table

Request and print WDS table from FW using WMI command and event.
WMI_PDEV_WDS_ENTRY_LIST_CMDID is used to request WDS table
entries and WMI_PDEV_WDS_ENTRY_LIST_EVENTID is used to process
received WDS entries.

Change-Id: I452c8067d191d09826a38b751bb66f1bde587d9b
CRs-Fixed: 2003377

wmi/inc/wmi_unified_api.h

@@ -1641,4 +1641,29 @@ QDF_STATUS wmi_unified_get_arp_stats_req(void *wmi_hdl,
  */
 QDF_STATUS wmi_send_bcn_offload_control_cmd(void *wmi_hdl,
 			struct bcn_offload_control *bcn_ctrl_param);
+/**
+ * wmi_unified_send_wds_entry_list_cmd() - WMI function to get list of
+ *  wds entries from FW
+ * @wmi_handle: wmi handle
+ *
+ * Send WMI_PDEV_WDS_ENTRY_LIST_CMDID parameters to fw.
+ *
+ * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error
+ */
+
+QDF_STATUS wmi_unified_send_dump_wds_table_cmd(void *wmi_hdl);
+
+/**
+ * wmi_extract_wds_entry - api to extract wds entry
+ * @wmi_handle: wma handle
+ * @evt_buf: pointer to event buffer
+ * @wds_entry: wds entry
+ * @idx: index to point wds entry in event buffer
+ *
+ * Return: QDF_STATUS_SUCCESS for successful event parse
+ *         else QDF_STATUS_E_INVAL or QDF_STATUS_E_FAILURE
+ */
+
+QDF_STATUS wmi_extract_wds_entry(void *wmi_hdl, uint8_t *evt_buf,
+			struct wdsentry *wds_entry, u_int32_t idx);
 #endif /* _WMI_UNIFIED_API_H_ */

wmi/inc/wmi_unified_param.h

@@ -5454,6 +5454,7 @@ typedef enum {
 	wmi_get_arp_stats_req_id,
 	wmi_service_available_event_id,
 	wmi_update_rcpi_event_id,
+	wmi_pdev_wds_entry_list_event_id,
 
 	wmi_events_max,
 } wmi_conv_event_id;
@@ -7978,4 +7979,16 @@ struct bcn_offload_control {
 	bool bcn_tx_enable;
 };
 
+/**
+ * struct wds_entry - WDS entry structure
+ * @peer_mac: peer mac
+ * @wds_mac: wds mac address
+ * @flags: flags
+ */
+struct wdsentry {
+	u_int8_t peer_mac[IEEE80211_ADDR_LEN];
+	u_int8_t wds_mac[IEEE80211_ADDR_LEN];
+	A_UINT32 flags;
+};
+
 #endif /* _WMI_UNIFIED_PARAM_H_ */

wmi/inc/wmi_unified_priv.h

@@ -1406,6 +1406,11 @@ QDF_STATUS (*send_limit_off_chan_cmd)(wmi_unified_t wmi_handle,
 
 QDF_STATUS (*send_wow_timer_pattern_cmd)(wmi_unified_t wmi_handle,
 			uint8_t vdev_id, uint32_t cookie, uint32_t time);
+QDF_STATUS (*send_wds_entry_list_cmd)(wmi_unified_t wmi_handle);
+QDF_STATUS (*extract_wds_entry)(wmi_unified_t wmi_handle,
+		uint8_t *evt_buf,
+		struct wdsentry *wds_entry,
+		u_int32_t idx);
 };
 
 /* Forward declartion for psoc*/

wmi/src/wmi_unified_api.c

@@ -6968,3 +6968,45 @@ QDF_STATUS wmi_send_bcn_offload_control_cmd(void *wmi_hdl,
 
 	return QDF_STATUS_E_FAILURE;
 }
+
+/**
+ * wmi_unified_send_wds_entry_list_cmd() - WMI function to get list of
+ *  wds entries from FW
+ * @wmi_handle: wmi handle
+ *
+ * Send WMI_PDEV_WDS_ENTRY_LIST_CMDID parameters to fw.
+ *
+ * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error
+ */
+QDF_STATUS wmi_unified_send_dump_wds_table_cmd(void *wmi_hdl)
+{
+	wmi_unified_t wmi_handle = (wmi_unified_t) wmi_hdl;
+
+	if (wmi_handle->ops->send_wds_entry_list_cmd)
+		return wmi_handle->ops->send_wds_entry_list_cmd(wmi_handle);
+
+	return QDF_STATUS_E_FAILURE;
+}
+
+/**
+ * wmi_extract_wds_entry - api to extract wds entry
+ * @wmi_handle: wma handle
+ * @evt_buf: pointer to event buffer
+ * @wds_entry: wds entry
+ * @idx: index to point wds entry in event buffer
+ *
+ * Return: QDF_STATUS_SUCCESS for successful event parse
+ *         else QDF_STATUS_E_INVAL or QDF_STATUS_E_FAILURE
+ */
+QDF_STATUS wmi_extract_wds_entry(void *wmi_hdl, uint8_t *evt_buf,
+			struct wdsentry *wds_entry,
+			u_int32_t idx)
+{
+	wmi_unified_t wmi_handle = (wmi_unified_t) wmi_hdl;
+
+	if (wmi_handle->ops->extract_wds_entry)
+		return wmi_handle->ops->extract_wds_entry(wmi_handle,
+						evt_buf, wds_entry, idx);
+
+	return QDF_STATUS_E_FAILURE;
+}

wmi/src/wmi_unified_non_tlv.c

@@ -8091,6 +8091,38 @@ static QDF_STATUS extract_pdev_qvit_event_non_tlv(
 	return QDF_STATUS_SUCCESS;
 }
 
+/**
+ * extract_wds_entry_non_tlv() - extract wds entry from event
+ * @wmi_handle: wmi handle
+ * @evt_buf: pointer to event buffer
+ * @wds_entry: wds entry
+ * @idx: index to point wds entry in event buffer
+ *
+ * Return: 0 for success or error code
+ */
+static QDF_STATUS extract_wds_entry_non_tlv(wmi_unified_t wmi_handle,
+			u_int8_t *evt_buf,
+			struct wdsentry *wds_entry,
+			u_int32_t idx)
+{
+	wmi_pdev_wds_entry_dump_event *wds_entry_dump_event =
+			(wmi_pdev_wds_entry_dump_event *)evt_buf;
+
+	if (idx >= wds_entry_dump_event->num_entries)
+		return QDF_STATUS_E_INVAL;
+	qdf_mem_zero(wds_entry, sizeof(struct wdsentry));
+	WMI_MAC_ADDR_TO_CHAR_ARRAY(
+			&(wds_entry_dump_event->wds_entry[idx].peer_macaddr),
+			wds_entry->peer_mac);
+	WMI_MAC_ADDR_TO_CHAR_ARRAY(
+			&(wds_entry_dump_event->wds_entry[idx].wds_macaddr),
+			wds_entry->wds_mac);
+	wds_entry->flags = wds_entry_dump_event->wds_entry[idx].flags;
+
+	return QDF_STATUS_SUCCESS;
+}
+
+
 static bool is_management_record_non_tlv(uint32_t cmd_id)
 {
 	if ((cmd_id == WMI_BCN_TX_CMDID) ||
@@ -8150,6 +8182,36 @@ static QDF_STATUS send_dfs_phyerr_offload_dis_cmd_non_tlv(
 	return QDF_STATUS_SUCCESS;
 }
 
+/**
+ *  send_wds_entry_list_cmd_non_tlv() - WMI function to get list of
+ *  wds entries from FW
+ *
+ *  @param wmi_handle	  : handle to WMI.
+ *  @return QDF_STATUS_SUCCESS  on success and -ve on failure.
+ */
+QDF_STATUS send_wds_entry_list_cmd_non_tlv(wmi_unified_t wmi_handle)
+{
+	wmi_buf_t buf;
+
+	/*
+	 * Passing a NULL pointer to wmi_unified_cmd_send() panics it,
+	 * so let's just use a 32 byte fake array for now.
+	 */
+	buf = wmi_buf_alloc(wmi_handle, 32);
+	if (buf == NULL)
+		return QDF_STATUS_E_NOMEM;
+
+	if (wmi_unified_cmd_send(wmi_handle, buf, 32,
+	  WMI_PDEV_WDS_ENTRY_LIST_CMDID) != QDF_STATUS_SUCCESS) {
+		qdf_print("%s: send failed\n", __func__);
+		wmi_buf_free(buf);
+		return QDF_STATUS_E_FAILURE;
+	}
+
+	return QDF_STATUS_SUCCESS;
+}
+
+
 struct wmi_ops non_tlv_ops =  {
 	.send_vdev_create_cmd = send_vdev_create_cmd_non_tlv,
 	.send_vdev_delete_cmd = send_vdev_delete_cmd_non_tlv,
@@ -8373,6 +8435,8 @@ struct wmi_ops non_tlv_ops =  {
 		send_dfs_phyerr_offload_en_cmd_non_tlv,
 	.send_dfs_phyerr_offload_dis_cmd =
 		send_dfs_phyerr_offload_dis_cmd_non_tlv,
+	.send_wds_entry_list_cmd = send_wds_entry_list_cmd_non_tlv,
+	.extract_wds_entry = extract_wds_entry_non_tlv,
 };
 
 /**
@@ -8660,6 +8724,8 @@ static void populate_non_tlv_events_id(uint32_t *event_ids)
 					WMI_PDEV_CHECK_CAL_VERSION_EVENTID;
 	event_ids[wmi_atf_peer_stats_event_id] =
 					WMI_ATF_PEER_STATS_EVENTID;
+	event_ids[wmi_pdev_wds_entry_list_event_id] =
+					WMI_PDEV_WDS_ENTRY_LIST_EVENTID;
 }
 
 /**