ath/ath10k/testmode.c

31 bool ath10k_tm_event_wmi(struct ath10k *ar, u32 cmd_id, struct sk_buff *skb)
37 	ath10k_dbg(ar, ATH10K_DBG_TESTMODE,
41 	ath10k_dbg_dump(ar, ATH10K_DBG_TESTMODE, NULL, "", skb->data, skb->len);
43 	spin_lock_bh(&ar->data_lock);
45 	if (!ar->testmode.utf_monitor) {
56 	nl_skb = cfg80211_testmode_alloc_event_skb(ar->hw->wiphy,
60 		ath10k_warn(ar,
67 		ath10k_warn(ar,
76 		ath10k_warn(ar,
85 		ath10k_warn(ar,
95 	spin_unlock_bh(&ar->data_lock);
100 static int ath10k_tm_cmd_get_version(struct ath10k *ar, struct nlattr *tb[])
105 	ath10k_dbg(ar, ATH10K_DBG_TESTMODE,
110 	skb = cfg80211_testmode_alloc_reply_skb(ar->hw->wiphy,
130 			  ar->normal_mode_fw.fw_file.wmi_op_version);
139 static int ath10k_tm_fetch_utf_firmware_api_1(struct ath10k *ar,
146 		 ar->hw_params.fw.dir, ATH10K_FW_UTF_FILE);
149 	ret = firmware_request_nowarn(&fw_file->firmware, filename, ar->dev);
150 	ath10k_dbg(ar, ATH10K_DBG_TESTMODE, "testmode fw request '%s': %d\n",
154 		ath10k_warn(ar, "failed to retrieve utf firmware '%s': %d\n",
173 static int ath10k_tm_fetch_firmware(struct ath10k *ar)
180 	switch (ar->hif.bus) {
184 			  ATH10K_FW_UTF_FILE_BASE, ath10k_bus_str(ar->hif.bus),
193 	ret = ath10k_core_fetch_firmware_api_n(ar, fw_name,
194 					       &ar->testmode.utf_mode_fw.fw_file);
196 		ath10k_dbg(ar, ATH10K_DBG_TESTMODE, "testmode using fw utf api 2");
200 	ret = ath10k_tm_fetch_utf_firmware_api_1(ar, &ar->testmode.utf_mode_fw.fw_file);
202 		ath10k_err(ar, "failed to fetch utf firmware binary: %d", ret);
206 	ath10k_dbg(ar, ATH10K_DBG_TESTMODE, "testmode using utf api 1");
209 	utf_mode_fw = &ar->testmode.utf_mode_fw;
214 	utf_mode_fw->board_data = ar->normal_mode_fw.board_data;
215 	utf_mode_fw->board_len = ar->normal_mode_fw.board_len;
218 		ath10k_info(ar, "utf.bin didn't contain otp binary, taking it from the normal mode firmware");
219 		utf_mode_fw->fw_file.otp_data = ar->normal_mode_fw.fw_file.otp_data;
220 		utf_mode_fw->fw_file.otp_len = ar->normal_mode_fw.fw_file.otp_len;
226 static int ath10k_tm_cmd_utf_start(struct ath10k *ar, struct nlattr *tb[])
231 	ath10k_dbg(ar, ATH10K_DBG_TESTMODE, "testmode cmd utf start\n");
233 	mutex_lock(&ar->conf_mutex);
235 	if (ar->state == ATH10K_STATE_UTF) {
241 	if (ar->state != ATH10K_STATE_OFF) {
246 	if (WARN_ON(ar->testmode.utf_mode_fw.fw_file.firmware != NULL)) {
252 	ret = ath10k_tm_fetch_firmware(ar);
254 		ath10k_err(ar, "failed to fetch UTF firmware: %d", ret);
258 	if (ar->testmode.utf_mode_fw.fw_file.codeswap_data &&
259 	    ar->testmode.utf_mode_fw.fw_file.codeswap_len) {
260 		ret = ath10k_swap_code_seg_init(ar,
261 						&ar->testmode.utf_mode_fw.fw_file);
263 			ath10k_warn(ar,
270 	spin_lock_bh(&ar->data_lock);
271 	ar->testmode.utf_monitor = true;
272 	spin_unlock_bh(&ar->data_lock);
274 	ath10k_dbg(ar, ATH10K_DBG_TESTMODE, "testmode wmi version %d\n",
275 		   ar->testmode.utf_mode_fw.fw_file.wmi_op_version);
277 	ret = ath10k_hif_power_up(ar, ATH10K_FIRMWARE_MODE_UTF);
279 		ath10k_err(ar, "failed to power up hif (testmode): %d\n", ret);
280 		ar->state = ATH10K_STATE_OFF;
284 	ret = ath10k_core_start(ar, ATH10K_FIRMWARE_MODE_UTF,
285 				&ar->testmode.utf_mode_fw);
287 		ath10k_err(ar, "failed to start core (testmode): %d\n", ret);
288 		ar->state = ATH10K_STATE_OFF;
292 	ar->state = ATH10K_STATE_UTF;
294 	if (strlen(ar->testmode.utf_mode_fw.fw_file.fw_version) > 0)
295 		ver = ar->testmode.utf_mode_fw.fw_file.fw_version;
299 	ath10k_info(ar, "UTF firmware %s started\n", ver);
301 	mutex_unlock(&ar->conf_mutex);
306 	ath10k_hif_power_down(ar);
309 	if (ar->testmode.utf_mode_fw.fw_file.codeswap_data &&
310 	    ar->testmode.utf_mode_fw.fw_file.codeswap_len)
311 		ath10k_swap_code_seg_release(ar,
312 					     &ar->testmode.utf_mode_fw.fw_file);
314 	release_firmware(ar->testmode.utf_mode_fw.fw_file.firmware);
315 	ar->testmode.utf_mode_fw.fw_file.firmware = NULL;
318 	mutex_unlock(&ar->conf_mutex);
323 static void __ath10k_tm_cmd_utf_stop(struct ath10k *ar)
325 	lockdep_assert_held(&ar->conf_mutex);
327 	ath10k_core_stop(ar);
328 	ath10k_hif_power_down(ar);
330 	spin_lock_bh(&ar->data_lock);
332 	ar->testmode.utf_monitor = false;
334 	spin_unlock_bh(&ar->data_lock);
336 	if (ar->testmode.utf_mode_fw.fw_file.codeswap_data &&
337 	    ar->testmode.utf_mode_fw.fw_file.codeswap_len)
338 		ath10k_swap_code_seg_release(ar,
339 					     &ar->testmode.utf_mode_fw.fw_file);
341 	release_firmware(ar->testmode.utf_mode_fw.fw_file.firmware);
342 	ar->testmode.utf_mode_fw.fw_file.firmware = NULL;
344 	ar->state = ATH10K_STATE_OFF;
347 static int ath10k_tm_cmd_utf_stop(struct ath10k *ar, struct nlattr *tb[])
351 	ath10k_dbg(ar, ATH10K_DBG_TESTMODE, "testmode cmd utf stop\n");
353 	mutex_lock(&ar->conf_mutex);
355 	if (ar->state != ATH10K_STATE_UTF) {
360 	__ath10k_tm_cmd_utf_stop(ar);
364 	ath10k_info(ar, "UTF firmware stopped\n");
367 	mutex_unlock(&ar->conf_mutex);
371 static int ath10k_tm_cmd_wmi(struct ath10k *ar, struct nlattr *tb[])
378 	mutex_lock(&ar->conf_mutex);
380 	if (ar->state != ATH10K_STATE_UTF) {
399 	ath10k_dbg(ar, ATH10K_DBG_TESTMODE,
403 	ath10k_dbg_dump(ar, ATH10K_DBG_TESTMODE, NULL, "", buf, buf_len);
405 	skb = ath10k_wmi_alloc_skb(ar, buf_len);
413 	ret = ath10k_wmi_cmd_send(ar, skb, cmd_id);
415 		ath10k_warn(ar, "failed to transmit wmi command (testmode): %d\n",
423 	mutex_unlock(&ar->conf_mutex);
430 	struct ath10k *ar = hw->priv;
444 		return ath10k_tm_cmd_get_version(ar, tb);
446 		return ath10k_tm_cmd_utf_start(ar, tb);
448 		return ath10k_tm_cmd_utf_stop(ar, tb);
450 		return ath10k_tm_cmd_wmi(ar, tb);
456 void ath10k_testmode_destroy(struct ath10k *ar)
458 	mutex_lock(&ar->conf_mutex);
460 	if (ar->state != ATH10K_STATE_UTF) {
465 	__ath10k_tm_cmd_utf_stop(ar);
468 	mutex_unlock(&ar->conf_mutex);