12be7d22fSVladimir Kondratiev /*
2849a564bSDedy Lansky  * Copyright (c) 2012-2017 Qualcomm Atheros, Inc.
34276d771SMaya Erez  * Copyright (c) 2018, The Linux Foundation. All rights reserved.
42be7d22fSVladimir Kondratiev  *
52be7d22fSVladimir Kondratiev  * Permission to use, copy, modify, and/or distribute this software for any
62be7d22fSVladimir Kondratiev  * purpose with or without fee is hereby granted, provided that the above
72be7d22fSVladimir Kondratiev  * copyright notice and this permission notice appear in all copies.
82be7d22fSVladimir Kondratiev  *
92be7d22fSVladimir Kondratiev  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
102be7d22fSVladimir Kondratiev  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
112be7d22fSVladimir Kondratiev  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
122be7d22fSVladimir Kondratiev  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
132be7d22fSVladimir Kondratiev  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
142be7d22fSVladimir Kondratiev  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
152be7d22fSVladimir Kondratiev  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
162be7d22fSVladimir Kondratiev  */
172be7d22fSVladimir Kondratiev 
181eb9d1e5SDedy Lansky #include <linux/moduleparam.h>
192be7d22fSVladimir Kondratiev #include <linux/etherdevice.h>
2047e19af9SVladimir Kondratiev #include <linux/if_arp.h>
212be7d22fSVladimir Kondratiev 
222be7d22fSVladimir Kondratiev #include "wil6210.h"
2347e19af9SVladimir Kondratiev #include "txrx.h"
242be7d22fSVladimir Kondratiev #include "wmi.h"
2598658095SVladimir Kondratiev #include "trace.h"
262be7d22fSVladimir Kondratiev 
27327755fbSVladimir Kondratiev static uint max_assoc_sta = WIL6210_MAX_CID;
2878484c44SMaya Erez module_param(max_assoc_sta, uint, 0644);
291eb9d1e5SDedy Lansky MODULE_PARM_DESC(max_assoc_sta, " Max number of stations associated to the AP");
301eb9d1e5SDedy Lansky 
313a3def8dSVladimir Kondratiev int agg_wsize; /* = 0; */
3278484c44SMaya Erez module_param(agg_wsize, int, 0644);
333a3def8dSVladimir Kondratiev MODULE_PARM_DESC(agg_wsize, " Window size for Tx Block Ack after connect;"
343a3def8dSVladimir Kondratiev 		 " 0 - use default; < 0 - don't auto-establish");
353a3def8dSVladimir Kondratiev 
3610d599adSMaya Erez u8 led_id = WIL_LED_INVALID_ID;
3778484c44SMaya Erez module_param(led_id, byte, 0444);
3810d599adSMaya Erez MODULE_PARM_DESC(led_id,
3910d599adSMaya Erez 		 " 60G device led enablement. Set the led ID (0-2) to enable");
4010d599adSMaya Erez 
41fe9ee51eSMaya Erez #define WIL_WAIT_FOR_SUSPEND_RESUME_COMP 200
42a5dc6883SDedy Lansky #define WIL_WMI_CALL_GENERAL_TO_MS 100
43fe9ee51eSMaya Erez 
442be7d22fSVladimir Kondratiev /**
452be7d22fSVladimir Kondratiev  * WMI event receiving - theory of operations
462be7d22fSVladimir Kondratiev  *
472be7d22fSVladimir Kondratiev  * When firmware about to report WMI event, it fills memory area
482be7d22fSVladimir Kondratiev  * in the mailbox and raises misc. IRQ. Thread interrupt handler invoked for
492be7d22fSVladimir Kondratiev  * the misc IRQ, function @wmi_recv_cmd called by thread IRQ handler.
502be7d22fSVladimir Kondratiev  *
512be7d22fSVladimir Kondratiev  * @wmi_recv_cmd reads event, allocates memory chunk  and attaches it to the
522be7d22fSVladimir Kondratiev  * event list @wil->pending_wmi_ev. Then, work queue @wil->wmi_wq wakes up
532be7d22fSVladimir Kondratiev  * and handles events within the @wmi_event_worker. Every event get detached
542be7d22fSVladimir Kondratiev  * from list, processed and deleted.
552be7d22fSVladimir Kondratiev  *
562be7d22fSVladimir Kondratiev  * Purpose for this mechanism is to release IRQ thread; otherwise,
572be7d22fSVladimir Kondratiev  * if WMI event handling involves another WMI command flow, this 2-nd flow
582be7d22fSVladimir Kondratiev  * won't be completed because of blocked IRQ thread.
592be7d22fSVladimir Kondratiev  */
602be7d22fSVladimir Kondratiev 
612be7d22fSVladimir Kondratiev /**
622be7d22fSVladimir Kondratiev  * Addressing - theory of operations
632be7d22fSVladimir Kondratiev  *
642be7d22fSVladimir Kondratiev  * There are several buses present on the WIL6210 card.
652be7d22fSVladimir Kondratiev  * Same memory areas are visible at different address on
662be7d22fSVladimir Kondratiev  * the different busses. There are 3 main bus masters:
672be7d22fSVladimir Kondratiev  *  - MAC CPU (ucode)
682be7d22fSVladimir Kondratiev  *  - User CPU (firmware)
692be7d22fSVladimir Kondratiev  *  - AHB (host)
702be7d22fSVladimir Kondratiev  *
712be7d22fSVladimir Kondratiev  * On the PCI bus, there is one BAR (BAR0) of 2Mb size, exposing
722be7d22fSVladimir Kondratiev  * AHB addresses starting from 0x880000
732be7d22fSVladimir Kondratiev  *
744276d771SMaya Erez  * Internally, firmware uses addresses that allow faster access but
752be7d22fSVladimir Kondratiev  * are invisible from the host. To read from these addresses, alternative
762be7d22fSVladimir Kondratiev  * AHB address must be used.
772be7d22fSVladimir Kondratiev  */
782be7d22fSVladimir Kondratiev 
792be7d22fSVladimir Kondratiev /**
804276d771SMaya Erez  * @sparrow_fw_mapping provides memory remapping table for sparrow
81b541d0a0SVladimir Kondratiev  *
82b541d0a0SVladimir Kondratiev  * array size should be in sync with the declaration in the wil6210.h
834276d771SMaya Erez  *
844276d771SMaya Erez  * Sparrow memory mapping:
854276d771SMaya Erez  * Linker address         PCI/Host address
864276d771SMaya Erez  *                        0x880000 .. 0xa80000  2Mb BAR0
874276d771SMaya Erez  * 0x800000 .. 0x808000   0x900000 .. 0x908000  32k DCCM
884276d771SMaya Erez  * 0x840000 .. 0x860000   0x908000 .. 0x928000  128k PERIPH
892be7d22fSVladimir Kondratiev  */
904276d771SMaya Erez const struct fw_map sparrow_fw_mapping[] = {
9161578820SLior David 	/* FW code RAM 256k */
929a53d0b6SMaya Erez 	{0x000000, 0x040000, 0x8c0000, "fw_code", true, true},
9361578820SLior David 	/* FW data RAM 32k */
949a53d0b6SMaya Erez 	{0x800000, 0x808000, 0x900000, "fw_data", true, true},
9561578820SLior David 	/* periph data 128k */
969a53d0b6SMaya Erez 	{0x840000, 0x860000, 0x908000, "fw_peri", true, true},
9761578820SLior David 	/* various RGF 40k */
989a53d0b6SMaya Erez 	{0x880000, 0x88a000, 0x880000, "rgf", true, true},
9961578820SLior David 	/* AGC table   4k */
1009a53d0b6SMaya Erez 	{0x88a000, 0x88b000, 0x88a000, "AGC_tbl", true, true},
10161578820SLior David 	/* Pcie_ext_rgf 4k */
1029a53d0b6SMaya Erez 	{0x88b000, 0x88c000, 0x88b000, "rgf_ext", true, true},
10361578820SLior David 	/* mac_ext_rgf 512b */
1049a53d0b6SMaya Erez 	{0x88c000, 0x88c200, 0x88c000, "mac_rgf_ext", true, true},
10561578820SLior David 	/* upper area 548k */
1069a53d0b6SMaya Erez 	{0x8c0000, 0x949000, 0x8c0000, "upper", true, true},
10761578820SLior David 	/* UCODE areas - accessible by debugfs blobs but not by
10861578820SLior David 	 * wmi_addr_remap. UCODE areas MUST be added AFTER FW areas!
1092be7d22fSVladimir Kondratiev 	 */
11061578820SLior David 	/* ucode code RAM 128k */
1119a53d0b6SMaya Erez 	{0x000000, 0x020000, 0x920000, "uc_code", false, false},
11261578820SLior David 	/* ucode data RAM 16k */
1139a53d0b6SMaya Erez 	{0x800000, 0x804000, 0x940000, "uc_data", false, false},
1142be7d22fSVladimir Kondratiev };
1152be7d22fSVladimir Kondratiev 
1164276d771SMaya Erez /**
11754fca595SLior David  * @sparrow_d0_mac_rgf_ext - mac_rgf_ext section for Sparrow D0
11854fca595SLior David  * it is a bit larger to support extra features
11954fca595SLior David  */
12054fca595SLior David const struct fw_map sparrow_d0_mac_rgf_ext = {
1219a53d0b6SMaya Erez 	0x88c000, 0x88c500, 0x88c000, "mac_rgf_ext", true, true
12254fca595SLior David };
12354fca595SLior David 
12454fca595SLior David /**
1254276d771SMaya Erez  * @talyn_fw_mapping provides memory remapping table for Talyn
1264276d771SMaya Erez  *
1274276d771SMaya Erez  * array size should be in sync with the declaration in the wil6210.h
1284276d771SMaya Erez  *
1294276d771SMaya Erez  * Talyn memory mapping:
1304276d771SMaya Erez  * Linker address         PCI/Host address
1314276d771SMaya Erez  *                        0x880000 .. 0xc80000  4Mb BAR0
1324276d771SMaya Erez  * 0x800000 .. 0x820000   0xa00000 .. 0xa20000  128k DCCM
1334276d771SMaya Erez  * 0x840000 .. 0x858000   0xa20000 .. 0xa38000  96k PERIPH
1344276d771SMaya Erez  */
1354276d771SMaya Erez const struct fw_map talyn_fw_mapping[] = {
1364276d771SMaya Erez 	/* FW code RAM 1M */
1379a53d0b6SMaya Erez 	{0x000000, 0x100000, 0x900000, "fw_code", true, true},
1384276d771SMaya Erez 	/* FW data RAM 128k */
1399a53d0b6SMaya Erez 	{0x800000, 0x820000, 0xa00000, "fw_data", true, true},
1404276d771SMaya Erez 	/* periph. data RAM 96k */
1419a53d0b6SMaya Erez 	{0x840000, 0x858000, 0xa20000, "fw_peri", true, true},
1424276d771SMaya Erez 	/* various RGF 40k */
1439a53d0b6SMaya Erez 	{0x880000, 0x88a000, 0x880000, "rgf", true, true},
1444276d771SMaya Erez 	/* AGC table 4k */
1459a53d0b6SMaya Erez 	{0x88a000, 0x88b000, 0x88a000, "AGC_tbl", true, true},
1464276d771SMaya Erez 	/* Pcie_ext_rgf 4k */
1479a53d0b6SMaya Erez 	{0x88b000, 0x88c000, 0x88b000, "rgf_ext", true, true},
1484276d771SMaya Erez 	/* mac_ext_rgf 1344b */
1499a53d0b6SMaya Erez 	{0x88c000, 0x88c540, 0x88c000, "mac_rgf_ext", true, true},
1504276d771SMaya Erez 	/* ext USER RGF 4k */
1519a53d0b6SMaya Erez 	{0x88d000, 0x88e000, 0x88d000, "ext_user_rgf", true, true},
1524276d771SMaya Erez 	/* OTP 4k */
1539a53d0b6SMaya Erez 	{0x8a0000, 0x8a1000, 0x8a0000, "otp", true, false},
1544276d771SMaya Erez 	/* DMA EXT RGF 64k */
1559a53d0b6SMaya Erez 	{0x8b0000, 0x8c0000, 0x8b0000, "dma_ext_rgf", true, true},
1564276d771SMaya Erez 	/* upper area 1536k */
1579a53d0b6SMaya Erez 	{0x900000, 0xa80000, 0x900000, "upper", true, true},
1584276d771SMaya Erez 	/* UCODE areas - accessible by debugfs blobs but not by
1594276d771SMaya Erez 	 * wmi_addr_remap. UCODE areas MUST be added AFTER FW areas!
1604276d771SMaya Erez 	 */
1614276d771SMaya Erez 	/* ucode code RAM 256k */
1629a53d0b6SMaya Erez 	{0x000000, 0x040000, 0xa38000, "uc_code", false, false},
1634276d771SMaya Erez 	/* ucode data RAM 32k */
1649a53d0b6SMaya Erez 	{0x800000, 0x808000, 0xa78000, "uc_data", false, false},
1654276d771SMaya Erez };
1664276d771SMaya Erez 
167485790d0SMaya Erez /**
168485790d0SMaya Erez  * @talyn_mb_fw_mapping provides memory remapping table for Talyn-MB
169485790d0SMaya Erez  *
170485790d0SMaya Erez  * array size should be in sync with the declaration in the wil6210.h
171485790d0SMaya Erez  *
172485790d0SMaya Erez  * Talyn MB memory mapping:
173485790d0SMaya Erez  * Linker address         PCI/Host address
174485790d0SMaya Erez  *                        0x880000 .. 0xc80000  4Mb BAR0
175485790d0SMaya Erez  * 0x800000 .. 0x820000   0xa00000 .. 0xa20000  128k DCCM
176485790d0SMaya Erez  * 0x840000 .. 0x858000   0xa20000 .. 0xa38000  96k PERIPH
177485790d0SMaya Erez  */
178485790d0SMaya Erez const struct fw_map talyn_mb_fw_mapping[] = {
179485790d0SMaya Erez 	/* FW code RAM 768k */
1809a53d0b6SMaya Erez 	{0x000000, 0x0c0000, 0x900000, "fw_code", true, true},
181485790d0SMaya Erez 	/* FW data RAM 128k */
1829a53d0b6SMaya Erez 	{0x800000, 0x820000, 0xa00000, "fw_data", true, true},
183485790d0SMaya Erez 	/* periph. data RAM 96k */
1849a53d0b6SMaya Erez 	{0x840000, 0x858000, 0xa20000, "fw_peri", true, true},
185485790d0SMaya Erez 	/* various RGF 40k */
1869a53d0b6SMaya Erez 	{0x880000, 0x88a000, 0x880000, "rgf", true, true},
187485790d0SMaya Erez 	/* AGC table 4k */
1889a53d0b6SMaya Erez 	{0x88a000, 0x88b000, 0x88a000, "AGC_tbl", true, true},
189485790d0SMaya Erez 	/* Pcie_ext_rgf 4k */
1909a53d0b6SMaya Erez 	{0x88b000, 0x88c000, 0x88b000, "rgf_ext", true, true},
191485790d0SMaya Erez 	/* mac_ext_rgf 2256b */
1929a53d0b6SMaya Erez 	{0x88c000, 0x88c8d0, 0x88c000, "mac_rgf_ext", true, true},
193485790d0SMaya Erez 	/* ext USER RGF 4k */
1949a53d0b6SMaya Erez 	{0x88d000, 0x88e000, 0x88d000, "ext_user_rgf", true, true},
195485790d0SMaya Erez 	/* SEC PKA 16k */
1969a53d0b6SMaya Erez 	{0x890000, 0x894000, 0x890000, "sec_pka", true, true},
197485790d0SMaya Erez 	/* SEC KDF RGF 3096b */
1989a53d0b6SMaya Erez 	{0x898000, 0x898c18, 0x898000, "sec_kdf_rgf", true, true},
199485790d0SMaya Erez 	/* SEC MAIN 2124b */
2009a53d0b6SMaya Erez 	{0x89a000, 0x89a84c, 0x89a000, "sec_main", true, true},
201485790d0SMaya Erez 	/* OTP 4k */
2029a53d0b6SMaya Erez 	{0x8a0000, 0x8a1000, 0x8a0000, "otp", true, false},
203485790d0SMaya Erez 	/* DMA EXT RGF 64k */
2049a53d0b6SMaya Erez 	{0x8b0000, 0x8c0000, 0x8b0000, "dma_ext_rgf", true, true},
205485790d0SMaya Erez 	/* DUM USER RGF 528b */
2069a53d0b6SMaya Erez 	{0x8c0000, 0x8c0210, 0x8c0000, "dum_user_rgf", true, true},
207485790d0SMaya Erez 	/* DMA OFU 296b */
2089a53d0b6SMaya Erez 	{0x8c2000, 0x8c2128, 0x8c2000, "dma_ofu", true, true},
209485790d0SMaya Erez 	/* ucode debug 4k */
2109a53d0b6SMaya Erez 	{0x8c3000, 0x8c4000, 0x8c3000, "ucode_debug", true, true},
211485790d0SMaya Erez 	/* upper area 1536k */
2129a53d0b6SMaya Erez 	{0x900000, 0xa80000, 0x900000, "upper", true, true},
213485790d0SMaya Erez 	/* UCODE areas - accessible by debugfs blobs but not by
214485790d0SMaya Erez 	 * wmi_addr_remap. UCODE areas MUST be added AFTER FW areas!
215485790d0SMaya Erez 	 */
216485790d0SMaya Erez 	/* ucode code RAM 256k */
2179a53d0b6SMaya Erez 	{0x000000, 0x040000, 0xa38000, "uc_code", false, false},
218485790d0SMaya Erez 	/* ucode data RAM 32k */
2199a53d0b6SMaya Erez 	{0x800000, 0x808000, 0xa78000, "uc_data", false, false},
220485790d0SMaya Erez };
221485790d0SMaya Erez 
2224276d771SMaya Erez struct fw_map fw_mapping[MAX_FW_MAPPING_TABLE_SIZE];
2234276d771SMaya Erez 
22410d599adSMaya Erez struct blink_on_off_time led_blink_time[] = {
22510d599adSMaya Erez 	{WIL_LED_BLINK_ON_SLOW_MS, WIL_LED_BLINK_OFF_SLOW_MS},
22610d599adSMaya Erez 	{WIL_LED_BLINK_ON_MED_MS, WIL_LED_BLINK_OFF_MED_MS},
22710d599adSMaya Erez 	{WIL_LED_BLINK_ON_FAST_MS, WIL_LED_BLINK_OFF_FAST_MS},
22810d599adSMaya Erez };
22910d599adSMaya Erez 
23010d599adSMaya Erez u8 led_polarity = LED_POLARITY_LOW_ACTIVE;
23110d599adSMaya Erez 
2322be7d22fSVladimir Kondratiev /**
23361578820SLior David  * return AHB address for given firmware internal (linker) address
2342be7d22fSVladimir Kondratiev  * @x - internal address
2352be7d22fSVladimir Kondratiev  * If address have no valid AHB mapping, return 0
2362be7d22fSVladimir Kondratiev  */
2372be7d22fSVladimir Kondratiev static u32 wmi_addr_remap(u32 x)
2382be7d22fSVladimir Kondratiev {
2392be7d22fSVladimir Kondratiev 	uint i;
2402be7d22fSVladimir Kondratiev 
2412be7d22fSVladimir Kondratiev 	for (i = 0; i < ARRAY_SIZE(fw_mapping); i++) {
24261578820SLior David 		if (fw_mapping[i].fw &&
24361578820SLior David 		    ((x >= fw_mapping[i].from) && (x < fw_mapping[i].to)))
2442be7d22fSVladimir Kondratiev 			return x + fw_mapping[i].host - fw_mapping[i].from;
2452be7d22fSVladimir Kondratiev 	}
2462be7d22fSVladimir Kondratiev 
2472be7d22fSVladimir Kondratiev 	return 0;
2482be7d22fSVladimir Kondratiev }
2492be7d22fSVladimir Kondratiev 
2502be7d22fSVladimir Kondratiev /**
25170bcc658SLior David  * find fw_mapping entry by section name
25270bcc658SLior David  * @section - section name
25370bcc658SLior David  *
25470bcc658SLior David  * Return pointer to section or NULL if not found
25570bcc658SLior David  */
25670bcc658SLior David struct fw_map *wil_find_fw_mapping(const char *section)
25770bcc658SLior David {
25870bcc658SLior David 	int i;
25970bcc658SLior David 
26070bcc658SLior David 	for (i = 0; i < ARRAY_SIZE(fw_mapping); i++)
26170bcc658SLior David 		if (fw_mapping[i].name &&
26270bcc658SLior David 		    !strcmp(section, fw_mapping[i].name))
26370bcc658SLior David 			return &fw_mapping[i];
26470bcc658SLior David 
26570bcc658SLior David 	return NULL;
26670bcc658SLior David }
26770bcc658SLior David 
26870bcc658SLior David /**
2692be7d22fSVladimir Kondratiev  * Check address validity for WMI buffer; remap if needed
2702be7d22fSVladimir Kondratiev  * @ptr - internal (linker) fw/ucode address
271705d2fdeSLior David  * @size - if non zero, validate the block does not
272705d2fdeSLior David  *  exceed the device memory (bar)
2732be7d22fSVladimir Kondratiev  *
2742be7d22fSVladimir Kondratiev  * Valid buffer should be DWORD aligned
2752be7d22fSVladimir Kondratiev  *
2762be7d22fSVladimir Kondratiev  * return address for accessing buffer from the host;
2772be7d22fSVladimir Kondratiev  * if buffer is not valid, return NULL.
2782be7d22fSVladimir Kondratiev  */
279705d2fdeSLior David void __iomem *wmi_buffer_block(struct wil6210_priv *wil, __le32 ptr_, u32 size)
2802be7d22fSVladimir Kondratiev {
2812be7d22fSVladimir Kondratiev 	u32 off;
2822be7d22fSVladimir Kondratiev 	u32 ptr = le32_to_cpu(ptr_);
2832be7d22fSVladimir Kondratiev 
2842be7d22fSVladimir Kondratiev 	if (ptr % 4)
2852be7d22fSVladimir Kondratiev 		return NULL;
2862be7d22fSVladimir Kondratiev 
2872be7d22fSVladimir Kondratiev 	ptr = wmi_addr_remap(ptr);
2882be7d22fSVladimir Kondratiev 	if (ptr < WIL6210_FW_HOST_OFF)
2892be7d22fSVladimir Kondratiev 		return NULL;
2902be7d22fSVladimir Kondratiev 
2912be7d22fSVladimir Kondratiev 	off = HOSTADDR(ptr);
292d86d4716SMaya Erez 	if (off > wil->bar_size - 4)
2932be7d22fSVladimir Kondratiev 		return NULL;
294705d2fdeSLior David 	if (size && ((off + size > wil->bar_size) || (off + size < off)))
295705d2fdeSLior David 		return NULL;
2962be7d22fSVladimir Kondratiev 
2972be7d22fSVladimir Kondratiev 	return wil->csr + off;
2982be7d22fSVladimir Kondratiev }
2992be7d22fSVladimir Kondratiev 
300705d2fdeSLior David void __iomem *wmi_buffer(struct wil6210_priv *wil, __le32 ptr_)
301705d2fdeSLior David {
302705d2fdeSLior David 	return wmi_buffer_block(wil, ptr_, 0);
303705d2fdeSLior David }
304705d2fdeSLior David 
3052be7d22fSVladimir Kondratiev /**
3062be7d22fSVladimir Kondratiev  * Check address validity
3072be7d22fSVladimir Kondratiev  */
3082be7d22fSVladimir Kondratiev void __iomem *wmi_addr(struct wil6210_priv *wil, u32 ptr)
3092be7d22fSVladimir Kondratiev {
3102be7d22fSVladimir Kondratiev 	u32 off;
3112be7d22fSVladimir Kondratiev 
3122be7d22fSVladimir Kondratiev 	if (ptr % 4)
3132be7d22fSVladimir Kondratiev 		return NULL;
3142be7d22fSVladimir Kondratiev 
3152be7d22fSVladimir Kondratiev 	if (ptr < WIL6210_FW_HOST_OFF)
3162be7d22fSVladimir Kondratiev 		return NULL;
3172be7d22fSVladimir Kondratiev 
3182be7d22fSVladimir Kondratiev 	off = HOSTADDR(ptr);
319d86d4716SMaya Erez 	if (off > wil->bar_size - 4)
3202be7d22fSVladimir Kondratiev 		return NULL;
3212be7d22fSVladimir Kondratiev 
3222be7d22fSVladimir Kondratiev 	return wil->csr + off;
3232be7d22fSVladimir Kondratiev }
3242be7d22fSVladimir Kondratiev 
3252be7d22fSVladimir Kondratiev int wmi_read_hdr(struct wil6210_priv *wil, __le32 ptr,
3262be7d22fSVladimir Kondratiev 		 struct wil6210_mbox_hdr *hdr)
3272be7d22fSVladimir Kondratiev {
3282be7d22fSVladimir Kondratiev 	void __iomem *src = wmi_buffer(wil, ptr);
3298fe59627SVladimir Kondratiev 
3302be7d22fSVladimir Kondratiev 	if (!src)
3312be7d22fSVladimir Kondratiev 		return -EINVAL;
3322be7d22fSVladimir Kondratiev 
3332be7d22fSVladimir Kondratiev 	wil_memcpy_fromio_32(hdr, src, sizeof(*hdr));
3342be7d22fSVladimir Kondratiev 
3352be7d22fSVladimir Kondratiev 	return 0;
3362be7d22fSVladimir Kondratiev }
3372be7d22fSVladimir Kondratiev 
3385fad7241SDedy Lansky static const char *cmdid2name(u16 cmdid)
3395fad7241SDedy Lansky {
3405fad7241SDedy Lansky 	switch (cmdid) {
3415fad7241SDedy Lansky 	case WMI_NOTIFY_REQ_CMDID:
3425fad7241SDedy Lansky 		return "WMI_NOTIFY_REQ_CMD";
3435fad7241SDedy Lansky 	case WMI_START_SCAN_CMDID:
3445fad7241SDedy Lansky 		return "WMI_START_SCAN_CMD";
3455fad7241SDedy Lansky 	case WMI_CONNECT_CMDID:
3465fad7241SDedy Lansky 		return "WMI_CONNECT_CMD";
3475fad7241SDedy Lansky 	case WMI_DISCONNECT_CMDID:
3485fad7241SDedy Lansky 		return "WMI_DISCONNECT_CMD";
3495fad7241SDedy Lansky 	case WMI_SW_TX_REQ_CMDID:
3505fad7241SDedy Lansky 		return "WMI_SW_TX_REQ_CMD";
3515fad7241SDedy Lansky 	case WMI_GET_RF_SECTOR_PARAMS_CMDID:
3525fad7241SDedy Lansky 		return "WMI_GET_RF_SECTOR_PARAMS_CMD";
3535fad7241SDedy Lansky 	case WMI_SET_RF_SECTOR_PARAMS_CMDID:
3545fad7241SDedy Lansky 		return "WMI_SET_RF_SECTOR_PARAMS_CMD";
3555fad7241SDedy Lansky 	case WMI_GET_SELECTED_RF_SECTOR_INDEX_CMDID:
3565fad7241SDedy Lansky 		return "WMI_GET_SELECTED_RF_SECTOR_INDEX_CMD";
3575fad7241SDedy Lansky 	case WMI_SET_SELECTED_RF_SECTOR_INDEX_CMDID:
3585fad7241SDedy Lansky 		return "WMI_SET_SELECTED_RF_SECTOR_INDEX_CMD";
3595fad7241SDedy Lansky 	case WMI_BRP_SET_ANT_LIMIT_CMDID:
3605fad7241SDedy Lansky 		return "WMI_BRP_SET_ANT_LIMIT_CMD";
3615fad7241SDedy Lansky 	case WMI_TOF_SESSION_START_CMDID:
3625fad7241SDedy Lansky 		return "WMI_TOF_SESSION_START_CMD";
3635fad7241SDedy Lansky 	case WMI_AOA_MEAS_CMDID:
3645fad7241SDedy Lansky 		return "WMI_AOA_MEAS_CMD";
3655fad7241SDedy Lansky 	case WMI_PMC_CMDID:
3665fad7241SDedy Lansky 		return "WMI_PMC_CMD";
3675fad7241SDedy Lansky 	case WMI_TOF_GET_TX_RX_OFFSET_CMDID:
3685fad7241SDedy Lansky 		return "WMI_TOF_GET_TX_RX_OFFSET_CMD";
3695fad7241SDedy Lansky 	case WMI_TOF_SET_TX_RX_OFFSET_CMDID:
3705fad7241SDedy Lansky 		return "WMI_TOF_SET_TX_RX_OFFSET_CMD";
3715fad7241SDedy Lansky 	case WMI_VRING_CFG_CMDID:
3725fad7241SDedy Lansky 		return "WMI_VRING_CFG_CMD";
3735fad7241SDedy Lansky 	case WMI_BCAST_VRING_CFG_CMDID:
3745fad7241SDedy Lansky 		return "WMI_BCAST_VRING_CFG_CMD";
3755fad7241SDedy Lansky 	case WMI_TRAFFIC_SUSPEND_CMDID:
3765fad7241SDedy Lansky 		return "WMI_TRAFFIC_SUSPEND_CMD";
3775fad7241SDedy Lansky 	case WMI_TRAFFIC_RESUME_CMDID:
3785fad7241SDedy Lansky 		return "WMI_TRAFFIC_RESUME_CMD";
3795fad7241SDedy Lansky 	case WMI_ECHO_CMDID:
3805fad7241SDedy Lansky 		return "WMI_ECHO_CMD";
3815fad7241SDedy Lansky 	case WMI_SET_MAC_ADDRESS_CMDID:
3825fad7241SDedy Lansky 		return "WMI_SET_MAC_ADDRESS_CMD";
3835fad7241SDedy Lansky 	case WMI_LED_CFG_CMDID:
3845fad7241SDedy Lansky 		return "WMI_LED_CFG_CMD";
3855fad7241SDedy Lansky 	case WMI_PCP_START_CMDID:
3865fad7241SDedy Lansky 		return "WMI_PCP_START_CMD";
3875fad7241SDedy Lansky 	case WMI_PCP_STOP_CMDID:
3885fad7241SDedy Lansky 		return "WMI_PCP_STOP_CMD";
3895fad7241SDedy Lansky 	case WMI_SET_SSID_CMDID:
3905fad7241SDedy Lansky 		return "WMI_SET_SSID_CMD";
3915fad7241SDedy Lansky 	case WMI_GET_SSID_CMDID:
3925fad7241SDedy Lansky 		return "WMI_GET_SSID_CMD";
3935fad7241SDedy Lansky 	case WMI_SET_PCP_CHANNEL_CMDID:
3945fad7241SDedy Lansky 		return "WMI_SET_PCP_CHANNEL_CMD";
3955fad7241SDedy Lansky 	case WMI_GET_PCP_CHANNEL_CMDID:
3965fad7241SDedy Lansky 		return "WMI_GET_PCP_CHANNEL_CMD";
3975fad7241SDedy Lansky 	case WMI_P2P_CFG_CMDID:
3985fad7241SDedy Lansky 		return "WMI_P2P_CFG_CMD";
3993ada9314SLior David 	case WMI_PORT_ALLOCATE_CMDID:
4003ada9314SLior David 		return "WMI_PORT_ALLOCATE_CMD";
4013ada9314SLior David 	case WMI_PORT_DELETE_CMDID:
4023ada9314SLior David 		return "WMI_PORT_DELETE_CMD";
4035fad7241SDedy Lansky 	case WMI_START_LISTEN_CMDID:
4045fad7241SDedy Lansky 		return "WMI_START_LISTEN_CMD";
4055fad7241SDedy Lansky 	case WMI_START_SEARCH_CMDID:
4065fad7241SDedy Lansky 		return "WMI_START_SEARCH_CMD";
4075fad7241SDedy Lansky 	case WMI_DISCOVERY_STOP_CMDID:
4085fad7241SDedy Lansky 		return "WMI_DISCOVERY_STOP_CMD";
4095fad7241SDedy Lansky 	case WMI_DELETE_CIPHER_KEY_CMDID:
4105fad7241SDedy Lansky 		return "WMI_DELETE_CIPHER_KEY_CMD";
4115fad7241SDedy Lansky 	case WMI_ADD_CIPHER_KEY_CMDID:
4125fad7241SDedy Lansky 		return "WMI_ADD_CIPHER_KEY_CMD";
4135fad7241SDedy Lansky 	case WMI_SET_APPIE_CMDID:
4145fad7241SDedy Lansky 		return "WMI_SET_APPIE_CMD";
4155fad7241SDedy Lansky 	case WMI_CFG_RX_CHAIN_CMDID:
4165fad7241SDedy Lansky 		return "WMI_CFG_RX_CHAIN_CMD";
4175fad7241SDedy Lansky 	case WMI_TEMP_SENSE_CMDID:
4185fad7241SDedy Lansky 		return "WMI_TEMP_SENSE_CMD";
4195fad7241SDedy Lansky 	case WMI_DEL_STA_CMDID:
4205fad7241SDedy Lansky 		return "WMI_DEL_STA_CMD";
4215fad7241SDedy Lansky 	case WMI_DISCONNECT_STA_CMDID:
4225fad7241SDedy Lansky 		return "WMI_DISCONNECT_STA_CMD";
42396c93589SGidon Studinski 	case WMI_RING_BA_EN_CMDID:
42496c93589SGidon Studinski 		return "WMI_RING_BA_EN_CMD";
42596c93589SGidon Studinski 	case WMI_RING_BA_DIS_CMDID:
42696c93589SGidon Studinski 		return "WMI_RING_BA_DIS_CMD";
4275fad7241SDedy Lansky 	case WMI_RCP_DELBA_CMDID:
4285fad7241SDedy Lansky 		return "WMI_RCP_DELBA_CMD";
4295fad7241SDedy Lansky 	case WMI_RCP_ADDBA_RESP_CMDID:
4305fad7241SDedy Lansky 		return "WMI_RCP_ADDBA_RESP_CMD";
4317be13fc3SGidon Studinski 	case WMI_RCP_ADDBA_RESP_EDMA_CMDID:
4327be13fc3SGidon Studinski 		return "WMI_RCP_ADDBA_RESP_EDMA_CMD";
4335fad7241SDedy Lansky 	case WMI_PS_DEV_PROFILE_CFG_CMDID:
4345fad7241SDedy Lansky 		return "WMI_PS_DEV_PROFILE_CFG_CMD";
4355fad7241SDedy Lansky 	case WMI_SET_MGMT_RETRY_LIMIT_CMDID:
4365fad7241SDedy Lansky 		return "WMI_SET_MGMT_RETRY_LIMIT_CMD";
4375fad7241SDedy Lansky 	case WMI_GET_MGMT_RETRY_LIMIT_CMDID:
4385fad7241SDedy Lansky 		return "WMI_GET_MGMT_RETRY_LIMIT_CMD";
4395fad7241SDedy Lansky 	case WMI_ABORT_SCAN_CMDID:
4405fad7241SDedy Lansky 		return "WMI_ABORT_SCAN_CMD";
4415fad7241SDedy Lansky 	case WMI_NEW_STA_CMDID:
4425fad7241SDedy Lansky 		return "WMI_NEW_STA_CMD";
4435fad7241SDedy Lansky 	case WMI_SET_THERMAL_THROTTLING_CFG_CMDID:
4445fad7241SDedy Lansky 		return "WMI_SET_THERMAL_THROTTLING_CFG_CMD";
4455fad7241SDedy Lansky 	case WMI_GET_THERMAL_THROTTLING_CFG_CMDID:
4465fad7241SDedy Lansky 		return "WMI_GET_THERMAL_THROTTLING_CFG_CMD";
4475fad7241SDedy Lansky 	case WMI_LINK_MAINTAIN_CFG_WRITE_CMDID:
4485fad7241SDedy Lansky 		return "WMI_LINK_MAINTAIN_CFG_WRITE_CMD";
4495fad7241SDedy Lansky 	case WMI_LO_POWER_CALIB_FROM_OTP_CMDID:
4505fad7241SDedy Lansky 		return "WMI_LO_POWER_CALIB_FROM_OTP_CMD";
451a5dc6883SDedy Lansky 	case WMI_START_SCHED_SCAN_CMDID:
452a5dc6883SDedy Lansky 		return "WMI_START_SCHED_SCAN_CMD";
453a5dc6883SDedy Lansky 	case WMI_STOP_SCHED_SCAN_CMDID:
454a5dc6883SDedy Lansky 		return "WMI_STOP_SCHED_SCAN_CMD";
45596c93589SGidon Studinski 	case WMI_TX_STATUS_RING_ADD_CMDID:
45696c93589SGidon Studinski 		return "WMI_TX_STATUS_RING_ADD_CMD";
45796c93589SGidon Studinski 	case WMI_RX_STATUS_RING_ADD_CMDID:
45896c93589SGidon Studinski 		return "WMI_RX_STATUS_RING_ADD_CMD";
45996c93589SGidon Studinski 	case WMI_TX_DESC_RING_ADD_CMDID:
46096c93589SGidon Studinski 		return "WMI_TX_DESC_RING_ADD_CMD";
46196c93589SGidon Studinski 	case WMI_RX_DESC_RING_ADD_CMDID:
46296c93589SGidon Studinski 		return "WMI_RX_DESC_RING_ADD_CMD";
46396c93589SGidon Studinski 	case WMI_BCAST_DESC_RING_ADD_CMDID:
46496c93589SGidon Studinski 		return "WMI_BCAST_DESC_RING_ADD_CMD";
46596c93589SGidon Studinski 	case WMI_CFG_DEF_RX_OFFLOAD_CMDID:
46696c93589SGidon Studinski 		return "WMI_CFG_DEF_RX_OFFLOAD_CMD";
4670c936b3cSDedy Lansky 	case WMI_LINK_STATS_CMDID:
4680c936b3cSDedy Lansky 		return "WMI_LINK_STATS_CMD";
469b698e2dfSAhmad Masri 	case WMI_SW_TX_REQ_EXT_CMDID:
470b698e2dfSAhmad Masri 		return "WMI_SW_TX_REQ_EXT_CMDID";
4715fad7241SDedy Lansky 	default:
4725fad7241SDedy Lansky 		return "Untracked CMD";
4735fad7241SDedy Lansky 	}
4745fad7241SDedy Lansky }
4755fad7241SDedy Lansky 
4765fad7241SDedy Lansky static const char *eventid2name(u16 eventid)
4775fad7241SDedy Lansky {
4785fad7241SDedy Lansky 	switch (eventid) {
4795fad7241SDedy Lansky 	case WMI_NOTIFY_REQ_DONE_EVENTID:
4805fad7241SDedy Lansky 		return "WMI_NOTIFY_REQ_DONE_EVENT";
4815fad7241SDedy Lansky 	case WMI_DISCONNECT_EVENTID:
4825fad7241SDedy Lansky 		return "WMI_DISCONNECT_EVENT";
4835fad7241SDedy Lansky 	case WMI_SW_TX_COMPLETE_EVENTID:
4845fad7241SDedy Lansky 		return "WMI_SW_TX_COMPLETE_EVENT";
4855fad7241SDedy Lansky 	case WMI_GET_RF_SECTOR_PARAMS_DONE_EVENTID:
4865fad7241SDedy Lansky 		return "WMI_GET_RF_SECTOR_PARAMS_DONE_EVENT";
4875fad7241SDedy Lansky 	case WMI_SET_RF_SECTOR_PARAMS_DONE_EVENTID:
4885fad7241SDedy Lansky 		return "WMI_SET_RF_SECTOR_PARAMS_DONE_EVENT";
4895fad7241SDedy Lansky 	case WMI_GET_SELECTED_RF_SECTOR_INDEX_DONE_EVENTID:
4905fad7241SDedy Lansky 		return "WMI_GET_SELECTED_RF_SECTOR_INDEX_DONE_EVENT";
4915fad7241SDedy Lansky 	case WMI_SET_SELECTED_RF_SECTOR_INDEX_DONE_EVENTID:
4925fad7241SDedy Lansky 		return "WMI_SET_SELECTED_RF_SECTOR_INDEX_DONE_EVENT";
4935fad7241SDedy Lansky 	case WMI_BRP_SET_ANT_LIMIT_EVENTID:
4945fad7241SDedy Lansky 		return "WMI_BRP_SET_ANT_LIMIT_EVENT";
4955fad7241SDedy Lansky 	case WMI_FW_READY_EVENTID:
4965fad7241SDedy Lansky 		return "WMI_FW_READY_EVENT";
4975fad7241SDedy Lansky 	case WMI_TRAFFIC_RESUME_EVENTID:
4985fad7241SDedy Lansky 		return "WMI_TRAFFIC_RESUME_EVENT";
4995fad7241SDedy Lansky 	case WMI_TOF_GET_TX_RX_OFFSET_EVENTID:
5005fad7241SDedy Lansky 		return "WMI_TOF_GET_TX_RX_OFFSET_EVENT";
5015fad7241SDedy Lansky 	case WMI_TOF_SET_TX_RX_OFFSET_EVENTID:
5025fad7241SDedy Lansky 		return "WMI_TOF_SET_TX_RX_OFFSET_EVENT";
5035fad7241SDedy Lansky 	case WMI_VRING_CFG_DONE_EVENTID:
5045fad7241SDedy Lansky 		return "WMI_VRING_CFG_DONE_EVENT";
5055fad7241SDedy Lansky 	case WMI_READY_EVENTID:
5065fad7241SDedy Lansky 		return "WMI_READY_EVENT";
5075fad7241SDedy Lansky 	case WMI_RX_MGMT_PACKET_EVENTID:
5085fad7241SDedy Lansky 		return "WMI_RX_MGMT_PACKET_EVENT";
5095fad7241SDedy Lansky 	case WMI_TX_MGMT_PACKET_EVENTID:
5105fad7241SDedy Lansky 		return "WMI_TX_MGMT_PACKET_EVENT";
5115fad7241SDedy Lansky 	case WMI_SCAN_COMPLETE_EVENTID:
5125fad7241SDedy Lansky 		return "WMI_SCAN_COMPLETE_EVENT";
5135fad7241SDedy Lansky 	case WMI_ACS_PASSIVE_SCAN_COMPLETE_EVENTID:
5145fad7241SDedy Lansky 		return "WMI_ACS_PASSIVE_SCAN_COMPLETE_EVENT";
5155fad7241SDedy Lansky 	case WMI_CONNECT_EVENTID:
5165fad7241SDedy Lansky 		return "WMI_CONNECT_EVENT";
5175fad7241SDedy Lansky 	case WMI_EAPOL_RX_EVENTID:
5185fad7241SDedy Lansky 		return "WMI_EAPOL_RX_EVENT";
5195fad7241SDedy Lansky 	case WMI_BA_STATUS_EVENTID:
5205fad7241SDedy Lansky 		return "WMI_BA_STATUS_EVENT";
5215fad7241SDedy Lansky 	case WMI_RCP_ADDBA_REQ_EVENTID:
5225fad7241SDedy Lansky 		return "WMI_RCP_ADDBA_REQ_EVENT";
5235fad7241SDedy Lansky 	case WMI_DELBA_EVENTID:
5245fad7241SDedy Lansky 		return "WMI_DELBA_EVENT";
52596c93589SGidon Studinski 	case WMI_RING_EN_EVENTID:
52696c93589SGidon Studinski 		return "WMI_RING_EN_EVENT";
5275fad7241SDedy Lansky 	case WMI_DATA_PORT_OPEN_EVENTID:
5285fad7241SDedy Lansky 		return "WMI_DATA_PORT_OPEN_EVENT";
5295fad7241SDedy Lansky 	case WMI_AOA_MEAS_EVENTID:
5305fad7241SDedy Lansky 		return "WMI_AOA_MEAS_EVENT";
5315fad7241SDedy Lansky 	case WMI_TOF_SESSION_END_EVENTID:
5325fad7241SDedy Lansky 		return "WMI_TOF_SESSION_END_EVENT";
5335fad7241SDedy Lansky 	case WMI_TOF_GET_CAPABILITIES_EVENTID:
5345fad7241SDedy Lansky 		return "WMI_TOF_GET_CAPABILITIES_EVENT";
5355fad7241SDedy Lansky 	case WMI_TOF_SET_LCR_EVENTID:
5365fad7241SDedy Lansky 		return "WMI_TOF_SET_LCR_EVENT";
5375fad7241SDedy Lansky 	case WMI_TOF_SET_LCI_EVENTID:
5385fad7241SDedy Lansky 		return "WMI_TOF_SET_LCI_EVENT";
5395fad7241SDedy Lansky 	case WMI_TOF_FTM_PER_DEST_RES_EVENTID:
5405fad7241SDedy Lansky 		return "WMI_TOF_FTM_PER_DEST_RES_EVENT";
5415fad7241SDedy Lansky 	case WMI_TOF_CHANNEL_INFO_EVENTID:
5425fad7241SDedy Lansky 		return "WMI_TOF_CHANNEL_INFO_EVENT";
5435fad7241SDedy Lansky 	case WMI_TRAFFIC_SUSPEND_EVENTID:
5445fad7241SDedy Lansky 		return "WMI_TRAFFIC_SUSPEND_EVENT";
5455fad7241SDedy Lansky 	case WMI_ECHO_RSP_EVENTID:
5465fad7241SDedy Lansky 		return "WMI_ECHO_RSP_EVENT";
5475fad7241SDedy Lansky 	case WMI_LED_CFG_DONE_EVENTID:
5485fad7241SDedy Lansky 		return "WMI_LED_CFG_DONE_EVENT";
5495fad7241SDedy Lansky 	case WMI_PCP_STARTED_EVENTID:
5505fad7241SDedy Lansky 		return "WMI_PCP_STARTED_EVENT";
5515fad7241SDedy Lansky 	case WMI_PCP_STOPPED_EVENTID:
5525fad7241SDedy Lansky 		return "WMI_PCP_STOPPED_EVENT";
5535fad7241SDedy Lansky 	case WMI_GET_SSID_EVENTID:
5545fad7241SDedy Lansky 		return "WMI_GET_SSID_EVENT";
5555fad7241SDedy Lansky 	case WMI_GET_PCP_CHANNEL_EVENTID:
5565fad7241SDedy Lansky 		return "WMI_GET_PCP_CHANNEL_EVENT";
5575fad7241SDedy Lansky 	case WMI_P2P_CFG_DONE_EVENTID:
5585fad7241SDedy Lansky 		return "WMI_P2P_CFG_DONE_EVENT";
5593ada9314SLior David 	case WMI_PORT_ALLOCATED_EVENTID:
5603ada9314SLior David 		return "WMI_PORT_ALLOCATED_EVENT";
5613ada9314SLior David 	case WMI_PORT_DELETED_EVENTID:
5623ada9314SLior David 		return "WMI_PORT_DELETED_EVENT";
5635fad7241SDedy Lansky 	case WMI_LISTEN_STARTED_EVENTID:
5645fad7241SDedy Lansky 		return "WMI_LISTEN_STARTED_EVENT";
5655fad7241SDedy Lansky 	case WMI_SEARCH_STARTED_EVENTID:
5665fad7241SDedy Lansky 		return "WMI_SEARCH_STARTED_EVENT";
5675fad7241SDedy Lansky 	case WMI_DISCOVERY_STOPPED_EVENTID:
5685fad7241SDedy Lansky 		return "WMI_DISCOVERY_STOPPED_EVENT";
5695fad7241SDedy Lansky 	case WMI_CFG_RX_CHAIN_DONE_EVENTID:
5705fad7241SDedy Lansky 		return "WMI_CFG_RX_CHAIN_DONE_EVENT";
5715fad7241SDedy Lansky 	case WMI_TEMP_SENSE_DONE_EVENTID:
5725fad7241SDedy Lansky 		return "WMI_TEMP_SENSE_DONE_EVENT";
5735fad7241SDedy Lansky 	case WMI_RCP_ADDBA_RESP_SENT_EVENTID:
5745fad7241SDedy Lansky 		return "WMI_RCP_ADDBA_RESP_SENT_EVENT";
5755fad7241SDedy Lansky 	case WMI_PS_DEV_PROFILE_CFG_EVENTID:
5765fad7241SDedy Lansky 		return "WMI_PS_DEV_PROFILE_CFG_EVENT";
5775fad7241SDedy Lansky 	case WMI_SET_MGMT_RETRY_LIMIT_EVENTID:
5785fad7241SDedy Lansky 		return "WMI_SET_MGMT_RETRY_LIMIT_EVENT";
5795fad7241SDedy Lansky 	case WMI_GET_MGMT_RETRY_LIMIT_EVENTID:
5805fad7241SDedy Lansky 		return "WMI_GET_MGMT_RETRY_LIMIT_EVENT";
5815fad7241SDedy Lansky 	case WMI_SET_THERMAL_THROTTLING_CFG_EVENTID:
5825fad7241SDedy Lansky 		return "WMI_SET_THERMAL_THROTTLING_CFG_EVENT";
5835fad7241SDedy Lansky 	case WMI_GET_THERMAL_THROTTLING_CFG_EVENTID:
5845fad7241SDedy Lansky 		return "WMI_GET_THERMAL_THROTTLING_CFG_EVENT";
5855fad7241SDedy Lansky 	case WMI_LINK_MAINTAIN_CFG_WRITE_DONE_EVENTID:
5865fad7241SDedy Lansky 		return "WMI_LINK_MAINTAIN_CFG_WRITE_DONE_EVENT";
5875fad7241SDedy Lansky 	case WMI_LO_POWER_CALIB_FROM_OTP_EVENTID:
5885fad7241SDedy Lansky 		return "WMI_LO_POWER_CALIB_FROM_OTP_EVENT";
589a5dc6883SDedy Lansky 	case WMI_START_SCHED_SCAN_EVENTID:
590a5dc6883SDedy Lansky 		return "WMI_START_SCHED_SCAN_EVENT";
591a5dc6883SDedy Lansky 	case WMI_STOP_SCHED_SCAN_EVENTID:
592a5dc6883SDedy Lansky 		return "WMI_STOP_SCHED_SCAN_EVENT";
593a5dc6883SDedy Lansky 	case WMI_SCHED_SCAN_RESULT_EVENTID:
594a5dc6883SDedy Lansky 		return "WMI_SCHED_SCAN_RESULT_EVENT";
59596c93589SGidon Studinski 	case WMI_TX_STATUS_RING_CFG_DONE_EVENTID:
59696c93589SGidon Studinski 		return "WMI_TX_STATUS_RING_CFG_DONE_EVENT";
59796c93589SGidon Studinski 	case WMI_RX_STATUS_RING_CFG_DONE_EVENTID:
59896c93589SGidon Studinski 		return "WMI_RX_STATUS_RING_CFG_DONE_EVENT";
59996c93589SGidon Studinski 	case WMI_TX_DESC_RING_CFG_DONE_EVENTID:
60096c93589SGidon Studinski 		return "WMI_TX_DESC_RING_CFG_DONE_EVENT";
60196c93589SGidon Studinski 	case WMI_RX_DESC_RING_CFG_DONE_EVENTID:
60296c93589SGidon Studinski 		return "WMI_RX_DESC_RING_CFG_DONE_EVENT";
60396c93589SGidon Studinski 	case WMI_CFG_DEF_RX_OFFLOAD_DONE_EVENTID:
60496c93589SGidon Studinski 		return "WMI_CFG_DEF_RX_OFFLOAD_DONE_EVENT";
6050c936b3cSDedy Lansky 	case WMI_LINK_STATS_CONFIG_DONE_EVENTID:
6060c936b3cSDedy Lansky 		return "WMI_LINK_STATS_CONFIG_DONE_EVENT";
6070c936b3cSDedy Lansky 	case WMI_LINK_STATS_EVENTID:
6080c936b3cSDedy Lansky 		return "WMI_LINK_STATS_EVENT";
6095fad7241SDedy Lansky 	default:
6105fad7241SDedy Lansky 		return "Untracked EVENT";
6115fad7241SDedy Lansky 	}
6125fad7241SDedy Lansky }
6135fad7241SDedy Lansky 
614e00243faSLior David static int __wmi_send(struct wil6210_priv *wil, u16 cmdid, u8 mid,
615e00243faSLior David 		      void *buf, u16 len)
6162be7d22fSVladimir Kondratiev {
6172be7d22fSVladimir Kondratiev 	struct {
6182be7d22fSVladimir Kondratiev 		struct wil6210_mbox_hdr hdr;
619b874ddecSLior David 		struct wmi_cmd_hdr wmi;
6202be7d22fSVladimir Kondratiev 	} __packed cmd = {
6212be7d22fSVladimir Kondratiev 		.hdr = {
6222be7d22fSVladimir Kondratiev 			.type = WIL_MBOX_HDR_TYPE_WMI,
6232be7d22fSVladimir Kondratiev 			.flags = 0,
6242be7d22fSVladimir Kondratiev 			.len = cpu_to_le16(sizeof(cmd.wmi) + len),
6252be7d22fSVladimir Kondratiev 		},
6262be7d22fSVladimir Kondratiev 		.wmi = {
627e00243faSLior David 			.mid = mid,
628b874ddecSLior David 			.command_id = cpu_to_le16(cmdid),
6292be7d22fSVladimir Kondratiev 		},
6302be7d22fSVladimir Kondratiev 	};
6312be7d22fSVladimir Kondratiev 	struct wil6210_mbox_ring *r = &wil->mbox_ctl.tx;
6322be7d22fSVladimir Kondratiev 	struct wil6210_mbox_ring_desc d_head;
6332be7d22fSVladimir Kondratiev 	u32 next_head;
6342be7d22fSVladimir Kondratiev 	void __iomem *dst;
6352be7d22fSVladimir Kondratiev 	void __iomem *head = wmi_addr(wil, r->head);
6362be7d22fSVladimir Kondratiev 	uint retry;
637349214c1SMaya Erez 	int rc = 0;
6382be7d22fSVladimir Kondratiev 
63926a6d527SLior David 	if (len > r->entry_size - sizeof(cmd)) {
6402be7d22fSVladimir Kondratiev 		wil_err(wil, "WMI size too large: %d bytes, max is %d\n",
6412be7d22fSVladimir Kondratiev 			(int)(sizeof(cmd) + len), r->entry_size);
6422be7d22fSVladimir Kondratiev 		return -ERANGE;
6432be7d22fSVladimir Kondratiev 	}
6442be7d22fSVladimir Kondratiev 
6452be7d22fSVladimir Kondratiev 	might_sleep();
6462be7d22fSVladimir Kondratiev 
6479419b6a2SVladimir Kondratiev 	if (!test_bit(wil_status_fwready, wil->status)) {
64815e23124SVladimir Kondratiev 		wil_err(wil, "WMI: cannot send command while FW not ready\n");
6492be7d22fSVladimir Kondratiev 		return -EAGAIN;
6502be7d22fSVladimir Kondratiev 	}
6512be7d22fSVladimir Kondratiev 
652fe9ee51eSMaya Erez 	/* Allow sending only suspend / resume commands during susepnd flow */
653fe9ee51eSMaya Erez 	if ((test_bit(wil_status_suspending, wil->status) ||
654fe9ee51eSMaya Erez 	     test_bit(wil_status_suspended, wil->status) ||
655fe9ee51eSMaya Erez 	     test_bit(wil_status_resuming, wil->status)) &&
656fe9ee51eSMaya Erez 	     ((cmdid != WMI_TRAFFIC_SUSPEND_CMDID) &&
657fe9ee51eSMaya Erez 	      (cmdid != WMI_TRAFFIC_RESUME_CMDID))) {
658fe9ee51eSMaya Erez 		wil_err(wil, "WMI: reject send_command during suspend\n");
659fe9ee51eSMaya Erez 		return -EINVAL;
660fe9ee51eSMaya Erez 	}
661fe9ee51eSMaya Erez 
6622be7d22fSVladimir Kondratiev 	if (!head) {
6632be7d22fSVladimir Kondratiev 		wil_err(wil, "WMI head is garbage: 0x%08x\n", r->head);
6642be7d22fSVladimir Kondratiev 		return -EINVAL;
6652be7d22fSVladimir Kondratiev 	}
666349214c1SMaya Erez 
667349214c1SMaya Erez 	wil_halp_vote(wil);
668349214c1SMaya Erez 
6692be7d22fSVladimir Kondratiev 	/* read Tx head till it is not busy */
6702be7d22fSVladimir Kondratiev 	for (retry = 5; retry > 0; retry--) {
6712be7d22fSVladimir Kondratiev 		wil_memcpy_fromio_32(&d_head, head, sizeof(d_head));
6722be7d22fSVladimir Kondratiev 		if (d_head.sync == 0)
6732be7d22fSVladimir Kondratiev 			break;
6742be7d22fSVladimir Kondratiev 		msleep(20);
6752be7d22fSVladimir Kondratiev 	}
6762be7d22fSVladimir Kondratiev 	if (d_head.sync != 0) {
6772be7d22fSVladimir Kondratiev 		wil_err(wil, "WMI head busy\n");
678349214c1SMaya Erez 		rc = -EBUSY;
679349214c1SMaya Erez 		goto out;
6802be7d22fSVladimir Kondratiev 	}
6812be7d22fSVladimir Kondratiev 	/* next head */
6822be7d22fSVladimir Kondratiev 	next_head = r->base + ((r->head - r->base + sizeof(d_head)) % r->size);
6837743882dSVladimir Kondratiev 	wil_dbg_wmi(wil, "Head 0x%08x -> 0x%08x\n", r->head, next_head);
6842be7d22fSVladimir Kondratiev 	/* wait till FW finish with previous command */
6852be7d22fSVladimir Kondratiev 	for (retry = 5; retry > 0; retry--) {
686452133a7SMaya Erez 		if (!test_bit(wil_status_fwready, wil->status)) {
687452133a7SMaya Erez 			wil_err(wil, "WMI: cannot send command while FW not ready\n");
688349214c1SMaya Erez 			rc = -EAGAIN;
689349214c1SMaya Erez 			goto out;
690452133a7SMaya Erez 		}
691b9eeb512SVladimir Kondratiev 		r->tail = wil_r(wil, RGF_MBOX +
6922be7d22fSVladimir Kondratiev 				offsetof(struct wil6210_mbox_ctl, tx.tail));
6932be7d22fSVladimir Kondratiev 		if (next_head != r->tail)
6942be7d22fSVladimir Kondratiev 			break;
6952be7d22fSVladimir Kondratiev 		msleep(20);
6962be7d22fSVladimir Kondratiev 	}
6972be7d22fSVladimir Kondratiev 	if (next_head == r->tail) {
6982be7d22fSVladimir Kondratiev 		wil_err(wil, "WMI ring full\n");
699349214c1SMaya Erez 		rc = -EBUSY;
700349214c1SMaya Erez 		goto out;
7012be7d22fSVladimir Kondratiev 	}
7022be7d22fSVladimir Kondratiev 	dst = wmi_buffer(wil, d_head.addr);
7032be7d22fSVladimir Kondratiev 	if (!dst) {
7042be7d22fSVladimir Kondratiev 		wil_err(wil, "invalid WMI buffer: 0x%08x\n",
7052be7d22fSVladimir Kondratiev 			le32_to_cpu(d_head.addr));
706349214c1SMaya Erez 		rc = -EAGAIN;
707349214c1SMaya Erez 		goto out;
7082be7d22fSVladimir Kondratiev 	}
7092be7d22fSVladimir Kondratiev 	cmd.hdr.seq = cpu_to_le16(++wil->wmi_seq);
7102be7d22fSVladimir Kondratiev 	/* set command */
711e00243faSLior David 	wil_dbg_wmi(wil, "sending %s (0x%04x) [%d] mid %d\n",
712e00243faSLior David 		    cmdid2name(cmdid), cmdid, len, mid);
7137743882dSVladimir Kondratiev 	wil_hex_dump_wmi("Cmd ", DUMP_PREFIX_OFFSET, 16, 1, &cmd,
7142be7d22fSVladimir Kondratiev 			 sizeof(cmd), true);
7157743882dSVladimir Kondratiev 	wil_hex_dump_wmi("cmd ", DUMP_PREFIX_OFFSET, 16, 1, buf,
7162be7d22fSVladimir Kondratiev 			 len, true);
7172be7d22fSVladimir Kondratiev 	wil_memcpy_toio_32(dst, &cmd, sizeof(cmd));
7182be7d22fSVladimir Kondratiev 	wil_memcpy_toio_32(dst + sizeof(cmd), buf, len);
7192be7d22fSVladimir Kondratiev 	/* mark entry as full */
720b9eeb512SVladimir Kondratiev 	wil_w(wil, r->head + offsetof(struct wil6210_mbox_ring_desc, sync), 1);
7212be7d22fSVladimir Kondratiev 	/* advance next ptr */
722b9eeb512SVladimir Kondratiev 	wil_w(wil, RGF_MBOX + offsetof(struct wil6210_mbox_ctl, tx.head),
723b9eeb512SVladimir Kondratiev 	      r->head = next_head);
7242be7d22fSVladimir Kondratiev 
725f988b23fSVladimir Kondratiev 	trace_wil6210_wmi_cmd(&cmd.wmi, buf, len);
72698658095SVladimir Kondratiev 
7272be7d22fSVladimir Kondratiev 	/* interrupt to FW */
728b9eeb512SVladimir Kondratiev 	wil_w(wil, RGF_USER_USER_ICR + offsetof(struct RGF_ICR, ICS),
729b9eeb512SVladimir Kondratiev 	      SW_INT_MBOX);
7302be7d22fSVladimir Kondratiev 
731349214c1SMaya Erez out:
732349214c1SMaya Erez 	wil_halp_unvote(wil);
733349214c1SMaya Erez 	return rc;
7342be7d22fSVladimir Kondratiev }
7352be7d22fSVladimir Kondratiev 
736e00243faSLior David int wmi_send(struct wil6210_priv *wil, u16 cmdid, u8 mid, void *buf, u16 len)
7372be7d22fSVladimir Kondratiev {
7382be7d22fSVladimir Kondratiev 	int rc;
7392be7d22fSVladimir Kondratiev 
7402be7d22fSVladimir Kondratiev 	mutex_lock(&wil->wmi_mutex);
741e00243faSLior David 	rc = __wmi_send(wil, cmdid, mid, buf, len);
7422be7d22fSVladimir Kondratiev 	mutex_unlock(&wil->wmi_mutex);
7432be7d22fSVladimir Kondratiev 
7442be7d22fSVladimir Kondratiev 	return rc;
7452be7d22fSVladimir Kondratiev }
7462be7d22fSVladimir Kondratiev 
7472be7d22fSVladimir Kondratiev /*=== Event handlers ===*/
748e00243faSLior David static void wmi_evt_ready(struct wil6210_vif *vif, int id, void *d, int len)
7492be7d22fSVladimir Kondratiev {
750e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
751e00243faSLior David 	struct wiphy *wiphy = wil_to_wiphy(wil);
7522be7d22fSVladimir Kondratiev 	struct wmi_ready_event *evt = d;
7538fe59627SVladimir Kondratiev 
75413cd9f75SLior David 	wil_info(wil, "FW ver. %s(SW %d); MAC %pM; %d MID's\n",
75513cd9f75SLior David 		 wil->fw_version, le32_to_cpu(evt->sw_version),
7564aebd3bdSLior David 		 evt->mac, evt->numof_additional_mids);
7574aebd3bdSLior David 	if (evt->numof_additional_mids + 1 < wil->max_vifs) {
7584aebd3bdSLior David 		wil_err(wil, "FW does not support enough MIDs (need %d)",
7594aebd3bdSLior David 			wil->max_vifs - 1);
7604aebd3bdSLior David 		return; /* FW load will fail after timeout */
7614aebd3bdSLior David 	}
7622cd0f021SVladimir Kondratiev 	/* ignore MAC address, we already have it from the boot loader */
763e00243faSLior David 	strlcpy(wiphy->fw_version, wil->fw_version, sizeof(wiphy->fw_version));
7642be7d22fSVladimir Kondratiev 
765eb4c0215SDedy Lansky 	if (len > offsetof(struct wmi_ready_event, rfc_read_calib_result)) {
766eb4c0215SDedy Lansky 		wil_dbg_wmi(wil, "rfc calibration result %d\n",
767eb4c0215SDedy Lansky 			    evt->rfc_read_calib_result);
768eb4c0215SDedy Lansky 		wil->fw_calib_result = evt->rfc_read_calib_result;
769eb4c0215SDedy Lansky 	}
770c33407a8SVladimir Kondratiev 	wil_set_recovery_state(wil, fw_recovery_idle);
7719419b6a2SVladimir Kondratiev 	set_bit(wil_status_fwready, wil->status);
77259502647SDedy Lansky 	/* let the reset sequence continue */
7732be7d22fSVladimir Kondratiev 	complete(&wil->wmi_ready);
7742be7d22fSVladimir Kondratiev }
7752be7d22fSVladimir Kondratiev 
776e00243faSLior David static void wmi_evt_rx_mgmt(struct wil6210_vif *vif, int id, void *d, int len)
7772be7d22fSVladimir Kondratiev {
778e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
7792be7d22fSVladimir Kondratiev 	struct wmi_rx_mgmt_packet_event *data = d;
7802be7d22fSVladimir Kondratiev 	struct wiphy *wiphy = wil_to_wiphy(wil);
7812be7d22fSVladimir Kondratiev 	struct ieee80211_mgmt *rx_mgmt_frame =
7822be7d22fSVladimir Kondratiev 			(struct ieee80211_mgmt *)data->payload;
78390d89e9aSVladimir Kondratiev 	int flen = len - offsetof(struct wmi_rx_mgmt_packet_event, payload);
78490d89e9aSVladimir Kondratiev 	int ch_no;
78590d89e9aSVladimir Kondratiev 	u32 freq;
78690d89e9aSVladimir Kondratiev 	struct ieee80211_channel *channel;
78790d89e9aSVladimir Kondratiev 	s32 signal;
78890d89e9aSVladimir Kondratiev 	__le16 fc;
78990d89e9aSVladimir Kondratiev 	u32 d_len;
79090d89e9aSVladimir Kondratiev 	u16 d_status;
7912be7d22fSVladimir Kondratiev 
79290d89e9aSVladimir Kondratiev 	if (flen < 0) {
79390d89e9aSVladimir Kondratiev 		wil_err(wil, "MGMT Rx: short event, len %d\n", len);
79490d89e9aSVladimir Kondratiev 		return;
79590d89e9aSVladimir Kondratiev 	}
79690d89e9aSVladimir Kondratiev 
79790d89e9aSVladimir Kondratiev 	d_len = le32_to_cpu(data->info.len);
79890d89e9aSVladimir Kondratiev 	if (d_len != flen) {
79990d89e9aSVladimir Kondratiev 		wil_err(wil,
80090d89e9aSVladimir Kondratiev 			"MGMT Rx: length mismatch, d_len %d should be %d\n",
80190d89e9aSVladimir Kondratiev 			d_len, flen);
80290d89e9aSVladimir Kondratiev 		return;
80390d89e9aSVladimir Kondratiev 	}
80490d89e9aSVladimir Kondratiev 
80590d89e9aSVladimir Kondratiev 	ch_no = data->info.channel + 1;
80657fbcce3SJohannes Berg 	freq = ieee80211_channel_to_frequency(ch_no, NL80211_BAND_60GHZ);
80790d89e9aSVladimir Kondratiev 	channel = ieee80211_get_channel(wiphy, freq);
80830868f5dSDedy Lansky 	if (test_bit(WMI_FW_CAPABILITY_RSSI_REPORTING, wil->fw_capabilities))
80930868f5dSDedy Lansky 		signal = 100 * data->info.rssi;
81030868f5dSDedy Lansky 	else
81190d89e9aSVladimir Kondratiev 		signal = data->info.sqi;
81290d89e9aSVladimir Kondratiev 	d_status = le16_to_cpu(data->info.status);
81390d89e9aSVladimir Kondratiev 	fc = rx_mgmt_frame->frame_control;
81490d89e9aSVladimir Kondratiev 
81530868f5dSDedy Lansky 	wil_dbg_wmi(wil, "MGMT Rx: channel %d MCS %d RSSI %d SQI %d%%\n",
81630868f5dSDedy Lansky 		    data->info.channel, data->info.mcs, data->info.rssi,
817b8b33a3aSVladimir Kondratiev 		    data->info.sqi);
818f27dbf78SVladimir Kondratiev 	wil_dbg_wmi(wil, "status 0x%04x len %d fc 0x%04x\n", d_status, d_len,
819f27dbf78SVladimir Kondratiev 		    le16_to_cpu(fc));
8207743882dSVladimir Kondratiev 	wil_dbg_wmi(wil, "qid %d mid %d cid %d\n",
8212be7d22fSVladimir Kondratiev 		    data->info.qid, data->info.mid, data->info.cid);
82290d89e9aSVladimir Kondratiev 	wil_hex_dump_wmi("MGMT Rx ", DUMP_PREFIX_OFFSET, 16, 1, rx_mgmt_frame,
82390d89e9aSVladimir Kondratiev 			 d_len, true);
8242be7d22fSVladimir Kondratiev 
8252be7d22fSVladimir Kondratiev 	if (!channel) {
8262be7d22fSVladimir Kondratiev 		wil_err(wil, "Frame on unsupported channel\n");
8272be7d22fSVladimir Kondratiev 		return;
8282be7d22fSVladimir Kondratiev 	}
8292be7d22fSVladimir Kondratiev 
8302be7d22fSVladimir Kondratiev 	if (ieee80211_is_beacon(fc) || ieee80211_is_probe_resp(fc)) {
8312be7d22fSVladimir Kondratiev 		struct cfg80211_bss *bss;
8328eea944aSVladimir Kondratiev 		u64 tsf = le64_to_cpu(rx_mgmt_frame->u.beacon.timestamp);
8338eea944aSVladimir Kondratiev 		u16 cap = le16_to_cpu(rx_mgmt_frame->u.beacon.capab_info);
8348eea944aSVladimir Kondratiev 		u16 bi = le16_to_cpu(rx_mgmt_frame->u.beacon.beacon_int);
8358eea944aSVladimir Kondratiev 		const u8 *ie_buf = rx_mgmt_frame->u.beacon.variable;
8368eea944aSVladimir Kondratiev 		size_t ie_len = d_len - offsetof(struct ieee80211_mgmt,
8378eea944aSVladimir Kondratiev 						 u.beacon.variable);
8388eea944aSVladimir Kondratiev 		wil_dbg_wmi(wil, "Capability info : 0x%04x\n", cap);
8398eea944aSVladimir Kondratiev 		wil_dbg_wmi(wil, "TSF : 0x%016llx\n", tsf);
8408eea944aSVladimir Kondratiev 		wil_dbg_wmi(wil, "Beacon interval : %d\n", bi);
8418eea944aSVladimir Kondratiev 		wil_hex_dump_wmi("IE ", DUMP_PREFIX_OFFSET, 16, 1, ie_buf,
8428eea944aSVladimir Kondratiev 				 ie_len, true);
8432be7d22fSVladimir Kondratiev 
844e6d68341SDedy Lansky 		wil_dbg_wmi(wil, "Capability info : 0x%04x\n", cap);
845e6d68341SDedy Lansky 
846a0f7845bSVladimir Kondratiev 		bss = cfg80211_inform_bss_frame(wiphy, channel, rx_mgmt_frame,
847a0f7845bSVladimir Kondratiev 						d_len, signal, GFP_KERNEL);
8482be7d22fSVladimir Kondratiev 		if (bss) {
8497743882dSVladimir Kondratiev 			wil_dbg_wmi(wil, "Added BSS %pM\n",
8502be7d22fSVladimir Kondratiev 				    rx_mgmt_frame->bssid);
8515b112d3dSJohannes Berg 			cfg80211_put_bss(wiphy, bss);
8522be7d22fSVladimir Kondratiev 		} else {
8535bc8c1f2SJohannes Berg 			wil_err(wil, "cfg80211_inform_bss_frame() failed\n");
8542be7d22fSVladimir Kondratiev 		}
855102b1d99SVladimir Kondratiev 	} else {
856404bbb3cSLior David 		mutex_lock(&wil->vif_mutex);
857e00243faSLior David 		cfg80211_rx_mgmt(vif_to_radio_wdev(wil, vif), freq, signal,
858970fdfa8SVladimir Kondratiev 				 (void *)rx_mgmt_frame, d_len, 0);
859404bbb3cSLior David 		mutex_unlock(&wil->vif_mutex);
8602be7d22fSVladimir Kondratiev 	}
8612be7d22fSVladimir Kondratiev }
8622be7d22fSVladimir Kondratiev 
863e00243faSLior David static void wmi_evt_tx_mgmt(struct wil6210_vif *vif, int id, void *d, int len)
86490d89e9aSVladimir Kondratiev {
86590d89e9aSVladimir Kondratiev 	struct wmi_tx_mgmt_packet_event *data = d;
86690d89e9aSVladimir Kondratiev 	struct ieee80211_mgmt *mgmt_frame =
86790d89e9aSVladimir Kondratiev 			(struct ieee80211_mgmt *)data->payload;
86890d89e9aSVladimir Kondratiev 	int flen = len - offsetof(struct wmi_tx_mgmt_packet_event, payload);
86990d89e9aSVladimir Kondratiev 
87090d89e9aSVladimir Kondratiev 	wil_hex_dump_wmi("MGMT Tx ", DUMP_PREFIX_OFFSET, 16, 1, mgmt_frame,
87190d89e9aSVladimir Kondratiev 			 flen, true);
87290d89e9aSVladimir Kondratiev }
87390d89e9aSVladimir Kondratiev 
874e00243faSLior David static void wmi_evt_scan_complete(struct wil6210_vif *vif, int id,
8752be7d22fSVladimir Kondratiev 				  void *d, int len)
8762be7d22fSVladimir Kondratiev {
877e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
878e00243faSLior David 
879404bbb3cSLior David 	mutex_lock(&wil->vif_mutex);
880e00243faSLior David 	if (vif->scan_request) {
8812be7d22fSVladimir Kondratiev 		struct wmi_scan_complete_event *data = d;
882035859a5SMaya Erez 		int status = le32_to_cpu(data->status);
8831d76250bSAvraham Stern 		struct cfg80211_scan_info info = {
884035859a5SMaya Erez 			.aborted = ((status != WMI_SCAN_SUCCESS) &&
885035859a5SMaya Erez 				(status != WMI_SCAN_ABORT_REJECTED)),
8861d76250bSAvraham Stern 		};
8872be7d22fSVladimir Kondratiev 
888035859a5SMaya Erez 		wil_dbg_wmi(wil, "SCAN_COMPLETE(0x%08x)\n", status);
8892a91d7d0SVladimir Kondratiev 		wil_dbg_misc(wil, "Complete scan_request 0x%p aborted %d\n",
890e00243faSLior David 			     vif->scan_request, info.aborted);
891e00243faSLior David 		del_timer_sync(&vif->scan_timer);
892e00243faSLior David 		cfg80211_scan_done(vif->scan_request, &info);
893e00243faSLior David 		if (vif->mid == 0)
894e00243faSLior David 			wil->radio_wdev = wil->main_ndev->ieee80211_ptr;
895e00243faSLior David 		vif->scan_request = NULL;
896035859a5SMaya Erez 		wake_up_interruptible(&wil->wq);
897e00243faSLior David 		if (vif->p2p.pending_listen_wdev) {
898bb6743f7SLior David 			wil_dbg_misc(wil, "Scheduling delayed listen\n");
899e00243faSLior David 			schedule_work(&vif->p2p.delayed_listen_work);
900bb6743f7SLior David 		}
9012be7d22fSVladimir Kondratiev 	} else {
9022be7d22fSVladimir Kondratiev 		wil_err(wil, "SCAN_COMPLETE while not scanning\n");
9032be7d22fSVladimir Kondratiev 	}
904404bbb3cSLior David 	mutex_unlock(&wil->vif_mutex);
9052be7d22fSVladimir Kondratiev }
9062be7d22fSVladimir Kondratiev 
907e00243faSLior David static void wmi_evt_connect(struct wil6210_vif *vif, int id, void *d, int len)
9082be7d22fSVladimir Kondratiev {
909e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
910e00243faSLior David 	struct net_device *ndev = vif_to_ndev(vif);
911e00243faSLior David 	struct wireless_dev *wdev = vif_to_wdev(vif);
9122be7d22fSVladimir Kondratiev 	struct wmi_connect_event *evt = d;
9132be7d22fSVladimir Kondratiev 	int ch; /* channel number */
91441bd3d58SToke Høiland-Jørgensen 	struct station_info *sinfo;
9152be7d22fSVladimir Kondratiev 	u8 *assoc_req_ie, *assoc_resp_ie;
9162be7d22fSVladimir Kondratiev 	size_t assoc_req_ielen, assoc_resp_ielen;
9172be7d22fSVladimir Kondratiev 	/* capinfo(u16) + listen_interval(u16) + IEs */
9182be7d22fSVladimir Kondratiev 	const size_t assoc_req_ie_offset = sizeof(u16) * 2;
9192be7d22fSVladimir Kondratiev 	/* capinfo(u16) + status_code(u16) + associd(u16) + IEs */
9202be7d22fSVladimir Kondratiev 	const size_t assoc_resp_ie_offset = sizeof(u16) * 3;
9210916d9f2SMaya Erez 	int rc;
9222be7d22fSVladimir Kondratiev 
9232be7d22fSVladimir Kondratiev 	if (len < sizeof(*evt)) {
9242be7d22fSVladimir Kondratiev 		wil_err(wil, "Connect event too short : %d bytes\n", len);
9252be7d22fSVladimir Kondratiev 		return;
9262be7d22fSVladimir Kondratiev 	}
9272be7d22fSVladimir Kondratiev 	if (len != sizeof(*evt) + evt->beacon_ie_len + evt->assoc_req_len +
9282be7d22fSVladimir Kondratiev 		   evt->assoc_resp_len) {
9292be7d22fSVladimir Kondratiev 		wil_err(wil,
9302be7d22fSVladimir Kondratiev 			"Connect event corrupted : %d != %d + %d + %d + %d\n",
9312be7d22fSVladimir Kondratiev 			len, (int)sizeof(*evt), evt->beacon_ie_len,
9322be7d22fSVladimir Kondratiev 			evt->assoc_req_len, evt->assoc_resp_len);
9332be7d22fSVladimir Kondratiev 		return;
9342be7d22fSVladimir Kondratiev 	}
9353df2cd36SVladimir Kondratiev 	if (evt->cid >= WIL6210_MAX_CID) {
9363df2cd36SVladimir Kondratiev 		wil_err(wil, "Connect CID invalid : %d\n", evt->cid);
9373df2cd36SVladimir Kondratiev 		return;
9383df2cd36SVladimir Kondratiev 	}
9393df2cd36SVladimir Kondratiev 
9402be7d22fSVladimir Kondratiev 	ch = evt->channel + 1;
9419d865ee2SLior David 	wil_info(wil, "Connect %pM channel [%d] cid %d aid %d\n",
9429d865ee2SLior David 		 evt->bssid, ch, evt->cid, evt->aid);
9437743882dSVladimir Kondratiev 	wil_hex_dump_wmi("connect AI : ", DUMP_PREFIX_OFFSET, 16, 1,
9442be7d22fSVladimir Kondratiev 			 evt->assoc_info, len - sizeof(*evt), true);
9452be7d22fSVladimir Kondratiev 
9462be7d22fSVladimir Kondratiev 	/* figure out IE's */
9472be7d22fSVladimir Kondratiev 	assoc_req_ie = &evt->assoc_info[evt->beacon_ie_len +
9482be7d22fSVladimir Kondratiev 					assoc_req_ie_offset];
9492be7d22fSVladimir Kondratiev 	assoc_req_ielen = evt->assoc_req_len - assoc_req_ie_offset;
9502be7d22fSVladimir Kondratiev 	if (evt->assoc_req_len <= assoc_req_ie_offset) {
9512be7d22fSVladimir Kondratiev 		assoc_req_ie = NULL;
9522be7d22fSVladimir Kondratiev 		assoc_req_ielen = 0;
9532be7d22fSVladimir Kondratiev 	}
9542be7d22fSVladimir Kondratiev 
9552be7d22fSVladimir Kondratiev 	assoc_resp_ie = &evt->assoc_info[evt->beacon_ie_len +
9562be7d22fSVladimir Kondratiev 					 evt->assoc_req_len +
9572be7d22fSVladimir Kondratiev 					 assoc_resp_ie_offset];
9582be7d22fSVladimir Kondratiev 	assoc_resp_ielen = evt->assoc_resp_len - assoc_resp_ie_offset;
9592be7d22fSVladimir Kondratiev 	if (evt->assoc_resp_len <= assoc_resp_ie_offset) {
9602be7d22fSVladimir Kondratiev 		assoc_resp_ie = NULL;
9612be7d22fSVladimir Kondratiev 		assoc_resp_ielen = 0;
9622be7d22fSVladimir Kondratiev 	}
9632be7d22fSVladimir Kondratiev 
9640916d9f2SMaya Erez 	if (test_bit(wil_status_resetting, wil->status) ||
9650916d9f2SMaya Erez 	    !test_bit(wil_status_fwready, wil->status)) {
9660916d9f2SMaya Erez 		wil_err(wil, "status_resetting, cancel connect event, CID %d\n",
9670916d9f2SMaya Erez 			evt->cid);
9680916d9f2SMaya Erez 		/* no need for cleanup, wil_reset will do that */
9690916d9f2SMaya Erez 		return;
9700916d9f2SMaya Erez 	}
9710916d9f2SMaya Erez 
972b819447dSHamad Kadmany 	mutex_lock(&wil->mutex);
973b819447dSHamad Kadmany 
9742be7d22fSVladimir Kondratiev 	if ((wdev->iftype == NL80211_IFTYPE_STATION) ||
9752be7d22fSVladimir Kondratiev 	    (wdev->iftype == NL80211_IFTYPE_P2P_CLIENT)) {
9765bd60982SLior David 		if (!test_bit(wil_vif_fwconnecting, vif->status)) {
9772be7d22fSVladimir Kondratiev 			wil_err(wil, "Not in connecting state\n");
9780916d9f2SMaya Erez 			mutex_unlock(&wil->mutex);
9792be7d22fSVladimir Kondratiev 			return;
9802be7d22fSVladimir Kondratiev 		}
981e00243faSLior David 		del_timer_sync(&vif->connect_timer);
9823d287fb3SMaya Erez 	} else if ((wdev->iftype == NL80211_IFTYPE_AP) ||
9833d287fb3SMaya Erez 		   (wdev->iftype == NL80211_IFTYPE_P2P_GO)) {
9843d287fb3SMaya Erez 		if (wil->sta[evt->cid].status != wil_sta_unused) {
985af3db60aSLazar Alexei 			wil_err(wil, "AP: Invalid status %d for CID %d\n",
986af3db60aSLazar Alexei 				wil->sta[evt->cid].status, evt->cid);
9873d287fb3SMaya Erez 			mutex_unlock(&wil->mutex);
9883d287fb3SMaya Erez 			return;
9893d287fb3SMaya Erez 		}
9900916d9f2SMaya Erez 	}
9910916d9f2SMaya Erez 
9920916d9f2SMaya Erez 	ether_addr_copy(wil->sta[evt->cid].addr, evt->bssid);
993e00243faSLior David 	wil->sta[evt->cid].mid = vif->mid;
9940916d9f2SMaya Erez 	wil->sta[evt->cid].status = wil_sta_conn_pending;
9950916d9f2SMaya Erez 
99696c93589SGidon Studinski 	rc = wil_ring_init_tx(vif, evt->cid);
9970916d9f2SMaya Erez 	if (rc) {
998af3db60aSLazar Alexei 		wil_err(wil, "config tx vring failed for CID %d, rc (%d)\n",
999af3db60aSLazar Alexei 			evt->cid, rc);
1000e00243faSLior David 		wmi_disconnect_sta(vif, wil->sta[evt->cid].addr,
1001849a564bSDedy Lansky 				   WLAN_REASON_UNSPECIFIED, false, false);
10020916d9f2SMaya Erez 	} else {
1003af3db60aSLazar Alexei 		wil_info(wil, "successful connection to CID %d\n", evt->cid);
10040916d9f2SMaya Erez 	}
10050916d9f2SMaya Erez 
10060916d9f2SMaya Erez 	if ((wdev->iftype == NL80211_IFTYPE_STATION) ||
10070916d9f2SMaya Erez 	    (wdev->iftype == NL80211_IFTYPE_P2P_CLIENT)) {
10080916d9f2SMaya Erez 		if (rc) {
10090916d9f2SMaya Erez 			netif_carrier_off(ndev);
10109953a782SLior David 			wil6210_bus_request(wil, WIL_DEFAULT_BUS_REQUEST_KBPS);
1011af3db60aSLazar Alexei 			wil_err(wil, "cfg80211_connect_result with failure\n");
10120916d9f2SMaya Erez 			cfg80211_connect_result(ndev, evt->bssid, NULL, 0,
10130916d9f2SMaya Erez 						NULL, 0,
10140916d9f2SMaya Erez 						WLAN_STATUS_UNSPECIFIED_FAILURE,
10150916d9f2SMaya Erez 						GFP_KERNEL);
10160916d9f2SMaya Erez 			goto out;
10170916d9f2SMaya Erez 		} else {
1018bcdd49b0SDedy Lansky 			struct wiphy *wiphy = wil_to_wiphy(wil);
1019bcdd49b0SDedy Lansky 
1020e00243faSLior David 			cfg80211_ref_bss(wiphy, vif->bss);
1021e00243faSLior David 			cfg80211_connect_bss(ndev, evt->bssid, vif->bss,
10222be7d22fSVladimir Kondratiev 					     assoc_req_ie, assoc_req_ielen,
10232be7d22fSVladimir Kondratiev 					     assoc_resp_ie, assoc_resp_ielen,
1024bcdd49b0SDedy Lansky 					     WLAN_STATUS_SUCCESS, GFP_KERNEL,
1025bcdd49b0SDedy Lansky 					     NL80211_TIMEOUT_UNSPECIFIED);
10260916d9f2SMaya Erez 		}
1027e00243faSLior David 		vif->bss = NULL;
10282be7d22fSVladimir Kondratiev 	} else if ((wdev->iftype == NL80211_IFTYPE_AP) ||
10292be7d22fSVladimir Kondratiev 		   (wdev->iftype == NL80211_IFTYPE_P2P_GO)) {
103041bd3d58SToke Høiland-Jørgensen 
1031849a564bSDedy Lansky 		if (rc) {
1032849a564bSDedy Lansky 			if (disable_ap_sme)
1033849a564bSDedy Lansky 				/* notify new_sta has failed */
1034849a564bSDedy Lansky 				cfg80211_del_sta(ndev, evt->bssid, GFP_KERNEL);
10350916d9f2SMaya Erez 			goto out;
1036849a564bSDedy Lansky 		}
10370916d9f2SMaya Erez 
103841bd3d58SToke Høiland-Jørgensen 		sinfo = kzalloc(sizeof(*sinfo), GFP_KERNEL);
103941bd3d58SToke Høiland-Jørgensen 		if (!sinfo) {
104041bd3d58SToke Høiland-Jørgensen 			rc = -ENOMEM;
104141bd3d58SToke Høiland-Jørgensen 			goto out;
10422be7d22fSVladimir Kondratiev 		}
10432be7d22fSVladimir Kondratiev 
104441bd3d58SToke Høiland-Jørgensen 		sinfo->generation = wil->sinfo_gen++;
104541bd3d58SToke Høiland-Jørgensen 
104641bd3d58SToke Høiland-Jørgensen 		if (assoc_req_ie) {
104741bd3d58SToke Høiland-Jørgensen 			sinfo->assoc_req_ies = assoc_req_ie;
104841bd3d58SToke Høiland-Jørgensen 			sinfo->assoc_req_ies_len = assoc_req_ielen;
104941bd3d58SToke Høiland-Jørgensen 		}
105041bd3d58SToke Høiland-Jørgensen 
105141bd3d58SToke Høiland-Jørgensen 		cfg80211_new_sta(ndev, evt->bssid, sinfo, GFP_KERNEL);
105241bd3d58SToke Høiland-Jørgensen 
105341bd3d58SToke Høiland-Jørgensen 		kfree(sinfo);
10540916d9f2SMaya Erez 	} else {
1055af3db60aSLazar Alexei 		wil_err(wil, "unhandled iftype %d for CID %d\n", wdev->iftype,
1056af3db60aSLazar Alexei 			evt->cid);
10570916d9f2SMaya Erez 		goto out;
10582be7d22fSVladimir Kondratiev 	}
10590916d9f2SMaya Erez 
10600916d9f2SMaya Erez 	wil->sta[evt->cid].status = wil_sta_connected;
10619d865ee2SLior David 	wil->sta[evt->cid].aid = evt->aid;
10625bd60982SLior David 	if (!test_and_set_bit(wil_vif_fwconnected, vif->status))
10635bd60982SLior David 		atomic_inc(&wil->connected_vifs);
10645bd60982SLior David 	wil_update_net_queues_bh(wil, vif, NULL, false);
10652be7d22fSVladimir Kondratiev 
10660916d9f2SMaya Erez out:
1067e00243faSLior David 	if (rc) {
10680916d9f2SMaya Erez 		wil->sta[evt->cid].status = wil_sta_unused;
1069e00243faSLior David 		wil->sta[evt->cid].mid = U8_MAX;
1070e00243faSLior David 	}
10715bd60982SLior David 	clear_bit(wil_vif_fwconnecting, vif->status);
10720916d9f2SMaya Erez 	mutex_unlock(&wil->mutex);
10732be7d22fSVladimir Kondratiev }
10742be7d22fSVladimir Kondratiev 
1075e00243faSLior David static void wmi_evt_disconnect(struct wil6210_vif *vif, int id,
10762be7d22fSVladimir Kondratiev 			       void *d, int len)
10772be7d22fSVladimir Kondratiev {
1078e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
10792be7d22fSVladimir Kondratiev 	struct wmi_disconnect_event *evt = d;
10804821e6d8SVladimir Kondratiev 	u16 reason_code = le16_to_cpu(evt->protocol_reason_status);
10812be7d22fSVladimir Kondratiev 
10820916d9f2SMaya Erez 	wil_info(wil, "Disconnect %pM reason [proto %d wmi %d]\n",
10834821e6d8SVladimir Kondratiev 		 evt->bssid, reason_code, evt->disconnect_reason);
10842be7d22fSVladimir Kondratiev 
10852be7d22fSVladimir Kondratiev 	wil->sinfo_gen++;
10862be7d22fSVladimir Kondratiev 
1087b819447dSHamad Kadmany 	if (test_bit(wil_status_resetting, wil->status) ||
1088b819447dSHamad Kadmany 	    !test_bit(wil_status_fwready, wil->status)) {
1089b819447dSHamad Kadmany 		wil_err(wil, "status_resetting, cancel disconnect event\n");
1090b819447dSHamad Kadmany 		/* no need for cleanup, wil_reset will do that */
1091b819447dSHamad Kadmany 		return;
1092b819447dSHamad Kadmany 	}
1093b819447dSHamad Kadmany 
1094097638a0SVladimir Kondratiev 	mutex_lock(&wil->mutex);
1095e00243faSLior David 	wil6210_disconnect(vif, evt->bssid, reason_code, true);
1096097638a0SVladimir Kondratiev 	mutex_unlock(&wil->mutex);
10972be7d22fSVladimir Kondratiev }
10982be7d22fSVladimir Kondratiev 
10992be7d22fSVladimir Kondratiev /*
11002be7d22fSVladimir Kondratiev  * Firmware reports EAPOL frame using WME event.
11012be7d22fSVladimir Kondratiev  * Reconstruct Ethernet frame and deliver it via normal Rx
11022be7d22fSVladimir Kondratiev  */
1103e00243faSLior David static void wmi_evt_eapol_rx(struct wil6210_vif *vif, int id, void *d, int len)
11042be7d22fSVladimir Kondratiev {
1105e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1106e00243faSLior David 	struct net_device *ndev = vif_to_ndev(vif);
11072be7d22fSVladimir Kondratiev 	struct wmi_eapol_rx_event *evt = d;
11082be7d22fSVladimir Kondratiev 	u16 eapol_len = le16_to_cpu(evt->eapol_len);
11092be7d22fSVladimir Kondratiev 	int sz = eapol_len + ETH_HLEN;
11102be7d22fSVladimir Kondratiev 	struct sk_buff *skb;
11112be7d22fSVladimir Kondratiev 	struct ethhdr *eth;
1112c8b78b5fSVladimir Kondratiev 	int cid;
1113c8b78b5fSVladimir Kondratiev 	struct wil_net_stats *stats = NULL;
11142be7d22fSVladimir Kondratiev 
1115e00243faSLior David 	wil_dbg_wmi(wil, "EAPOL len %d from %pM MID %d\n", eapol_len,
1116e00243faSLior David 		    evt->src_mac, vif->mid);
11172be7d22fSVladimir Kondratiev 
1118e00243faSLior David 	cid = wil_find_cid(wil, vif->mid, evt->src_mac);
1119c8b78b5fSVladimir Kondratiev 	if (cid >= 0)
1120c8b78b5fSVladimir Kondratiev 		stats = &wil->sta[cid].stats;
1121c8b78b5fSVladimir Kondratiev 
11222be7d22fSVladimir Kondratiev 	if (eapol_len > 196) { /* TODO: revisit size limit */
11232be7d22fSVladimir Kondratiev 		wil_err(wil, "EAPOL too large\n");
11242be7d22fSVladimir Kondratiev 		return;
11252be7d22fSVladimir Kondratiev 	}
11262be7d22fSVladimir Kondratiev 
11272be7d22fSVladimir Kondratiev 	skb = alloc_skb(sz, GFP_KERNEL);
11282be7d22fSVladimir Kondratiev 	if (!skb) {
11292be7d22fSVladimir Kondratiev 		wil_err(wil, "Failed to allocate skb\n");
11302be7d22fSVladimir Kondratiev 		return;
11312be7d22fSVladimir Kondratiev 	}
1132c8b78b5fSVladimir Kondratiev 
11334df864c1SJohannes Berg 	eth = skb_put(skb, ETH_HLEN);
1134a82553bbSVladimir Kondratiev 	ether_addr_copy(eth->h_dest, ndev->dev_addr);
1135a82553bbSVladimir Kondratiev 	ether_addr_copy(eth->h_source, evt->src_mac);
11362be7d22fSVladimir Kondratiev 	eth->h_proto = cpu_to_be16(ETH_P_PAE);
113759ae1d12SJohannes Berg 	skb_put_data(skb, evt->eapol, eapol_len);
11382be7d22fSVladimir Kondratiev 	skb->protocol = eth_type_trans(skb, ndev);
11392be7d22fSVladimir Kondratiev 	if (likely(netif_rx_ni(skb) == NET_RX_SUCCESS)) {
11402be7d22fSVladimir Kondratiev 		ndev->stats.rx_packets++;
1141c8b78b5fSVladimir Kondratiev 		ndev->stats.rx_bytes += sz;
1142c8b78b5fSVladimir Kondratiev 		if (stats) {
1143c8b78b5fSVladimir Kondratiev 			stats->rx_packets++;
1144c8b78b5fSVladimir Kondratiev 			stats->rx_bytes += sz;
1145c8b78b5fSVladimir Kondratiev 		}
11462be7d22fSVladimir Kondratiev 	} else {
11472be7d22fSVladimir Kondratiev 		ndev->stats.rx_dropped++;
1148c8b78b5fSVladimir Kondratiev 		if (stats)
1149c8b78b5fSVladimir Kondratiev 			stats->rx_dropped++;
11502be7d22fSVladimir Kondratiev 	}
11512be7d22fSVladimir Kondratiev }
11522be7d22fSVladimir Kondratiev 
115396c93589SGidon Studinski static void wmi_evt_ring_en(struct wil6210_vif *vif, int id, void *d, int len)
11543a124ed6SVladimir Kondratiev {
1155e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
115696c93589SGidon Studinski 	struct wmi_ring_en_event *evt = d;
115796c93589SGidon Studinski 	u8 vri = evt->ring_index;
1158e00243faSLior David 	struct wireless_dev *wdev = vif_to_wdev(vif);
11593a124ed6SVladimir Kondratiev 
1160e00243faSLior David 	wil_dbg_wmi(wil, "Enable vring %d MID %d\n", vri, vif->mid);
11613a124ed6SVladimir Kondratiev 
116210590c6aSGidon Studinski 	if (vri >= ARRAY_SIZE(wil->ring_tx)) {
1163230d8442SVladimir Kondratiev 		wil_err(wil, "Enable for invalid vring %d\n", vri);
1164e58c9f70SVladimir Kondratiev 		return;
1165e58c9f70SVladimir Kondratiev 	}
1166849a564bSDedy Lansky 
1167849a564bSDedy Lansky 	if (wdev->iftype != NL80211_IFTYPE_AP || !disable_ap_sme)
1168849a564bSDedy Lansky 		/* in AP mode with disable_ap_sme, this is done by
1169849a564bSDedy Lansky 		 * wil_cfg80211_change_station()
1170849a564bSDedy Lansky 		 */
117110590c6aSGidon Studinski 		wil->ring_tx_data[vri].dot1x_open = true;
117210590c6aSGidon Studinski 	if (vri == vif->bcast_ring) /* no BA for bcast */
1173230d8442SVladimir Kondratiev 		return;
11743a3def8dSVladimir Kondratiev 	if (agg_wsize >= 0)
1175230d8442SVladimir Kondratiev 		wil_addba_tx_request(wil, vri, agg_wsize);
11763442a504SVladimir Kondratiev }
11773442a504SVladimir Kondratiev 
1178e00243faSLior David static void wmi_evt_ba_status(struct wil6210_vif *vif, int id,
1179e00243faSLior David 			      void *d, int len)
1180249a382bSVladimir Kondratiev {
1181e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1182b874ddecSLior David 	struct wmi_ba_status_event *evt = d;
118310590c6aSGidon Studinski 	struct wil_ring_tx_data *txdata;
1184249a382bSVladimir Kondratiev 
1185cbcf5866SVladimir Kondratiev 	wil_dbg_wmi(wil, "BACK[%d] %s {%d} timeout %d AMSDU%s\n",
11867b05b0abSVladimir Kondratiev 		    evt->ringid,
11877b05b0abSVladimir Kondratiev 		    evt->status == WMI_BA_AGREED ? "OK" : "N/A",
1188cbcf5866SVladimir Kondratiev 		    evt->agg_wsize, __le16_to_cpu(evt->ba_timeout),
1189cbcf5866SVladimir Kondratiev 		    evt->amsdu ? "+" : "-");
1190b4490f42SVladimir Kondratiev 
11917b05b0abSVladimir Kondratiev 	if (evt->ringid >= WIL6210_MAX_TX_RINGS) {
11927b05b0abSVladimir Kondratiev 		wil_err(wil, "invalid ring id %d\n", evt->ringid);
11937b05b0abSVladimir Kondratiev 		return;
11947b05b0abSVladimir Kondratiev 	}
11957b05b0abSVladimir Kondratiev 
11963277213fSVladimir Kondratiev 	if (evt->status != WMI_BA_AGREED) {
11973277213fSVladimir Kondratiev 		evt->ba_timeout = 0;
11983277213fSVladimir Kondratiev 		evt->agg_wsize = 0;
1199cbcf5866SVladimir Kondratiev 		evt->amsdu = 0;
12007b05b0abSVladimir Kondratiev 	}
12017b05b0abSVladimir Kondratiev 
120210590c6aSGidon Studinski 	txdata = &wil->ring_tx_data[evt->ringid];
12033277213fSVladimir Kondratiev 
12043277213fSVladimir Kondratiev 	txdata->agg_timeout = le16_to_cpu(evt->ba_timeout);
12053277213fSVladimir Kondratiev 	txdata->agg_wsize = evt->agg_wsize;
1206cbcf5866SVladimir Kondratiev 	txdata->agg_amsdu = evt->amsdu;
12073a124ed6SVladimir Kondratiev 	txdata->addba_in_progress = false;
12087b05b0abSVladimir Kondratiev }
12097b05b0abSVladimir Kondratiev 
1210e00243faSLior David static void wmi_evt_addba_rx_req(struct wil6210_vif *vif, int id,
1211e00243faSLior David 				 void *d, int len)
12123277213fSVladimir Kondratiev {
1213e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
12143277213fSVladimir Kondratiev 	struct wmi_rcp_addba_req_event *evt = d;
12153277213fSVladimir Kondratiev 
1216e00243faSLior David 	wil_addba_rx_request(wil, vif->mid, evt->cidxtid, evt->dialog_token,
12173277213fSVladimir Kondratiev 			     evt->ba_param_set, evt->ba_timeout,
12183277213fSVladimir Kondratiev 			     evt->ba_seq_ctrl);
12193277213fSVladimir Kondratiev }
12203277213fSVladimir Kondratiev 
1221e00243faSLior David static void wmi_evt_delba(struct wil6210_vif *vif, int id, void *d, int len)
1222bd33273bSVladimir Kondratiev __acquires(&sta->tid_rx_lock) __releases(&sta->tid_rx_lock)
12233277213fSVladimir Kondratiev {
1224e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
12253277213fSVladimir Kondratiev 	struct wmi_delba_event *evt = d;
12263277213fSVladimir Kondratiev 	u8 cid, tid;
12273277213fSVladimir Kondratiev 	u16 reason = __le16_to_cpu(evt->reason);
12283277213fSVladimir Kondratiev 	struct wil_sta_info *sta;
1229ec81b5adSDedy Lansky 	struct wil_tid_ampdu_rx *r;
1230ec81b5adSDedy Lansky 
1231bd33273bSVladimir Kondratiev 	might_sleep();
12323277213fSVladimir Kondratiev 	parse_cidxtid(evt->cidxtid, &cid, &tid);
1233e00243faSLior David 	wil_dbg_wmi(wil, "DELBA MID %d CID %d TID %d from %s reason %d\n",
1234e00243faSLior David 		    vif->mid, cid, tid,
12353277213fSVladimir Kondratiev 		    evt->from_initiator ? "originator" : "recipient",
12363277213fSVladimir Kondratiev 		    reason);
12373277213fSVladimir Kondratiev 	if (!evt->from_initiator) {
12383277213fSVladimir Kondratiev 		int i;
12393277213fSVladimir Kondratiev 		/* find Tx vring it belongs to */
124010590c6aSGidon Studinski 		for (i = 0; i < ARRAY_SIZE(wil->ring2cid_tid); i++) {
124110590c6aSGidon Studinski 			if (wil->ring2cid_tid[i][0] == cid &&
124210590c6aSGidon Studinski 			    wil->ring2cid_tid[i][1] == tid) {
124310590c6aSGidon Studinski 				struct wil_ring_tx_data *txdata =
124410590c6aSGidon Studinski 					&wil->ring_tx_data[i];
12453277213fSVladimir Kondratiev 
12463277213fSVladimir Kondratiev 				wil_dbg_wmi(wil, "DELBA Tx vring %d\n", i);
12473277213fSVladimir Kondratiev 				txdata->agg_timeout = 0;
12483277213fSVladimir Kondratiev 				txdata->agg_wsize = 0;
12493a124ed6SVladimir Kondratiev 				txdata->addba_in_progress = false;
12503277213fSVladimir Kondratiev 
12513277213fSVladimir Kondratiev 				break; /* max. 1 matching ring */
12523277213fSVladimir Kondratiev 			}
12533277213fSVladimir Kondratiev 		}
125410590c6aSGidon Studinski 		if (i >= ARRAY_SIZE(wil->ring2cid_tid))
12553277213fSVladimir Kondratiev 			wil_err(wil, "DELBA: unable to find Tx vring\n");
12563277213fSVladimir Kondratiev 		return;
12573277213fSVladimir Kondratiev 	}
12583277213fSVladimir Kondratiev 
12593277213fSVladimir Kondratiev 	sta = &wil->sta[cid];
12603277213fSVladimir Kondratiev 
1261bd33273bSVladimir Kondratiev 	spin_lock_bh(&sta->tid_rx_lock);
1262ec81b5adSDedy Lansky 
12633277213fSVladimir Kondratiev 	r = sta->tid_rx[tid];
12643277213fSVladimir Kondratiev 	sta->tid_rx[tid] = NULL;
1265b4490f42SVladimir Kondratiev 	wil_tid_ampdu_rx_free(wil, r);
1266ec81b5adSDedy Lansky 
1267bd33273bSVladimir Kondratiev 	spin_unlock_bh(&sta->tid_rx_lock);
1268b4490f42SVladimir Kondratiev }
1269b4490f42SVladimir Kondratiev 
1270a5dc6883SDedy Lansky static void
1271e00243faSLior David wmi_evt_sched_scan_result(struct wil6210_vif *vif, int id, void *d, int len)
1272a5dc6883SDedy Lansky {
1273e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1274a5dc6883SDedy Lansky 	struct wmi_sched_scan_result_event *data = d;
1275a5dc6883SDedy Lansky 	struct wiphy *wiphy = wil_to_wiphy(wil);
1276a5dc6883SDedy Lansky 	struct ieee80211_mgmt *rx_mgmt_frame =
1277a5dc6883SDedy Lansky 		(struct ieee80211_mgmt *)data->payload;
1278a5dc6883SDedy Lansky 	int flen = len - offsetof(struct wmi_sched_scan_result_event, payload);
1279a5dc6883SDedy Lansky 	int ch_no;
1280a5dc6883SDedy Lansky 	u32 freq;
1281a5dc6883SDedy Lansky 	struct ieee80211_channel *channel;
1282a5dc6883SDedy Lansky 	s32 signal;
1283a5dc6883SDedy Lansky 	__le16 fc;
1284a5dc6883SDedy Lansky 	u32 d_len;
1285a5dc6883SDedy Lansky 	struct cfg80211_bss *bss;
1286a5dc6883SDedy Lansky 
1287a5dc6883SDedy Lansky 	if (flen < 0) {
1288a5dc6883SDedy Lansky 		wil_err(wil, "sched scan result event too short, len %d\n",
1289a5dc6883SDedy Lansky 			len);
1290a5dc6883SDedy Lansky 		return;
1291a5dc6883SDedy Lansky 	}
1292a5dc6883SDedy Lansky 
1293a5dc6883SDedy Lansky 	d_len = le32_to_cpu(data->info.len);
1294a5dc6883SDedy Lansky 	if (d_len != flen) {
1295a5dc6883SDedy Lansky 		wil_err(wil,
1296a5dc6883SDedy Lansky 			"sched scan result length mismatch, d_len %d should be %d\n",
1297a5dc6883SDedy Lansky 			d_len, flen);
1298a5dc6883SDedy Lansky 		return;
1299a5dc6883SDedy Lansky 	}
1300a5dc6883SDedy Lansky 
1301a5dc6883SDedy Lansky 	fc = rx_mgmt_frame->frame_control;
1302a5dc6883SDedy Lansky 	if (!ieee80211_is_probe_resp(fc)) {
1303a5dc6883SDedy Lansky 		wil_err(wil, "sched scan result invalid frame, fc 0x%04x\n",
1304a5dc6883SDedy Lansky 			fc);
1305a5dc6883SDedy Lansky 		return;
1306a5dc6883SDedy Lansky 	}
1307a5dc6883SDedy Lansky 
1308a5dc6883SDedy Lansky 	ch_no = data->info.channel + 1;
1309a5dc6883SDedy Lansky 	freq = ieee80211_channel_to_frequency(ch_no, NL80211_BAND_60GHZ);
1310a5dc6883SDedy Lansky 	channel = ieee80211_get_channel(wiphy, freq);
1311a5dc6883SDedy Lansky 	if (test_bit(WMI_FW_CAPABILITY_RSSI_REPORTING, wil->fw_capabilities))
1312a5dc6883SDedy Lansky 		signal = 100 * data->info.rssi;
1313a5dc6883SDedy Lansky 	else
1314a5dc6883SDedy Lansky 		signal = data->info.sqi;
1315a5dc6883SDedy Lansky 
1316a5dc6883SDedy Lansky 	wil_dbg_wmi(wil, "sched scan result: channel %d MCS %d RSSI %d\n",
1317a5dc6883SDedy Lansky 		    data->info.channel, data->info.mcs, data->info.rssi);
1318a5dc6883SDedy Lansky 	wil_dbg_wmi(wil, "len %d qid %d mid %d cid %d\n",
1319a5dc6883SDedy Lansky 		    d_len, data->info.qid, data->info.mid, data->info.cid);
1320a5dc6883SDedy Lansky 	wil_hex_dump_wmi("PROBE ", DUMP_PREFIX_OFFSET, 16, 1, rx_mgmt_frame,
1321a5dc6883SDedy Lansky 			 d_len, true);
1322a5dc6883SDedy Lansky 
1323a5dc6883SDedy Lansky 	if (!channel) {
1324a5dc6883SDedy Lansky 		wil_err(wil, "Frame on unsupported channel\n");
1325a5dc6883SDedy Lansky 		return;
1326a5dc6883SDedy Lansky 	}
1327a5dc6883SDedy Lansky 
1328a5dc6883SDedy Lansky 	bss = cfg80211_inform_bss_frame(wiphy, channel, rx_mgmt_frame,
1329a5dc6883SDedy Lansky 					d_len, signal, GFP_KERNEL);
1330a5dc6883SDedy Lansky 	if (bss) {
1331a5dc6883SDedy Lansky 		wil_dbg_wmi(wil, "Added BSS %pM\n", rx_mgmt_frame->bssid);
1332a5dc6883SDedy Lansky 		cfg80211_put_bss(wiphy, bss);
1333a5dc6883SDedy Lansky 	} else {
1334a5dc6883SDedy Lansky 		wil_err(wil, "cfg80211_inform_bss_frame() failed\n");
1335a5dc6883SDedy Lansky 	}
1336a5dc6883SDedy Lansky 
1337a5dc6883SDedy Lansky 	cfg80211_sched_scan_results(wiphy, 0);
1338a5dc6883SDedy Lansky }
1339a5dc6883SDedy Lansky 
13400c936b3cSDedy Lansky static void wil_link_stats_store_basic(struct wil6210_vif *vif,
13410c936b3cSDedy Lansky 				       struct wmi_link_stats_basic *basic)
13420c936b3cSDedy Lansky {
13430c936b3cSDedy Lansky 	struct wil6210_priv *wil = vif_to_wil(vif);
13440c936b3cSDedy Lansky 	u8 cid = basic->cid;
13450c936b3cSDedy Lansky 	struct wil_sta_info *sta;
13460c936b3cSDedy Lansky 
13470c936b3cSDedy Lansky 	if (cid < 0 || cid >= WIL6210_MAX_CID) {
13480c936b3cSDedy Lansky 		wil_err(wil, "invalid cid %d\n", cid);
13490c936b3cSDedy Lansky 		return;
13500c936b3cSDedy Lansky 	}
13510c936b3cSDedy Lansky 
13520c936b3cSDedy Lansky 	sta = &wil->sta[cid];
13530c936b3cSDedy Lansky 	sta->fw_stats_basic = *basic;
13540c936b3cSDedy Lansky }
13550c936b3cSDedy Lansky 
13560c936b3cSDedy Lansky static void wil_link_stats_store_global(struct wil6210_vif *vif,
13570c936b3cSDedy Lansky 					struct wmi_link_stats_global *global)
13580c936b3cSDedy Lansky {
13590c936b3cSDedy Lansky 	struct wil6210_priv *wil = vif_to_wil(vif);
13600c936b3cSDedy Lansky 
13610c936b3cSDedy Lansky 	wil->fw_stats_global.stats = *global;
13620c936b3cSDedy Lansky }
13630c936b3cSDedy Lansky 
13640c936b3cSDedy Lansky static void wmi_link_stats_parse(struct wil6210_vif *vif, u64 tsf,
13650c936b3cSDedy Lansky 				 bool has_next, void *payload,
13660c936b3cSDedy Lansky 				 size_t payload_size)
13670c936b3cSDedy Lansky {
13680c936b3cSDedy Lansky 	struct wil6210_priv *wil = vif_to_wil(vif);
13690c936b3cSDedy Lansky 	size_t hdr_size = sizeof(struct wmi_link_stats_record);
13700c936b3cSDedy Lansky 	size_t stats_size, record_size, expected_size;
13710c936b3cSDedy Lansky 	struct wmi_link_stats_record *hdr;
13720c936b3cSDedy Lansky 
13730c936b3cSDedy Lansky 	if (payload_size < hdr_size) {
13740c936b3cSDedy Lansky 		wil_err(wil, "link stats wrong event size %zu\n", payload_size);
13750c936b3cSDedy Lansky 		return;
13760c936b3cSDedy Lansky 	}
13770c936b3cSDedy Lansky 
13780c936b3cSDedy Lansky 	while (payload_size >= hdr_size) {
13790c936b3cSDedy Lansky 		hdr = payload;
13800c936b3cSDedy Lansky 		stats_size = le16_to_cpu(hdr->record_size);
13810c936b3cSDedy Lansky 		record_size = hdr_size + stats_size;
13820c936b3cSDedy Lansky 
13830c936b3cSDedy Lansky 		if (payload_size < record_size) {
13840c936b3cSDedy Lansky 			wil_err(wil, "link stats payload ended unexpectedly, size %zu < %zu\n",
13850c936b3cSDedy Lansky 				payload_size, record_size);
13860c936b3cSDedy Lansky 			return;
13870c936b3cSDedy Lansky 		}
13880c936b3cSDedy Lansky 
13890c936b3cSDedy Lansky 		switch (hdr->record_type_id) {
13900c936b3cSDedy Lansky 		case WMI_LINK_STATS_TYPE_BASIC:
13910c936b3cSDedy Lansky 			expected_size = sizeof(struct wmi_link_stats_basic);
13920c936b3cSDedy Lansky 			if (stats_size < expected_size) {
13930c936b3cSDedy Lansky 				wil_err(wil, "link stats invalid basic record size %zu < %zu\n",
13940c936b3cSDedy Lansky 					stats_size, expected_size);
13950c936b3cSDedy Lansky 				return;
13960c936b3cSDedy Lansky 			}
13970c936b3cSDedy Lansky 			if (vif->fw_stats_ready) {
13980c936b3cSDedy Lansky 				/* clean old statistics */
13990c936b3cSDedy Lansky 				vif->fw_stats_tsf = 0;
14000c936b3cSDedy Lansky 				vif->fw_stats_ready = 0;
14010c936b3cSDedy Lansky 			}
14020c936b3cSDedy Lansky 
14030c936b3cSDedy Lansky 			wil_link_stats_store_basic(vif, payload + hdr_size);
14040c936b3cSDedy Lansky 
14050c936b3cSDedy Lansky 			if (!has_next) {
14060c936b3cSDedy Lansky 				vif->fw_stats_tsf = tsf;
14070c936b3cSDedy Lansky 				vif->fw_stats_ready = 1;
14080c936b3cSDedy Lansky 			}
14090c936b3cSDedy Lansky 
14100c936b3cSDedy Lansky 			break;
14110c936b3cSDedy Lansky 		case WMI_LINK_STATS_TYPE_GLOBAL:
14120c936b3cSDedy Lansky 			expected_size = sizeof(struct wmi_link_stats_global);
14130c936b3cSDedy Lansky 			if (stats_size < sizeof(struct wmi_link_stats_global)) {
14140c936b3cSDedy Lansky 				wil_err(wil, "link stats invalid global record size %zu < %zu\n",
14150c936b3cSDedy Lansky 					stats_size, expected_size);
14160c936b3cSDedy Lansky 				return;
14170c936b3cSDedy Lansky 			}
14180c936b3cSDedy Lansky 
14190c936b3cSDedy Lansky 			if (wil->fw_stats_global.ready) {
14200c936b3cSDedy Lansky 				/* clean old statistics */
14210c936b3cSDedy Lansky 				wil->fw_stats_global.tsf = 0;
14220c936b3cSDedy Lansky 				wil->fw_stats_global.ready = 0;
14230c936b3cSDedy Lansky 			}
14240c936b3cSDedy Lansky 
14250c936b3cSDedy Lansky 			wil_link_stats_store_global(vif, payload + hdr_size);
14260c936b3cSDedy Lansky 
14270c936b3cSDedy Lansky 			if (!has_next) {
14280c936b3cSDedy Lansky 				wil->fw_stats_global.tsf = tsf;
14290c936b3cSDedy Lansky 				wil->fw_stats_global.ready = 1;
14300c936b3cSDedy Lansky 			}
14310c936b3cSDedy Lansky 
14320c936b3cSDedy Lansky 			break;
14330c936b3cSDedy Lansky 		default:
14340c936b3cSDedy Lansky 			break;
14350c936b3cSDedy Lansky 		}
14360c936b3cSDedy Lansky 
14370c936b3cSDedy Lansky 		/* skip to next record */
14380c936b3cSDedy Lansky 		payload += record_size;
14390c936b3cSDedy Lansky 		payload_size -= record_size;
14400c936b3cSDedy Lansky 	}
14410c936b3cSDedy Lansky }
14420c936b3cSDedy Lansky 
14430c936b3cSDedy Lansky static void
14440c936b3cSDedy Lansky wmi_evt_link_stats(struct wil6210_vif *vif, int id, void *d, int len)
14450c936b3cSDedy Lansky {
14460c936b3cSDedy Lansky 	struct wil6210_priv *wil = vif_to_wil(vif);
14470c936b3cSDedy Lansky 	struct wmi_link_stats_event *evt = d;
14480c936b3cSDedy Lansky 	size_t payload_size;
14490c936b3cSDedy Lansky 
14500c936b3cSDedy Lansky 	if (len < offsetof(struct wmi_link_stats_event, payload)) {
14510c936b3cSDedy Lansky 		wil_err(wil, "stats event way too short %d\n", len);
14520c936b3cSDedy Lansky 		return;
14530c936b3cSDedy Lansky 	}
14540c936b3cSDedy Lansky 	payload_size = le16_to_cpu(evt->payload_size);
14550c936b3cSDedy Lansky 	if (len < sizeof(struct wmi_link_stats_event) + payload_size) {
14560c936b3cSDedy Lansky 		wil_err(wil, "stats event too short %d\n", len);
14570c936b3cSDedy Lansky 		return;
14580c936b3cSDedy Lansky 	}
14590c936b3cSDedy Lansky 
14600c936b3cSDedy Lansky 	wmi_link_stats_parse(vif, le64_to_cpu(evt->tsf), evt->has_next,
14610c936b3cSDedy Lansky 			     evt->payload, payload_size);
14620c936b3cSDedy Lansky }
14630c936b3cSDedy Lansky 
1464b03fbab0SVladimir Kondratiev /**
1465b03fbab0SVladimir Kondratiev  * Some events are ignored for purpose; and need not be interpreted as
1466b03fbab0SVladimir Kondratiev  * "unhandled events"
1467b03fbab0SVladimir Kondratiev  */
1468e00243faSLior David static void wmi_evt_ignore(struct wil6210_vif *vif, int id, void *d, int len)
1469b03fbab0SVladimir Kondratiev {
1470e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1471e00243faSLior David 
1472b03fbab0SVladimir Kondratiev 	wil_dbg_wmi(wil, "Ignore event 0x%04x len %d\n", id, len);
1473b03fbab0SVladimir Kondratiev }
1474b03fbab0SVladimir Kondratiev 
14752be7d22fSVladimir Kondratiev static const struct {
14762be7d22fSVladimir Kondratiev 	int eventid;
1477e00243faSLior David 	void (*handler)(struct wil6210_vif *vif,
1478e00243faSLior David 			int eventid, void *data, int data_len);
14792be7d22fSVladimir Kondratiev } wmi_evt_handlers[] = {
14802be7d22fSVladimir Kondratiev 	{WMI_READY_EVENTID,		wmi_evt_ready},
1481817f1853SVladimir Kondratiev 	{WMI_FW_READY_EVENTID,			wmi_evt_ignore},
14822be7d22fSVladimir Kondratiev 	{WMI_RX_MGMT_PACKET_EVENTID,	wmi_evt_rx_mgmt},
148390d89e9aSVladimir Kondratiev 	{WMI_TX_MGMT_PACKET_EVENTID,		wmi_evt_tx_mgmt},
14842be7d22fSVladimir Kondratiev 	{WMI_SCAN_COMPLETE_EVENTID,	wmi_evt_scan_complete},
14852be7d22fSVladimir Kondratiev 	{WMI_CONNECT_EVENTID,		wmi_evt_connect},
14862be7d22fSVladimir Kondratiev 	{WMI_DISCONNECT_EVENTID,	wmi_evt_disconnect},
14872be7d22fSVladimir Kondratiev 	{WMI_EAPOL_RX_EVENTID,		wmi_evt_eapol_rx},
1488249a382bSVladimir Kondratiev 	{WMI_BA_STATUS_EVENTID,		wmi_evt_ba_status},
14893277213fSVladimir Kondratiev 	{WMI_RCP_ADDBA_REQ_EVENTID,	wmi_evt_addba_rx_req},
14903277213fSVladimir Kondratiev 	{WMI_DELBA_EVENTID,		wmi_evt_delba},
149196c93589SGidon Studinski 	{WMI_RING_EN_EVENTID,		wmi_evt_ring_en},
1492b03fbab0SVladimir Kondratiev 	{WMI_DATA_PORT_OPEN_EVENTID,		wmi_evt_ignore},
1493a5dc6883SDedy Lansky 	{WMI_SCHED_SCAN_RESULT_EVENTID,		wmi_evt_sched_scan_result},
14940c936b3cSDedy Lansky 	{WMI_LINK_STATS_EVENTID,		wmi_evt_link_stats},
14952be7d22fSVladimir Kondratiev };
14962be7d22fSVladimir Kondratiev 
14972be7d22fSVladimir Kondratiev /*
14982be7d22fSVladimir Kondratiev  * Run in IRQ context
14992be7d22fSVladimir Kondratiev  * Extract WMI command from mailbox. Queue it to the @wil->pending_wmi_ev
15002be7d22fSVladimir Kondratiev  * that will be eventually handled by the @wmi_event_worker in the thread
15012be7d22fSVladimir Kondratiev  * context of thread "wil6210_wmi"
15022be7d22fSVladimir Kondratiev  */
15032be7d22fSVladimir Kondratiev void wmi_recv_cmd(struct wil6210_priv *wil)
15042be7d22fSVladimir Kondratiev {
15052be7d22fSVladimir Kondratiev 	struct wil6210_mbox_ring_desc d_tail;
15062be7d22fSVladimir Kondratiev 	struct wil6210_mbox_hdr hdr;
15072be7d22fSVladimir Kondratiev 	struct wil6210_mbox_ring *r = &wil->mbox_ctl.rx;
15082be7d22fSVladimir Kondratiev 	struct pending_wmi_event *evt;
15092be7d22fSVladimir Kondratiev 	u8 *cmd;
15102be7d22fSVladimir Kondratiev 	void __iomem *src;
15112be7d22fSVladimir Kondratiev 	ulong flags;
1512a715c7ddSVladimir Kondratiev 	unsigned n;
15130916d9f2SMaya Erez 	unsigned int num_immed_reply = 0;
15142be7d22fSVladimir Kondratiev 
1515817f1853SVladimir Kondratiev 	if (!test_bit(wil_status_mbox_ready, wil->status)) {
15164cf99c93SDedy Lansky 		wil_err(wil, "Reset in progress. Cannot handle WMI event\n");
151755f7acddSVladimir Kondratiev 		return;
151855f7acddSVladimir Kondratiev 	}
151955f7acddSVladimir Kondratiev 
1520fe9ee51eSMaya Erez 	if (test_bit(wil_status_suspended, wil->status)) {
1521fe9ee51eSMaya Erez 		wil_err(wil, "suspended. cannot handle WMI event\n");
1522fe9ee51eSMaya Erez 		return;
1523fe9ee51eSMaya Erez 	}
1524fe9ee51eSMaya Erez 
1525a715c7ddSVladimir Kondratiev 	for (n = 0;; n++) {
15262be7d22fSVladimir Kondratiev 		u16 len;
152795266dc0SVladimir Kondratiev 		bool q;
15280916d9f2SMaya Erez 		bool immed_reply = false;
15292be7d22fSVladimir Kondratiev 
1530b9eeb512SVladimir Kondratiev 		r->head = wil_r(wil, RGF_MBOX +
15312be7d22fSVladimir Kondratiev 				offsetof(struct wil6210_mbox_ctl, rx.head));
153295266dc0SVladimir Kondratiev 		if (r->tail == r->head)
153395266dc0SVladimir Kondratiev 			break;
15342be7d22fSVladimir Kondratiev 
1535a715c7ddSVladimir Kondratiev 		wil_dbg_wmi(wil, "Mbox head %08x tail %08x\n",
1536a715c7ddSVladimir Kondratiev 			    r->head, r->tail);
1537a715c7ddSVladimir Kondratiev 		/* read cmd descriptor from tail */
15382be7d22fSVladimir Kondratiev 		wil_memcpy_fromio_32(&d_tail, wil->csr + HOSTADDR(r->tail),
15392be7d22fSVladimir Kondratiev 				     sizeof(struct wil6210_mbox_ring_desc));
15402be7d22fSVladimir Kondratiev 		if (d_tail.sync == 0) {
15412be7d22fSVladimir Kondratiev 			wil_err(wil, "Mbox evt not owned by FW?\n");
154295266dc0SVladimir Kondratiev 			break;
15432be7d22fSVladimir Kondratiev 		}
15442be7d22fSVladimir Kondratiev 
1545a715c7ddSVladimir Kondratiev 		/* read cmd header from descriptor */
15462be7d22fSVladimir Kondratiev 		if (0 != wmi_read_hdr(wil, d_tail.addr, &hdr)) {
15472be7d22fSVladimir Kondratiev 			wil_err(wil, "Mbox evt at 0x%08x?\n",
15482be7d22fSVladimir Kondratiev 				le32_to_cpu(d_tail.addr));
154995266dc0SVladimir Kondratiev 			break;
15502be7d22fSVladimir Kondratiev 		}
15512be7d22fSVladimir Kondratiev 		len = le16_to_cpu(hdr.len);
1552a715c7ddSVladimir Kondratiev 		wil_dbg_wmi(wil, "Mbox evt %04x %04x %04x %02x\n",
1553a715c7ddSVladimir Kondratiev 			    le16_to_cpu(hdr.seq), len, le16_to_cpu(hdr.type),
1554a715c7ddSVladimir Kondratiev 			    hdr.flags);
1555a715c7ddSVladimir Kondratiev 
1556a715c7ddSVladimir Kondratiev 		/* read cmd buffer from descriptor */
15572be7d22fSVladimir Kondratiev 		src = wmi_buffer(wil, d_tail.addr) +
15582be7d22fSVladimir Kondratiev 		      sizeof(struct wil6210_mbox_hdr);
15592be7d22fSVladimir Kondratiev 		evt = kmalloc(ALIGN(offsetof(struct pending_wmi_event,
15602be7d22fSVladimir Kondratiev 					     event.wmi) + len, 4),
15612be7d22fSVladimir Kondratiev 			      GFP_KERNEL);
156214f8dc49SJoe Perches 		if (!evt)
156395266dc0SVladimir Kondratiev 			break;
156414f8dc49SJoe Perches 
15652be7d22fSVladimir Kondratiev 		evt->event.hdr = hdr;
15662be7d22fSVladimir Kondratiev 		cmd = (void *)&evt->event.wmi;
15672be7d22fSVladimir Kondratiev 		wil_memcpy_fromio_32(cmd, src, len);
15682be7d22fSVladimir Kondratiev 		/* mark entry as empty */
1569b9eeb512SVladimir Kondratiev 		wil_w(wil, r->tail +
1570b9eeb512SVladimir Kondratiev 		      offsetof(struct wil6210_mbox_ring_desc, sync), 0);
15712be7d22fSVladimir Kondratiev 		/* indicate */
15722be7d22fSVladimir Kondratiev 		if ((hdr.type == WIL_MBOX_HDR_TYPE_WMI) &&
1573b874ddecSLior David 		    (len >= sizeof(struct wmi_cmd_hdr))) {
1574b874ddecSLior David 			struct wmi_cmd_hdr *wmi = &evt->event.wmi;
1575b874ddecSLior David 			u16 id = le16_to_cpu(wmi->command_id);
1576e00243faSLior David 			u8 mid = wmi->mid;
1577b874ddecSLior David 			u32 tstamp = le32_to_cpu(wmi->fw_timestamp);
1578fe9ee51eSMaya Erez 			if (test_bit(wil_status_resuming, wil->status)) {
1579fe9ee51eSMaya Erez 				if (id == WMI_TRAFFIC_RESUME_EVENTID)
1580fe9ee51eSMaya Erez 					clear_bit(wil_status_resuming,
1581fe9ee51eSMaya Erez 						  wil->status);
1582fe9ee51eSMaya Erez 				else
1583fe9ee51eSMaya Erez 					wil_err(wil,
1584fe9ee51eSMaya Erez 						"WMI evt %d while resuming\n",
1585fe9ee51eSMaya Erez 						id);
1586fe9ee51eSMaya Erez 			}
1587fe5c271eSMaya Erez 			spin_lock_irqsave(&wil->wmi_ev_lock, flags);
1588e00243faSLior David 			if (wil->reply_id && wil->reply_id == id &&
1589e00243faSLior David 			    wil->reply_mid == mid) {
15900916d9f2SMaya Erez 				if (wil->reply_buf) {
15910916d9f2SMaya Erez 					memcpy(wil->reply_buf, wmi,
15920916d9f2SMaya Erez 					       min(len, wil->reply_size));
15930916d9f2SMaya Erez 					immed_reply = true;
15940916d9f2SMaya Erez 				}
1595fe9ee51eSMaya Erez 				if (id == WMI_TRAFFIC_SUSPEND_EVENTID) {
1596fe9ee51eSMaya Erez 					wil_dbg_wmi(wil,
1597fe9ee51eSMaya Erez 						    "set suspend_resp_rcvd\n");
1598fe9ee51eSMaya Erez 					wil->suspend_resp_rcvd = true;
1599fe9ee51eSMaya Erez 				}
16000916d9f2SMaya Erez 			}
1601fe5c271eSMaya Erez 			spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
16028fe59627SVladimir Kondratiev 
16035fad7241SDedy Lansky 			wil_dbg_wmi(wil, "recv %s (0x%04x) MID %d @%d msec\n",
16045fad7241SDedy Lansky 				    eventid2name(id), id, wmi->mid, tstamp);
1605f988b23fSVladimir Kondratiev 			trace_wil6210_wmi_event(wmi, &wmi[1],
1606f988b23fSVladimir Kondratiev 						len - sizeof(*wmi));
16072be7d22fSVladimir Kondratiev 		}
16087743882dSVladimir Kondratiev 		wil_hex_dump_wmi("evt ", DUMP_PREFIX_OFFSET, 16, 1,
16092be7d22fSVladimir Kondratiev 				 &evt->event.hdr, sizeof(hdr) + len, true);
16102be7d22fSVladimir Kondratiev 
16112be7d22fSVladimir Kondratiev 		/* advance tail */
16122be7d22fSVladimir Kondratiev 		r->tail = r->base + ((r->tail - r->base +
16132be7d22fSVladimir Kondratiev 			  sizeof(struct wil6210_mbox_ring_desc)) % r->size);
1614b9eeb512SVladimir Kondratiev 		wil_w(wil, RGF_MBOX +
1615b9eeb512SVladimir Kondratiev 		      offsetof(struct wil6210_mbox_ctl, rx.tail), r->tail);
16162be7d22fSVladimir Kondratiev 
16170916d9f2SMaya Erez 		if (immed_reply) {
1618af3db60aSLazar Alexei 			wil_dbg_wmi(wil, "recv_cmd: Complete WMI 0x%04x\n",
1619af3db60aSLazar Alexei 				    wil->reply_id);
16200916d9f2SMaya Erez 			kfree(evt);
16210916d9f2SMaya Erez 			num_immed_reply++;
16220916d9f2SMaya Erez 			complete(&wil->wmi_call);
16230916d9f2SMaya Erez 		} else {
16242be7d22fSVladimir Kondratiev 			/* add to the pending list */
16252be7d22fSVladimir Kondratiev 			spin_lock_irqsave(&wil->wmi_ev_lock, flags);
16262be7d22fSVladimir Kondratiev 			list_add_tail(&evt->list, &wil->pending_wmi_ev);
16272be7d22fSVladimir Kondratiev 			spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
162895266dc0SVladimir Kondratiev 			q = queue_work(wil->wmi_wq, &wil->wmi_event_worker);
16297743882dSVladimir Kondratiev 			wil_dbg_wmi(wil, "queue_work -> %d\n", q);
16302be7d22fSVladimir Kondratiev 		}
16310916d9f2SMaya Erez 	}
163295266dc0SVladimir Kondratiev 	/* normally, 1 event per IRQ should be processed */
1633af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "recv_cmd: -> %d events queued, %d completed\n",
16340916d9f2SMaya Erez 		    n - num_immed_reply, num_immed_reply);
16352be7d22fSVladimir Kondratiev }
16362be7d22fSVladimir Kondratiev 
1637e00243faSLior David int wmi_call(struct wil6210_priv *wil, u16 cmdid, u8 mid, void *buf, u16 len,
16385f85c7e7SLior David 	     u16 reply_id, void *reply, u16 reply_size, int to_msec)
16392be7d22fSVladimir Kondratiev {
16402be7d22fSVladimir Kondratiev 	int rc;
1641f4bbb829SNicholas Mc Guire 	unsigned long remain;
16422be7d22fSVladimir Kondratiev 
16432be7d22fSVladimir Kondratiev 	mutex_lock(&wil->wmi_mutex);
16442be7d22fSVladimir Kondratiev 
1645fe5c271eSMaya Erez 	spin_lock(&wil->wmi_ev_lock);
1646fe5c271eSMaya Erez 	wil->reply_id = reply_id;
1647e00243faSLior David 	wil->reply_mid = mid;
1648fe5c271eSMaya Erez 	wil->reply_buf = reply;
1649fe5c271eSMaya Erez 	wil->reply_size = reply_size;
16504d4c4dc3SLior David 	reinit_completion(&wil->wmi_call);
1651fe5c271eSMaya Erez 	spin_unlock(&wil->wmi_ev_lock);
1652fe5c271eSMaya Erez 
1653e00243faSLior David 	rc = __wmi_send(wil, cmdid, mid, buf, len);
16542be7d22fSVladimir Kondratiev 	if (rc)
16552be7d22fSVladimir Kondratiev 		goto out;
16562be7d22fSVladimir Kondratiev 
165759502647SDedy Lansky 	remain = wait_for_completion_timeout(&wil->wmi_call,
16582be7d22fSVladimir Kondratiev 					     msecs_to_jiffies(to_msec));
16592be7d22fSVladimir Kondratiev 	if (0 == remain) {
16602be7d22fSVladimir Kondratiev 		wil_err(wil, "wmi_call(0x%04x->0x%04x) timeout %d msec\n",
16612be7d22fSVladimir Kondratiev 			cmdid, reply_id, to_msec);
16622be7d22fSVladimir Kondratiev 		rc = -ETIME;
16632be7d22fSVladimir Kondratiev 	} else {
16647743882dSVladimir Kondratiev 		wil_dbg_wmi(wil,
16652be7d22fSVladimir Kondratiev 			    "wmi_call(0x%04x->0x%04x) completed in %d msec\n",
16662be7d22fSVladimir Kondratiev 			    cmdid, reply_id,
16672be7d22fSVladimir Kondratiev 			    to_msec - jiffies_to_msecs(remain));
16682be7d22fSVladimir Kondratiev 	}
1669fe5c271eSMaya Erez 
1670fe5c271eSMaya Erez out:
1671fe5c271eSMaya Erez 	spin_lock(&wil->wmi_ev_lock);
16722be7d22fSVladimir Kondratiev 	wil->reply_id = 0;
1673e00243faSLior David 	wil->reply_mid = U8_MAX;
16742be7d22fSVladimir Kondratiev 	wil->reply_buf = NULL;
16752be7d22fSVladimir Kondratiev 	wil->reply_size = 0;
1676fe5c271eSMaya Erez 	spin_unlock(&wil->wmi_ev_lock);
1677fe5c271eSMaya Erez 
16782be7d22fSVladimir Kondratiev 	mutex_unlock(&wil->wmi_mutex);
16792be7d22fSVladimir Kondratiev 
16802be7d22fSVladimir Kondratiev 	return rc;
16812be7d22fSVladimir Kondratiev }
16822be7d22fSVladimir Kondratiev 
16832be7d22fSVladimir Kondratiev int wmi_echo(struct wil6210_priv *wil)
16842be7d22fSVladimir Kondratiev {
1685e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
16862be7d22fSVladimir Kondratiev 	struct wmi_echo_cmd cmd = {
16872be7d22fSVladimir Kondratiev 		.value = cpu_to_le32(0x12345678),
16882be7d22fSVladimir Kondratiev 	};
16892be7d22fSVladimir Kondratiev 
1690e00243faSLior David 	return wmi_call(wil, WMI_ECHO_CMDID, vif->mid, &cmd, sizeof(cmd),
1691a54a40daSVladimir Kondratiev 			WMI_ECHO_RSP_EVENTID, NULL, 0, 50);
16922be7d22fSVladimir Kondratiev }
16932be7d22fSVladimir Kondratiev 
16942be7d22fSVladimir Kondratiev int wmi_set_mac_address(struct wil6210_priv *wil, void *addr)
16952be7d22fSVladimir Kondratiev {
1696e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
16972be7d22fSVladimir Kondratiev 	struct wmi_set_mac_address_cmd cmd;
16982be7d22fSVladimir Kondratiev 
1699a82553bbSVladimir Kondratiev 	ether_addr_copy(cmd.mac, addr);
17002be7d22fSVladimir Kondratiev 
17017743882dSVladimir Kondratiev 	wil_dbg_wmi(wil, "Set MAC %pM\n", addr);
17022be7d22fSVladimir Kondratiev 
1703e00243faSLior David 	return wmi_send(wil, WMI_SET_MAC_ADDRESS_CMDID, vif->mid,
1704e00243faSLior David 			&cmd, sizeof(cmd));
17052be7d22fSVladimir Kondratiev }
17062be7d22fSVladimir Kondratiev 
170710d599adSMaya Erez int wmi_led_cfg(struct wil6210_priv *wil, bool enable)
170810d599adSMaya Erez {
1709e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
171010d599adSMaya Erez 	int rc = 0;
171110d599adSMaya Erez 	struct wmi_led_cfg_cmd cmd = {
171210d599adSMaya Erez 		.led_mode = enable,
171310d599adSMaya Erez 		.id = led_id,
171410d599adSMaya Erez 		.slow_blink_cfg.blink_on =
171510d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_SLOW].on_ms),
171610d599adSMaya Erez 		.slow_blink_cfg.blink_off =
171710d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_SLOW].off_ms),
171810d599adSMaya Erez 		.medium_blink_cfg.blink_on =
171910d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_MED].on_ms),
172010d599adSMaya Erez 		.medium_blink_cfg.blink_off =
172110d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_MED].off_ms),
172210d599adSMaya Erez 		.fast_blink_cfg.blink_on =
172310d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_FAST].on_ms),
172410d599adSMaya Erez 		.fast_blink_cfg.blink_off =
172510d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_FAST].off_ms),
172610d599adSMaya Erez 		.led_polarity = led_polarity,
172710d599adSMaya Erez 	};
172810d599adSMaya Erez 	struct {
172910d599adSMaya Erez 		struct wmi_cmd_hdr wmi;
173010d599adSMaya Erez 		struct wmi_led_cfg_done_event evt;
1731807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1732807b0860SAlexei Avshalom Lazar 		.evt = {.status = cpu_to_le32(WMI_FW_STATUS_FAILURE)},
1733807b0860SAlexei Avshalom Lazar 	};
173410d599adSMaya Erez 
173510d599adSMaya Erez 	if (led_id == WIL_LED_INVALID_ID)
173610d599adSMaya Erez 		goto out;
173710d599adSMaya Erez 
173810d599adSMaya Erez 	if (led_id > WIL_LED_MAX_ID) {
173910d599adSMaya Erez 		wil_err(wil, "Invalid led id %d\n", led_id);
174010d599adSMaya Erez 		rc = -EINVAL;
174110d599adSMaya Erez 		goto out;
174210d599adSMaya Erez 	}
174310d599adSMaya Erez 
174410d599adSMaya Erez 	wil_dbg_wmi(wil,
174510d599adSMaya Erez 		    "%s led %d\n",
174610d599adSMaya Erez 		    enable ? "enabling" : "disabling", led_id);
174710d599adSMaya Erez 
1748e00243faSLior David 	rc = wmi_call(wil, WMI_LED_CFG_CMDID, vif->mid, &cmd, sizeof(cmd),
174910d599adSMaya Erez 		      WMI_LED_CFG_DONE_EVENTID, &reply, sizeof(reply),
175010d599adSMaya Erez 		      100);
175110d599adSMaya Erez 	if (rc)
175210d599adSMaya Erez 		goto out;
175310d599adSMaya Erez 
175410d599adSMaya Erez 	if (reply.evt.status) {
175510d599adSMaya Erez 		wil_err(wil, "led %d cfg failed with status %d\n",
175610d599adSMaya Erez 			led_id, le32_to_cpu(reply.evt.status));
175710d599adSMaya Erez 		rc = -EINVAL;
175810d599adSMaya Erez 	}
175910d599adSMaya Erez 
176010d599adSMaya Erez out:
176110d599adSMaya Erez 	return rc;
176210d599adSMaya Erez }
176310d599adSMaya Erez 
1764e00243faSLior David int wmi_pcp_start(struct wil6210_vif *vif,
1765e00243faSLior David 		  int bi, u8 wmi_nettype, u8 chan, u8 hidden_ssid, u8 is_go)
17662be7d22fSVladimir Kondratiev {
1767e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1768b8023177SVladimir Kondratiev 	int rc;
1769b8023177SVladimir Kondratiev 
1770b8023177SVladimir Kondratiev 	struct wmi_pcp_start_cmd cmd = {
17712be7d22fSVladimir Kondratiev 		.bcon_interval = cpu_to_le16(bi),
17722be7d22fSVladimir Kondratiev 		.network_type = wmi_nettype,
17732be7d22fSVladimir Kondratiev 		.disable_sec_offload = 1,
1774adc2d122SVladimir Kondratiev 		.channel = chan - 1,
17751eb9d1e5SDedy Lansky 		.pcp_max_assoc_sta = max_assoc_sta,
17768e52fe30SHamad Kadmany 		.hidden_ssid = hidden_ssid,
1777b4944f2cSLior David 		.is_go = is_go,
17788a4fa214SAhmad Masri 		.ap_sme_offload_mode = disable_ap_sme ?
17798a4fa214SAhmad Masri 				       WMI_AP_SME_OFFLOAD_PARTIAL :
17808a4fa214SAhmad Masri 				       WMI_AP_SME_OFFLOAD_FULL,
1781c3bfea05SLior David 		.abft_len = wil->abft_len,
17822be7d22fSVladimir Kondratiev 	};
1783b8023177SVladimir Kondratiev 	struct {
1784b874ddecSLior David 		struct wmi_cmd_hdr wmi;
1785b8023177SVladimir Kondratiev 		struct wmi_pcp_started_event evt;
1786807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1787807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1788807b0860SAlexei Avshalom Lazar 	};
17892be7d22fSVladimir Kondratiev 
1790e00243faSLior David 	if (!vif->privacy)
17912be7d22fSVladimir Kondratiev 		cmd.disable_sec = 1;
17922be7d22fSVladimir Kondratiev 
17931eb9d1e5SDedy Lansky 	if ((cmd.pcp_max_assoc_sta > WIL6210_MAX_CID) ||
17941eb9d1e5SDedy Lansky 	    (cmd.pcp_max_assoc_sta <= 0)) {
17951eb9d1e5SDedy Lansky 		wil_info(wil,
17961eb9d1e5SDedy Lansky 			 "Requested connection limit %u, valid values are 1 - %d. Setting to %d\n",
17971eb9d1e5SDedy Lansky 			 max_assoc_sta, WIL6210_MAX_CID, WIL6210_MAX_CID);
17981eb9d1e5SDedy Lansky 		cmd.pcp_max_assoc_sta = WIL6210_MAX_CID;
17991eb9d1e5SDedy Lansky 	}
18001eb9d1e5SDedy Lansky 
1801849a564bSDedy Lansky 	if (disable_ap_sme &&
18028a4fa214SAhmad Masri 	    !test_bit(WMI_FW_CAPABILITY_AP_SME_OFFLOAD_PARTIAL,
1803849a564bSDedy Lansky 		      wil->fw_capabilities)) {
1804849a564bSDedy Lansky 		wil_err(wil, "disable_ap_sme not supported by FW\n");
1805849a564bSDedy Lansky 		return -EOPNOTSUPP;
1806849a564bSDedy Lansky 	}
1807849a564bSDedy Lansky 
18088b5c7f6cSVladimir Kondratiev 	/*
18098b5c7f6cSVladimir Kondratiev 	 * Processing time may be huge, in case of secure AP it takes about
18108b5c7f6cSVladimir Kondratiev 	 * 3500ms for FW to start AP
18118b5c7f6cSVladimir Kondratiev 	 */
1812e00243faSLior David 	rc = wmi_call(wil, WMI_PCP_START_CMDID, vif->mid, &cmd, sizeof(cmd),
18138b5c7f6cSVladimir Kondratiev 		      WMI_PCP_STARTED_EVENTID, &reply, sizeof(reply), 5000);
1814b8023177SVladimir Kondratiev 	if (rc)
1815b8023177SVladimir Kondratiev 		return rc;
1816b8023177SVladimir Kondratiev 
1817b8023177SVladimir Kondratiev 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS)
1818b8023177SVladimir Kondratiev 		rc = -EINVAL;
1819b8023177SVladimir Kondratiev 
182010d599adSMaya Erez 	if (wmi_nettype != WMI_NETTYPE_P2P)
182110d599adSMaya Erez 		/* Don't fail due to error in the led configuration */
182210d599adSMaya Erez 		wmi_led_cfg(wil, true);
182310d599adSMaya Erez 
1824b8023177SVladimir Kondratiev 	return rc;
1825b8023177SVladimir Kondratiev }
1826b8023177SVladimir Kondratiev 
1827e00243faSLior David int wmi_pcp_stop(struct wil6210_vif *vif)
1828b8023177SVladimir Kondratiev {
1829e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
183010d599adSMaya Erez 	int rc;
183110d599adSMaya Erez 
183210d599adSMaya Erez 	rc = wmi_led_cfg(wil, false);
183310d599adSMaya Erez 	if (rc)
183410d599adSMaya Erez 		return rc;
183510d599adSMaya Erez 
1836e00243faSLior David 	return wmi_call(wil, WMI_PCP_STOP_CMDID, vif->mid, NULL, 0,
1837b8023177SVladimir Kondratiev 			WMI_PCP_STOPPED_EVENTID, NULL, 0, 20);
18382be7d22fSVladimir Kondratiev }
18392be7d22fSVladimir Kondratiev 
1840e00243faSLior David int wmi_set_ssid(struct wil6210_vif *vif, u8 ssid_len, const void *ssid)
18412be7d22fSVladimir Kondratiev {
1842e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
18432be7d22fSVladimir Kondratiev 	struct wmi_set_ssid_cmd cmd = {
18442be7d22fSVladimir Kondratiev 		.ssid_len = cpu_to_le32(ssid_len),
18452be7d22fSVladimir Kondratiev 	};
18462be7d22fSVladimir Kondratiev 
18472be7d22fSVladimir Kondratiev 	if (ssid_len > sizeof(cmd.ssid))
18482be7d22fSVladimir Kondratiev 		return -EINVAL;
18492be7d22fSVladimir Kondratiev 
18502be7d22fSVladimir Kondratiev 	memcpy(cmd.ssid, ssid, ssid_len);
18512be7d22fSVladimir Kondratiev 
1852e00243faSLior David 	return wmi_send(wil, WMI_SET_SSID_CMDID, vif->mid, &cmd, sizeof(cmd));
18532be7d22fSVladimir Kondratiev }
18542be7d22fSVladimir Kondratiev 
1855e00243faSLior David int wmi_get_ssid(struct wil6210_vif *vif, u8 *ssid_len, void *ssid)
18562be7d22fSVladimir Kondratiev {
1857e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
18582be7d22fSVladimir Kondratiev 	int rc;
18592be7d22fSVladimir Kondratiev 	struct {
1860b874ddecSLior David 		struct wmi_cmd_hdr wmi;
18612be7d22fSVladimir Kondratiev 		struct wmi_set_ssid_cmd cmd;
18622be7d22fSVladimir Kondratiev 	} __packed reply;
18632be7d22fSVladimir Kondratiev 	int len; /* reply.cmd.ssid_len in CPU order */
18642be7d22fSVladimir Kondratiev 
1865807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
1866807b0860SAlexei Avshalom Lazar 
1867e00243faSLior David 	rc = wmi_call(wil, WMI_GET_SSID_CMDID, vif->mid, NULL, 0,
1868e00243faSLior David 		      WMI_GET_SSID_EVENTID, &reply, sizeof(reply), 20);
18692be7d22fSVladimir Kondratiev 	if (rc)
18702be7d22fSVladimir Kondratiev 		return rc;
18712be7d22fSVladimir Kondratiev 
18722be7d22fSVladimir Kondratiev 	len = le32_to_cpu(reply.cmd.ssid_len);
18732be7d22fSVladimir Kondratiev 	if (len > sizeof(reply.cmd.ssid))
18742be7d22fSVladimir Kondratiev 		return -EINVAL;
18752be7d22fSVladimir Kondratiev 
18762be7d22fSVladimir Kondratiev 	*ssid_len = len;
18772be7d22fSVladimir Kondratiev 	memcpy(ssid, reply.cmd.ssid, len);
18782be7d22fSVladimir Kondratiev 
18792be7d22fSVladimir Kondratiev 	return 0;
18802be7d22fSVladimir Kondratiev }
18812be7d22fSVladimir Kondratiev 
18822be7d22fSVladimir Kondratiev int wmi_set_channel(struct wil6210_priv *wil, int channel)
18832be7d22fSVladimir Kondratiev {
1884e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
18852be7d22fSVladimir Kondratiev 	struct wmi_set_pcp_channel_cmd cmd = {
18862be7d22fSVladimir Kondratiev 		.channel = channel - 1,
18872be7d22fSVladimir Kondratiev 	};
18882be7d22fSVladimir Kondratiev 
1889e00243faSLior David 	return wmi_send(wil, WMI_SET_PCP_CHANNEL_CMDID, vif->mid,
1890e00243faSLior David 			&cmd, sizeof(cmd));
18912be7d22fSVladimir Kondratiev }
18922be7d22fSVladimir Kondratiev 
18932be7d22fSVladimir Kondratiev int wmi_get_channel(struct wil6210_priv *wil, int *channel)
18942be7d22fSVladimir Kondratiev {
1895e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
18962be7d22fSVladimir Kondratiev 	int rc;
18972be7d22fSVladimir Kondratiev 	struct {
1898b874ddecSLior David 		struct wmi_cmd_hdr wmi;
18992be7d22fSVladimir Kondratiev 		struct wmi_set_pcp_channel_cmd cmd;
19002be7d22fSVladimir Kondratiev 	} __packed reply;
19012be7d22fSVladimir Kondratiev 
1902807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
1903807b0860SAlexei Avshalom Lazar 
1904e00243faSLior David 	rc = wmi_call(wil, WMI_GET_PCP_CHANNEL_CMDID, vif->mid, NULL, 0,
19052be7d22fSVladimir Kondratiev 		      WMI_GET_PCP_CHANNEL_EVENTID, &reply, sizeof(reply), 20);
19062be7d22fSVladimir Kondratiev 	if (rc)
19072be7d22fSVladimir Kondratiev 		return rc;
19082be7d22fSVladimir Kondratiev 
19092be7d22fSVladimir Kondratiev 	if (reply.cmd.channel > 3)
19102be7d22fSVladimir Kondratiev 		return -EINVAL;
19112be7d22fSVladimir Kondratiev 
19122be7d22fSVladimir Kondratiev 	*channel = reply.cmd.channel + 1;
19132be7d22fSVladimir Kondratiev 
19142be7d22fSVladimir Kondratiev 	return 0;
19152be7d22fSVladimir Kondratiev }
19162be7d22fSVladimir Kondratiev 
1917e00243faSLior David int wmi_p2p_cfg(struct wil6210_vif *vif, int channel, int bi)
1918b8023177SVladimir Kondratiev {
1919e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1920e6d68341SDedy Lansky 	int rc;
1921b8023177SVladimir Kondratiev 	struct wmi_p2p_cfg_cmd cmd = {
1922e6d68341SDedy Lansky 		.discovery_mode = WMI_DISCOVERY_MODE_PEER2PEER,
1923e6d68341SDedy Lansky 		.bcon_interval = cpu_to_le16(bi),
1924b8023177SVladimir Kondratiev 		.channel = channel - 1,
1925b8023177SVladimir Kondratiev 	};
1926e6d68341SDedy Lansky 	struct {
1927e6d68341SDedy Lansky 		struct wmi_cmd_hdr wmi;
1928e6d68341SDedy Lansky 		struct wmi_p2p_cfg_done_event evt;
1929807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1930807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1931807b0860SAlexei Avshalom Lazar 	};
1932b8023177SVladimir Kondratiev 
1933e6d68341SDedy Lansky 	wil_dbg_wmi(wil, "sending WMI_P2P_CFG_CMDID\n");
1934e6d68341SDedy Lansky 
1935e00243faSLior David 	rc = wmi_call(wil, WMI_P2P_CFG_CMDID, vif->mid, &cmd, sizeof(cmd),
1936e6d68341SDedy Lansky 		      WMI_P2P_CFG_DONE_EVENTID, &reply, sizeof(reply), 300);
1937e6d68341SDedy Lansky 	if (!rc && reply.evt.status != WMI_FW_STATUS_SUCCESS) {
1938e6d68341SDedy Lansky 		wil_err(wil, "P2P_CFG failed. status %d\n", reply.evt.status);
1939e6d68341SDedy Lansky 		rc = -EINVAL;
1940e6d68341SDedy Lansky 	}
1941e6d68341SDedy Lansky 
1942e6d68341SDedy Lansky 	return rc;
1943e6d68341SDedy Lansky }
1944e6d68341SDedy Lansky 
1945e00243faSLior David int wmi_start_listen(struct wil6210_vif *vif)
1946e6d68341SDedy Lansky {
1947e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1948e6d68341SDedy Lansky 	int rc;
1949e6d68341SDedy Lansky 	struct {
1950e6d68341SDedy Lansky 		struct wmi_cmd_hdr wmi;
1951e6d68341SDedy Lansky 		struct wmi_listen_started_event evt;
1952807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1953807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1954807b0860SAlexei Avshalom Lazar 	};
1955e6d68341SDedy Lansky 
1956e6d68341SDedy Lansky 	wil_dbg_wmi(wil, "sending WMI_START_LISTEN_CMDID\n");
1957e6d68341SDedy Lansky 
1958e00243faSLior David 	rc = wmi_call(wil, WMI_START_LISTEN_CMDID, vif->mid, NULL, 0,
1959e6d68341SDedy Lansky 		      WMI_LISTEN_STARTED_EVENTID, &reply, sizeof(reply), 300);
1960e6d68341SDedy Lansky 	if (!rc && reply.evt.status != WMI_FW_STATUS_SUCCESS) {
1961e6d68341SDedy Lansky 		wil_err(wil, "device failed to start listen. status %d\n",
1962e6d68341SDedy Lansky 			reply.evt.status);
1963e6d68341SDedy Lansky 		rc = -EINVAL;
1964e6d68341SDedy Lansky 	}
1965e6d68341SDedy Lansky 
1966e6d68341SDedy Lansky 	return rc;
1967e6d68341SDedy Lansky }
1968e6d68341SDedy Lansky 
1969e00243faSLior David int wmi_start_search(struct wil6210_vif *vif)
1970e6d68341SDedy Lansky {
1971e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1972e6d68341SDedy Lansky 	int rc;
1973e6d68341SDedy Lansky 	struct {
1974e6d68341SDedy Lansky 		struct wmi_cmd_hdr wmi;
1975e6d68341SDedy Lansky 		struct wmi_search_started_event evt;
1976807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1977807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1978807b0860SAlexei Avshalom Lazar 	};
1979e6d68341SDedy Lansky 
1980e6d68341SDedy Lansky 	wil_dbg_wmi(wil, "sending WMI_START_SEARCH_CMDID\n");
1981e6d68341SDedy Lansky 
1982e00243faSLior David 	rc = wmi_call(wil, WMI_START_SEARCH_CMDID, vif->mid, NULL, 0,
1983e6d68341SDedy Lansky 		      WMI_SEARCH_STARTED_EVENTID, &reply, sizeof(reply), 300);
1984e6d68341SDedy Lansky 	if (!rc && reply.evt.status != WMI_FW_STATUS_SUCCESS) {
1985e6d68341SDedy Lansky 		wil_err(wil, "device failed to start search. status %d\n",
1986e6d68341SDedy Lansky 			reply.evt.status);
1987e6d68341SDedy Lansky 		rc = -EINVAL;
1988e6d68341SDedy Lansky 	}
1989e6d68341SDedy Lansky 
1990e6d68341SDedy Lansky 	return rc;
1991e6d68341SDedy Lansky }
1992e6d68341SDedy Lansky 
1993e00243faSLior David int wmi_stop_discovery(struct wil6210_vif *vif)
1994e6d68341SDedy Lansky {
1995e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1996e6d68341SDedy Lansky 	int rc;
1997e6d68341SDedy Lansky 
1998e6d68341SDedy Lansky 	wil_dbg_wmi(wil, "sending WMI_DISCOVERY_STOP_CMDID\n");
1999e6d68341SDedy Lansky 
2000e00243faSLior David 	rc = wmi_call(wil, WMI_DISCOVERY_STOP_CMDID, vif->mid, NULL, 0,
2001e6d68341SDedy Lansky 		      WMI_DISCOVERY_STOPPED_EVENTID, NULL, 0, 100);
2002e6d68341SDedy Lansky 
2003e6d68341SDedy Lansky 	if (rc)
2004e6d68341SDedy Lansky 		wil_err(wil, "Failed to stop discovery\n");
2005e6d68341SDedy Lansky 
2006e6d68341SDedy Lansky 	return rc;
2007b8023177SVladimir Kondratiev }
2008b8023177SVladimir Kondratiev 
2009e00243faSLior David int wmi_del_cipher_key(struct wil6210_vif *vif, u8 key_index,
2010230d8442SVladimir Kondratiev 		       const void *mac_addr, int key_usage)
20112be7d22fSVladimir Kondratiev {
2012e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
20132be7d22fSVladimir Kondratiev 	struct wmi_delete_cipher_key_cmd cmd = {
20142be7d22fSVladimir Kondratiev 		.key_index = key_index,
20152be7d22fSVladimir Kondratiev 	};
20162be7d22fSVladimir Kondratiev 
20172be7d22fSVladimir Kondratiev 	if (mac_addr)
20182be7d22fSVladimir Kondratiev 		memcpy(cmd.mac, mac_addr, WMI_MAC_LEN);
20192be7d22fSVladimir Kondratiev 
2020e00243faSLior David 	return wmi_send(wil, WMI_DELETE_CIPHER_KEY_CMDID, vif->mid,
2021e00243faSLior David 			&cmd, sizeof(cmd));
20222be7d22fSVladimir Kondratiev }
20232be7d22fSVladimir Kondratiev 
2024e00243faSLior David int wmi_add_cipher_key(struct wil6210_vif *vif, u8 key_index,
2025230d8442SVladimir Kondratiev 		       const void *mac_addr, int key_len, const void *key,
2026230d8442SVladimir Kondratiev 		       int key_usage)
20272be7d22fSVladimir Kondratiev {
2028e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
20292be7d22fSVladimir Kondratiev 	struct wmi_add_cipher_key_cmd cmd = {
20302be7d22fSVladimir Kondratiev 		.key_index = key_index,
2031230d8442SVladimir Kondratiev 		.key_usage = key_usage,
20322be7d22fSVladimir Kondratiev 		.key_len = key_len,
20332be7d22fSVladimir Kondratiev 	};
20342be7d22fSVladimir Kondratiev 
20352be7d22fSVladimir Kondratiev 	if (!key || (key_len > sizeof(cmd.key)))
20362be7d22fSVladimir Kondratiev 		return -EINVAL;
20372be7d22fSVladimir Kondratiev 
20382be7d22fSVladimir Kondratiev 	memcpy(cmd.key, key, key_len);
20392be7d22fSVladimir Kondratiev 	if (mac_addr)
20402be7d22fSVladimir Kondratiev 		memcpy(cmd.mac, mac_addr, WMI_MAC_LEN);
20412be7d22fSVladimir Kondratiev 
2042e00243faSLior David 	return wmi_send(wil, WMI_ADD_CIPHER_KEY_CMDID, vif->mid,
2043e00243faSLior David 			&cmd, sizeof(cmd));
20442be7d22fSVladimir Kondratiev }
20452be7d22fSVladimir Kondratiev 
2046e00243faSLior David int wmi_set_ie(struct wil6210_vif *vif, u8 type, u16 ie_len, const void *ie)
20472be7d22fSVladimir Kondratiev {
2048e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
20495421bf0cSVladimir Kondratiev 	static const char *const names[] = {
20505421bf0cSVladimir Kondratiev 		[WMI_FRAME_BEACON]	= "BEACON",
20515421bf0cSVladimir Kondratiev 		[WMI_FRAME_PROBE_REQ]	= "PROBE_REQ",
20525421bf0cSVladimir Kondratiev 		[WMI_FRAME_PROBE_RESP]	= "WMI_FRAME_PROBE_RESP",
20535421bf0cSVladimir Kondratiev 		[WMI_FRAME_ASSOC_REQ]	= "WMI_FRAME_ASSOC_REQ",
20545421bf0cSVladimir Kondratiev 		[WMI_FRAME_ASSOC_RESP]	= "WMI_FRAME_ASSOC_RESP",
20555421bf0cSVladimir Kondratiev 	};
20562be7d22fSVladimir Kondratiev 	int rc;
20572be7d22fSVladimir Kondratiev 	u16 len = sizeof(struct wmi_set_appie_cmd) + ie_len;
2058b5a8ffcaSLior David 	struct wmi_set_appie_cmd *cmd;
20598fe59627SVladimir Kondratiev 
2060b5a8ffcaSLior David 	if (len < ie_len) {
2061b5a8ffcaSLior David 		rc = -EINVAL;
2062b5a8ffcaSLior David 		goto out;
2063b5a8ffcaSLior David 	}
2064b5a8ffcaSLior David 
2065b5a8ffcaSLior David 	cmd = kzalloc(len, GFP_KERNEL);
20665421bf0cSVladimir Kondratiev 	if (!cmd) {
20675421bf0cSVladimir Kondratiev 		rc = -ENOMEM;
20685421bf0cSVladimir Kondratiev 		goto out;
20695421bf0cSVladimir Kondratiev 	}
2070ac4acdb7SVladimir Kondratiev 	if (!ie)
2071ac4acdb7SVladimir Kondratiev 		ie_len = 0;
20722be7d22fSVladimir Kondratiev 
20732be7d22fSVladimir Kondratiev 	cmd->mgmt_frm_type = type;
20742be7d22fSVladimir Kondratiev 	/* BUG: FW API define ieLen as u8. Will fix FW */
20752be7d22fSVladimir Kondratiev 	cmd->ie_len = cpu_to_le16(ie_len);
20762be7d22fSVladimir Kondratiev 	memcpy(cmd->ie_info, ie, ie_len);
2077e00243faSLior David 	rc = wmi_send(wil, WMI_SET_APPIE_CMDID, vif->mid, cmd, len);
20782be7d22fSVladimir Kondratiev 	kfree(cmd);
20795421bf0cSVladimir Kondratiev out:
20805421bf0cSVladimir Kondratiev 	if (rc) {
20815421bf0cSVladimir Kondratiev 		const char *name = type < ARRAY_SIZE(names) ?
20825421bf0cSVladimir Kondratiev 				   names[type] : "??";
20835421bf0cSVladimir Kondratiev 		wil_err(wil, "set_ie(%d %s) failed : %d\n", type, name, rc);
20845421bf0cSVladimir Kondratiev 	}
20852be7d22fSVladimir Kondratiev 
20862be7d22fSVladimir Kondratiev 	return rc;
20872be7d22fSVladimir Kondratiev }
20882be7d22fSVladimir Kondratiev 
20891647f12fSVladimir Kondratiev /**
20901647f12fSVladimir Kondratiev  * wmi_rxon - turn radio on/off
20911647f12fSVladimir Kondratiev  * @on:		turn on if true, off otherwise
20921647f12fSVladimir Kondratiev  *
20931647f12fSVladimir Kondratiev  * Only switch radio. Channel should be set separately.
20941647f12fSVladimir Kondratiev  * No timeout for rxon - radio turned on forever unless some other call
20951647f12fSVladimir Kondratiev  * turns it off
20961647f12fSVladimir Kondratiev  */
20971647f12fSVladimir Kondratiev int wmi_rxon(struct wil6210_priv *wil, bool on)
20981647f12fSVladimir Kondratiev {
2099e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
21001647f12fSVladimir Kondratiev 	int rc;
21011647f12fSVladimir Kondratiev 	struct {
2102b874ddecSLior David 		struct wmi_cmd_hdr wmi;
21031647f12fSVladimir Kondratiev 		struct wmi_listen_started_event evt;
2104807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2105807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
2106807b0860SAlexei Avshalom Lazar 	};
21071647f12fSVladimir Kondratiev 
2108af3db60aSLazar Alexei 	wil_info(wil, "(%s)\n", on ? "on" : "off");
21091647f12fSVladimir Kondratiev 
21101647f12fSVladimir Kondratiev 	if (on) {
2111e00243faSLior David 		rc = wmi_call(wil, WMI_START_LISTEN_CMDID, vif->mid, NULL, 0,
21121647f12fSVladimir Kondratiev 			      WMI_LISTEN_STARTED_EVENTID,
21131647f12fSVladimir Kondratiev 			      &reply, sizeof(reply), 100);
21141647f12fSVladimir Kondratiev 		if ((rc == 0) && (reply.evt.status != WMI_FW_STATUS_SUCCESS))
21151647f12fSVladimir Kondratiev 			rc = -EINVAL;
21161647f12fSVladimir Kondratiev 	} else {
2117e00243faSLior David 		rc = wmi_call(wil, WMI_DISCOVERY_STOP_CMDID, vif->mid, NULL, 0,
21181647f12fSVladimir Kondratiev 			      WMI_DISCOVERY_STOPPED_EVENTID, NULL, 0, 20);
21191647f12fSVladimir Kondratiev 	}
21201647f12fSVladimir Kondratiev 
21211647f12fSVladimir Kondratiev 	return rc;
21221647f12fSVladimir Kondratiev }
21231647f12fSVladimir Kondratiev 
212410590c6aSGidon Studinski int wmi_rx_chain_add(struct wil6210_priv *wil, struct wil_ring *vring)
212547e19af9SVladimir Kondratiev {
2126e00243faSLior David 	struct net_device *ndev = wil->main_ndev;
2127e00243faSLior David 	struct wireless_dev *wdev = ndev->ieee80211_ptr;
2128e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(ndev);
212947e19af9SVladimir Kondratiev 	struct wmi_cfg_rx_chain_cmd cmd = {
213047e19af9SVladimir Kondratiev 		.action = WMI_RX_CHAIN_ADD,
213147e19af9SVladimir Kondratiev 		.rx_sw_ring = {
213252a45702SLior David 			.max_mpdu_size = cpu_to_le16(
213352a45702SLior David 				wil_mtu2macbuf(wil->rx_buf_len)),
213447e19af9SVladimir Kondratiev 			.ring_mem_base = cpu_to_le64(vring->pa),
213547e19af9SVladimir Kondratiev 			.ring_size = cpu_to_le16(vring->size),
213647e19af9SVladimir Kondratiev 		},
213747e19af9SVladimir Kondratiev 		.mid = 0, /* TODO - what is it? */
213847e19af9SVladimir Kondratiev 		.decap_trans_type = WMI_DECAP_TYPE_802_3,
2139b4490f42SVladimir Kondratiev 		.reorder_type = WMI_RX_SW_REORDER,
2140ab954628SVladimir Kondratiev 		.host_thrsh = cpu_to_le16(rx_ring_overflow_thrsh),
214147e19af9SVladimir Kondratiev 	};
214247e19af9SVladimir Kondratiev 	struct {
2143b874ddecSLior David 		struct wmi_cmd_hdr wmi;
214447e19af9SVladimir Kondratiev 		struct wmi_cfg_rx_chain_done_event evt;
214547e19af9SVladimir Kondratiev 	} __packed evt;
214647e19af9SVladimir Kondratiev 	int rc;
214747e19af9SVladimir Kondratiev 
2148807b0860SAlexei Avshalom Lazar 	memset(&evt, 0, sizeof(evt));
2149807b0860SAlexei Avshalom Lazar 
215047e19af9SVladimir Kondratiev 	if (wdev->iftype == NL80211_IFTYPE_MONITOR) {
21517d3e4dbeSLior David 		struct ieee80211_channel *ch = wil->monitor_chandef.chan;
215247e19af9SVladimir Kondratiev 
215347e19af9SVladimir Kondratiev 		cmd.sniffer_cfg.mode = cpu_to_le32(WMI_SNIFFER_ON);
215447e19af9SVladimir Kondratiev 		if (ch)
215547e19af9SVladimir Kondratiev 			cmd.sniffer_cfg.channel = ch->hw_value - 1;
215647e19af9SVladimir Kondratiev 		cmd.sniffer_cfg.phy_info_mode =
215747e19af9SVladimir Kondratiev 			cpu_to_le32(ndev->type == ARPHRD_IEEE80211_RADIOTAP);
215847e19af9SVladimir Kondratiev 		cmd.sniffer_cfg.phy_support =
215947e19af9SVladimir Kondratiev 			cpu_to_le32((wil->monitor_flags & MONITOR_FLAG_CONTROL)
21604765332dSVladimir Kondratiev 				    ? WMI_SNIFFER_CP : WMI_SNIFFER_BOTH_PHYS);
2161504937d4SKirshenbaum Erez 	} else {
2162504937d4SKirshenbaum Erez 		/* Initialize offload (in non-sniffer mode).
2163504937d4SKirshenbaum Erez 		 * Linux IP stack always calculates IP checksum
2164504937d4SKirshenbaum Erez 		 * HW always calculate TCP/UDP checksum
2165504937d4SKirshenbaum Erez 		 */
2166504937d4SKirshenbaum Erez 		cmd.l3_l4_ctrl |= (1 << L3_L4_CTRL_TCPIP_CHECKSUM_EN_POS);
216747e19af9SVladimir Kondratiev 	}
2168c406ea7cSVladimir Kondratiev 
2169c406ea7cSVladimir Kondratiev 	if (rx_align_2)
2170c406ea7cSVladimir Kondratiev 		cmd.l2_802_3_offload_ctrl |=
2171c406ea7cSVladimir Kondratiev 				L2_802_3_OFFLOAD_CTRL_SNAP_KEEP_MSK;
2172c406ea7cSVladimir Kondratiev 
217347e19af9SVladimir Kondratiev 	/* typical time for secure PCP is 840ms */
2174e00243faSLior David 	rc = wmi_call(wil, WMI_CFG_RX_CHAIN_CMDID, vif->mid, &cmd, sizeof(cmd),
217547e19af9SVladimir Kondratiev 		      WMI_CFG_RX_CHAIN_DONE_EVENTID, &evt, sizeof(evt), 2000);
217647e19af9SVladimir Kondratiev 	if (rc)
217747e19af9SVladimir Kondratiev 		return rc;
217847e19af9SVladimir Kondratiev 
2179807b0860SAlexei Avshalom Lazar 	if (le32_to_cpu(evt.evt.status) != WMI_CFG_RX_CHAIN_SUCCESS)
2180807b0860SAlexei Avshalom Lazar 		rc = -EINVAL;
2181807b0860SAlexei Avshalom Lazar 
218247e19af9SVladimir Kondratiev 	vring->hwtail = le32_to_cpu(evt.evt.rx_ring_tail_ptr);
218347e19af9SVladimir Kondratiev 
21847743882dSVladimir Kondratiev 	wil_dbg_misc(wil, "Rx init: status %d tail 0x%08x\n",
218547e19af9SVladimir Kondratiev 		     le32_to_cpu(evt.evt.status), vring->hwtail);
218647e19af9SVladimir Kondratiev 
218747e19af9SVladimir Kondratiev 	return rc;
218847e19af9SVladimir Kondratiev }
218947e19af9SVladimir Kondratiev 
21908c679675SVladimir Kondratiev int wmi_get_temperature(struct wil6210_priv *wil, u32 *t_bb, u32 *t_rf)
21911a2780e0SVladimir Kondratiev {
2192e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
21931a2780e0SVladimir Kondratiev 	int rc;
21941a2780e0SVladimir Kondratiev 	struct wmi_temp_sense_cmd cmd = {
21958c679675SVladimir Kondratiev 		.measure_baseband_en = cpu_to_le32(!!t_bb),
21968c679675SVladimir Kondratiev 		.measure_rf_en = cpu_to_le32(!!t_rf),
21978c679675SVladimir Kondratiev 		.measure_mode = cpu_to_le32(TEMPERATURE_MEASURE_NOW),
21981a2780e0SVladimir Kondratiev 	};
21991a2780e0SVladimir Kondratiev 	struct {
2200b874ddecSLior David 		struct wmi_cmd_hdr wmi;
22011a2780e0SVladimir Kondratiev 		struct wmi_temp_sense_done_event evt;
22021a2780e0SVladimir Kondratiev 	} __packed reply;
22031a2780e0SVladimir Kondratiev 
2204807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
2205807b0860SAlexei Avshalom Lazar 
2206e00243faSLior David 	rc = wmi_call(wil, WMI_TEMP_SENSE_CMDID, vif->mid, &cmd, sizeof(cmd),
22071a2780e0SVladimir Kondratiev 		      WMI_TEMP_SENSE_DONE_EVENTID, &reply, sizeof(reply), 100);
22081a2780e0SVladimir Kondratiev 	if (rc)
22091a2780e0SVladimir Kondratiev 		return rc;
22101a2780e0SVladimir Kondratiev 
22118c679675SVladimir Kondratiev 	if (t_bb)
22128c679675SVladimir Kondratiev 		*t_bb = le32_to_cpu(reply.evt.baseband_t1000);
22138c679675SVladimir Kondratiev 	if (t_rf)
22148c679675SVladimir Kondratiev 		*t_rf = le32_to_cpu(reply.evt.rf_t1000);
22151a2780e0SVladimir Kondratiev 
22161a2780e0SVladimir Kondratiev 	return 0;
22171a2780e0SVladimir Kondratiev }
22181a2780e0SVladimir Kondratiev 
2219e00243faSLior David int wmi_disconnect_sta(struct wil6210_vif *vif, const u8 *mac,
2220849a564bSDedy Lansky 		       u16 reason, bool full_disconnect, bool del_sta)
22214d55a0a1SVladimir Kondratiev {
2222e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
22233e9191fcSVladimir Kondratiev 	int rc;
22243e9191fcSVladimir Kondratiev 	u16 reason_code;
2225849a564bSDedy Lansky 	struct wmi_disconnect_sta_cmd disc_sta_cmd = {
2226849a564bSDedy Lansky 		.disconnect_reason = cpu_to_le16(reason),
2227849a564bSDedy Lansky 	};
2228849a564bSDedy Lansky 	struct wmi_del_sta_cmd del_sta_cmd = {
22294d55a0a1SVladimir Kondratiev 		.disconnect_reason = cpu_to_le16(reason),
22304d55a0a1SVladimir Kondratiev 	};
22313e9191fcSVladimir Kondratiev 	struct {
2232b874ddecSLior David 		struct wmi_cmd_hdr wmi;
22333e9191fcSVladimir Kondratiev 		struct wmi_disconnect_event evt;
22343e9191fcSVladimir Kondratiev 	} __packed reply;
2235a82553bbSVladimir Kondratiev 
2236af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "disconnect_sta: (%pM, reason %d)\n", mac, reason);
22374d55a0a1SVladimir Kondratiev 
2238807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
2239e00243faSLior David 	vif->locally_generated_disc = true;
2240849a564bSDedy Lansky 	if (del_sta) {
2241849a564bSDedy Lansky 		ether_addr_copy(del_sta_cmd.dst_mac, mac);
2242e00243faSLior David 		rc = wmi_call(wil, WMI_DEL_STA_CMDID, vif->mid, &del_sta_cmd,
2243849a564bSDedy Lansky 			      sizeof(del_sta_cmd), WMI_DISCONNECT_EVENTID,
2244849a564bSDedy Lansky 			      &reply, sizeof(reply), 1000);
2245849a564bSDedy Lansky 	} else {
2246849a564bSDedy Lansky 		ether_addr_copy(disc_sta_cmd.dst_mac, mac);
2247e00243faSLior David 		rc = wmi_call(wil, WMI_DISCONNECT_STA_CMDID, vif->mid,
2248e00243faSLior David 			      &disc_sta_cmd, sizeof(disc_sta_cmd),
2249e00243faSLior David 			      WMI_DISCONNECT_EVENTID,
2250849a564bSDedy Lansky 			      &reply, sizeof(reply), 1000);
2251849a564bSDedy Lansky 	}
22523e9191fcSVladimir Kondratiev 	/* failure to disconnect in reasonable time treated as FW error */
22533e9191fcSVladimir Kondratiev 	if (rc) {
22543e9191fcSVladimir Kondratiev 		wil_fw_error_recovery(wil);
22553e9191fcSVladimir Kondratiev 		return rc;
22563e9191fcSVladimir Kondratiev 	}
22573e9191fcSVladimir Kondratiev 
22580916d9f2SMaya Erez 	if (full_disconnect) {
22593e9191fcSVladimir Kondratiev 		/* call event handler manually after processing wmi_call,
22600916d9f2SMaya Erez 		 * to avoid deadlock - disconnect event handler acquires
22610916d9f2SMaya Erez 		 * wil->mutex while it is already held here
22623e9191fcSVladimir Kondratiev 		 */
22633e9191fcSVladimir Kondratiev 		reason_code = le16_to_cpu(reply.evt.protocol_reason_status);
22643e9191fcSVladimir Kondratiev 
22653e9191fcSVladimir Kondratiev 		wil_dbg_wmi(wil, "Disconnect %pM reason [proto %d wmi %d]\n",
22663e9191fcSVladimir Kondratiev 			    reply.evt.bssid, reason_code,
22673e9191fcSVladimir Kondratiev 			    reply.evt.disconnect_reason);
22683e9191fcSVladimir Kondratiev 
22693e9191fcSVladimir Kondratiev 		wil->sinfo_gen++;
2270e00243faSLior David 		wil6210_disconnect(vif, reply.evt.bssid, reason_code, true);
22710916d9f2SMaya Erez 	}
22723e9191fcSVladimir Kondratiev 	return 0;
22734d55a0a1SVladimir Kondratiev }
22744d55a0a1SVladimir Kondratiev 
2275e00243faSLior David int wmi_addba(struct wil6210_priv *wil, u8 mid,
2276e00243faSLior David 	      u8 ringid, u8 size, u16 timeout)
22773277213fSVladimir Kondratiev {
22787be13fc3SGidon Studinski 	u8 amsdu = wil->use_enhanced_dma_hw && wil->use_rx_hw_reordering &&
22797be13fc3SGidon Studinski 		test_bit(WMI_FW_CAPABILITY_AMSDU, wil->fw_capabilities) &&
22807be13fc3SGidon Studinski 		wil->amsdu_en;
228196c93589SGidon Studinski 	struct wmi_ring_ba_en_cmd cmd = {
228296c93589SGidon Studinski 		.ring_id = ringid,
22833277213fSVladimir Kondratiev 		.agg_max_wsize = size,
22843277213fSVladimir Kondratiev 		.ba_timeout = cpu_to_le16(timeout),
22857be13fc3SGidon Studinski 		.amsdu = amsdu,
22863277213fSVladimir Kondratiev 	};
22873277213fSVladimir Kondratiev 
22887be13fc3SGidon Studinski 	wil_dbg_wmi(wil, "addba: (ring %d size %d timeout %d amsdu %d)\n",
22897be13fc3SGidon Studinski 		    ringid, size, timeout, amsdu);
22903277213fSVladimir Kondratiev 
229196c93589SGidon Studinski 	return wmi_send(wil, WMI_RING_BA_EN_CMDID, mid, &cmd, sizeof(cmd));
22923277213fSVladimir Kondratiev }
22933277213fSVladimir Kondratiev 
2294e00243faSLior David int wmi_delba_tx(struct wil6210_priv *wil, u8 mid, u8 ringid, u16 reason)
22953277213fSVladimir Kondratiev {
229696c93589SGidon Studinski 	struct wmi_ring_ba_dis_cmd cmd = {
229796c93589SGidon Studinski 		.ring_id = ringid,
22983277213fSVladimir Kondratiev 		.reason = cpu_to_le16(reason),
22993277213fSVladimir Kondratiev 	};
23003277213fSVladimir Kondratiev 
2301af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "delba_tx: (ring %d reason %d)\n", ringid, reason);
23023277213fSVladimir Kondratiev 
230396c93589SGidon Studinski 	return wmi_send(wil, WMI_RING_BA_DIS_CMDID, mid, &cmd, sizeof(cmd));
23043277213fSVladimir Kondratiev }
23053277213fSVladimir Kondratiev 
2306e00243faSLior David int wmi_delba_rx(struct wil6210_priv *wil, u8 mid, u8 cidxtid, u16 reason)
230726a359d9SVladimir Kondratiev {
230826a359d9SVladimir Kondratiev 	struct wmi_rcp_delba_cmd cmd = {
230926a359d9SVladimir Kondratiev 		.cidxtid = cidxtid,
231026a359d9SVladimir Kondratiev 		.reason = cpu_to_le16(reason),
231126a359d9SVladimir Kondratiev 	};
231226a359d9SVladimir Kondratiev 
2313af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "delba_rx: (CID %d TID %d reason %d)\n", cidxtid & 0xf,
2314af3db60aSLazar Alexei 		    (cidxtid >> 4) & 0xf, reason);
231526a359d9SVladimir Kondratiev 
2316e00243faSLior David 	return wmi_send(wil, WMI_RCP_DELBA_CMDID, mid, &cmd, sizeof(cmd));
231726a359d9SVladimir Kondratiev }
231826a359d9SVladimir Kondratiev 
2319e00243faSLior David int wmi_addba_rx_resp(struct wil6210_priv *wil,
2320e00243faSLior David 		      u8 mid, u8 cid, u8 tid, u8 token,
23213277213fSVladimir Kondratiev 		      u16 status, bool amsdu, u16 agg_wsize, u16 timeout)
23223277213fSVladimir Kondratiev {
23233277213fSVladimir Kondratiev 	int rc;
23243277213fSVladimir Kondratiev 	struct wmi_rcp_addba_resp_cmd cmd = {
23253277213fSVladimir Kondratiev 		.cidxtid = mk_cidxtid(cid, tid),
23263277213fSVladimir Kondratiev 		.dialog_token = token,
23273277213fSVladimir Kondratiev 		.status_code = cpu_to_le16(status),
23283277213fSVladimir Kondratiev 		/* bit 0: A-MSDU supported
23293277213fSVladimir Kondratiev 		 * bit 1: policy (should be 0 for us)
23303277213fSVladimir Kondratiev 		 * bits 2..5: TID
23313277213fSVladimir Kondratiev 		 * bits 6..15: buffer size
23323277213fSVladimir Kondratiev 		 */
23333277213fSVladimir Kondratiev 		.ba_param_set = cpu_to_le16((amsdu ? 1 : 0) | (tid << 2) |
23343277213fSVladimir Kondratiev 					    (agg_wsize << 6)),
23353277213fSVladimir Kondratiev 		.ba_timeout = cpu_to_le16(timeout),
23363277213fSVladimir Kondratiev 	};
23373277213fSVladimir Kondratiev 	struct {
2338b874ddecSLior David 		struct wmi_cmd_hdr wmi;
23393277213fSVladimir Kondratiev 		struct wmi_rcp_addba_resp_sent_event evt;
2340807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2341807b0860SAlexei Avshalom Lazar 		.evt = {.status = cpu_to_le16(WMI_FW_STATUS_FAILURE)},
2342807b0860SAlexei Avshalom Lazar 	};
23433277213fSVladimir Kondratiev 
23443277213fSVladimir Kondratiev 	wil_dbg_wmi(wil,
2345e00243faSLior David 		    "ADDBA response for MID %d CID %d TID %d size %d timeout %d status %d AMSDU%s\n",
2346e00243faSLior David 		    mid, cid, tid, agg_wsize,
2347e00243faSLior David 		    timeout, status, amsdu ? "+" : "-");
23483277213fSVladimir Kondratiev 
2349e00243faSLior David 	rc = wmi_call(wil, WMI_RCP_ADDBA_RESP_CMDID, mid, &cmd, sizeof(cmd),
2350230d8442SVladimir Kondratiev 		      WMI_RCP_ADDBA_RESP_SENT_EVENTID, &reply, sizeof(reply),
2351230d8442SVladimir Kondratiev 		      100);
23523277213fSVladimir Kondratiev 	if (rc)
23533277213fSVladimir Kondratiev 		return rc;
23543277213fSVladimir Kondratiev 
23553277213fSVladimir Kondratiev 	if (reply.evt.status) {
23563277213fSVladimir Kondratiev 		wil_err(wil, "ADDBA response failed with status %d\n",
23573277213fSVladimir Kondratiev 			le16_to_cpu(reply.evt.status));
23583277213fSVladimir Kondratiev 		rc = -EINVAL;
23593277213fSVladimir Kondratiev 	}
23603277213fSVladimir Kondratiev 
23613277213fSVladimir Kondratiev 	return rc;
23623277213fSVladimir Kondratiev }
23633277213fSVladimir Kondratiev 
23647be13fc3SGidon Studinski int wmi_addba_rx_resp_edma(struct wil6210_priv *wil, u8 mid, u8 cid, u8 tid,
23657be13fc3SGidon Studinski 			   u8 token, u16 status, bool amsdu, u16 agg_wsize,
23667be13fc3SGidon Studinski 			   u16 timeout)
23677be13fc3SGidon Studinski {
23687be13fc3SGidon Studinski 	int rc;
23697be13fc3SGidon Studinski 	struct wmi_rcp_addba_resp_edma_cmd cmd = {
23707be13fc3SGidon Studinski 		.cid = cid,
23717be13fc3SGidon Studinski 		.tid = tid,
23727be13fc3SGidon Studinski 		.dialog_token = token,
23737be13fc3SGidon Studinski 		.status_code = cpu_to_le16(status),
23747be13fc3SGidon Studinski 		/* bit 0: A-MSDU supported
23757be13fc3SGidon Studinski 		 * bit 1: policy (should be 0 for us)
23767be13fc3SGidon Studinski 		 * bits 2..5: TID
23777be13fc3SGidon Studinski 		 * bits 6..15: buffer size
23787be13fc3SGidon Studinski 		 */
23797be13fc3SGidon Studinski 		.ba_param_set = cpu_to_le16((amsdu ? 1 : 0) | (tid << 2) |
23807be13fc3SGidon Studinski 					    (agg_wsize << 6)),
23817be13fc3SGidon Studinski 		.ba_timeout = cpu_to_le16(timeout),
23827be13fc3SGidon Studinski 		/* route all the connections to status ring 0 */
23837be13fc3SGidon Studinski 		.status_ring_id = WIL_DEFAULT_RX_STATUS_RING_ID,
23847be13fc3SGidon Studinski 	};
23857be13fc3SGidon Studinski 	struct {
23867be13fc3SGidon Studinski 		struct wmi_cmd_hdr wmi;
23877be13fc3SGidon Studinski 		struct wmi_rcp_addba_resp_sent_event evt;
23887be13fc3SGidon Studinski 	} __packed reply = {
23897be13fc3SGidon Studinski 		.evt = {.status = cpu_to_le16(WMI_FW_STATUS_FAILURE)},
23907be13fc3SGidon Studinski 	};
23917be13fc3SGidon Studinski 
23927be13fc3SGidon Studinski 	wil_dbg_wmi(wil,
23937be13fc3SGidon Studinski 		    "ADDBA response for CID %d TID %d size %d timeout %d status %d AMSDU%s, sring_id %d\n",
23947be13fc3SGidon Studinski 		    cid, tid, agg_wsize, timeout, status, amsdu ? "+" : "-",
23957be13fc3SGidon Studinski 		    WIL_DEFAULT_RX_STATUS_RING_ID);
23967be13fc3SGidon Studinski 
23977be13fc3SGidon Studinski 	rc = wmi_call(wil, WMI_RCP_ADDBA_RESP_EDMA_CMDID, mid, &cmd,
23987be13fc3SGidon Studinski 		      sizeof(cmd), WMI_RCP_ADDBA_RESP_SENT_EVENTID, &reply,
23997be13fc3SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
24007be13fc3SGidon Studinski 	if (rc)
24017be13fc3SGidon Studinski 		return rc;
24027be13fc3SGidon Studinski 
24037be13fc3SGidon Studinski 	if (reply.evt.status) {
24047be13fc3SGidon Studinski 		wil_err(wil, "ADDBA response failed with status %d\n",
24057be13fc3SGidon Studinski 			le16_to_cpu(reply.evt.status));
24067be13fc3SGidon Studinski 		rc = -EINVAL;
24077be13fc3SGidon Studinski 	}
24087be13fc3SGidon Studinski 
24097be13fc3SGidon Studinski 	return rc;
24107be13fc3SGidon Studinski }
24117be13fc3SGidon Studinski 
24122c207eb8SMaya Erez int wmi_ps_dev_profile_cfg(struct wil6210_priv *wil,
24132c207eb8SMaya Erez 			   enum wmi_ps_profile_type ps_profile)
24142c207eb8SMaya Erez {
2415e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
24162c207eb8SMaya Erez 	int rc;
24172c207eb8SMaya Erez 	struct wmi_ps_dev_profile_cfg_cmd cmd = {
24182c207eb8SMaya Erez 		.ps_profile = ps_profile,
24192c207eb8SMaya Erez 	};
24202c207eb8SMaya Erez 	struct {
24212c207eb8SMaya Erez 		struct wmi_cmd_hdr wmi;
24222c207eb8SMaya Erez 		struct wmi_ps_dev_profile_cfg_event evt;
2423807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2424807b0860SAlexei Avshalom Lazar 		.evt = {.status = cpu_to_le32(WMI_PS_CFG_CMD_STATUS_ERROR)},
2425807b0860SAlexei Avshalom Lazar 	};
24262c207eb8SMaya Erez 	u32 status;
24272c207eb8SMaya Erez 
24282c207eb8SMaya Erez 	wil_dbg_wmi(wil, "Setting ps dev profile %d\n", ps_profile);
24292c207eb8SMaya Erez 
2430e00243faSLior David 	rc = wmi_call(wil, WMI_PS_DEV_PROFILE_CFG_CMDID, vif->mid,
2431e00243faSLior David 		      &cmd, sizeof(cmd),
24322c207eb8SMaya Erez 		      WMI_PS_DEV_PROFILE_CFG_EVENTID, &reply, sizeof(reply),
24332c207eb8SMaya Erez 		      100);
24342c207eb8SMaya Erez 	if (rc)
24352c207eb8SMaya Erez 		return rc;
24362c207eb8SMaya Erez 
24372c207eb8SMaya Erez 	status = le32_to_cpu(reply.evt.status);
24382c207eb8SMaya Erez 
24392c207eb8SMaya Erez 	if (status != WMI_PS_CFG_CMD_STATUS_SUCCESS) {
24402c207eb8SMaya Erez 		wil_err(wil, "ps dev profile cfg failed with status %d\n",
24412c207eb8SMaya Erez 			status);
24422c207eb8SMaya Erez 		rc = -EINVAL;
24432c207eb8SMaya Erez 	}
24442c207eb8SMaya Erez 
24452c207eb8SMaya Erez 	return rc;
24462c207eb8SMaya Erez }
24472c207eb8SMaya Erez 
24483fea18d0SLior David int wmi_set_mgmt_retry(struct wil6210_priv *wil, u8 retry_short)
24493fea18d0SLior David {
2450e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
24513fea18d0SLior David 	int rc;
24523fea18d0SLior David 	struct wmi_set_mgmt_retry_limit_cmd cmd = {
24533fea18d0SLior David 		.mgmt_retry_limit = retry_short,
24543fea18d0SLior David 	};
24553fea18d0SLior David 	struct {
24563fea18d0SLior David 		struct wmi_cmd_hdr wmi;
24573fea18d0SLior David 		struct wmi_set_mgmt_retry_limit_event evt;
2458807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2459807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
2460807b0860SAlexei Avshalom Lazar 	};
24613fea18d0SLior David 
24623fea18d0SLior David 	wil_dbg_wmi(wil, "Setting mgmt retry short %d\n", retry_short);
24633fea18d0SLior David 
24643fea18d0SLior David 	if (!test_bit(WMI_FW_CAPABILITY_MGMT_RETRY_LIMIT, wil->fw_capabilities))
24653fea18d0SLior David 		return -ENOTSUPP;
24663fea18d0SLior David 
2467e00243faSLior David 	rc = wmi_call(wil, WMI_SET_MGMT_RETRY_LIMIT_CMDID, vif->mid,
2468e00243faSLior David 		      &cmd, sizeof(cmd),
24693fea18d0SLior David 		      WMI_SET_MGMT_RETRY_LIMIT_EVENTID, &reply, sizeof(reply),
24703fea18d0SLior David 		      100);
24713fea18d0SLior David 	if (rc)
24723fea18d0SLior David 		return rc;
24733fea18d0SLior David 
24743fea18d0SLior David 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
24753fea18d0SLior David 		wil_err(wil, "set mgmt retry limit failed with status %d\n",
24763fea18d0SLior David 			reply.evt.status);
24773fea18d0SLior David 		rc = -EINVAL;
24783fea18d0SLior David 	}
24793fea18d0SLior David 
24803fea18d0SLior David 	return rc;
24813fea18d0SLior David }
24823fea18d0SLior David 
24833fea18d0SLior David int wmi_get_mgmt_retry(struct wil6210_priv *wil, u8 *retry_short)
24843fea18d0SLior David {
2485e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
24863fea18d0SLior David 	int rc;
24873fea18d0SLior David 	struct {
24883fea18d0SLior David 		struct wmi_cmd_hdr wmi;
24893fea18d0SLior David 		struct wmi_get_mgmt_retry_limit_event evt;
24903fea18d0SLior David 	} __packed reply;
24913fea18d0SLior David 
24923fea18d0SLior David 	wil_dbg_wmi(wil, "getting mgmt retry short\n");
24933fea18d0SLior David 
24943fea18d0SLior David 	if (!test_bit(WMI_FW_CAPABILITY_MGMT_RETRY_LIMIT, wil->fw_capabilities))
24953fea18d0SLior David 		return -ENOTSUPP;
24963fea18d0SLior David 
2497807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
2498e00243faSLior David 	rc = wmi_call(wil, WMI_GET_MGMT_RETRY_LIMIT_CMDID, vif->mid, NULL, 0,
24993fea18d0SLior David 		      WMI_GET_MGMT_RETRY_LIMIT_EVENTID, &reply, sizeof(reply),
25003fea18d0SLior David 		      100);
25013fea18d0SLior David 	if (rc)
25023fea18d0SLior David 		return rc;
25033fea18d0SLior David 
25043fea18d0SLior David 	if (retry_short)
25053fea18d0SLior David 		*retry_short = reply.evt.mgmt_retry_limit;
25063fea18d0SLior David 
25073fea18d0SLior David 	return 0;
25083fea18d0SLior David }
25093fea18d0SLior David 
2510e00243faSLior David int wmi_abort_scan(struct wil6210_vif *vif)
2511035859a5SMaya Erez {
2512e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
2513035859a5SMaya Erez 	int rc;
2514035859a5SMaya Erez 
2515035859a5SMaya Erez 	wil_dbg_wmi(wil, "sending WMI_ABORT_SCAN_CMDID\n");
2516035859a5SMaya Erez 
2517e00243faSLior David 	rc = wmi_send(wil, WMI_ABORT_SCAN_CMDID, vif->mid, NULL, 0);
2518035859a5SMaya Erez 	if (rc)
2519035859a5SMaya Erez 		wil_err(wil, "Failed to abort scan (%d)\n", rc);
2520035859a5SMaya Erez 
2521035859a5SMaya Erez 	return rc;
2522035859a5SMaya Erez }
2523035859a5SMaya Erez 
2524e00243faSLior David int wmi_new_sta(struct wil6210_vif *vif, const u8 *mac, u8 aid)
2525849a564bSDedy Lansky {
2526e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
2527849a564bSDedy Lansky 	int rc;
2528849a564bSDedy Lansky 	struct wmi_new_sta_cmd cmd = {
2529849a564bSDedy Lansky 		.aid = aid,
2530849a564bSDedy Lansky 	};
2531849a564bSDedy Lansky 
2532849a564bSDedy Lansky 	wil_dbg_wmi(wil, "new sta %pM, aid %d\n", mac, aid);
2533849a564bSDedy Lansky 
2534849a564bSDedy Lansky 	ether_addr_copy(cmd.dst_mac, mac);
2535849a564bSDedy Lansky 
2536e00243faSLior David 	rc = wmi_send(wil, WMI_NEW_STA_CMDID, vif->mid, &cmd, sizeof(cmd));
2537849a564bSDedy Lansky 	if (rc)
2538849a564bSDedy Lansky 		wil_err(wil, "Failed to send new sta (%d)\n", rc);
2539849a564bSDedy Lansky 
2540849a564bSDedy Lansky 	return rc;
2541849a564bSDedy Lansky }
2542849a564bSDedy Lansky 
25432be7d22fSVladimir Kondratiev void wmi_event_flush(struct wil6210_priv *wil)
25442be7d22fSVladimir Kondratiev {
2545f6b29b65SHamad Kadmany 	ulong flags;
25462be7d22fSVladimir Kondratiev 	struct pending_wmi_event *evt, *t;
25472be7d22fSVladimir Kondratiev 
2548af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "event_flush\n");
25492be7d22fSVladimir Kondratiev 
2550f6b29b65SHamad Kadmany 	spin_lock_irqsave(&wil->wmi_ev_lock, flags);
2551f6b29b65SHamad Kadmany 
25522be7d22fSVladimir Kondratiev 	list_for_each_entry_safe(evt, t, &wil->pending_wmi_ev, list) {
25532be7d22fSVladimir Kondratiev 		list_del(&evt->list);
25542be7d22fSVladimir Kondratiev 		kfree(evt);
25552be7d22fSVladimir Kondratiev 	}
2556f6b29b65SHamad Kadmany 
2557f6b29b65SHamad Kadmany 	spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
25582be7d22fSVladimir Kondratiev }
25592be7d22fSVladimir Kondratiev 
25606804cd10SLazar Alexei static const char *suspend_status2name(u8 status)
25616804cd10SLazar Alexei {
25626804cd10SLazar Alexei 	switch (status) {
25636804cd10SLazar Alexei 	case WMI_TRAFFIC_SUSPEND_REJECTED_LINK_NOT_IDLE:
25646804cd10SLazar Alexei 		return "LINK_NOT_IDLE";
25656804cd10SLazar Alexei 	default:
25666804cd10SLazar Alexei 		return "Untracked status";
25676804cd10SLazar Alexei 	}
25686804cd10SLazar Alexei }
25696804cd10SLazar Alexei 
2570fe9ee51eSMaya Erez int wmi_suspend(struct wil6210_priv *wil)
2571fe9ee51eSMaya Erez {
2572e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
2573fe9ee51eSMaya Erez 	int rc;
2574fe9ee51eSMaya Erez 	struct wmi_traffic_suspend_cmd cmd = {
2575fe9ee51eSMaya Erez 		.wakeup_trigger = wil->wakeup_trigger,
2576fe9ee51eSMaya Erez 	};
2577fe9ee51eSMaya Erez 	struct {
2578fe9ee51eSMaya Erez 		struct wmi_cmd_hdr wmi;
2579fe9ee51eSMaya Erez 		struct wmi_traffic_suspend_event evt;
2580807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2581807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_TRAFFIC_SUSPEND_REJECTED_LINK_NOT_IDLE},
2582807b0860SAlexei Avshalom Lazar 	};
2583807b0860SAlexei Avshalom Lazar 
2584fe9ee51eSMaya Erez 	u32 suspend_to = WIL_WAIT_FOR_SUSPEND_RESUME_COMP;
2585fe9ee51eSMaya Erez 
2586fe9ee51eSMaya Erez 	wil->suspend_resp_rcvd = false;
2587fe9ee51eSMaya Erez 	wil->suspend_resp_comp = false;
2588fe9ee51eSMaya Erez 
2589e00243faSLior David 	rc = wmi_call(wil, WMI_TRAFFIC_SUSPEND_CMDID, vif->mid,
2590e00243faSLior David 		      &cmd, sizeof(cmd),
2591fe9ee51eSMaya Erez 		      WMI_TRAFFIC_SUSPEND_EVENTID, &reply, sizeof(reply),
2592fe9ee51eSMaya Erez 		      suspend_to);
2593fe9ee51eSMaya Erez 	if (rc) {
2594fe9ee51eSMaya Erez 		wil_err(wil, "wmi_call for suspend req failed, rc=%d\n", rc);
2595fe9ee51eSMaya Erez 		if (rc == -ETIME)
2596fe9ee51eSMaya Erez 			/* wmi_call TO */
2597fe9ee51eSMaya Erez 			wil->suspend_stats.rejected_by_device++;
2598fe9ee51eSMaya Erez 		else
2599fe9ee51eSMaya Erez 			wil->suspend_stats.rejected_by_host++;
2600fe9ee51eSMaya Erez 		goto out;
2601fe9ee51eSMaya Erez 	}
2602fe9ee51eSMaya Erez 
2603fe9ee51eSMaya Erez 	wil_dbg_wmi(wil, "waiting for suspend_response_completed\n");
2604fe9ee51eSMaya Erez 
2605fe9ee51eSMaya Erez 	rc = wait_event_interruptible_timeout(wil->wq,
2606fe9ee51eSMaya Erez 					      wil->suspend_resp_comp,
2607fe9ee51eSMaya Erez 					      msecs_to_jiffies(suspend_to));
2608fe9ee51eSMaya Erez 	if (rc == 0) {
2609fe9ee51eSMaya Erez 		wil_err(wil, "TO waiting for suspend_response_completed\n");
2610fe9ee51eSMaya Erez 		if (wil->suspend_resp_rcvd)
2611fe9ee51eSMaya Erez 			/* Device responded but we TO due to another reason */
2612fe9ee51eSMaya Erez 			wil->suspend_stats.rejected_by_host++;
2613fe9ee51eSMaya Erez 		else
2614fe9ee51eSMaya Erez 			wil->suspend_stats.rejected_by_device++;
2615fe9ee51eSMaya Erez 		rc = -EBUSY;
2616fe9ee51eSMaya Erez 		goto out;
2617fe9ee51eSMaya Erez 	}
2618fe9ee51eSMaya Erez 
2619fe9ee51eSMaya Erez 	wil_dbg_wmi(wil, "suspend_response_completed rcvd\n");
26206804cd10SLazar Alexei 	if (reply.evt.status != WMI_TRAFFIC_SUSPEND_APPROVED) {
26216804cd10SLazar Alexei 		wil_dbg_pm(wil, "device rejected the suspend, %s\n",
26226804cd10SLazar Alexei 			   suspend_status2name(reply.evt.status));
2623fe9ee51eSMaya Erez 		wil->suspend_stats.rejected_by_device++;
2624fe9ee51eSMaya Erez 	}
2625fe9ee51eSMaya Erez 	rc = reply.evt.status;
2626fe9ee51eSMaya Erez 
2627fe9ee51eSMaya Erez out:
2628fe9ee51eSMaya Erez 	wil->suspend_resp_rcvd = false;
2629fe9ee51eSMaya Erez 	wil->suspend_resp_comp = false;
2630fe9ee51eSMaya Erez 
2631fe9ee51eSMaya Erez 	return rc;
2632fe9ee51eSMaya Erez }
2633fe9ee51eSMaya Erez 
26346804cd10SLazar Alexei static void resume_triggers2string(u32 triggers, char *string, int str_size)
26356804cd10SLazar Alexei {
26366804cd10SLazar Alexei 	string[0] = '\0';
26376804cd10SLazar Alexei 
26386804cd10SLazar Alexei 	if (!triggers) {
26396804cd10SLazar Alexei 		strlcat(string, " UNKNOWN", str_size);
26406804cd10SLazar Alexei 		return;
26416804cd10SLazar Alexei 	}
26426804cd10SLazar Alexei 
26436804cd10SLazar Alexei 	if (triggers & WMI_RESUME_TRIGGER_HOST)
26446804cd10SLazar Alexei 		strlcat(string, " HOST", str_size);
26456804cd10SLazar Alexei 
26466804cd10SLazar Alexei 	if (triggers & WMI_RESUME_TRIGGER_UCAST_RX)
26476804cd10SLazar Alexei 		strlcat(string, " UCAST_RX", str_size);
26486804cd10SLazar Alexei 
26496804cd10SLazar Alexei 	if (triggers & WMI_RESUME_TRIGGER_BCAST_RX)
26506804cd10SLazar Alexei 		strlcat(string, " BCAST_RX", str_size);
26516804cd10SLazar Alexei 
26526804cd10SLazar Alexei 	if (triggers & WMI_RESUME_TRIGGER_WMI_EVT)
26536804cd10SLazar Alexei 		strlcat(string, " WMI_EVT", str_size);
26546804cd10SLazar Alexei }
26556804cd10SLazar Alexei 
2656fe9ee51eSMaya Erez int wmi_resume(struct wil6210_priv *wil)
2657fe9ee51eSMaya Erez {
2658e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
2659fe9ee51eSMaya Erez 	int rc;
26606804cd10SLazar Alexei 	char string[100];
2661fe9ee51eSMaya Erez 	struct {
2662fe9ee51eSMaya Erez 		struct wmi_cmd_hdr wmi;
2663fe9ee51eSMaya Erez 		struct wmi_traffic_resume_event evt;
2664807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2665807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_TRAFFIC_RESUME_FAILED,
2666807b0860SAlexei Avshalom Lazar 			.resume_triggers =
2667807b0860SAlexei Avshalom Lazar 				cpu_to_le32(WMI_RESUME_TRIGGER_UNKNOWN)},
2668807b0860SAlexei Avshalom Lazar 	};
2669fe9ee51eSMaya Erez 
2670e00243faSLior David 	rc = wmi_call(wil, WMI_TRAFFIC_RESUME_CMDID, vif->mid, NULL, 0,
2671fe9ee51eSMaya Erez 		      WMI_TRAFFIC_RESUME_EVENTID, &reply, sizeof(reply),
2672fe9ee51eSMaya Erez 		      WIL_WAIT_FOR_SUSPEND_RESUME_COMP);
2673fe9ee51eSMaya Erez 	if (rc)
2674fe9ee51eSMaya Erez 		return rc;
26756804cd10SLazar Alexei 	resume_triggers2string(le32_to_cpu(reply.evt.resume_triggers), string,
26766804cd10SLazar Alexei 			       sizeof(string));
26776804cd10SLazar Alexei 	wil_dbg_pm(wil, "device resume %s, resume triggers:%s (0x%x)\n",
26786804cd10SLazar Alexei 		   reply.evt.status ? "failed" : "passed", string,
26796804cd10SLazar Alexei 		   le32_to_cpu(reply.evt.resume_triggers));
2680fe9ee51eSMaya Erez 
2681fe9ee51eSMaya Erez 	return reply.evt.status;
2682fe9ee51eSMaya Erez }
2683fe9ee51eSMaya Erez 
26844aebd3bdSLior David int wmi_port_allocate(struct wil6210_priv *wil, u8 mid,
26854aebd3bdSLior David 		      const u8 *mac, enum nl80211_iftype iftype)
26864aebd3bdSLior David {
26874aebd3bdSLior David 	int rc;
26884aebd3bdSLior David 	struct wmi_port_allocate_cmd cmd = {
26894aebd3bdSLior David 		.mid = mid,
26904aebd3bdSLior David 	};
26914aebd3bdSLior David 	struct {
26924aebd3bdSLior David 		struct wmi_cmd_hdr wmi;
26934aebd3bdSLior David 		struct wmi_port_allocated_event evt;
2694807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2695807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
2696807b0860SAlexei Avshalom Lazar 	};
26974aebd3bdSLior David 
26984aebd3bdSLior David 	wil_dbg_misc(wil, "port allocate, mid %d iftype %d, mac %pM\n",
26994aebd3bdSLior David 		     mid, iftype, mac);
27004aebd3bdSLior David 
27014aebd3bdSLior David 	ether_addr_copy(cmd.mac, mac);
27024aebd3bdSLior David 	switch (iftype) {
27034aebd3bdSLior David 	case NL80211_IFTYPE_STATION:
27044aebd3bdSLior David 		cmd.port_role = WMI_PORT_STA;
27054aebd3bdSLior David 		break;
27064aebd3bdSLior David 	case NL80211_IFTYPE_AP:
27074aebd3bdSLior David 		cmd.port_role = WMI_PORT_AP;
27084aebd3bdSLior David 		break;
27094aebd3bdSLior David 	case NL80211_IFTYPE_P2P_CLIENT:
27104aebd3bdSLior David 		cmd.port_role = WMI_PORT_P2P_CLIENT;
27114aebd3bdSLior David 		break;
27124aebd3bdSLior David 	case NL80211_IFTYPE_P2P_GO:
27134aebd3bdSLior David 		cmd.port_role = WMI_PORT_P2P_GO;
27144aebd3bdSLior David 		break;
27154aebd3bdSLior David 	/* what about monitor??? */
27164aebd3bdSLior David 	default:
27174aebd3bdSLior David 		wil_err(wil, "unsupported iftype: %d\n", iftype);
27184aebd3bdSLior David 		return -EINVAL;
27194aebd3bdSLior David 	}
27204aebd3bdSLior David 
27214aebd3bdSLior David 	rc = wmi_call(wil, WMI_PORT_ALLOCATE_CMDID, mid,
27224aebd3bdSLior David 		      &cmd, sizeof(cmd),
27234aebd3bdSLior David 		      WMI_PORT_ALLOCATED_EVENTID, &reply,
27244aebd3bdSLior David 		      sizeof(reply), 300);
27254aebd3bdSLior David 	if (rc) {
27264aebd3bdSLior David 		wil_err(wil, "failed to allocate port, status %d\n", rc);
27274aebd3bdSLior David 		return rc;
27284aebd3bdSLior David 	}
27294aebd3bdSLior David 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
27304aebd3bdSLior David 		wil_err(wil, "WMI_PORT_ALLOCATE returned status %d\n",
27314aebd3bdSLior David 			reply.evt.status);
27324aebd3bdSLior David 		return -EINVAL;
27334aebd3bdSLior David 	}
27344aebd3bdSLior David 
27354aebd3bdSLior David 	return 0;
27364aebd3bdSLior David }
27374aebd3bdSLior David 
27384aebd3bdSLior David int wmi_port_delete(struct wil6210_priv *wil, u8 mid)
27394aebd3bdSLior David {
27404aebd3bdSLior David 	int rc;
27414aebd3bdSLior David 	struct wmi_port_delete_cmd cmd = {
27424aebd3bdSLior David 		.mid = mid,
27434aebd3bdSLior David 	};
27444aebd3bdSLior David 	struct {
27454aebd3bdSLior David 		struct wmi_cmd_hdr wmi;
27464aebd3bdSLior David 		struct wmi_port_deleted_event evt;
2747807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2748807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
2749807b0860SAlexei Avshalom Lazar 	};
27504aebd3bdSLior David 
27514aebd3bdSLior David 	wil_dbg_misc(wil, "port delete, mid %d\n", mid);
27524aebd3bdSLior David 
27534aebd3bdSLior David 	rc = wmi_call(wil, WMI_PORT_DELETE_CMDID, mid,
27544aebd3bdSLior David 		      &cmd, sizeof(cmd),
27554aebd3bdSLior David 		      WMI_PORT_DELETED_EVENTID, &reply,
27564aebd3bdSLior David 		      sizeof(reply), 2000);
27574aebd3bdSLior David 	if (rc) {
27584aebd3bdSLior David 		wil_err(wil, "failed to delete port, status %d\n", rc);
27594aebd3bdSLior David 		return rc;
27604aebd3bdSLior David 	}
27614aebd3bdSLior David 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
27624aebd3bdSLior David 		wil_err(wil, "WMI_PORT_DELETE returned status %d\n",
27634aebd3bdSLior David 			reply.evt.status);
27644aebd3bdSLior David 		return -EINVAL;
27654aebd3bdSLior David 	}
27664aebd3bdSLior David 
27674aebd3bdSLior David 	return 0;
27684aebd3bdSLior David }
27694aebd3bdSLior David 
2770e00243faSLior David static bool wmi_evt_call_handler(struct wil6210_vif *vif, int id,
27712be7d22fSVladimir Kondratiev 				 void *d, int len)
27722be7d22fSVladimir Kondratiev {
27732be7d22fSVladimir Kondratiev 	uint i;
27742be7d22fSVladimir Kondratiev 
27752be7d22fSVladimir Kondratiev 	for (i = 0; i < ARRAY_SIZE(wmi_evt_handlers); i++) {
27762be7d22fSVladimir Kondratiev 		if (wmi_evt_handlers[i].eventid == id) {
2777e00243faSLior David 			wmi_evt_handlers[i].handler(vif, id, d, len);
27782be7d22fSVladimir Kondratiev 			return true;
27792be7d22fSVladimir Kondratiev 		}
27802be7d22fSVladimir Kondratiev 	}
27812be7d22fSVladimir Kondratiev 
27822be7d22fSVladimir Kondratiev 	return false;
27832be7d22fSVladimir Kondratiev }
27842be7d22fSVladimir Kondratiev 
27852be7d22fSVladimir Kondratiev static void wmi_event_handle(struct wil6210_priv *wil,
27862be7d22fSVladimir Kondratiev 			     struct wil6210_mbox_hdr *hdr)
27872be7d22fSVladimir Kondratiev {
27882be7d22fSVladimir Kondratiev 	u16 len = le16_to_cpu(hdr->len);
27894aebd3bdSLior David 	struct wil6210_vif *vif;
27902be7d22fSVladimir Kondratiev 
27912be7d22fSVladimir Kondratiev 	if ((hdr->type == WIL_MBOX_HDR_TYPE_WMI) &&
2792b874ddecSLior David 	    (len >= sizeof(struct wmi_cmd_hdr))) {
2793b874ddecSLior David 		struct wmi_cmd_hdr *wmi = (void *)(&hdr[1]);
27942be7d22fSVladimir Kondratiev 		void *evt_data = (void *)(&wmi[1]);
2795b874ddecSLior David 		u16 id = le16_to_cpu(wmi->command_id);
2796e00243faSLior David 		u8 mid = wmi->mid;
2797028e1836SVladimir Kondratiev 
2798e00243faSLior David 		wil_dbg_wmi(wil, "Handle %s (0x%04x) (reply_id 0x%04x,%d)\n",
2799e00243faSLior David 			    eventid2name(id), id, wil->reply_id,
2800e00243faSLior David 			    wil->reply_mid);
2801e00243faSLior David 
28024aebd3bdSLior David 		if (mid == MID_BROADCAST)
28034aebd3bdSLior David 			mid = 0;
28044aebd3bdSLior David 		if (mid >= wil->max_vifs) {
28054aebd3bdSLior David 			wil_dbg_wmi(wil, "invalid mid %d, event skipped\n",
28064aebd3bdSLior David 				    mid);
28074aebd3bdSLior David 			return;
28084aebd3bdSLior David 		}
28094aebd3bdSLior David 		vif = wil->vifs[mid];
28104aebd3bdSLior David 		if (!vif) {
28114aebd3bdSLior David 			wil_dbg_wmi(wil, "event for empty VIF(%d), skipped\n",
28124aebd3bdSLior David 				    mid);
28134aebd3bdSLior David 			return;
28144aebd3bdSLior David 		}
28154aebd3bdSLior David 
28162be7d22fSVladimir Kondratiev 		/* check if someone waits for this event */
2817e00243faSLior David 		if (wil->reply_id && wil->reply_id == id &&
2818e00243faSLior David 		    wil->reply_mid == mid) {
28190916d9f2SMaya Erez 			WARN_ON(wil->reply_buf);
2820e00243faSLior David 
2821e00243faSLior David 			wmi_evt_call_handler(vif, id, evt_data,
28222be7d22fSVladimir Kondratiev 					     len - sizeof(*wmi));
2823af3db60aSLazar Alexei 			wil_dbg_wmi(wil, "event_handle: Complete WMI 0x%04x\n",
2824af3db60aSLazar Alexei 				    id);
282559502647SDedy Lansky 			complete(&wil->wmi_call);
28262be7d22fSVladimir Kondratiev 			return;
28272be7d22fSVladimir Kondratiev 		}
28282be7d22fSVladimir Kondratiev 		/* unsolicited event */
28292be7d22fSVladimir Kondratiev 		/* search for handler */
2830e00243faSLior David 		if (!wmi_evt_call_handler(vif, id, evt_data,
28312be7d22fSVladimir Kondratiev 					  len - sizeof(*wmi))) {
2832a3ce5ccdSDedy Lansky 			wil_info(wil, "Unhandled event 0x%04x\n", id);
28332be7d22fSVladimir Kondratiev 		}
28342be7d22fSVladimir Kondratiev 	} else {
28352be7d22fSVladimir Kondratiev 		wil_err(wil, "Unknown event type\n");
28362be7d22fSVladimir Kondratiev 		print_hex_dump(KERN_ERR, "evt?? ", DUMP_PREFIX_OFFSET, 16, 1,
28372be7d22fSVladimir Kondratiev 			       hdr, sizeof(*hdr) + len, true);
28382be7d22fSVladimir Kondratiev 	}
28392be7d22fSVladimir Kondratiev }
28402be7d22fSVladimir Kondratiev 
28412be7d22fSVladimir Kondratiev /*
28422be7d22fSVladimir Kondratiev  * Retrieve next WMI event from the pending list
28432be7d22fSVladimir Kondratiev  */
28442be7d22fSVladimir Kondratiev static struct list_head *next_wmi_ev(struct wil6210_priv *wil)
28452be7d22fSVladimir Kondratiev {
28462be7d22fSVladimir Kondratiev 	ulong flags;
28472be7d22fSVladimir Kondratiev 	struct list_head *ret = NULL;
28482be7d22fSVladimir Kondratiev 
28492be7d22fSVladimir Kondratiev 	spin_lock_irqsave(&wil->wmi_ev_lock, flags);
28502be7d22fSVladimir Kondratiev 
28512be7d22fSVladimir Kondratiev 	if (!list_empty(&wil->pending_wmi_ev)) {
28522be7d22fSVladimir Kondratiev 		ret = wil->pending_wmi_ev.next;
28532be7d22fSVladimir Kondratiev 		list_del(ret);
28542be7d22fSVladimir Kondratiev 	}
28552be7d22fSVladimir Kondratiev 
28562be7d22fSVladimir Kondratiev 	spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
28572be7d22fSVladimir Kondratiev 
28582be7d22fSVladimir Kondratiev 	return ret;
28592be7d22fSVladimir Kondratiev }
28602be7d22fSVladimir Kondratiev 
28612be7d22fSVladimir Kondratiev /*
28622be7d22fSVladimir Kondratiev  * Handler for the WMI events
28632be7d22fSVladimir Kondratiev  */
28642be7d22fSVladimir Kondratiev void wmi_event_worker(struct work_struct *work)
28652be7d22fSVladimir Kondratiev {
28662be7d22fSVladimir Kondratiev 	struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
28672be7d22fSVladimir Kondratiev 						 wmi_event_worker);
28682be7d22fSVladimir Kondratiev 	struct pending_wmi_event *evt;
28692be7d22fSVladimir Kondratiev 	struct list_head *lh;
28702be7d22fSVladimir Kondratiev 
2871af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "event_worker: Start\n");
28722be7d22fSVladimir Kondratiev 	while ((lh = next_wmi_ev(wil)) != NULL) {
28732be7d22fSVladimir Kondratiev 		evt = list_entry(lh, struct pending_wmi_event, list);
28742be7d22fSVladimir Kondratiev 		wmi_event_handle(wil, &evt->event.hdr);
28752be7d22fSVladimir Kondratiev 		kfree(evt);
28762be7d22fSVladimir Kondratiev 	}
2877af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "event_worker: Finished\n");
28782be7d22fSVladimir Kondratiev }
2879fe9ee51eSMaya Erez 
2880fe9ee51eSMaya Erez bool wil_is_wmi_idle(struct wil6210_priv *wil)
2881fe9ee51eSMaya Erez {
2882fe9ee51eSMaya Erez 	ulong flags;
2883fe9ee51eSMaya Erez 	struct wil6210_mbox_ring *r = &wil->mbox_ctl.rx;
2884fe9ee51eSMaya Erez 	bool rc = false;
2885fe9ee51eSMaya Erez 
2886fe9ee51eSMaya Erez 	spin_lock_irqsave(&wil->wmi_ev_lock, flags);
2887fe9ee51eSMaya Erez 
2888fe9ee51eSMaya Erez 	/* Check if there are pending WMI events in the events queue */
2889fe9ee51eSMaya Erez 	if (!list_empty(&wil->pending_wmi_ev)) {
2890fe9ee51eSMaya Erez 		wil_dbg_pm(wil, "Pending WMI events in queue\n");
2891fe9ee51eSMaya Erez 		goto out;
2892fe9ee51eSMaya Erez 	}
2893fe9ee51eSMaya Erez 
2894fe9ee51eSMaya Erez 	/* Check if there is a pending WMI call */
2895fe9ee51eSMaya Erez 	if (wil->reply_id) {
2896fe9ee51eSMaya Erez 		wil_dbg_pm(wil, "Pending WMI call\n");
2897fe9ee51eSMaya Erez 		goto out;
2898fe9ee51eSMaya Erez 	}
2899fe9ee51eSMaya Erez 
2900fe9ee51eSMaya Erez 	/* Check if there are pending RX events in mbox */
2901fe9ee51eSMaya Erez 	r->head = wil_r(wil, RGF_MBOX +
2902fe9ee51eSMaya Erez 			offsetof(struct wil6210_mbox_ctl, rx.head));
2903fe9ee51eSMaya Erez 	if (r->tail != r->head)
2904fe9ee51eSMaya Erez 		wil_dbg_pm(wil, "Pending WMI mbox events\n");
2905fe9ee51eSMaya Erez 	else
2906fe9ee51eSMaya Erez 		rc = true;
2907fe9ee51eSMaya Erez 
2908fe9ee51eSMaya Erez out:
2909fe9ee51eSMaya Erez 	spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
2910fe9ee51eSMaya Erez 	return rc;
2911fe9ee51eSMaya Erez }
2912a5dc6883SDedy Lansky 
2913a5dc6883SDedy Lansky static void
2914a5dc6883SDedy Lansky wmi_sched_scan_set_ssids(struct wil6210_priv *wil,
2915a5dc6883SDedy Lansky 			 struct wmi_start_sched_scan_cmd *cmd,
2916a5dc6883SDedy Lansky 			 struct cfg80211_ssid *ssids, int n_ssids,
2917a5dc6883SDedy Lansky 			 struct cfg80211_match_set *match_sets,
2918a5dc6883SDedy Lansky 			 int n_match_sets)
2919a5dc6883SDedy Lansky {
2920a5dc6883SDedy Lansky 	int i;
2921a5dc6883SDedy Lansky 
2922a5dc6883SDedy Lansky 	if (n_match_sets > WMI_MAX_PNO_SSID_NUM) {
2923a5dc6883SDedy Lansky 		wil_dbg_wmi(wil, "too many match sets (%d), use first %d\n",
2924a5dc6883SDedy Lansky 			    n_match_sets, WMI_MAX_PNO_SSID_NUM);
2925a5dc6883SDedy Lansky 		n_match_sets = WMI_MAX_PNO_SSID_NUM;
2926a5dc6883SDedy Lansky 	}
2927a5dc6883SDedy Lansky 	cmd->num_of_ssids = n_match_sets;
2928a5dc6883SDedy Lansky 
2929a5dc6883SDedy Lansky 	for (i = 0; i < n_match_sets; i++) {
2930a5dc6883SDedy Lansky 		struct wmi_sched_scan_ssid_match *wmi_match =
2931a5dc6883SDedy Lansky 			&cmd->ssid_for_match[i];
2932a5dc6883SDedy Lansky 		struct cfg80211_match_set *cfg_match = &match_sets[i];
2933a5dc6883SDedy Lansky 		int j;
2934a5dc6883SDedy Lansky 
2935a5dc6883SDedy Lansky 		wmi_match->ssid_len = cfg_match->ssid.ssid_len;
2936a5dc6883SDedy Lansky 		memcpy(wmi_match->ssid, cfg_match->ssid.ssid,
2937a5dc6883SDedy Lansky 		       min_t(u8, wmi_match->ssid_len, WMI_MAX_SSID_LEN));
2938a5dc6883SDedy Lansky 		wmi_match->rssi_threshold = S8_MIN;
2939a5dc6883SDedy Lansky 		if (cfg_match->rssi_thold >= S8_MIN &&
2940a5dc6883SDedy Lansky 		    cfg_match->rssi_thold <= S8_MAX)
2941a5dc6883SDedy Lansky 			wmi_match->rssi_threshold = cfg_match->rssi_thold;
2942a5dc6883SDedy Lansky 
2943a5dc6883SDedy Lansky 		for (j = 0; j < n_ssids; j++)
2944a5dc6883SDedy Lansky 			if (wmi_match->ssid_len == ssids[j].ssid_len &&
2945a5dc6883SDedy Lansky 			    memcmp(wmi_match->ssid, ssids[j].ssid,
2946a5dc6883SDedy Lansky 				   wmi_match->ssid_len) == 0)
2947a5dc6883SDedy Lansky 				wmi_match->add_ssid_to_probe = true;
2948a5dc6883SDedy Lansky 	}
2949a5dc6883SDedy Lansky }
2950a5dc6883SDedy Lansky 
2951a5dc6883SDedy Lansky static void
2952a5dc6883SDedy Lansky wmi_sched_scan_set_channels(struct wil6210_priv *wil,
2953a5dc6883SDedy Lansky 			    struct wmi_start_sched_scan_cmd *cmd,
2954a5dc6883SDedy Lansky 			    u32 n_channels,
2955a5dc6883SDedy Lansky 			    struct ieee80211_channel **channels)
2956a5dc6883SDedy Lansky {
2957a5dc6883SDedy Lansky 	int i;
2958a5dc6883SDedy Lansky 
2959a5dc6883SDedy Lansky 	if (n_channels > WMI_MAX_CHANNEL_NUM) {
2960a5dc6883SDedy Lansky 		wil_dbg_wmi(wil, "too many channels (%d), use first %d\n",
2961a5dc6883SDedy Lansky 			    n_channels, WMI_MAX_CHANNEL_NUM);
2962a5dc6883SDedy Lansky 		n_channels = WMI_MAX_CHANNEL_NUM;
2963a5dc6883SDedy Lansky 	}
2964a5dc6883SDedy Lansky 	cmd->num_of_channels = n_channels;
2965a5dc6883SDedy Lansky 
2966a5dc6883SDedy Lansky 	for (i = 0; i < n_channels; i++) {
2967a5dc6883SDedy Lansky 		struct ieee80211_channel *cfg_chan = channels[i];
2968a5dc6883SDedy Lansky 
2969a5dc6883SDedy Lansky 		cmd->channel_list[i] = cfg_chan->hw_value - 1;
2970a5dc6883SDedy Lansky 	}
2971a5dc6883SDedy Lansky }
2972a5dc6883SDedy Lansky 
2973a5dc6883SDedy Lansky static void
2974a5dc6883SDedy Lansky wmi_sched_scan_set_plans(struct wil6210_priv *wil,
2975a5dc6883SDedy Lansky 			 struct wmi_start_sched_scan_cmd *cmd,
2976a5dc6883SDedy Lansky 			 struct cfg80211_sched_scan_plan *scan_plans,
2977a5dc6883SDedy Lansky 			 int n_scan_plans)
2978a5dc6883SDedy Lansky {
2979a5dc6883SDedy Lansky 	int i;
2980a5dc6883SDedy Lansky 
2981a5dc6883SDedy Lansky 	if (n_scan_plans > WMI_MAX_PLANS_NUM) {
2982a5dc6883SDedy Lansky 		wil_dbg_wmi(wil, "too many plans (%d), use first %d\n",
2983a5dc6883SDedy Lansky 			    n_scan_plans, WMI_MAX_PLANS_NUM);
2984a5dc6883SDedy Lansky 		n_scan_plans = WMI_MAX_PLANS_NUM;
2985a5dc6883SDedy Lansky 	}
2986a5dc6883SDedy Lansky 
2987a5dc6883SDedy Lansky 	for (i = 0; i < n_scan_plans; i++) {
2988a5dc6883SDedy Lansky 		struct cfg80211_sched_scan_plan *cfg_plan = &scan_plans[i];
2989a5dc6883SDedy Lansky 
2990a5dc6883SDedy Lansky 		cmd->scan_plans[i].interval_sec =
2991a5dc6883SDedy Lansky 			cpu_to_le16(cfg_plan->interval);
2992a5dc6883SDedy Lansky 		cmd->scan_plans[i].num_of_iterations =
2993a5dc6883SDedy Lansky 			cpu_to_le16(cfg_plan->iterations);
2994a5dc6883SDedy Lansky 	}
2995a5dc6883SDedy Lansky }
2996a5dc6883SDedy Lansky 
2997a5dc6883SDedy Lansky int wmi_start_sched_scan(struct wil6210_priv *wil,
2998a5dc6883SDedy Lansky 			 struct cfg80211_sched_scan_request *request)
2999a5dc6883SDedy Lansky {
3000e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
3001a5dc6883SDedy Lansky 	int rc;
3002a5dc6883SDedy Lansky 	struct wmi_start_sched_scan_cmd cmd = {
3003a5dc6883SDedy Lansky 		.min_rssi_threshold = S8_MIN,
3004a5dc6883SDedy Lansky 		.initial_delay_sec = cpu_to_le16(request->delay),
3005a5dc6883SDedy Lansky 	};
3006a5dc6883SDedy Lansky 	struct {
3007a5dc6883SDedy Lansky 		struct wmi_cmd_hdr wmi;
3008a5dc6883SDedy Lansky 		struct wmi_start_sched_scan_event evt;
3009807b0860SAlexei Avshalom Lazar 	} __packed reply = {
3010807b0860SAlexei Avshalom Lazar 		.evt = {.result = WMI_PNO_REJECT},
3011807b0860SAlexei Avshalom Lazar 	};
3012a5dc6883SDedy Lansky 
3013a5dc6883SDedy Lansky 	if (!test_bit(WMI_FW_CAPABILITY_PNO, wil->fw_capabilities))
3014a5dc6883SDedy Lansky 		return -ENOTSUPP;
3015a5dc6883SDedy Lansky 
3016a5dc6883SDedy Lansky 	if (request->min_rssi_thold >= S8_MIN &&
3017a5dc6883SDedy Lansky 	    request->min_rssi_thold <= S8_MAX)
3018a5dc6883SDedy Lansky 		cmd.min_rssi_threshold = request->min_rssi_thold;
3019a5dc6883SDedy Lansky 
3020a5dc6883SDedy Lansky 	wmi_sched_scan_set_ssids(wil, &cmd, request->ssids, request->n_ssids,
3021a5dc6883SDedy Lansky 				 request->match_sets, request->n_match_sets);
3022a5dc6883SDedy Lansky 	wmi_sched_scan_set_channels(wil, &cmd,
3023a5dc6883SDedy Lansky 				    request->n_channels, request->channels);
3024a5dc6883SDedy Lansky 	wmi_sched_scan_set_plans(wil, &cmd,
3025a5dc6883SDedy Lansky 				 request->scan_plans, request->n_scan_plans);
3026a5dc6883SDedy Lansky 
3027e00243faSLior David 	rc = wmi_call(wil, WMI_START_SCHED_SCAN_CMDID, vif->mid,
3028e00243faSLior David 		      &cmd, sizeof(cmd),
3029a5dc6883SDedy Lansky 		      WMI_START_SCHED_SCAN_EVENTID, &reply, sizeof(reply),
3030a5dc6883SDedy Lansky 		      WIL_WMI_CALL_GENERAL_TO_MS);
3031a5dc6883SDedy Lansky 	if (rc)
3032a5dc6883SDedy Lansky 		return rc;
3033a5dc6883SDedy Lansky 
3034a5dc6883SDedy Lansky 	if (reply.evt.result != WMI_PNO_SUCCESS) {
3035a5dc6883SDedy Lansky 		wil_err(wil, "start sched scan failed, result %d\n",
3036a5dc6883SDedy Lansky 			reply.evt.result);
3037a5dc6883SDedy Lansky 		return -EINVAL;
3038a5dc6883SDedy Lansky 	}
3039a5dc6883SDedy Lansky 
3040a5dc6883SDedy Lansky 	return 0;
3041a5dc6883SDedy Lansky }
3042a5dc6883SDedy Lansky 
3043a5dc6883SDedy Lansky int wmi_stop_sched_scan(struct wil6210_priv *wil)
3044a5dc6883SDedy Lansky {
3045e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
3046a5dc6883SDedy Lansky 	int rc;
3047a5dc6883SDedy Lansky 	struct {
3048a5dc6883SDedy Lansky 		struct wmi_cmd_hdr wmi;
3049a5dc6883SDedy Lansky 		struct wmi_stop_sched_scan_event evt;
3050807b0860SAlexei Avshalom Lazar 	} __packed reply = {
3051807b0860SAlexei Avshalom Lazar 		.evt = {.result = WMI_PNO_REJECT},
3052807b0860SAlexei Avshalom Lazar 	};
3053a5dc6883SDedy Lansky 
3054a5dc6883SDedy Lansky 	if (!test_bit(WMI_FW_CAPABILITY_PNO, wil->fw_capabilities))
3055a5dc6883SDedy Lansky 		return -ENOTSUPP;
3056a5dc6883SDedy Lansky 
3057e00243faSLior David 	rc = wmi_call(wil, WMI_STOP_SCHED_SCAN_CMDID, vif->mid, NULL, 0,
3058a5dc6883SDedy Lansky 		      WMI_STOP_SCHED_SCAN_EVENTID, &reply, sizeof(reply),
3059a5dc6883SDedy Lansky 		      WIL_WMI_CALL_GENERAL_TO_MS);
3060a5dc6883SDedy Lansky 	if (rc)
3061a5dc6883SDedy Lansky 		return rc;
3062a5dc6883SDedy Lansky 
3063a5dc6883SDedy Lansky 	if (reply.evt.result != WMI_PNO_SUCCESS) {
3064a5dc6883SDedy Lansky 		wil_err(wil, "stop sched scan failed, result %d\n",
3065a5dc6883SDedy Lansky 			reply.evt.result);
3066a5dc6883SDedy Lansky 		return -EINVAL;
3067a5dc6883SDedy Lansky 	}
3068a5dc6883SDedy Lansky 
3069a5dc6883SDedy Lansky 	return 0;
3070a5dc6883SDedy Lansky }
30711c21cc5fSDedy Lansky 
30721c21cc5fSDedy Lansky int wmi_mgmt_tx(struct wil6210_vif *vif, const u8 *buf, size_t len)
30731c21cc5fSDedy Lansky {
30741c21cc5fSDedy Lansky 	size_t total;
30751c21cc5fSDedy Lansky 	struct wil6210_priv *wil = vif_to_wil(vif);
30761c21cc5fSDedy Lansky 	struct ieee80211_mgmt *mgmt_frame = (void *)buf;
30771c21cc5fSDedy Lansky 	struct wmi_sw_tx_req_cmd *cmd;
30781c21cc5fSDedy Lansky 	struct {
30791c21cc5fSDedy Lansky 		struct wmi_cmd_hdr wmi;
30801c21cc5fSDedy Lansky 		struct wmi_sw_tx_complete_event evt;
30811c21cc5fSDedy Lansky 	} __packed evt = {
30821c21cc5fSDedy Lansky 		.evt = {.status = WMI_FW_STATUS_FAILURE},
30831c21cc5fSDedy Lansky 	};
30841c21cc5fSDedy Lansky 	int rc;
30851c21cc5fSDedy Lansky 
30861c21cc5fSDedy Lansky 	wil_dbg_misc(wil, "mgmt_tx mid %d\n", vif->mid);
30871c21cc5fSDedy Lansky 	wil_hex_dump_misc("mgmt tx frame ", DUMP_PREFIX_OFFSET, 16, 1, buf,
30881c21cc5fSDedy Lansky 			  len, true);
30891c21cc5fSDedy Lansky 
30901c21cc5fSDedy Lansky 	if (len < sizeof(struct ieee80211_hdr_3addr))
30911c21cc5fSDedy Lansky 		return -EINVAL;
30921c21cc5fSDedy Lansky 
30931c21cc5fSDedy Lansky 	total = sizeof(*cmd) + len;
30941c21cc5fSDedy Lansky 	if (total < len) {
30951c21cc5fSDedy Lansky 		wil_err(wil, "mgmt_tx invalid len %zu\n", len);
30961c21cc5fSDedy Lansky 		return -EINVAL;
30971c21cc5fSDedy Lansky 	}
30981c21cc5fSDedy Lansky 
30991c21cc5fSDedy Lansky 	cmd = kmalloc(total, GFP_KERNEL);
31001c21cc5fSDedy Lansky 	if (!cmd)
31011c21cc5fSDedy Lansky 		return -ENOMEM;
31021c21cc5fSDedy Lansky 
31031c21cc5fSDedy Lansky 	memcpy(cmd->dst_mac, mgmt_frame->da, WMI_MAC_LEN);
31041c21cc5fSDedy Lansky 	cmd->len = cpu_to_le16(len);
31051c21cc5fSDedy Lansky 	memcpy(cmd->payload, buf, len);
31061c21cc5fSDedy Lansky 
31071c21cc5fSDedy Lansky 	rc = wmi_call(wil, WMI_SW_TX_REQ_CMDID, vif->mid, cmd, total,
31081c21cc5fSDedy Lansky 		      WMI_SW_TX_COMPLETE_EVENTID, &evt, sizeof(evt), 2000);
31091c21cc5fSDedy Lansky 	if (!rc && evt.evt.status != WMI_FW_STATUS_SUCCESS) {
31101c21cc5fSDedy Lansky 		wil_err(wil, "mgmt_tx failed with status %d\n", evt.evt.status);
31111c21cc5fSDedy Lansky 		rc = -EINVAL;
31121c21cc5fSDedy Lansky 	}
31131c21cc5fSDedy Lansky 
31141c21cc5fSDedy Lansky 	kfree(cmd);
31151c21cc5fSDedy Lansky 
31161c21cc5fSDedy Lansky 	return rc;
31171c21cc5fSDedy Lansky }
311896c93589SGidon Studinski 
3119b698e2dfSAhmad Masri int wmi_mgmt_tx_ext(struct wil6210_vif *vif, const u8 *buf, size_t len,
3120b698e2dfSAhmad Masri 		    u8 channel, u16 duration_ms)
3121b698e2dfSAhmad Masri {
3122b698e2dfSAhmad Masri 	size_t total;
3123b698e2dfSAhmad Masri 	struct wil6210_priv *wil = vif_to_wil(vif);
3124b698e2dfSAhmad Masri 	struct ieee80211_mgmt *mgmt_frame = (void *)buf;
3125b698e2dfSAhmad Masri 	struct wmi_sw_tx_req_ext_cmd *cmd;
3126b698e2dfSAhmad Masri 	struct {
3127b698e2dfSAhmad Masri 		struct wmi_cmd_hdr wmi;
3128b698e2dfSAhmad Masri 		struct wmi_sw_tx_complete_event evt;
3129b698e2dfSAhmad Masri 	} __packed evt = {
3130b698e2dfSAhmad Masri 		.evt = {.status = WMI_FW_STATUS_FAILURE},
3131b698e2dfSAhmad Masri 	};
3132b698e2dfSAhmad Masri 	int rc;
3133b698e2dfSAhmad Masri 
3134b698e2dfSAhmad Masri 	wil_dbg_wmi(wil, "mgmt_tx_ext mid %d channel %d duration %d\n",
3135b698e2dfSAhmad Masri 		    vif->mid, channel, duration_ms);
3136b698e2dfSAhmad Masri 	wil_hex_dump_wmi("mgmt_tx_ext frame ", DUMP_PREFIX_OFFSET, 16, 1, buf,
3137b698e2dfSAhmad Masri 			 len, true);
3138b698e2dfSAhmad Masri 
3139b698e2dfSAhmad Masri 	if (len < sizeof(struct ieee80211_hdr_3addr)) {
3140b698e2dfSAhmad Masri 		wil_err(wil, "short frame. len %zu\n", len);
3141b698e2dfSAhmad Masri 		return -EINVAL;
3142b698e2dfSAhmad Masri 	}
3143b698e2dfSAhmad Masri 
3144b698e2dfSAhmad Masri 	total = sizeof(*cmd) + len;
3145b698e2dfSAhmad Masri 	if (total < len) {
3146b698e2dfSAhmad Masri 		wil_err(wil, "mgmt_tx_ext invalid len %zu\n", len);
3147b698e2dfSAhmad Masri 		return -EINVAL;
3148b698e2dfSAhmad Masri 	}
3149b698e2dfSAhmad Masri 
3150b698e2dfSAhmad Masri 	cmd = kzalloc(total, GFP_KERNEL);
3151b698e2dfSAhmad Masri 	if (!cmd)
3152b698e2dfSAhmad Masri 		return -ENOMEM;
3153b698e2dfSAhmad Masri 
3154b698e2dfSAhmad Masri 	memcpy(cmd->dst_mac, mgmt_frame->da, WMI_MAC_LEN);
3155b698e2dfSAhmad Masri 	cmd->len = cpu_to_le16(len);
3156b698e2dfSAhmad Masri 	memcpy(cmd->payload, buf, len);
3157b698e2dfSAhmad Masri 	cmd->channel = channel - 1;
3158b698e2dfSAhmad Masri 	cmd->duration_ms = cpu_to_le16(duration_ms);
3159b698e2dfSAhmad Masri 
3160b698e2dfSAhmad Masri 	rc = wmi_call(wil, WMI_SW_TX_REQ_EXT_CMDID, vif->mid, cmd, total,
3161b698e2dfSAhmad Masri 		      WMI_SW_TX_COMPLETE_EVENTID, &evt, sizeof(evt), 2000);
3162b698e2dfSAhmad Masri 	if (!rc && evt.evt.status != WMI_FW_STATUS_SUCCESS) {
3163b698e2dfSAhmad Masri 		wil_err(wil, "mgmt_tx_ext failed with status %d\n",
3164b698e2dfSAhmad Masri 			evt.evt.status);
3165b698e2dfSAhmad Masri 		rc = -EINVAL;
3166b698e2dfSAhmad Masri 	}
3167b698e2dfSAhmad Masri 
3168b698e2dfSAhmad Masri 	kfree(cmd);
3169b698e2dfSAhmad Masri 
3170b698e2dfSAhmad Masri 	return rc;
3171b698e2dfSAhmad Masri }
3172b698e2dfSAhmad Masri 
317396c93589SGidon Studinski int wil_wmi_tx_sring_cfg(struct wil6210_priv *wil, int ring_id)
317496c93589SGidon Studinski {
317596c93589SGidon Studinski 	int rc;
317696c93589SGidon Studinski 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
317796c93589SGidon Studinski 	struct wil_status_ring *sring = &wil->srings[ring_id];
317896c93589SGidon Studinski 	struct wmi_tx_status_ring_add_cmd cmd = {
317996c93589SGidon Studinski 		.ring_cfg = {
318096c93589SGidon Studinski 			.ring_size = cpu_to_le16(sring->size),
318196c93589SGidon Studinski 		},
318296c93589SGidon Studinski 		.irq_index = WIL_TX_STATUS_IRQ_IDX
318396c93589SGidon Studinski 	};
318496c93589SGidon Studinski 	struct {
318596c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
318696c93589SGidon Studinski 		struct wmi_tx_status_ring_cfg_done_event evt;
318796c93589SGidon Studinski 	} __packed reply = {
318896c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
318996c93589SGidon Studinski 	};
319096c93589SGidon Studinski 
319196c93589SGidon Studinski 	cmd.ring_cfg.ring_id = ring_id;
319296c93589SGidon Studinski 
319396c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(sring->pa);
319496c93589SGidon Studinski 	rc = wmi_call(wil, WMI_TX_STATUS_RING_ADD_CMDID, vif->mid, &cmd,
319596c93589SGidon Studinski 		      sizeof(cmd), WMI_TX_STATUS_RING_CFG_DONE_EVENTID,
319696c93589SGidon Studinski 		      &reply, sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
319796c93589SGidon Studinski 	if (rc) {
319896c93589SGidon Studinski 		wil_err(wil, "TX_STATUS_RING_ADD_CMD failed, rc %d\n", rc);
319996c93589SGidon Studinski 		return rc;
320096c93589SGidon Studinski 	}
320196c93589SGidon Studinski 
320296c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
320396c93589SGidon Studinski 		wil_err(wil, "TX_STATUS_RING_ADD_CMD failed, status %d\n",
320496c93589SGidon Studinski 			reply.evt.status);
320596c93589SGidon Studinski 		return -EINVAL;
320696c93589SGidon Studinski 	}
320796c93589SGidon Studinski 
320896c93589SGidon Studinski 	sring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
320996c93589SGidon Studinski 
321096c93589SGidon Studinski 	return 0;
321196c93589SGidon Studinski }
321296c93589SGidon Studinski 
321396c93589SGidon Studinski int wil_wmi_cfg_def_rx_offload(struct wil6210_priv *wil, u16 max_rx_pl_per_desc)
321496c93589SGidon Studinski {
321596c93589SGidon Studinski 	struct net_device *ndev = wil->main_ndev;
321696c93589SGidon Studinski 	struct wil6210_vif *vif = ndev_to_vif(ndev);
321796c93589SGidon Studinski 	int rc;
321896c93589SGidon Studinski 	struct wmi_cfg_def_rx_offload_cmd cmd = {
321996c93589SGidon Studinski 		.max_msdu_size = cpu_to_le16(wil_mtu2macbuf(WIL_MAX_ETH_MTU)),
322096c93589SGidon Studinski 		.max_rx_pl_per_desc = cpu_to_le16(max_rx_pl_per_desc),
322196c93589SGidon Studinski 		.decap_trans_type = WMI_DECAP_TYPE_802_3,
322296c93589SGidon Studinski 		.l2_802_3_offload_ctrl = 0,
322396c93589SGidon Studinski 		.l3_l4_ctrl = 1 << L3_L4_CTRL_TCPIP_CHECKSUM_EN_POS,
322496c93589SGidon Studinski 	};
322596c93589SGidon Studinski 	struct {
322696c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
322796c93589SGidon Studinski 		struct wmi_cfg_def_rx_offload_done_event evt;
322896c93589SGidon Studinski 	} __packed reply = {
322996c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
323096c93589SGidon Studinski 	};
323196c93589SGidon Studinski 
323296c93589SGidon Studinski 	rc = wmi_call(wil, WMI_CFG_DEF_RX_OFFLOAD_CMDID, vif->mid, &cmd,
323396c93589SGidon Studinski 		      sizeof(cmd), WMI_CFG_DEF_RX_OFFLOAD_DONE_EVENTID, &reply,
323496c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
323596c93589SGidon Studinski 	if (rc) {
323696c93589SGidon Studinski 		wil_err(wil, "WMI_CFG_DEF_RX_OFFLOAD_CMD failed, rc %d\n", rc);
323796c93589SGidon Studinski 		return rc;
323896c93589SGidon Studinski 	}
323996c93589SGidon Studinski 
324096c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
324196c93589SGidon Studinski 		wil_err(wil, "WMI_CFG_DEF_RX_OFFLOAD_CMD failed, status %d\n",
324296c93589SGidon Studinski 			reply.evt.status);
324396c93589SGidon Studinski 		return -EINVAL;
324496c93589SGidon Studinski 	}
324596c93589SGidon Studinski 
324696c93589SGidon Studinski 	return 0;
324796c93589SGidon Studinski }
324896c93589SGidon Studinski 
324996c93589SGidon Studinski int wil_wmi_rx_sring_add(struct wil6210_priv *wil, u16 ring_id)
325096c93589SGidon Studinski {
325196c93589SGidon Studinski 	struct net_device *ndev = wil->main_ndev;
325296c93589SGidon Studinski 	struct wil6210_vif *vif = ndev_to_vif(ndev);
325396c93589SGidon Studinski 	struct wil_status_ring *sring = &wil->srings[ring_id];
325496c93589SGidon Studinski 	int rc;
325596c93589SGidon Studinski 	struct wmi_rx_status_ring_add_cmd cmd = {
325696c93589SGidon Studinski 		.ring_cfg = {
325796c93589SGidon Studinski 			.ring_size = cpu_to_le16(sring->size),
325896c93589SGidon Studinski 			.ring_id = ring_id,
325996c93589SGidon Studinski 		},
326096c93589SGidon Studinski 		.rx_msg_type = wil->use_compressed_rx_status ?
326196c93589SGidon Studinski 			WMI_RX_MSG_TYPE_COMPRESSED :
326296c93589SGidon Studinski 			WMI_RX_MSG_TYPE_EXTENDED,
326396c93589SGidon Studinski 		.irq_index = WIL_RX_STATUS_IRQ_IDX,
326496c93589SGidon Studinski 	};
326596c93589SGidon Studinski 	struct {
326696c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
326796c93589SGidon Studinski 		struct wmi_rx_status_ring_cfg_done_event evt;
326896c93589SGidon Studinski 	} __packed reply = {
326996c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
327096c93589SGidon Studinski 	};
327196c93589SGidon Studinski 
327296c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(sring->pa);
327396c93589SGidon Studinski 	rc = wmi_call(wil, WMI_RX_STATUS_RING_ADD_CMDID, vif->mid, &cmd,
327496c93589SGidon Studinski 		      sizeof(cmd), WMI_RX_STATUS_RING_CFG_DONE_EVENTID, &reply,
327596c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
327696c93589SGidon Studinski 	if (rc) {
327796c93589SGidon Studinski 		wil_err(wil, "RX_STATUS_RING_ADD_CMD failed, rc %d\n", rc);
327896c93589SGidon Studinski 		return rc;
327996c93589SGidon Studinski 	}
328096c93589SGidon Studinski 
328196c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
328296c93589SGidon Studinski 		wil_err(wil, "RX_STATUS_RING_ADD_CMD failed, status %d\n",
328396c93589SGidon Studinski 			reply.evt.status);
328496c93589SGidon Studinski 		return -EINVAL;
328596c93589SGidon Studinski 	}
328696c93589SGidon Studinski 
328796c93589SGidon Studinski 	sring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
328896c93589SGidon Studinski 
328996c93589SGidon Studinski 	return 0;
329096c93589SGidon Studinski }
329196c93589SGidon Studinski 
329296c93589SGidon Studinski int wil_wmi_rx_desc_ring_add(struct wil6210_priv *wil, int status_ring_id)
329396c93589SGidon Studinski {
329496c93589SGidon Studinski 	struct net_device *ndev = wil->main_ndev;
329596c93589SGidon Studinski 	struct wil6210_vif *vif = ndev_to_vif(ndev);
329696c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_rx;
329796c93589SGidon Studinski 	int rc;
329896c93589SGidon Studinski 	struct wmi_rx_desc_ring_add_cmd cmd = {
329996c93589SGidon Studinski 		.ring_cfg = {
330096c93589SGidon Studinski 			.ring_size = cpu_to_le16(ring->size),
330196c93589SGidon Studinski 			.ring_id = WIL_RX_DESC_RING_ID,
330296c93589SGidon Studinski 		},
330396c93589SGidon Studinski 		.status_ring_id = status_ring_id,
330496c93589SGidon Studinski 		.irq_index = WIL_RX_STATUS_IRQ_IDX,
330596c93589SGidon Studinski 	};
330696c93589SGidon Studinski 	struct {
330796c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
330896c93589SGidon Studinski 		struct wmi_rx_desc_ring_cfg_done_event evt;
330996c93589SGidon Studinski 	} __packed reply = {
331096c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
331196c93589SGidon Studinski 	};
331296c93589SGidon Studinski 
331396c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(ring->pa);
331496c93589SGidon Studinski 	cmd.sw_tail_host_addr = cpu_to_le64(ring->edma_rx_swtail.pa);
331596c93589SGidon Studinski 	rc = wmi_call(wil, WMI_RX_DESC_RING_ADD_CMDID, vif->mid, &cmd,
331696c93589SGidon Studinski 		      sizeof(cmd), WMI_RX_DESC_RING_CFG_DONE_EVENTID, &reply,
331796c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
331896c93589SGidon Studinski 	if (rc) {
331996c93589SGidon Studinski 		wil_err(wil, "WMI_RX_DESC_RING_ADD_CMD failed, rc %d\n", rc);
332096c93589SGidon Studinski 		return rc;
332196c93589SGidon Studinski 	}
332296c93589SGidon Studinski 
332396c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
332496c93589SGidon Studinski 		wil_err(wil, "WMI_RX_DESC_RING_ADD_CMD failed, status %d\n",
332596c93589SGidon Studinski 			reply.evt.status);
332696c93589SGidon Studinski 		return -EINVAL;
332796c93589SGidon Studinski 	}
332896c93589SGidon Studinski 
332996c93589SGidon Studinski 	ring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
333096c93589SGidon Studinski 
333196c93589SGidon Studinski 	return 0;
333296c93589SGidon Studinski }
333396c93589SGidon Studinski 
333496c93589SGidon Studinski int wil_wmi_tx_desc_ring_add(struct wil6210_vif *vif, int ring_id, int cid,
333596c93589SGidon Studinski 			     int tid)
333696c93589SGidon Studinski {
333796c93589SGidon Studinski 	struct wil6210_priv *wil = vif_to_wil(vif);
333896c93589SGidon Studinski 	int sring_id = wil->tx_sring_idx; /* there is only one TX sring */
333996c93589SGidon Studinski 	int rc;
334096c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_tx[ring_id];
334196c93589SGidon Studinski 	struct wil_ring_tx_data *txdata = &wil->ring_tx_data[ring_id];
334296c93589SGidon Studinski 	struct wmi_tx_desc_ring_add_cmd cmd = {
334396c93589SGidon Studinski 		.ring_cfg = {
334496c93589SGidon Studinski 			.ring_size = cpu_to_le16(ring->size),
334596c93589SGidon Studinski 			.ring_id = ring_id,
334696c93589SGidon Studinski 		},
334796c93589SGidon Studinski 		.status_ring_id = sring_id,
334896c93589SGidon Studinski 		.cid = cid,
334996c93589SGidon Studinski 		.tid = tid,
335096c93589SGidon Studinski 		.encap_trans_type = WMI_VRING_ENC_TYPE_802_3,
335196c93589SGidon Studinski 		.max_msdu_size = cpu_to_le16(wil_mtu2macbuf(mtu_max)),
335296c93589SGidon Studinski 		.schd_params = {
335396c93589SGidon Studinski 			.priority = cpu_to_le16(0),
335496c93589SGidon Studinski 			.timeslot_us = cpu_to_le16(0xfff),
335596c93589SGidon Studinski 		}
335696c93589SGidon Studinski 	};
335796c93589SGidon Studinski 	struct {
335896c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
335996c93589SGidon Studinski 		struct wmi_tx_desc_ring_cfg_done_event evt;
336096c93589SGidon Studinski 	} __packed reply = {
336196c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
336296c93589SGidon Studinski 	};
336396c93589SGidon Studinski 
336496c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(ring->pa);
336596c93589SGidon Studinski 	rc = wmi_call(wil, WMI_TX_DESC_RING_ADD_CMDID, vif->mid, &cmd,
336696c93589SGidon Studinski 		      sizeof(cmd), WMI_TX_DESC_RING_CFG_DONE_EVENTID, &reply,
336796c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
336896c93589SGidon Studinski 	if (rc) {
336996c93589SGidon Studinski 		wil_err(wil, "WMI_TX_DESC_RING_ADD_CMD failed, rc %d\n", rc);
337096c93589SGidon Studinski 		return rc;
337196c93589SGidon Studinski 	}
337296c93589SGidon Studinski 
337396c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
337496c93589SGidon Studinski 		wil_err(wil, "WMI_TX_DESC_RING_ADD_CMD failed, status %d\n",
337596c93589SGidon Studinski 			reply.evt.status);
337696c93589SGidon Studinski 		return -EINVAL;
337796c93589SGidon Studinski 	}
337896c93589SGidon Studinski 
337996c93589SGidon Studinski 	spin_lock_bh(&txdata->lock);
338096c93589SGidon Studinski 	ring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
338196c93589SGidon Studinski 	txdata->mid = vif->mid;
338296c93589SGidon Studinski 	txdata->enabled = 1;
338396c93589SGidon Studinski 	spin_unlock_bh(&txdata->lock);
338496c93589SGidon Studinski 
338596c93589SGidon Studinski 	return 0;
338696c93589SGidon Studinski }
338796c93589SGidon Studinski 
338896c93589SGidon Studinski int wil_wmi_bcast_desc_ring_add(struct wil6210_vif *vif, int ring_id)
338996c93589SGidon Studinski {
339096c93589SGidon Studinski 	struct wil6210_priv *wil = vif_to_wil(vif);
339196c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_tx[ring_id];
339296c93589SGidon Studinski 	int rc;
339396c93589SGidon Studinski 	struct wmi_bcast_desc_ring_add_cmd cmd = {
339496c93589SGidon Studinski 		.ring_cfg = {
339596c93589SGidon Studinski 			.ring_size = cpu_to_le16(ring->size),
339696c93589SGidon Studinski 			.ring_id = ring_id,
339796c93589SGidon Studinski 		},
339896c93589SGidon Studinski 		.status_ring_id = wil->tx_sring_idx,
339996c93589SGidon Studinski 		.encap_trans_type = WMI_VRING_ENC_TYPE_802_3,
340096c93589SGidon Studinski 	};
340196c93589SGidon Studinski 	struct {
340296c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
340396c93589SGidon Studinski 		struct wmi_rx_desc_ring_cfg_done_event evt;
340496c93589SGidon Studinski 	} __packed reply = {
340596c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
340696c93589SGidon Studinski 	};
340796c93589SGidon Studinski 	struct wil_ring_tx_data *txdata = &wil->ring_tx_data[ring_id];
340896c93589SGidon Studinski 
340996c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(ring->pa);
341096c93589SGidon Studinski 	rc = wmi_call(wil, WMI_BCAST_DESC_RING_ADD_CMDID, vif->mid, &cmd,
341196c93589SGidon Studinski 		      sizeof(cmd), WMI_TX_DESC_RING_CFG_DONE_EVENTID, &reply,
341296c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
341396c93589SGidon Studinski 	if (rc) {
341496c93589SGidon Studinski 		wil_err(wil, "WMI_BCAST_DESC_RING_ADD_CMD failed, rc %d\n", rc);
341596c93589SGidon Studinski 		return rc;
341696c93589SGidon Studinski 	}
341796c93589SGidon Studinski 
341896c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
341996c93589SGidon Studinski 		wil_err(wil, "Broadcast Tx config failed, status %d\n",
342096c93589SGidon Studinski 			reply.evt.status);
342196c93589SGidon Studinski 		return -EINVAL;
342296c93589SGidon Studinski 	}
342396c93589SGidon Studinski 
342496c93589SGidon Studinski 	spin_lock_bh(&txdata->lock);
342596c93589SGidon Studinski 	ring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
342696c93589SGidon Studinski 	txdata->mid = vif->mid;
342796c93589SGidon Studinski 	txdata->enabled = 1;
342896c93589SGidon Studinski 	spin_unlock_bh(&txdata->lock);
342996c93589SGidon Studinski 
343096c93589SGidon Studinski 	return 0;
343196c93589SGidon Studinski }
34320c936b3cSDedy Lansky 
34330c936b3cSDedy Lansky int wmi_link_stats_cfg(struct wil6210_vif *vif, u32 type, u8 cid, u32 interval)
34340c936b3cSDedy Lansky {
34350c936b3cSDedy Lansky 	struct wil6210_priv *wil = vif_to_wil(vif);
34360c936b3cSDedy Lansky 	struct wmi_link_stats_cmd cmd = {
34370c936b3cSDedy Lansky 		.record_type_mask = cpu_to_le32(type),
34380c936b3cSDedy Lansky 		.cid = cid,
34390c936b3cSDedy Lansky 		.action = WMI_LINK_STATS_SNAPSHOT,
34400c936b3cSDedy Lansky 		.interval_msec = cpu_to_le32(interval),
34410c936b3cSDedy Lansky 	};
34420c936b3cSDedy Lansky 	struct {
34430c936b3cSDedy Lansky 		struct wmi_cmd_hdr wmi;
34440c936b3cSDedy Lansky 		struct wmi_link_stats_config_done_event evt;
34450c936b3cSDedy Lansky 	} __packed reply = {
34460c936b3cSDedy Lansky 		.evt = {.status = WMI_FW_STATUS_FAILURE},
34470c936b3cSDedy Lansky 	};
34480c936b3cSDedy Lansky 	int rc;
34490c936b3cSDedy Lansky 
34500c936b3cSDedy Lansky 	rc = wmi_call(wil, WMI_LINK_STATS_CMDID, vif->mid, &cmd, sizeof(cmd),
34510c936b3cSDedy Lansky 		      WMI_LINK_STATS_CONFIG_DONE_EVENTID, &reply,
34520c936b3cSDedy Lansky 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
34530c936b3cSDedy Lansky 	if (rc) {
34540c936b3cSDedy Lansky 		wil_err(wil, "WMI_LINK_STATS_CMDID failed, rc %d\n", rc);
34550c936b3cSDedy Lansky 		return rc;
34560c936b3cSDedy Lansky 	}
34570c936b3cSDedy Lansky 
34580c936b3cSDedy Lansky 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
34590c936b3cSDedy Lansky 		wil_err(wil, "Link statistics config failed, status %d\n",
34600c936b3cSDedy Lansky 			reply.evt.status);
34610c936b3cSDedy Lansky 		return -EINVAL;
34620c936b3cSDedy Lansky 	}
34630c936b3cSDedy Lansky 
34640c936b3cSDedy Lansky 	return 0;
34650c936b3cSDedy Lansky }
3466