xref: /freebsd/sys/contrib/dev/athk/ath12k/core.c (revision 5c1def83)
1 // SPDX-License-Identifier: BSD-3-Clause-Clear
2 /*
3  * Copyright (c) 2018-2021 The Linux Foundation. All rights reserved.
4  * Copyright (c) 2021-2022 Qualcomm Innovation Center, Inc. All rights reserved.
5  */
6 
7 #if defined(__FreeBSD__)
8 #define	LINUXKPI_PARAM_PREFIX	ath12k_core_
9 #endif
10 
11 #include <linux/module.h>
12 #include <linux/slab.h>
13 #include <linux/remoteproc.h>
14 #include <linux/firmware.h>
15 #include <linux/of.h>
16 #if defined(__FreeBSD__)
17 #include <linux/delay.h>
18 #endif
19 #include "core.h"
20 #include "dp_tx.h"
21 #include "dp_rx.h"
22 #include "debug.h"
23 #include "hif.h"
24 
25 unsigned int ath12k_debug_mask;
26 module_param_named(debug_mask, ath12k_debug_mask, uint, 0644);
27 MODULE_PARM_DESC(debug_mask, "Debugging mask");
28 
ath12k_core_suspend(struct ath12k_base * ab)29 int ath12k_core_suspend(struct ath12k_base *ab)
30 {
31 	int ret;
32 
33 	if (!ab->hw_params->supports_suspend)
34 		return -EOPNOTSUPP;
35 
36 	/* TODO: there can frames in queues so for now add delay as a hack.
37 	 * Need to implement to handle and remove this delay.
38 	 */
39 #if defined(__linux__)
40 	msleep(500);
41 #elif defined(__FreeBSD__)
42 	linux_msleep(500);
43 #endif
44 
45 	ret = ath12k_dp_rx_pktlog_stop(ab, true);
46 	if (ret) {
47 		ath12k_warn(ab, "failed to stop dp rx (and timer) pktlog during suspend: %d\n",
48 			    ret);
49 		return ret;
50 	}
51 
52 	ret = ath12k_dp_rx_pktlog_stop(ab, false);
53 	if (ret) {
54 		ath12k_warn(ab, "failed to stop dp rx pktlog during suspend: %d\n",
55 			    ret);
56 		return ret;
57 	}
58 
59 	ath12k_hif_irq_disable(ab);
60 	ath12k_hif_ce_irq_disable(ab);
61 
62 	ret = ath12k_hif_suspend(ab);
63 	if (ret) {
64 		ath12k_warn(ab, "failed to suspend hif: %d\n", ret);
65 		return ret;
66 	}
67 
68 	return 0;
69 }
70 
ath12k_core_resume(struct ath12k_base * ab)71 int ath12k_core_resume(struct ath12k_base *ab)
72 {
73 	int ret;
74 
75 	if (!ab->hw_params->supports_suspend)
76 		return -EOPNOTSUPP;
77 
78 	ret = ath12k_hif_resume(ab);
79 	if (ret) {
80 		ath12k_warn(ab, "failed to resume hif during resume: %d\n", ret);
81 		return ret;
82 	}
83 
84 	ath12k_hif_ce_irq_enable(ab);
85 	ath12k_hif_irq_enable(ab);
86 
87 	ret = ath12k_dp_rx_pktlog_start(ab);
88 	if (ret) {
89 		ath12k_warn(ab, "failed to start rx pktlog during resume: %d\n",
90 			    ret);
91 		return ret;
92 	}
93 
94 	return 0;
95 }
96 
ath12k_core_create_board_name(struct ath12k_base * ab,char * name,size_t name_len)97 static int ath12k_core_create_board_name(struct ath12k_base *ab, char *name,
98 					 size_t name_len)
99 {
100 	/* strlen(',variant=') + strlen(ab->qmi.target.bdf_ext) */
101 	char variant[9 + ATH12K_QMI_BDF_EXT_STR_LENGTH] = { 0 };
102 
103 	if (ab->qmi.target.bdf_ext[0] != '\0')
104 		scnprintf(variant, sizeof(variant), ",variant=%s",
105 			  ab->qmi.target.bdf_ext);
106 
107 	scnprintf(name, name_len,
108 		  "bus=%s,qmi-chip-id=%d,qmi-board-id=%d%s",
109 		  ath12k_bus_str(ab->hif.bus),
110 		  ab->qmi.target.chip_id,
111 		  ab->qmi.target.board_id, variant);
112 
113 	ath12k_dbg(ab, ATH12K_DBG_BOOT, "boot using board name '%s'\n", name);
114 
115 	return 0;
116 }
117 
ath12k_core_firmware_request(struct ath12k_base * ab,const char * file)118 const struct firmware *ath12k_core_firmware_request(struct ath12k_base *ab,
119 						    const char *file)
120 {
121 	const struct firmware *fw;
122 	char path[100];
123 	int ret;
124 
125 	if (!file)
126 		return ERR_PTR(-ENOENT);
127 
128 	ath12k_core_create_firmware_path(ab, file, path, sizeof(path));
129 
130 	ret = firmware_request_nowarn(&fw, path, ab->dev);
131 	if (ret)
132 		return ERR_PTR(ret);
133 
134 	ath12k_dbg(ab, ATH12K_DBG_BOOT, "boot firmware request %s size %zu\n",
135 		   path, fw->size);
136 
137 	return fw;
138 }
139 
ath12k_core_free_bdf(struct ath12k_base * ab,struct ath12k_board_data * bd)140 void ath12k_core_free_bdf(struct ath12k_base *ab, struct ath12k_board_data *bd)
141 {
142 	if (!IS_ERR(bd->fw))
143 		release_firmware(bd->fw);
144 
145 	memset(bd, 0, sizeof(*bd));
146 }
147 
ath12k_core_parse_bd_ie_board(struct ath12k_base * ab,struct ath12k_board_data * bd,const void * buf,size_t buf_len,const char * boardname,int bd_ie_type)148 static int ath12k_core_parse_bd_ie_board(struct ath12k_base *ab,
149 					 struct ath12k_board_data *bd,
150 #if defined(__linux__)
151 					 const void *buf, size_t buf_len,
152 #elif defined(__FreeBSD__)
153 					 const u8 *buf, size_t buf_len,
154 #endif
155 					 const char *boardname,
156 					 int bd_ie_type)
157 {
158 	const struct ath12k_fw_ie *hdr;
159 	bool name_match_found;
160 	int ret, board_ie_id;
161 	size_t board_ie_len;
162 	const void *board_ie_data;
163 
164 	name_match_found = false;
165 
166 	/* go through ATH12K_BD_IE_BOARD_ elements */
167 	while (buf_len > sizeof(struct ath12k_fw_ie)) {
168 #if defined(__linux__)
169 		hdr = buf;
170 #elif defined(__FreeBSD__)
171 		hdr = (const struct ath12k_fw_ie *)buf;
172 #endif
173 		board_ie_id = le32_to_cpu(hdr->id);
174 		board_ie_len = le32_to_cpu(hdr->len);
175 		board_ie_data = hdr->data;
176 
177 		buf_len -= sizeof(*hdr);
178 		buf += sizeof(*hdr);
179 
180 		if (buf_len < ALIGN(board_ie_len, 4)) {
181 			ath12k_err(ab, "invalid ATH12K_BD_IE_BOARD length: %zu < %zu\n",
182 				   buf_len, ALIGN(board_ie_len, 4));
183 			ret = -EINVAL;
184 			goto out;
185 		}
186 
187 		switch (board_ie_id) {
188 		case ATH12K_BD_IE_BOARD_NAME:
189 			ath12k_dbg_dump(ab, ATH12K_DBG_BOOT, "board name", "",
190 					board_ie_data, board_ie_len);
191 
192 			if (board_ie_len != strlen(boardname))
193 				break;
194 
195 			ret = memcmp(board_ie_data, boardname, strlen(boardname));
196 			if (ret)
197 				break;
198 
199 			name_match_found = true;
200 			ath12k_dbg(ab, ATH12K_DBG_BOOT,
201 				   "boot found match for name '%s'",
202 				   boardname);
203 			break;
204 		case ATH12K_BD_IE_BOARD_DATA:
205 			if (!name_match_found)
206 				/* no match found */
207 				break;
208 
209 			ath12k_dbg(ab, ATH12K_DBG_BOOT,
210 				   "boot found board data for '%s'", boardname);
211 
212 			bd->data = board_ie_data;
213 			bd->len = board_ie_len;
214 
215 			ret = 0;
216 			goto out;
217 		default:
218 			ath12k_warn(ab, "unknown ATH12K_BD_IE_BOARD found: %d\n",
219 				    board_ie_id);
220 			break;
221 		}
222 
223 		/* jump over the padding */
224 		board_ie_len = ALIGN(board_ie_len, 4);
225 
226 		buf_len -= board_ie_len;
227 		buf += board_ie_len;
228 	}
229 
230 	/* no match found */
231 	ret = -ENOENT;
232 
233 out:
234 	return ret;
235 }
236 
ath12k_core_fetch_board_data_api_n(struct ath12k_base * ab,struct ath12k_board_data * bd,const char * boardname)237 static int ath12k_core_fetch_board_data_api_n(struct ath12k_base *ab,
238 					      struct ath12k_board_data *bd,
239 					      const char *boardname)
240 {
241 	size_t len, magic_len;
242 	const u8 *data;
243 	char *filename, filepath[100];
244 	size_t ie_len;
245 #if defined(__linux__)
246 	struct ath12k_fw_ie *hdr;
247 #elif defined(__FreeBSD__)
248 	const struct ath12k_fw_ie *hdr;
249 #endif
250 	int ret, ie_id;
251 
252 	filename = ATH12K_BOARD_API2_FILE;
253 
254 	if (!bd->fw)
255 		bd->fw = ath12k_core_firmware_request(ab, filename);
256 
257 	if (IS_ERR(bd->fw))
258 		return PTR_ERR(bd->fw);
259 
260 	data = bd->fw->data;
261 	len = bd->fw->size;
262 
263 	ath12k_core_create_firmware_path(ab, filename,
264 					 filepath, sizeof(filepath));
265 
266 	/* magic has extra null byte padded */
267 	magic_len = strlen(ATH12K_BOARD_MAGIC) + 1;
268 	if (len < magic_len) {
269 		ath12k_err(ab, "failed to find magic value in %s, file too short: %zu\n",
270 			   filepath, len);
271 		ret = -EINVAL;
272 		goto err;
273 	}
274 
275 	if (memcmp(data, ATH12K_BOARD_MAGIC, magic_len)) {
276 		ath12k_err(ab, "found invalid board magic\n");
277 		ret = -EINVAL;
278 		goto err;
279 	}
280 
281 	/* magic is padded to 4 bytes */
282 	magic_len = ALIGN(magic_len, 4);
283 	if (len < magic_len) {
284 		ath12k_err(ab, "failed: %s too small to contain board data, len: %zu\n",
285 			   filepath, len);
286 		ret = -EINVAL;
287 		goto err;
288 	}
289 
290 	data += magic_len;
291 	len -= magic_len;
292 
293 	while (len > sizeof(struct ath12k_fw_ie)) {
294 #if defined(__linux__)
295 		hdr = (struct ath12k_fw_ie *)data;
296 #elif defined(__FreeBSD__)
297 		hdr = (const struct ath12k_fw_ie *)data;
298 #endif
299 		ie_id = le32_to_cpu(hdr->id);
300 		ie_len = le32_to_cpu(hdr->len);
301 
302 		len -= sizeof(*hdr);
303 		data = hdr->data;
304 
305 		if (len < ALIGN(ie_len, 4)) {
306 			ath12k_err(ab, "invalid length for board ie_id %d ie_len %zu len %zu\n",
307 				   ie_id, ie_len, len);
308 			ret = -EINVAL;
309 			goto err;
310 		}
311 
312 		switch (ie_id) {
313 		case ATH12K_BD_IE_BOARD:
314 			ret = ath12k_core_parse_bd_ie_board(ab, bd, data,
315 							    ie_len,
316 							    boardname,
317 							    ATH12K_BD_IE_BOARD);
318 			if (ret == -ENOENT)
319 				/* no match found, continue */
320 				break;
321 			else if (ret)
322 				/* there was an error, bail out */
323 				goto err;
324 			/* either found or error, so stop searching */
325 			goto out;
326 		}
327 
328 		/* jump over the padding */
329 		ie_len = ALIGN(ie_len, 4);
330 
331 		len -= ie_len;
332 		data += ie_len;
333 	}
334 
335 out:
336 	if (!bd->data || !bd->len) {
337 		ath12k_err(ab,
338 			   "failed to fetch board data for %s from %s\n",
339 			   boardname, filepath);
340 		ret = -ENODATA;
341 		goto err;
342 	}
343 
344 	return 0;
345 
346 err:
347 	ath12k_core_free_bdf(ab, bd);
348 	return ret;
349 }
350 
ath12k_core_fetch_board_data_api_1(struct ath12k_base * ab,struct ath12k_board_data * bd,char * filename)351 int ath12k_core_fetch_board_data_api_1(struct ath12k_base *ab,
352 				       struct ath12k_board_data *bd,
353 				       char *filename)
354 {
355 	bd->fw = ath12k_core_firmware_request(ab, filename);
356 	if (IS_ERR(bd->fw))
357 		return PTR_ERR(bd->fw);
358 
359 	bd->data = bd->fw->data;
360 	bd->len = bd->fw->size;
361 
362 	return 0;
363 }
364 
365 #define BOARD_NAME_SIZE 100
ath12k_core_fetch_bdf(struct ath12k_base * ab,struct ath12k_board_data * bd)366 int ath12k_core_fetch_bdf(struct ath12k_base *ab, struct ath12k_board_data *bd)
367 {
368 	char boardname[BOARD_NAME_SIZE];
369 	int ret;
370 
371 	ret = ath12k_core_create_board_name(ab, boardname, BOARD_NAME_SIZE);
372 	if (ret) {
373 		ath12k_err(ab, "failed to create board name: %d", ret);
374 		return ret;
375 	}
376 
377 	ab->bd_api = 2;
378 	ret = ath12k_core_fetch_board_data_api_n(ab, bd, boardname);
379 	if (!ret)
380 		goto success;
381 
382 	ab->bd_api = 1;
383 	ret = ath12k_core_fetch_board_data_api_1(ab, bd, ATH12K_DEFAULT_BOARD_FILE);
384 	if (ret) {
385 		ath12k_err(ab, "failed to fetch board-2.bin or board.bin from %s\n",
386 			   ab->hw_params->fw.dir);
387 		return ret;
388 	}
389 
390 success:
391 	ath12k_dbg(ab, ATH12K_DBG_BOOT, "using board api %d\n", ab->bd_api);
392 	return 0;
393 }
394 
ath12k_core_stop(struct ath12k_base * ab)395 static void ath12k_core_stop(struct ath12k_base *ab)
396 {
397 	if (!test_bit(ATH12K_FLAG_CRASH_FLUSH, &ab->dev_flags))
398 		ath12k_qmi_firmware_stop(ab);
399 
400 	ath12k_hif_stop(ab);
401 	ath12k_wmi_detach(ab);
402 	ath12k_dp_rx_pdev_reo_cleanup(ab);
403 
404 	/* De-Init of components as needed */
405 }
406 
ath12k_core_soc_create(struct ath12k_base * ab)407 static int ath12k_core_soc_create(struct ath12k_base *ab)
408 {
409 	int ret;
410 
411 	ret = ath12k_qmi_init_service(ab);
412 	if (ret) {
413 		ath12k_err(ab, "failed to initialize qmi :%d\n", ret);
414 		return ret;
415 	}
416 
417 	ret = ath12k_hif_power_up(ab);
418 	if (ret) {
419 		ath12k_err(ab, "failed to power up :%d\n", ret);
420 		goto err_qmi_deinit;
421 	}
422 
423 	return 0;
424 
425 err_qmi_deinit:
426 	ath12k_qmi_deinit_service(ab);
427 	return ret;
428 }
429 
ath12k_core_soc_destroy(struct ath12k_base * ab)430 static void ath12k_core_soc_destroy(struct ath12k_base *ab)
431 {
432 	ath12k_dp_free(ab);
433 	ath12k_reg_free(ab);
434 	ath12k_qmi_deinit_service(ab);
435 }
436 
ath12k_core_pdev_create(struct ath12k_base * ab)437 static int ath12k_core_pdev_create(struct ath12k_base *ab)
438 {
439 	int ret;
440 
441 	ret = ath12k_mac_register(ab);
442 	if (ret) {
443 		ath12k_err(ab, "failed register the radio with mac80211: %d\n", ret);
444 		return ret;
445 	}
446 
447 	ret = ath12k_dp_pdev_alloc(ab);
448 	if (ret) {
449 		ath12k_err(ab, "failed to attach DP pdev: %d\n", ret);
450 		goto err_mac_unregister;
451 	}
452 
453 	return 0;
454 
455 err_mac_unregister:
456 	ath12k_mac_unregister(ab);
457 
458 	return ret;
459 }
460 
ath12k_core_pdev_destroy(struct ath12k_base * ab)461 static void ath12k_core_pdev_destroy(struct ath12k_base *ab)
462 {
463 	ath12k_mac_unregister(ab);
464 	ath12k_hif_irq_disable(ab);
465 	ath12k_dp_pdev_free(ab);
466 }
467 
ath12k_core_start(struct ath12k_base * ab,enum ath12k_firmware_mode mode)468 static int ath12k_core_start(struct ath12k_base *ab,
469 			     enum ath12k_firmware_mode mode)
470 {
471 	int ret;
472 
473 	ret = ath12k_wmi_attach(ab);
474 	if (ret) {
475 		ath12k_err(ab, "failed to attach wmi: %d\n", ret);
476 		return ret;
477 	}
478 
479 	ret = ath12k_htc_init(ab);
480 	if (ret) {
481 		ath12k_err(ab, "failed to init htc: %d\n", ret);
482 		goto err_wmi_detach;
483 	}
484 
485 	ret = ath12k_hif_start(ab);
486 	if (ret) {
487 		ath12k_err(ab, "failed to start HIF: %d\n", ret);
488 		goto err_wmi_detach;
489 	}
490 
491 	ret = ath12k_htc_wait_target(&ab->htc);
492 	if (ret) {
493 		ath12k_err(ab, "failed to connect to HTC: %d\n", ret);
494 		goto err_hif_stop;
495 	}
496 
497 	ret = ath12k_dp_htt_connect(&ab->dp);
498 	if (ret) {
499 		ath12k_err(ab, "failed to connect to HTT: %d\n", ret);
500 		goto err_hif_stop;
501 	}
502 
503 	ret = ath12k_wmi_connect(ab);
504 	if (ret) {
505 		ath12k_err(ab, "failed to connect wmi: %d\n", ret);
506 		goto err_hif_stop;
507 	}
508 
509 	ret = ath12k_htc_start(&ab->htc);
510 	if (ret) {
511 		ath12k_err(ab, "failed to start HTC: %d\n", ret);
512 		goto err_hif_stop;
513 	}
514 
515 	ret = ath12k_wmi_wait_for_service_ready(ab);
516 	if (ret) {
517 		ath12k_err(ab, "failed to receive wmi service ready event: %d\n",
518 			   ret);
519 		goto err_hif_stop;
520 	}
521 
522 	ret = ath12k_mac_allocate(ab);
523 	if (ret) {
524 		ath12k_err(ab, "failed to create new hw device with mac80211 :%d\n",
525 			   ret);
526 		goto err_hif_stop;
527 	}
528 
529 	ath12k_dp_cc_config(ab);
530 
531 	ath12k_dp_pdev_pre_alloc(ab);
532 
533 	ret = ath12k_dp_rx_pdev_reo_setup(ab);
534 	if (ret) {
535 		ath12k_err(ab, "failed to initialize reo destination rings: %d\n", ret);
536 		goto err_mac_destroy;
537 	}
538 
539 	ret = ath12k_wmi_cmd_init(ab);
540 	if (ret) {
541 		ath12k_err(ab, "failed to send wmi init cmd: %d\n", ret);
542 		goto err_reo_cleanup;
543 	}
544 
545 	ret = ath12k_wmi_wait_for_unified_ready(ab);
546 	if (ret) {
547 		ath12k_err(ab, "failed to receive wmi unified ready event: %d\n",
548 			   ret);
549 		goto err_reo_cleanup;
550 	}
551 
552 	/* put hardware to DBS mode */
553 	if (ab->hw_params->single_pdev_only) {
554 		ret = ath12k_wmi_set_hw_mode(ab, WMI_HOST_HW_MODE_DBS);
555 		if (ret) {
556 			ath12k_err(ab, "failed to send dbs mode: %d\n", ret);
557 			goto err_reo_cleanup;
558 		}
559 	}
560 
561 	ret = ath12k_dp_tx_htt_h2t_ver_req_msg(ab);
562 	if (ret) {
563 		ath12k_err(ab, "failed to send htt version request message: %d\n",
564 			   ret);
565 		goto err_reo_cleanup;
566 	}
567 
568 	return 0;
569 
570 err_reo_cleanup:
571 	ath12k_dp_rx_pdev_reo_cleanup(ab);
572 err_mac_destroy:
573 	ath12k_mac_destroy(ab);
574 err_hif_stop:
575 	ath12k_hif_stop(ab);
576 err_wmi_detach:
577 	ath12k_wmi_detach(ab);
578 	return ret;
579 }
580 
ath12k_core_start_firmware(struct ath12k_base * ab,enum ath12k_firmware_mode mode)581 static int ath12k_core_start_firmware(struct ath12k_base *ab,
582 				      enum ath12k_firmware_mode mode)
583 {
584 	int ret;
585 
586 	ath12k_ce_get_shadow_config(ab, &ab->qmi.ce_cfg.shadow_reg_v3,
587 				    &ab->qmi.ce_cfg.shadow_reg_v3_len);
588 
589 	ret = ath12k_qmi_firmware_start(ab, mode);
590 	if (ret) {
591 		ath12k_err(ab, "failed to send firmware start: %d\n", ret);
592 		return ret;
593 	}
594 
595 	return ret;
596 }
597 
ath12k_core_qmi_firmware_ready(struct ath12k_base * ab)598 int ath12k_core_qmi_firmware_ready(struct ath12k_base *ab)
599 {
600 	int ret;
601 
602 	ret = ath12k_core_start_firmware(ab, ATH12K_FIRMWARE_MODE_NORMAL);
603 	if (ret) {
604 		ath12k_err(ab, "failed to start firmware: %d\n", ret);
605 		return ret;
606 	}
607 
608 	ret = ath12k_ce_init_pipes(ab);
609 	if (ret) {
610 		ath12k_err(ab, "failed to initialize CE: %d\n", ret);
611 		goto err_firmware_stop;
612 	}
613 
614 	ret = ath12k_dp_alloc(ab);
615 	if (ret) {
616 		ath12k_err(ab, "failed to init DP: %d\n", ret);
617 		goto err_firmware_stop;
618 	}
619 
620 	mutex_lock(&ab->core_lock);
621 	ret = ath12k_core_start(ab, ATH12K_FIRMWARE_MODE_NORMAL);
622 	if (ret) {
623 		ath12k_err(ab, "failed to start core: %d\n", ret);
624 		goto err_dp_free;
625 	}
626 
627 	ret = ath12k_core_pdev_create(ab);
628 	if (ret) {
629 		ath12k_err(ab, "failed to create pdev core: %d\n", ret);
630 		goto err_core_stop;
631 	}
632 	ath12k_hif_irq_enable(ab);
633 	mutex_unlock(&ab->core_lock);
634 
635 	return 0;
636 
637 err_core_stop:
638 	ath12k_core_stop(ab);
639 	ath12k_mac_destroy(ab);
640 err_dp_free:
641 	ath12k_dp_free(ab);
642 	mutex_unlock(&ab->core_lock);
643 err_firmware_stop:
644 	ath12k_qmi_firmware_stop(ab);
645 
646 	return ret;
647 }
648 
ath12k_core_reconfigure_on_crash(struct ath12k_base * ab)649 static int ath12k_core_reconfigure_on_crash(struct ath12k_base *ab)
650 {
651 	int ret;
652 
653 	mutex_lock(&ab->core_lock);
654 	ath12k_hif_irq_disable(ab);
655 	ath12k_dp_pdev_free(ab);
656 	ath12k_hif_stop(ab);
657 	ath12k_wmi_detach(ab);
658 	ath12k_dp_rx_pdev_reo_cleanup(ab);
659 	mutex_unlock(&ab->core_lock);
660 
661 	ath12k_dp_free(ab);
662 	ath12k_hal_srng_deinit(ab);
663 
664 	ab->free_vdev_map = (1LL << (ab->num_radios * TARGET_NUM_VDEVS)) - 1;
665 
666 	ret = ath12k_hal_srng_init(ab);
667 	if (ret)
668 		return ret;
669 
670 	clear_bit(ATH12K_FLAG_CRASH_FLUSH, &ab->dev_flags);
671 
672 	ret = ath12k_core_qmi_firmware_ready(ab);
673 	if (ret)
674 		goto err_hal_srng_deinit;
675 
676 	clear_bit(ATH12K_FLAG_RECOVERY, &ab->dev_flags);
677 
678 	return 0;
679 
680 err_hal_srng_deinit:
681 	ath12k_hal_srng_deinit(ab);
682 	return ret;
683 }
684 
ath12k_core_halt(struct ath12k * ar)685 void ath12k_core_halt(struct ath12k *ar)
686 {
687 	struct ath12k_base *ab = ar->ab;
688 
689 	lockdep_assert_held(&ar->conf_mutex);
690 
691 	ar->num_created_vdevs = 0;
692 	ar->allocated_vdev_map = 0;
693 
694 	ath12k_mac_scan_finish(ar);
695 	ath12k_mac_peer_cleanup_all(ar);
696 	cancel_delayed_work_sync(&ar->scan.timeout);
697 	cancel_work_sync(&ar->regd_update_work);
698 
699 	rcu_assign_pointer(ab->pdevs_active[ar->pdev_idx], NULL);
700 	synchronize_rcu();
701 	INIT_LIST_HEAD(&ar->arvifs);
702 	idr_init(&ar->txmgmt_idr);
703 }
704 
ath12k_core_pre_reconfigure_recovery(struct ath12k_base * ab)705 static void ath12k_core_pre_reconfigure_recovery(struct ath12k_base *ab)
706 {
707 	struct ath12k *ar;
708 	struct ath12k_pdev *pdev;
709 	int i;
710 
711 	spin_lock_bh(&ab->base_lock);
712 	ab->stats.fw_crash_counter++;
713 	spin_unlock_bh(&ab->base_lock);
714 
715 	for (i = 0; i < ab->num_radios; i++) {
716 		pdev = &ab->pdevs[i];
717 		ar = pdev->ar;
718 		if (!ar || ar->state == ATH12K_STATE_OFF)
719 			continue;
720 
721 		ieee80211_stop_queues(ar->hw);
722 		ath12k_mac_drain_tx(ar);
723 		complete(&ar->scan.started);
724 		complete(&ar->scan.completed);
725 		complete(&ar->peer_assoc_done);
726 		complete(&ar->peer_delete_done);
727 		complete(&ar->install_key_done);
728 		complete(&ar->vdev_setup_done);
729 		complete(&ar->vdev_delete_done);
730 		complete(&ar->bss_survey_done);
731 
732 		wake_up(&ar->dp.tx_empty_waitq);
733 		idr_for_each(&ar->txmgmt_idr,
734 			     ath12k_mac_tx_mgmt_pending_free, ar);
735 		idr_destroy(&ar->txmgmt_idr);
736 		wake_up(&ar->txmgmt_empty_waitq);
737 	}
738 
739 	wake_up(&ab->wmi_ab.tx_credits_wq);
740 	wake_up(&ab->peer_mapping_wq);
741 }
742 
ath12k_core_post_reconfigure_recovery(struct ath12k_base * ab)743 static void ath12k_core_post_reconfigure_recovery(struct ath12k_base *ab)
744 {
745 	struct ath12k *ar;
746 	struct ath12k_pdev *pdev;
747 	int i;
748 
749 	for (i = 0; i < ab->num_radios; i++) {
750 		pdev = &ab->pdevs[i];
751 		ar = pdev->ar;
752 		if (!ar || ar->state == ATH12K_STATE_OFF)
753 			continue;
754 
755 		mutex_lock(&ar->conf_mutex);
756 
757 		switch (ar->state) {
758 		case ATH12K_STATE_ON:
759 			ar->state = ATH12K_STATE_RESTARTING;
760 			ath12k_core_halt(ar);
761 			ieee80211_restart_hw(ar->hw);
762 			break;
763 		case ATH12K_STATE_OFF:
764 			ath12k_warn(ab,
765 				    "cannot restart radio %d that hasn't been started\n",
766 				    i);
767 			break;
768 		case ATH12K_STATE_RESTARTING:
769 			break;
770 		case ATH12K_STATE_RESTARTED:
771 			ar->state = ATH12K_STATE_WEDGED;
772 			fallthrough;
773 		case ATH12K_STATE_WEDGED:
774 			ath12k_warn(ab,
775 				    "device is wedged, will not restart radio %d\n", i);
776 			break;
777 		}
778 		mutex_unlock(&ar->conf_mutex);
779 	}
780 	complete(&ab->driver_recovery);
781 }
782 
ath12k_core_restart(struct work_struct * work)783 static void ath12k_core_restart(struct work_struct *work)
784 {
785 	struct ath12k_base *ab = container_of(work, struct ath12k_base, restart_work);
786 	int ret;
787 
788 	if (!ab->is_reset)
789 		ath12k_core_pre_reconfigure_recovery(ab);
790 
791 	ret = ath12k_core_reconfigure_on_crash(ab);
792 	if (ret) {
793 		ath12k_err(ab, "failed to reconfigure driver on crash recovery\n");
794 		return;
795 	}
796 
797 	if (ab->is_reset)
798 		complete_all(&ab->reconfigure_complete);
799 
800 	if (!ab->is_reset)
801 		ath12k_core_post_reconfigure_recovery(ab);
802 }
803 
ath12k_core_reset(struct work_struct * work)804 static void ath12k_core_reset(struct work_struct *work)
805 {
806 	struct ath12k_base *ab = container_of(work, struct ath12k_base, reset_work);
807 	int reset_count, fail_cont_count;
808 	long time_left;
809 
810 	if (!(test_bit(ATH12K_FLAG_REGISTERED, &ab->dev_flags))) {
811 		ath12k_warn(ab, "ignore reset dev flags 0x%lx\n", ab->dev_flags);
812 		return;
813 	}
814 
815 	/* Sometimes the recovery will fail and then the next all recovery fail,
816 	 * this is to avoid infinite recovery since it can not recovery success
817 	 */
818 	fail_cont_count = atomic_read(&ab->fail_cont_count);
819 
820 	if (fail_cont_count >= ATH12K_RESET_MAX_FAIL_COUNT_FINAL)
821 		return;
822 
823 	if (fail_cont_count >= ATH12K_RESET_MAX_FAIL_COUNT_FIRST &&
824 	    time_before(jiffies, ab->reset_fail_timeout))
825 		return;
826 
827 	reset_count = atomic_inc_return(&ab->reset_count);
828 
829 	if (reset_count > 1) {
830 		/* Sometimes it happened another reset worker before the previous one
831 		 * completed, then the second reset worker will destroy the previous one,
832 		 * thus below is to avoid that.
833 		 */
834 		ath12k_warn(ab, "already resetting count %d\n", reset_count);
835 
836 		reinit_completion(&ab->reset_complete);
837 		time_left = wait_for_completion_timeout(&ab->reset_complete,
838 							ATH12K_RESET_TIMEOUT_HZ);
839 		if (time_left) {
840 			ath12k_dbg(ab, ATH12K_DBG_BOOT, "to skip reset\n");
841 			atomic_dec(&ab->reset_count);
842 			return;
843 		}
844 
845 		ab->reset_fail_timeout = jiffies + ATH12K_RESET_FAIL_TIMEOUT_HZ;
846 		/* Record the continuous recovery fail count when recovery failed*/
847 		fail_cont_count = atomic_inc_return(&ab->fail_cont_count);
848 	}
849 
850 	ath12k_dbg(ab, ATH12K_DBG_BOOT, "reset starting\n");
851 
852 	ab->is_reset = true;
853 	atomic_set(&ab->recovery_count, 0);
854 
855 	ath12k_core_pre_reconfigure_recovery(ab);
856 
857 	reinit_completion(&ab->reconfigure_complete);
858 	ath12k_core_post_reconfigure_recovery(ab);
859 
860 	reinit_completion(&ab->recovery_start);
861 	atomic_set(&ab->recovery_start_count, 0);
862 
863 	ath12k_dbg(ab, ATH12K_DBG_BOOT, "waiting recovery start...\n");
864 
865 	time_left = wait_for_completion_timeout(&ab->recovery_start,
866 						ATH12K_RECOVER_START_TIMEOUT_HZ);
867 
868 	ath12k_hif_power_down(ab);
869 	ath12k_hif_power_up(ab);
870 
871 	ath12k_dbg(ab, ATH12K_DBG_BOOT, "reset started\n");
872 }
873 
ath12k_core_pre_init(struct ath12k_base * ab)874 int ath12k_core_pre_init(struct ath12k_base *ab)
875 {
876 	int ret;
877 
878 	ret = ath12k_hw_init(ab);
879 	if (ret) {
880 		ath12k_err(ab, "failed to init hw params: %d\n", ret);
881 		return ret;
882 	}
883 
884 	return 0;
885 }
886 
ath12k_core_init(struct ath12k_base * ab)887 int ath12k_core_init(struct ath12k_base *ab)
888 {
889 	int ret;
890 
891 	ret = ath12k_core_soc_create(ab);
892 	if (ret) {
893 		ath12k_err(ab, "failed to create soc core: %d\n", ret);
894 		return ret;
895 	}
896 
897 	return 0;
898 }
899 
ath12k_core_deinit(struct ath12k_base * ab)900 void ath12k_core_deinit(struct ath12k_base *ab)
901 {
902 	mutex_lock(&ab->core_lock);
903 
904 	ath12k_core_pdev_destroy(ab);
905 	ath12k_core_stop(ab);
906 
907 	mutex_unlock(&ab->core_lock);
908 
909 	ath12k_hif_power_down(ab);
910 	ath12k_mac_destroy(ab);
911 	ath12k_core_soc_destroy(ab);
912 }
913 
ath12k_core_free(struct ath12k_base * ab)914 void ath12k_core_free(struct ath12k_base *ab)
915 {
916 	timer_delete_sync(&ab->rx_replenish_retry);
917 	destroy_workqueue(ab->workqueue_aux);
918 	destroy_workqueue(ab->workqueue);
919 	kfree(ab);
920 }
921 
ath12k_core_alloc(struct device * dev,size_t priv_size,enum ath12k_bus bus)922 struct ath12k_base *ath12k_core_alloc(struct device *dev, size_t priv_size,
923 				      enum ath12k_bus bus)
924 {
925 	struct ath12k_base *ab;
926 
927 	ab = kzalloc(sizeof(*ab) + priv_size, GFP_KERNEL);
928 	if (!ab)
929 		return NULL;
930 
931 	init_completion(&ab->driver_recovery);
932 
933 	ab->workqueue = create_singlethread_workqueue("ath12k_wq");
934 	if (!ab->workqueue)
935 		goto err_sc_free;
936 
937 	ab->workqueue_aux = create_singlethread_workqueue("ath12k_aux_wq");
938 	if (!ab->workqueue_aux)
939 		goto err_free_wq;
940 
941 	mutex_init(&ab->core_lock);
942 	spin_lock_init(&ab->base_lock);
943 	init_completion(&ab->reset_complete);
944 	init_completion(&ab->reconfigure_complete);
945 	init_completion(&ab->recovery_start);
946 
947 	INIT_LIST_HEAD(&ab->peers);
948 	init_waitqueue_head(&ab->peer_mapping_wq);
949 	init_waitqueue_head(&ab->wmi_ab.tx_credits_wq);
950 	INIT_WORK(&ab->restart_work, ath12k_core_restart);
951 	INIT_WORK(&ab->reset_work, ath12k_core_reset);
952 	timer_setup(&ab->rx_replenish_retry, ath12k_ce_rx_replenish_retry, 0);
953 	init_completion(&ab->htc_suspend);
954 
955 	ab->dev = dev;
956 	ab->hif.bus = bus;
957 
958 	return ab;
959 
960 err_free_wq:
961 	destroy_workqueue(ab->workqueue);
962 err_sc_free:
963 	kfree(ab);
964 	return NULL;
965 }
966 
967 MODULE_DESCRIPTION("Core module for Qualcomm Atheros 802.11be wireless LAN cards.");
968 MODULE_LICENSE("Dual BSD/GPL");
969