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 */
9261578820SLior David 	{0x000000, 0x040000, 0x8c0000, "fw_code", true},
9361578820SLior David 	/* FW data RAM 32k */
9461578820SLior David 	{0x800000, 0x808000, 0x900000, "fw_data", true},
9561578820SLior David 	/* periph data 128k */
9661578820SLior David 	{0x840000, 0x860000, 0x908000, "fw_peri", true},
9761578820SLior David 	/* various RGF 40k */
9861578820SLior David 	{0x880000, 0x88a000, 0x880000, "rgf", true},
9961578820SLior David 	/* AGC table   4k */
10061578820SLior David 	{0x88a000, 0x88b000, 0x88a000, "AGC_tbl", true},
10161578820SLior David 	/* Pcie_ext_rgf 4k */
10261578820SLior David 	{0x88b000, 0x88c000, 0x88b000, "rgf_ext", true},
10361578820SLior David 	/* mac_ext_rgf 512b */
10461578820SLior David 	{0x88c000, 0x88c200, 0x88c000, "mac_rgf_ext", true},
10561578820SLior David 	/* upper area 548k */
10661578820SLior David 	{0x8c0000, 0x949000, 0x8c0000, "upper", 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 */
11161578820SLior David 	{0x000000, 0x020000, 0x920000, "uc_code", false},
11261578820SLior David 	/* ucode data RAM 16k */
11361578820SLior David 	{0x800000, 0x804000, 0x940000, "uc_data", 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 = {
12154fca595SLior David 	0x88c000, 0x88c500, 0x88c000, "mac_rgf_ext", 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 */
1374276d771SMaya Erez 	{0x000000, 0x100000, 0x900000, "fw_code", true},
1384276d771SMaya Erez 	/* FW data RAM 128k */
1394276d771SMaya Erez 	{0x800000, 0x820000, 0xa00000, "fw_data", true},
1404276d771SMaya Erez 	/* periph. data RAM 96k */
1414276d771SMaya Erez 	{0x840000, 0x858000, 0xa20000, "fw_peri", true},
1424276d771SMaya Erez 	/* various RGF 40k */
1434276d771SMaya Erez 	{0x880000, 0x88a000, 0x880000, "rgf", true},
1444276d771SMaya Erez 	/* AGC table 4k */
1454276d771SMaya Erez 	{0x88a000, 0x88b000, 0x88a000, "AGC_tbl", true},
1464276d771SMaya Erez 	/* Pcie_ext_rgf 4k */
1474276d771SMaya Erez 	{0x88b000, 0x88c000, 0x88b000, "rgf_ext", true},
1484276d771SMaya Erez 	/* mac_ext_rgf 1344b */
1494276d771SMaya Erez 	{0x88c000, 0x88c540, 0x88c000, "mac_rgf_ext", true},
1504276d771SMaya Erez 	/* ext USER RGF 4k */
1514276d771SMaya Erez 	{0x88d000, 0x88e000, 0x88d000, "ext_user_rgf", true},
1524276d771SMaya Erez 	/* OTP 4k */
1534276d771SMaya Erez 	{0x8a0000, 0x8a1000, 0x8a0000, "otp", true},
1544276d771SMaya Erez 	/* DMA EXT RGF 64k */
1554276d771SMaya Erez 	{0x8b0000, 0x8c0000, 0x8b0000, "dma_ext_rgf", true},
1564276d771SMaya Erez 	/* upper area 1536k */
1574276d771SMaya Erez 	{0x900000, 0xa80000, 0x900000, "upper", 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 */
1624276d771SMaya Erez 	{0x000000, 0x040000, 0xa38000, "uc_code", false},
1634276d771SMaya Erez 	/* ucode data RAM 32k */
1644276d771SMaya Erez 	{0x800000, 0x808000, 0xa78000, "uc_data", 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 */
180485790d0SMaya Erez 	{0x000000, 0x0c0000, 0x900000, "fw_code", true},
181485790d0SMaya Erez 	/* FW data RAM 128k */
182485790d0SMaya Erez 	{0x800000, 0x820000, 0xa00000, "fw_data", true},
183485790d0SMaya Erez 	/* periph. data RAM 96k */
184485790d0SMaya Erez 	{0x840000, 0x858000, 0xa20000, "fw_peri", true},
185485790d0SMaya Erez 	/* various RGF 40k */
186485790d0SMaya Erez 	{0x880000, 0x88a000, 0x880000, "rgf", true},
187485790d0SMaya Erez 	/* AGC table 4k */
188485790d0SMaya Erez 	{0x88a000, 0x88b000, 0x88a000, "AGC_tbl", true},
189485790d0SMaya Erez 	/* Pcie_ext_rgf 4k */
190485790d0SMaya Erez 	{0x88b000, 0x88c000, 0x88b000, "rgf_ext", true},
191485790d0SMaya Erez 	/* mac_ext_rgf 2256b */
192485790d0SMaya Erez 	{0x88c000, 0x88c8d0, 0x88c000, "mac_rgf_ext", true},
193485790d0SMaya Erez 	/* ext USER RGF 4k */
194485790d0SMaya Erez 	{0x88d000, 0x88e000, 0x88d000, "ext_user_rgf", true},
195485790d0SMaya Erez 	/* SEC PKA 16k */
196485790d0SMaya Erez 	{0x890000, 0x894000, 0x890000, "sec_pka", true},
197485790d0SMaya Erez 	/* SEC KDF RGF 3096b */
198485790d0SMaya Erez 	{0x898000, 0x898c18, 0x898000, "sec_kdf_rgf", true},
199485790d0SMaya Erez 	/* SEC MAIN 2124b */
200485790d0SMaya Erez 	{0x89a000, 0x89a84c, 0x89a000, "sec_main", true},
201485790d0SMaya Erez 	/* OTP 4k */
202485790d0SMaya Erez 	{0x8a0000, 0x8a1000, 0x8a0000, "otp", true},
203485790d0SMaya Erez 	/* DMA EXT RGF 64k */
204485790d0SMaya Erez 	{0x8b0000, 0x8c0000, 0x8b0000, "dma_ext_rgf", true},
205485790d0SMaya Erez 	/* DUM USER RGF 528b */
206485790d0SMaya Erez 	{0x8c0000, 0x8c0210, 0x8c0000, "dum_user_rgf", true},
207485790d0SMaya Erez 	/* DMA OFU 296b */
208485790d0SMaya Erez 	{0x8c2000, 0x8c2128, 0x8c2000, "dma_ofu", true},
209485790d0SMaya Erez 	/* ucode debug 4k */
210485790d0SMaya Erez 	{0x8c3000, 0x8c4000, 0x8c3000, "ucode_debug", true},
211485790d0SMaya Erez 	/* upper area 1536k */
212485790d0SMaya Erez 	{0x900000, 0xa80000, 0x900000, "upper", 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 */
217485790d0SMaya Erez 	{0x000000, 0x040000, 0xa38000, "uc_code", false},
218485790d0SMaya Erez 	/* ucode data RAM 32k */
219485790d0SMaya Erez 	{0x800000, 0x808000, 0xa78000, "uc_data", 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";
4675fad7241SDedy Lansky 	default:
4685fad7241SDedy Lansky 		return "Untracked CMD";
4695fad7241SDedy Lansky 	}
4705fad7241SDedy Lansky }
4715fad7241SDedy Lansky 
4725fad7241SDedy Lansky static const char *eventid2name(u16 eventid)
4735fad7241SDedy Lansky {
4745fad7241SDedy Lansky 	switch (eventid) {
4755fad7241SDedy Lansky 	case WMI_NOTIFY_REQ_DONE_EVENTID:
4765fad7241SDedy Lansky 		return "WMI_NOTIFY_REQ_DONE_EVENT";
4775fad7241SDedy Lansky 	case WMI_DISCONNECT_EVENTID:
4785fad7241SDedy Lansky 		return "WMI_DISCONNECT_EVENT";
4795fad7241SDedy Lansky 	case WMI_SW_TX_COMPLETE_EVENTID:
4805fad7241SDedy Lansky 		return "WMI_SW_TX_COMPLETE_EVENT";
4815fad7241SDedy Lansky 	case WMI_GET_RF_SECTOR_PARAMS_DONE_EVENTID:
4825fad7241SDedy Lansky 		return "WMI_GET_RF_SECTOR_PARAMS_DONE_EVENT";
4835fad7241SDedy Lansky 	case WMI_SET_RF_SECTOR_PARAMS_DONE_EVENTID:
4845fad7241SDedy Lansky 		return "WMI_SET_RF_SECTOR_PARAMS_DONE_EVENT";
4855fad7241SDedy Lansky 	case WMI_GET_SELECTED_RF_SECTOR_INDEX_DONE_EVENTID:
4865fad7241SDedy Lansky 		return "WMI_GET_SELECTED_RF_SECTOR_INDEX_DONE_EVENT";
4875fad7241SDedy Lansky 	case WMI_SET_SELECTED_RF_SECTOR_INDEX_DONE_EVENTID:
4885fad7241SDedy Lansky 		return "WMI_SET_SELECTED_RF_SECTOR_INDEX_DONE_EVENT";
4895fad7241SDedy Lansky 	case WMI_BRP_SET_ANT_LIMIT_EVENTID:
4905fad7241SDedy Lansky 		return "WMI_BRP_SET_ANT_LIMIT_EVENT";
4915fad7241SDedy Lansky 	case WMI_FW_READY_EVENTID:
4925fad7241SDedy Lansky 		return "WMI_FW_READY_EVENT";
4935fad7241SDedy Lansky 	case WMI_TRAFFIC_RESUME_EVENTID:
4945fad7241SDedy Lansky 		return "WMI_TRAFFIC_RESUME_EVENT";
4955fad7241SDedy Lansky 	case WMI_TOF_GET_TX_RX_OFFSET_EVENTID:
4965fad7241SDedy Lansky 		return "WMI_TOF_GET_TX_RX_OFFSET_EVENT";
4975fad7241SDedy Lansky 	case WMI_TOF_SET_TX_RX_OFFSET_EVENTID:
4985fad7241SDedy Lansky 		return "WMI_TOF_SET_TX_RX_OFFSET_EVENT";
4995fad7241SDedy Lansky 	case WMI_VRING_CFG_DONE_EVENTID:
5005fad7241SDedy Lansky 		return "WMI_VRING_CFG_DONE_EVENT";
5015fad7241SDedy Lansky 	case WMI_READY_EVENTID:
5025fad7241SDedy Lansky 		return "WMI_READY_EVENT";
5035fad7241SDedy Lansky 	case WMI_RX_MGMT_PACKET_EVENTID:
5045fad7241SDedy Lansky 		return "WMI_RX_MGMT_PACKET_EVENT";
5055fad7241SDedy Lansky 	case WMI_TX_MGMT_PACKET_EVENTID:
5065fad7241SDedy Lansky 		return "WMI_TX_MGMT_PACKET_EVENT";
5075fad7241SDedy Lansky 	case WMI_SCAN_COMPLETE_EVENTID:
5085fad7241SDedy Lansky 		return "WMI_SCAN_COMPLETE_EVENT";
5095fad7241SDedy Lansky 	case WMI_ACS_PASSIVE_SCAN_COMPLETE_EVENTID:
5105fad7241SDedy Lansky 		return "WMI_ACS_PASSIVE_SCAN_COMPLETE_EVENT";
5115fad7241SDedy Lansky 	case WMI_CONNECT_EVENTID:
5125fad7241SDedy Lansky 		return "WMI_CONNECT_EVENT";
5135fad7241SDedy Lansky 	case WMI_EAPOL_RX_EVENTID:
5145fad7241SDedy Lansky 		return "WMI_EAPOL_RX_EVENT";
5155fad7241SDedy Lansky 	case WMI_BA_STATUS_EVENTID:
5165fad7241SDedy Lansky 		return "WMI_BA_STATUS_EVENT";
5175fad7241SDedy Lansky 	case WMI_RCP_ADDBA_REQ_EVENTID:
5185fad7241SDedy Lansky 		return "WMI_RCP_ADDBA_REQ_EVENT";
5195fad7241SDedy Lansky 	case WMI_DELBA_EVENTID:
5205fad7241SDedy Lansky 		return "WMI_DELBA_EVENT";
52196c93589SGidon Studinski 	case WMI_RING_EN_EVENTID:
52296c93589SGidon Studinski 		return "WMI_RING_EN_EVENT";
5235fad7241SDedy Lansky 	case WMI_DATA_PORT_OPEN_EVENTID:
5245fad7241SDedy Lansky 		return "WMI_DATA_PORT_OPEN_EVENT";
5255fad7241SDedy Lansky 	case WMI_AOA_MEAS_EVENTID:
5265fad7241SDedy Lansky 		return "WMI_AOA_MEAS_EVENT";
5275fad7241SDedy Lansky 	case WMI_TOF_SESSION_END_EVENTID:
5285fad7241SDedy Lansky 		return "WMI_TOF_SESSION_END_EVENT";
5295fad7241SDedy Lansky 	case WMI_TOF_GET_CAPABILITIES_EVENTID:
5305fad7241SDedy Lansky 		return "WMI_TOF_GET_CAPABILITIES_EVENT";
5315fad7241SDedy Lansky 	case WMI_TOF_SET_LCR_EVENTID:
5325fad7241SDedy Lansky 		return "WMI_TOF_SET_LCR_EVENT";
5335fad7241SDedy Lansky 	case WMI_TOF_SET_LCI_EVENTID:
5345fad7241SDedy Lansky 		return "WMI_TOF_SET_LCI_EVENT";
5355fad7241SDedy Lansky 	case WMI_TOF_FTM_PER_DEST_RES_EVENTID:
5365fad7241SDedy Lansky 		return "WMI_TOF_FTM_PER_DEST_RES_EVENT";
5375fad7241SDedy Lansky 	case WMI_TOF_CHANNEL_INFO_EVENTID:
5385fad7241SDedy Lansky 		return "WMI_TOF_CHANNEL_INFO_EVENT";
5395fad7241SDedy Lansky 	case WMI_TRAFFIC_SUSPEND_EVENTID:
5405fad7241SDedy Lansky 		return "WMI_TRAFFIC_SUSPEND_EVENT";
5415fad7241SDedy Lansky 	case WMI_ECHO_RSP_EVENTID:
5425fad7241SDedy Lansky 		return "WMI_ECHO_RSP_EVENT";
5435fad7241SDedy Lansky 	case WMI_LED_CFG_DONE_EVENTID:
5445fad7241SDedy Lansky 		return "WMI_LED_CFG_DONE_EVENT";
5455fad7241SDedy Lansky 	case WMI_PCP_STARTED_EVENTID:
5465fad7241SDedy Lansky 		return "WMI_PCP_STARTED_EVENT";
5475fad7241SDedy Lansky 	case WMI_PCP_STOPPED_EVENTID:
5485fad7241SDedy Lansky 		return "WMI_PCP_STOPPED_EVENT";
5495fad7241SDedy Lansky 	case WMI_GET_SSID_EVENTID:
5505fad7241SDedy Lansky 		return "WMI_GET_SSID_EVENT";
5515fad7241SDedy Lansky 	case WMI_GET_PCP_CHANNEL_EVENTID:
5525fad7241SDedy Lansky 		return "WMI_GET_PCP_CHANNEL_EVENT";
5535fad7241SDedy Lansky 	case WMI_P2P_CFG_DONE_EVENTID:
5545fad7241SDedy Lansky 		return "WMI_P2P_CFG_DONE_EVENT";
5553ada9314SLior David 	case WMI_PORT_ALLOCATED_EVENTID:
5563ada9314SLior David 		return "WMI_PORT_ALLOCATED_EVENT";
5573ada9314SLior David 	case WMI_PORT_DELETED_EVENTID:
5583ada9314SLior David 		return "WMI_PORT_DELETED_EVENT";
5595fad7241SDedy Lansky 	case WMI_LISTEN_STARTED_EVENTID:
5605fad7241SDedy Lansky 		return "WMI_LISTEN_STARTED_EVENT";
5615fad7241SDedy Lansky 	case WMI_SEARCH_STARTED_EVENTID:
5625fad7241SDedy Lansky 		return "WMI_SEARCH_STARTED_EVENT";
5635fad7241SDedy Lansky 	case WMI_DISCOVERY_STOPPED_EVENTID:
5645fad7241SDedy Lansky 		return "WMI_DISCOVERY_STOPPED_EVENT";
5655fad7241SDedy Lansky 	case WMI_CFG_RX_CHAIN_DONE_EVENTID:
5665fad7241SDedy Lansky 		return "WMI_CFG_RX_CHAIN_DONE_EVENT";
5675fad7241SDedy Lansky 	case WMI_TEMP_SENSE_DONE_EVENTID:
5685fad7241SDedy Lansky 		return "WMI_TEMP_SENSE_DONE_EVENT";
5695fad7241SDedy Lansky 	case WMI_RCP_ADDBA_RESP_SENT_EVENTID:
5705fad7241SDedy Lansky 		return "WMI_RCP_ADDBA_RESP_SENT_EVENT";
5715fad7241SDedy Lansky 	case WMI_PS_DEV_PROFILE_CFG_EVENTID:
5725fad7241SDedy Lansky 		return "WMI_PS_DEV_PROFILE_CFG_EVENT";
5735fad7241SDedy Lansky 	case WMI_SET_MGMT_RETRY_LIMIT_EVENTID:
5745fad7241SDedy Lansky 		return "WMI_SET_MGMT_RETRY_LIMIT_EVENT";
5755fad7241SDedy Lansky 	case WMI_GET_MGMT_RETRY_LIMIT_EVENTID:
5765fad7241SDedy Lansky 		return "WMI_GET_MGMT_RETRY_LIMIT_EVENT";
5775fad7241SDedy Lansky 	case WMI_SET_THERMAL_THROTTLING_CFG_EVENTID:
5785fad7241SDedy Lansky 		return "WMI_SET_THERMAL_THROTTLING_CFG_EVENT";
5795fad7241SDedy Lansky 	case WMI_GET_THERMAL_THROTTLING_CFG_EVENTID:
5805fad7241SDedy Lansky 		return "WMI_GET_THERMAL_THROTTLING_CFG_EVENT";
5815fad7241SDedy Lansky 	case WMI_LINK_MAINTAIN_CFG_WRITE_DONE_EVENTID:
5825fad7241SDedy Lansky 		return "WMI_LINK_MAINTAIN_CFG_WRITE_DONE_EVENT";
5835fad7241SDedy Lansky 	case WMI_LO_POWER_CALIB_FROM_OTP_EVENTID:
5845fad7241SDedy Lansky 		return "WMI_LO_POWER_CALIB_FROM_OTP_EVENT";
585a5dc6883SDedy Lansky 	case WMI_START_SCHED_SCAN_EVENTID:
586a5dc6883SDedy Lansky 		return "WMI_START_SCHED_SCAN_EVENT";
587a5dc6883SDedy Lansky 	case WMI_STOP_SCHED_SCAN_EVENTID:
588a5dc6883SDedy Lansky 		return "WMI_STOP_SCHED_SCAN_EVENT";
589a5dc6883SDedy Lansky 	case WMI_SCHED_SCAN_RESULT_EVENTID:
590a5dc6883SDedy Lansky 		return "WMI_SCHED_SCAN_RESULT_EVENT";
59196c93589SGidon Studinski 	case WMI_TX_STATUS_RING_CFG_DONE_EVENTID:
59296c93589SGidon Studinski 		return "WMI_TX_STATUS_RING_CFG_DONE_EVENT";
59396c93589SGidon Studinski 	case WMI_RX_STATUS_RING_CFG_DONE_EVENTID:
59496c93589SGidon Studinski 		return "WMI_RX_STATUS_RING_CFG_DONE_EVENT";
59596c93589SGidon Studinski 	case WMI_TX_DESC_RING_CFG_DONE_EVENTID:
59696c93589SGidon Studinski 		return "WMI_TX_DESC_RING_CFG_DONE_EVENT";
59796c93589SGidon Studinski 	case WMI_RX_DESC_RING_CFG_DONE_EVENTID:
59896c93589SGidon Studinski 		return "WMI_RX_DESC_RING_CFG_DONE_EVENT";
59996c93589SGidon Studinski 	case WMI_CFG_DEF_RX_OFFLOAD_DONE_EVENTID:
60096c93589SGidon Studinski 		return "WMI_CFG_DEF_RX_OFFLOAD_DONE_EVENT";
6015fad7241SDedy Lansky 	default:
6025fad7241SDedy Lansky 		return "Untracked EVENT";
6035fad7241SDedy Lansky 	}
6045fad7241SDedy Lansky }
6055fad7241SDedy Lansky 
606e00243faSLior David static int __wmi_send(struct wil6210_priv *wil, u16 cmdid, u8 mid,
607e00243faSLior David 		      void *buf, u16 len)
6082be7d22fSVladimir Kondratiev {
6092be7d22fSVladimir Kondratiev 	struct {
6102be7d22fSVladimir Kondratiev 		struct wil6210_mbox_hdr hdr;
611b874ddecSLior David 		struct wmi_cmd_hdr wmi;
6122be7d22fSVladimir Kondratiev 	} __packed cmd = {
6132be7d22fSVladimir Kondratiev 		.hdr = {
6142be7d22fSVladimir Kondratiev 			.type = WIL_MBOX_HDR_TYPE_WMI,
6152be7d22fSVladimir Kondratiev 			.flags = 0,
6162be7d22fSVladimir Kondratiev 			.len = cpu_to_le16(sizeof(cmd.wmi) + len),
6172be7d22fSVladimir Kondratiev 		},
6182be7d22fSVladimir Kondratiev 		.wmi = {
619e00243faSLior David 			.mid = mid,
620b874ddecSLior David 			.command_id = cpu_to_le16(cmdid),
6212be7d22fSVladimir Kondratiev 		},
6222be7d22fSVladimir Kondratiev 	};
6232be7d22fSVladimir Kondratiev 	struct wil6210_mbox_ring *r = &wil->mbox_ctl.tx;
6242be7d22fSVladimir Kondratiev 	struct wil6210_mbox_ring_desc d_head;
6252be7d22fSVladimir Kondratiev 	u32 next_head;
6262be7d22fSVladimir Kondratiev 	void __iomem *dst;
6272be7d22fSVladimir Kondratiev 	void __iomem *head = wmi_addr(wil, r->head);
6282be7d22fSVladimir Kondratiev 	uint retry;
629349214c1SMaya Erez 	int rc = 0;
6302be7d22fSVladimir Kondratiev 
63126a6d527SLior David 	if (len > r->entry_size - sizeof(cmd)) {
6322be7d22fSVladimir Kondratiev 		wil_err(wil, "WMI size too large: %d bytes, max is %d\n",
6332be7d22fSVladimir Kondratiev 			(int)(sizeof(cmd) + len), r->entry_size);
6342be7d22fSVladimir Kondratiev 		return -ERANGE;
6352be7d22fSVladimir Kondratiev 	}
6362be7d22fSVladimir Kondratiev 
6372be7d22fSVladimir Kondratiev 	might_sleep();
6382be7d22fSVladimir Kondratiev 
6399419b6a2SVladimir Kondratiev 	if (!test_bit(wil_status_fwready, wil->status)) {
64015e23124SVladimir Kondratiev 		wil_err(wil, "WMI: cannot send command while FW not ready\n");
6412be7d22fSVladimir Kondratiev 		return -EAGAIN;
6422be7d22fSVladimir Kondratiev 	}
6432be7d22fSVladimir Kondratiev 
644fe9ee51eSMaya Erez 	/* Allow sending only suspend / resume commands during susepnd flow */
645fe9ee51eSMaya Erez 	if ((test_bit(wil_status_suspending, wil->status) ||
646fe9ee51eSMaya Erez 	     test_bit(wil_status_suspended, wil->status) ||
647fe9ee51eSMaya Erez 	     test_bit(wil_status_resuming, wil->status)) &&
648fe9ee51eSMaya Erez 	     ((cmdid != WMI_TRAFFIC_SUSPEND_CMDID) &&
649fe9ee51eSMaya Erez 	      (cmdid != WMI_TRAFFIC_RESUME_CMDID))) {
650fe9ee51eSMaya Erez 		wil_err(wil, "WMI: reject send_command during suspend\n");
651fe9ee51eSMaya Erez 		return -EINVAL;
652fe9ee51eSMaya Erez 	}
653fe9ee51eSMaya Erez 
6542be7d22fSVladimir Kondratiev 	if (!head) {
6552be7d22fSVladimir Kondratiev 		wil_err(wil, "WMI head is garbage: 0x%08x\n", r->head);
6562be7d22fSVladimir Kondratiev 		return -EINVAL;
6572be7d22fSVladimir Kondratiev 	}
658349214c1SMaya Erez 
659349214c1SMaya Erez 	wil_halp_vote(wil);
660349214c1SMaya Erez 
6612be7d22fSVladimir Kondratiev 	/* read Tx head till it is not busy */
6622be7d22fSVladimir Kondratiev 	for (retry = 5; retry > 0; retry--) {
6632be7d22fSVladimir Kondratiev 		wil_memcpy_fromio_32(&d_head, head, sizeof(d_head));
6642be7d22fSVladimir Kondratiev 		if (d_head.sync == 0)
6652be7d22fSVladimir Kondratiev 			break;
6662be7d22fSVladimir Kondratiev 		msleep(20);
6672be7d22fSVladimir Kondratiev 	}
6682be7d22fSVladimir Kondratiev 	if (d_head.sync != 0) {
6692be7d22fSVladimir Kondratiev 		wil_err(wil, "WMI head busy\n");
670349214c1SMaya Erez 		rc = -EBUSY;
671349214c1SMaya Erez 		goto out;
6722be7d22fSVladimir Kondratiev 	}
6732be7d22fSVladimir Kondratiev 	/* next head */
6742be7d22fSVladimir Kondratiev 	next_head = r->base + ((r->head - r->base + sizeof(d_head)) % r->size);
6757743882dSVladimir Kondratiev 	wil_dbg_wmi(wil, "Head 0x%08x -> 0x%08x\n", r->head, next_head);
6762be7d22fSVladimir Kondratiev 	/* wait till FW finish with previous command */
6772be7d22fSVladimir Kondratiev 	for (retry = 5; retry > 0; retry--) {
678452133a7SMaya Erez 		if (!test_bit(wil_status_fwready, wil->status)) {
679452133a7SMaya Erez 			wil_err(wil, "WMI: cannot send command while FW not ready\n");
680349214c1SMaya Erez 			rc = -EAGAIN;
681349214c1SMaya Erez 			goto out;
682452133a7SMaya Erez 		}
683b9eeb512SVladimir Kondratiev 		r->tail = wil_r(wil, RGF_MBOX +
6842be7d22fSVladimir Kondratiev 				offsetof(struct wil6210_mbox_ctl, tx.tail));
6852be7d22fSVladimir Kondratiev 		if (next_head != r->tail)
6862be7d22fSVladimir Kondratiev 			break;
6872be7d22fSVladimir Kondratiev 		msleep(20);
6882be7d22fSVladimir Kondratiev 	}
6892be7d22fSVladimir Kondratiev 	if (next_head == r->tail) {
6902be7d22fSVladimir Kondratiev 		wil_err(wil, "WMI ring full\n");
691349214c1SMaya Erez 		rc = -EBUSY;
692349214c1SMaya Erez 		goto out;
6932be7d22fSVladimir Kondratiev 	}
6942be7d22fSVladimir Kondratiev 	dst = wmi_buffer(wil, d_head.addr);
6952be7d22fSVladimir Kondratiev 	if (!dst) {
6962be7d22fSVladimir Kondratiev 		wil_err(wil, "invalid WMI buffer: 0x%08x\n",
6972be7d22fSVladimir Kondratiev 			le32_to_cpu(d_head.addr));
698349214c1SMaya Erez 		rc = -EAGAIN;
699349214c1SMaya Erez 		goto out;
7002be7d22fSVladimir Kondratiev 	}
7012be7d22fSVladimir Kondratiev 	cmd.hdr.seq = cpu_to_le16(++wil->wmi_seq);
7022be7d22fSVladimir Kondratiev 	/* set command */
703e00243faSLior David 	wil_dbg_wmi(wil, "sending %s (0x%04x) [%d] mid %d\n",
704e00243faSLior David 		    cmdid2name(cmdid), cmdid, len, mid);
7057743882dSVladimir Kondratiev 	wil_hex_dump_wmi("Cmd ", DUMP_PREFIX_OFFSET, 16, 1, &cmd,
7062be7d22fSVladimir Kondratiev 			 sizeof(cmd), true);
7077743882dSVladimir Kondratiev 	wil_hex_dump_wmi("cmd ", DUMP_PREFIX_OFFSET, 16, 1, buf,
7082be7d22fSVladimir Kondratiev 			 len, true);
7092be7d22fSVladimir Kondratiev 	wil_memcpy_toio_32(dst, &cmd, sizeof(cmd));
7102be7d22fSVladimir Kondratiev 	wil_memcpy_toio_32(dst + sizeof(cmd), buf, len);
7112be7d22fSVladimir Kondratiev 	/* mark entry as full */
712b9eeb512SVladimir Kondratiev 	wil_w(wil, r->head + offsetof(struct wil6210_mbox_ring_desc, sync), 1);
7132be7d22fSVladimir Kondratiev 	/* advance next ptr */
714b9eeb512SVladimir Kondratiev 	wil_w(wil, RGF_MBOX + offsetof(struct wil6210_mbox_ctl, tx.head),
715b9eeb512SVladimir Kondratiev 	      r->head = next_head);
7162be7d22fSVladimir Kondratiev 
717f988b23fSVladimir Kondratiev 	trace_wil6210_wmi_cmd(&cmd.wmi, buf, len);
71898658095SVladimir Kondratiev 
7192be7d22fSVladimir Kondratiev 	/* interrupt to FW */
720b9eeb512SVladimir Kondratiev 	wil_w(wil, RGF_USER_USER_ICR + offsetof(struct RGF_ICR, ICS),
721b9eeb512SVladimir Kondratiev 	      SW_INT_MBOX);
7222be7d22fSVladimir Kondratiev 
723349214c1SMaya Erez out:
724349214c1SMaya Erez 	wil_halp_unvote(wil);
725349214c1SMaya Erez 	return rc;
7262be7d22fSVladimir Kondratiev }
7272be7d22fSVladimir Kondratiev 
728e00243faSLior David int wmi_send(struct wil6210_priv *wil, u16 cmdid, u8 mid, void *buf, u16 len)
7292be7d22fSVladimir Kondratiev {
7302be7d22fSVladimir Kondratiev 	int rc;
7312be7d22fSVladimir Kondratiev 
7322be7d22fSVladimir Kondratiev 	mutex_lock(&wil->wmi_mutex);
733e00243faSLior David 	rc = __wmi_send(wil, cmdid, mid, buf, len);
7342be7d22fSVladimir Kondratiev 	mutex_unlock(&wil->wmi_mutex);
7352be7d22fSVladimir Kondratiev 
7362be7d22fSVladimir Kondratiev 	return rc;
7372be7d22fSVladimir Kondratiev }
7382be7d22fSVladimir Kondratiev 
7392be7d22fSVladimir Kondratiev /*=== Event handlers ===*/
740e00243faSLior David static void wmi_evt_ready(struct wil6210_vif *vif, int id, void *d, int len)
7412be7d22fSVladimir Kondratiev {
742e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
743e00243faSLior David 	struct wiphy *wiphy = wil_to_wiphy(wil);
7442be7d22fSVladimir Kondratiev 	struct wmi_ready_event *evt = d;
7458fe59627SVladimir Kondratiev 
74613cd9f75SLior David 	wil_info(wil, "FW ver. %s(SW %d); MAC %pM; %d MID's\n",
74713cd9f75SLior David 		 wil->fw_version, le32_to_cpu(evt->sw_version),
7484aebd3bdSLior David 		 evt->mac, evt->numof_additional_mids);
7494aebd3bdSLior David 	if (evt->numof_additional_mids + 1 < wil->max_vifs) {
7504aebd3bdSLior David 		wil_err(wil, "FW does not support enough MIDs (need %d)",
7514aebd3bdSLior David 			wil->max_vifs - 1);
7524aebd3bdSLior David 		return; /* FW load will fail after timeout */
7534aebd3bdSLior David 	}
7542cd0f021SVladimir Kondratiev 	/* ignore MAC address, we already have it from the boot loader */
755e00243faSLior David 	strlcpy(wiphy->fw_version, wil->fw_version, sizeof(wiphy->fw_version));
7562be7d22fSVladimir Kondratiev 
757eb4c0215SDedy Lansky 	if (len > offsetof(struct wmi_ready_event, rfc_read_calib_result)) {
758eb4c0215SDedy Lansky 		wil_dbg_wmi(wil, "rfc calibration result %d\n",
759eb4c0215SDedy Lansky 			    evt->rfc_read_calib_result);
760eb4c0215SDedy Lansky 		wil->fw_calib_result = evt->rfc_read_calib_result;
761eb4c0215SDedy Lansky 	}
762c33407a8SVladimir Kondratiev 	wil_set_recovery_state(wil, fw_recovery_idle);
7639419b6a2SVladimir Kondratiev 	set_bit(wil_status_fwready, wil->status);
76459502647SDedy Lansky 	/* let the reset sequence continue */
7652be7d22fSVladimir Kondratiev 	complete(&wil->wmi_ready);
7662be7d22fSVladimir Kondratiev }
7672be7d22fSVladimir Kondratiev 
768e00243faSLior David static void wmi_evt_rx_mgmt(struct wil6210_vif *vif, int id, void *d, int len)
7692be7d22fSVladimir Kondratiev {
770e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
7712be7d22fSVladimir Kondratiev 	struct wmi_rx_mgmt_packet_event *data = d;
7722be7d22fSVladimir Kondratiev 	struct wiphy *wiphy = wil_to_wiphy(wil);
7732be7d22fSVladimir Kondratiev 	struct ieee80211_mgmt *rx_mgmt_frame =
7742be7d22fSVladimir Kondratiev 			(struct ieee80211_mgmt *)data->payload;
77590d89e9aSVladimir Kondratiev 	int flen = len - offsetof(struct wmi_rx_mgmt_packet_event, payload);
77690d89e9aSVladimir Kondratiev 	int ch_no;
77790d89e9aSVladimir Kondratiev 	u32 freq;
77890d89e9aSVladimir Kondratiev 	struct ieee80211_channel *channel;
77990d89e9aSVladimir Kondratiev 	s32 signal;
78090d89e9aSVladimir Kondratiev 	__le16 fc;
78190d89e9aSVladimir Kondratiev 	u32 d_len;
78290d89e9aSVladimir Kondratiev 	u16 d_status;
7832be7d22fSVladimir Kondratiev 
78490d89e9aSVladimir Kondratiev 	if (flen < 0) {
78590d89e9aSVladimir Kondratiev 		wil_err(wil, "MGMT Rx: short event, len %d\n", len);
78690d89e9aSVladimir Kondratiev 		return;
78790d89e9aSVladimir Kondratiev 	}
78890d89e9aSVladimir Kondratiev 
78990d89e9aSVladimir Kondratiev 	d_len = le32_to_cpu(data->info.len);
79090d89e9aSVladimir Kondratiev 	if (d_len != flen) {
79190d89e9aSVladimir Kondratiev 		wil_err(wil,
79290d89e9aSVladimir Kondratiev 			"MGMT Rx: length mismatch, d_len %d should be %d\n",
79390d89e9aSVladimir Kondratiev 			d_len, flen);
79490d89e9aSVladimir Kondratiev 		return;
79590d89e9aSVladimir Kondratiev 	}
79690d89e9aSVladimir Kondratiev 
79790d89e9aSVladimir Kondratiev 	ch_no = data->info.channel + 1;
79857fbcce3SJohannes Berg 	freq = ieee80211_channel_to_frequency(ch_no, NL80211_BAND_60GHZ);
79990d89e9aSVladimir Kondratiev 	channel = ieee80211_get_channel(wiphy, freq);
80030868f5dSDedy Lansky 	if (test_bit(WMI_FW_CAPABILITY_RSSI_REPORTING, wil->fw_capabilities))
80130868f5dSDedy Lansky 		signal = 100 * data->info.rssi;
80230868f5dSDedy Lansky 	else
80390d89e9aSVladimir Kondratiev 		signal = data->info.sqi;
80490d89e9aSVladimir Kondratiev 	d_status = le16_to_cpu(data->info.status);
80590d89e9aSVladimir Kondratiev 	fc = rx_mgmt_frame->frame_control;
80690d89e9aSVladimir Kondratiev 
80730868f5dSDedy Lansky 	wil_dbg_wmi(wil, "MGMT Rx: channel %d MCS %d RSSI %d SQI %d%%\n",
80830868f5dSDedy Lansky 		    data->info.channel, data->info.mcs, data->info.rssi,
809b8b33a3aSVladimir Kondratiev 		    data->info.sqi);
810f27dbf78SVladimir Kondratiev 	wil_dbg_wmi(wil, "status 0x%04x len %d fc 0x%04x\n", d_status, d_len,
811f27dbf78SVladimir Kondratiev 		    le16_to_cpu(fc));
8127743882dSVladimir Kondratiev 	wil_dbg_wmi(wil, "qid %d mid %d cid %d\n",
8132be7d22fSVladimir Kondratiev 		    data->info.qid, data->info.mid, data->info.cid);
81490d89e9aSVladimir Kondratiev 	wil_hex_dump_wmi("MGMT Rx ", DUMP_PREFIX_OFFSET, 16, 1, rx_mgmt_frame,
81590d89e9aSVladimir Kondratiev 			 d_len, true);
8162be7d22fSVladimir Kondratiev 
8172be7d22fSVladimir Kondratiev 	if (!channel) {
8182be7d22fSVladimir Kondratiev 		wil_err(wil, "Frame on unsupported channel\n");
8192be7d22fSVladimir Kondratiev 		return;
8202be7d22fSVladimir Kondratiev 	}
8212be7d22fSVladimir Kondratiev 
8222be7d22fSVladimir Kondratiev 	if (ieee80211_is_beacon(fc) || ieee80211_is_probe_resp(fc)) {
8232be7d22fSVladimir Kondratiev 		struct cfg80211_bss *bss;
8248eea944aSVladimir Kondratiev 		u64 tsf = le64_to_cpu(rx_mgmt_frame->u.beacon.timestamp);
8258eea944aSVladimir Kondratiev 		u16 cap = le16_to_cpu(rx_mgmt_frame->u.beacon.capab_info);
8268eea944aSVladimir Kondratiev 		u16 bi = le16_to_cpu(rx_mgmt_frame->u.beacon.beacon_int);
8278eea944aSVladimir Kondratiev 		const u8 *ie_buf = rx_mgmt_frame->u.beacon.variable;
8288eea944aSVladimir Kondratiev 		size_t ie_len = d_len - offsetof(struct ieee80211_mgmt,
8298eea944aSVladimir Kondratiev 						 u.beacon.variable);
8308eea944aSVladimir Kondratiev 		wil_dbg_wmi(wil, "Capability info : 0x%04x\n", cap);
8318eea944aSVladimir Kondratiev 		wil_dbg_wmi(wil, "TSF : 0x%016llx\n", tsf);
8328eea944aSVladimir Kondratiev 		wil_dbg_wmi(wil, "Beacon interval : %d\n", bi);
8338eea944aSVladimir Kondratiev 		wil_hex_dump_wmi("IE ", DUMP_PREFIX_OFFSET, 16, 1, ie_buf,
8348eea944aSVladimir Kondratiev 				 ie_len, true);
8352be7d22fSVladimir Kondratiev 
836e6d68341SDedy Lansky 		wil_dbg_wmi(wil, "Capability info : 0x%04x\n", cap);
837e6d68341SDedy Lansky 
838a0f7845bSVladimir Kondratiev 		bss = cfg80211_inform_bss_frame(wiphy, channel, rx_mgmt_frame,
839a0f7845bSVladimir Kondratiev 						d_len, signal, GFP_KERNEL);
8402be7d22fSVladimir Kondratiev 		if (bss) {
8417743882dSVladimir Kondratiev 			wil_dbg_wmi(wil, "Added BSS %pM\n",
8422be7d22fSVladimir Kondratiev 				    rx_mgmt_frame->bssid);
8435b112d3dSJohannes Berg 			cfg80211_put_bss(wiphy, bss);
8442be7d22fSVladimir Kondratiev 		} else {
8455bc8c1f2SJohannes Berg 			wil_err(wil, "cfg80211_inform_bss_frame() failed\n");
8462be7d22fSVladimir Kondratiev 		}
847102b1d99SVladimir Kondratiev 	} else {
848404bbb3cSLior David 		mutex_lock(&wil->vif_mutex);
849e00243faSLior David 		cfg80211_rx_mgmt(vif_to_radio_wdev(wil, vif), freq, signal,
850970fdfa8SVladimir Kondratiev 				 (void *)rx_mgmt_frame, d_len, 0);
851404bbb3cSLior David 		mutex_unlock(&wil->vif_mutex);
8522be7d22fSVladimir Kondratiev 	}
8532be7d22fSVladimir Kondratiev }
8542be7d22fSVladimir Kondratiev 
855e00243faSLior David static void wmi_evt_tx_mgmt(struct wil6210_vif *vif, int id, void *d, int len)
85690d89e9aSVladimir Kondratiev {
85790d89e9aSVladimir Kondratiev 	struct wmi_tx_mgmt_packet_event *data = d;
85890d89e9aSVladimir Kondratiev 	struct ieee80211_mgmt *mgmt_frame =
85990d89e9aSVladimir Kondratiev 			(struct ieee80211_mgmt *)data->payload;
86090d89e9aSVladimir Kondratiev 	int flen = len - offsetof(struct wmi_tx_mgmt_packet_event, payload);
86190d89e9aSVladimir Kondratiev 
86290d89e9aSVladimir Kondratiev 	wil_hex_dump_wmi("MGMT Tx ", DUMP_PREFIX_OFFSET, 16, 1, mgmt_frame,
86390d89e9aSVladimir Kondratiev 			 flen, true);
86490d89e9aSVladimir Kondratiev }
86590d89e9aSVladimir Kondratiev 
866e00243faSLior David static void wmi_evt_scan_complete(struct wil6210_vif *vif, int id,
8672be7d22fSVladimir Kondratiev 				  void *d, int len)
8682be7d22fSVladimir Kondratiev {
869e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
870e00243faSLior David 
871404bbb3cSLior David 	mutex_lock(&wil->vif_mutex);
872e00243faSLior David 	if (vif->scan_request) {
8732be7d22fSVladimir Kondratiev 		struct wmi_scan_complete_event *data = d;
874035859a5SMaya Erez 		int status = le32_to_cpu(data->status);
8751d76250bSAvraham Stern 		struct cfg80211_scan_info info = {
876035859a5SMaya Erez 			.aborted = ((status != WMI_SCAN_SUCCESS) &&
877035859a5SMaya Erez 				(status != WMI_SCAN_ABORT_REJECTED)),
8781d76250bSAvraham Stern 		};
8792be7d22fSVladimir Kondratiev 
880035859a5SMaya Erez 		wil_dbg_wmi(wil, "SCAN_COMPLETE(0x%08x)\n", status);
8812a91d7d0SVladimir Kondratiev 		wil_dbg_misc(wil, "Complete scan_request 0x%p aborted %d\n",
882e00243faSLior David 			     vif->scan_request, info.aborted);
883e00243faSLior David 		del_timer_sync(&vif->scan_timer);
884e00243faSLior David 		cfg80211_scan_done(vif->scan_request, &info);
885e00243faSLior David 		if (vif->mid == 0)
886e00243faSLior David 			wil->radio_wdev = wil->main_ndev->ieee80211_ptr;
887e00243faSLior David 		vif->scan_request = NULL;
888035859a5SMaya Erez 		wake_up_interruptible(&wil->wq);
889e00243faSLior David 		if (vif->p2p.pending_listen_wdev) {
890bb6743f7SLior David 			wil_dbg_misc(wil, "Scheduling delayed listen\n");
891e00243faSLior David 			schedule_work(&vif->p2p.delayed_listen_work);
892bb6743f7SLior David 		}
8932be7d22fSVladimir Kondratiev 	} else {
8942be7d22fSVladimir Kondratiev 		wil_err(wil, "SCAN_COMPLETE while not scanning\n");
8952be7d22fSVladimir Kondratiev 	}
896404bbb3cSLior David 	mutex_unlock(&wil->vif_mutex);
8972be7d22fSVladimir Kondratiev }
8982be7d22fSVladimir Kondratiev 
899e00243faSLior David static void wmi_evt_connect(struct wil6210_vif *vif, int id, void *d, int len)
9002be7d22fSVladimir Kondratiev {
901e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
902e00243faSLior David 	struct net_device *ndev = vif_to_ndev(vif);
903e00243faSLior David 	struct wireless_dev *wdev = vif_to_wdev(vif);
9042be7d22fSVladimir Kondratiev 	struct wmi_connect_event *evt = d;
9052be7d22fSVladimir Kondratiev 	int ch; /* channel number */
90641bd3d58SToke Høiland-Jørgensen 	struct station_info *sinfo;
9072be7d22fSVladimir Kondratiev 	u8 *assoc_req_ie, *assoc_resp_ie;
9082be7d22fSVladimir Kondratiev 	size_t assoc_req_ielen, assoc_resp_ielen;
9092be7d22fSVladimir Kondratiev 	/* capinfo(u16) + listen_interval(u16) + IEs */
9102be7d22fSVladimir Kondratiev 	const size_t assoc_req_ie_offset = sizeof(u16) * 2;
9112be7d22fSVladimir Kondratiev 	/* capinfo(u16) + status_code(u16) + associd(u16) + IEs */
9122be7d22fSVladimir Kondratiev 	const size_t assoc_resp_ie_offset = sizeof(u16) * 3;
9130916d9f2SMaya Erez 	int rc;
9142be7d22fSVladimir Kondratiev 
9152be7d22fSVladimir Kondratiev 	if (len < sizeof(*evt)) {
9162be7d22fSVladimir Kondratiev 		wil_err(wil, "Connect event too short : %d bytes\n", len);
9172be7d22fSVladimir Kondratiev 		return;
9182be7d22fSVladimir Kondratiev 	}
9192be7d22fSVladimir Kondratiev 	if (len != sizeof(*evt) + evt->beacon_ie_len + evt->assoc_req_len +
9202be7d22fSVladimir Kondratiev 		   evt->assoc_resp_len) {
9212be7d22fSVladimir Kondratiev 		wil_err(wil,
9222be7d22fSVladimir Kondratiev 			"Connect event corrupted : %d != %d + %d + %d + %d\n",
9232be7d22fSVladimir Kondratiev 			len, (int)sizeof(*evt), evt->beacon_ie_len,
9242be7d22fSVladimir Kondratiev 			evt->assoc_req_len, evt->assoc_resp_len);
9252be7d22fSVladimir Kondratiev 		return;
9262be7d22fSVladimir Kondratiev 	}
9273df2cd36SVladimir Kondratiev 	if (evt->cid >= WIL6210_MAX_CID) {
9283df2cd36SVladimir Kondratiev 		wil_err(wil, "Connect CID invalid : %d\n", evt->cid);
9293df2cd36SVladimir Kondratiev 		return;
9303df2cd36SVladimir Kondratiev 	}
9313df2cd36SVladimir Kondratiev 
9322be7d22fSVladimir Kondratiev 	ch = evt->channel + 1;
9339d865ee2SLior David 	wil_info(wil, "Connect %pM channel [%d] cid %d aid %d\n",
9349d865ee2SLior David 		 evt->bssid, ch, evt->cid, evt->aid);
9357743882dSVladimir Kondratiev 	wil_hex_dump_wmi("connect AI : ", DUMP_PREFIX_OFFSET, 16, 1,
9362be7d22fSVladimir Kondratiev 			 evt->assoc_info, len - sizeof(*evt), true);
9372be7d22fSVladimir Kondratiev 
9382be7d22fSVladimir Kondratiev 	/* figure out IE's */
9392be7d22fSVladimir Kondratiev 	assoc_req_ie = &evt->assoc_info[evt->beacon_ie_len +
9402be7d22fSVladimir Kondratiev 					assoc_req_ie_offset];
9412be7d22fSVladimir Kondratiev 	assoc_req_ielen = evt->assoc_req_len - assoc_req_ie_offset;
9422be7d22fSVladimir Kondratiev 	if (evt->assoc_req_len <= assoc_req_ie_offset) {
9432be7d22fSVladimir Kondratiev 		assoc_req_ie = NULL;
9442be7d22fSVladimir Kondratiev 		assoc_req_ielen = 0;
9452be7d22fSVladimir Kondratiev 	}
9462be7d22fSVladimir Kondratiev 
9472be7d22fSVladimir Kondratiev 	assoc_resp_ie = &evt->assoc_info[evt->beacon_ie_len +
9482be7d22fSVladimir Kondratiev 					 evt->assoc_req_len +
9492be7d22fSVladimir Kondratiev 					 assoc_resp_ie_offset];
9502be7d22fSVladimir Kondratiev 	assoc_resp_ielen = evt->assoc_resp_len - assoc_resp_ie_offset;
9512be7d22fSVladimir Kondratiev 	if (evt->assoc_resp_len <= assoc_resp_ie_offset) {
9522be7d22fSVladimir Kondratiev 		assoc_resp_ie = NULL;
9532be7d22fSVladimir Kondratiev 		assoc_resp_ielen = 0;
9542be7d22fSVladimir Kondratiev 	}
9552be7d22fSVladimir Kondratiev 
9560916d9f2SMaya Erez 	if (test_bit(wil_status_resetting, wil->status) ||
9570916d9f2SMaya Erez 	    !test_bit(wil_status_fwready, wil->status)) {
9580916d9f2SMaya Erez 		wil_err(wil, "status_resetting, cancel connect event, CID %d\n",
9590916d9f2SMaya Erez 			evt->cid);
9600916d9f2SMaya Erez 		/* no need for cleanup, wil_reset will do that */
9610916d9f2SMaya Erez 		return;
9620916d9f2SMaya Erez 	}
9630916d9f2SMaya Erez 
964b819447dSHamad Kadmany 	mutex_lock(&wil->mutex);
965b819447dSHamad Kadmany 
9662be7d22fSVladimir Kondratiev 	if ((wdev->iftype == NL80211_IFTYPE_STATION) ||
9672be7d22fSVladimir Kondratiev 	    (wdev->iftype == NL80211_IFTYPE_P2P_CLIENT)) {
9685bd60982SLior David 		if (!test_bit(wil_vif_fwconnecting, vif->status)) {
9692be7d22fSVladimir Kondratiev 			wil_err(wil, "Not in connecting state\n");
9700916d9f2SMaya Erez 			mutex_unlock(&wil->mutex);
9712be7d22fSVladimir Kondratiev 			return;
9722be7d22fSVladimir Kondratiev 		}
973e00243faSLior David 		del_timer_sync(&vif->connect_timer);
9743d287fb3SMaya Erez 	} else if ((wdev->iftype == NL80211_IFTYPE_AP) ||
9753d287fb3SMaya Erez 		   (wdev->iftype == NL80211_IFTYPE_P2P_GO)) {
9763d287fb3SMaya Erez 		if (wil->sta[evt->cid].status != wil_sta_unused) {
977af3db60aSLazar Alexei 			wil_err(wil, "AP: Invalid status %d for CID %d\n",
978af3db60aSLazar Alexei 				wil->sta[evt->cid].status, evt->cid);
9793d287fb3SMaya Erez 			mutex_unlock(&wil->mutex);
9803d287fb3SMaya Erez 			return;
9813d287fb3SMaya Erez 		}
9820916d9f2SMaya Erez 	}
9830916d9f2SMaya Erez 
9840916d9f2SMaya Erez 	ether_addr_copy(wil->sta[evt->cid].addr, evt->bssid);
985e00243faSLior David 	wil->sta[evt->cid].mid = vif->mid;
9860916d9f2SMaya Erez 	wil->sta[evt->cid].status = wil_sta_conn_pending;
9870916d9f2SMaya Erez 
98896c93589SGidon Studinski 	rc = wil_ring_init_tx(vif, evt->cid);
9890916d9f2SMaya Erez 	if (rc) {
990af3db60aSLazar Alexei 		wil_err(wil, "config tx vring failed for CID %d, rc (%d)\n",
991af3db60aSLazar Alexei 			evt->cid, rc);
992e00243faSLior David 		wmi_disconnect_sta(vif, wil->sta[evt->cid].addr,
993849a564bSDedy Lansky 				   WLAN_REASON_UNSPECIFIED, false, false);
9940916d9f2SMaya Erez 	} else {
995af3db60aSLazar Alexei 		wil_info(wil, "successful connection to CID %d\n", evt->cid);
9960916d9f2SMaya Erez 	}
9970916d9f2SMaya Erez 
9980916d9f2SMaya Erez 	if ((wdev->iftype == NL80211_IFTYPE_STATION) ||
9990916d9f2SMaya Erez 	    (wdev->iftype == NL80211_IFTYPE_P2P_CLIENT)) {
10000916d9f2SMaya Erez 		if (rc) {
10010916d9f2SMaya Erez 			netif_carrier_off(ndev);
10029953a782SLior David 			wil6210_bus_request(wil, WIL_DEFAULT_BUS_REQUEST_KBPS);
1003af3db60aSLazar Alexei 			wil_err(wil, "cfg80211_connect_result with failure\n");
10040916d9f2SMaya Erez 			cfg80211_connect_result(ndev, evt->bssid, NULL, 0,
10050916d9f2SMaya Erez 						NULL, 0,
10060916d9f2SMaya Erez 						WLAN_STATUS_UNSPECIFIED_FAILURE,
10070916d9f2SMaya Erez 						GFP_KERNEL);
10080916d9f2SMaya Erez 			goto out;
10090916d9f2SMaya Erez 		} else {
1010bcdd49b0SDedy Lansky 			struct wiphy *wiphy = wil_to_wiphy(wil);
1011bcdd49b0SDedy Lansky 
1012e00243faSLior David 			cfg80211_ref_bss(wiphy, vif->bss);
1013e00243faSLior David 			cfg80211_connect_bss(ndev, evt->bssid, vif->bss,
10142be7d22fSVladimir Kondratiev 					     assoc_req_ie, assoc_req_ielen,
10152be7d22fSVladimir Kondratiev 					     assoc_resp_ie, assoc_resp_ielen,
1016bcdd49b0SDedy Lansky 					     WLAN_STATUS_SUCCESS, GFP_KERNEL,
1017bcdd49b0SDedy Lansky 					     NL80211_TIMEOUT_UNSPECIFIED);
10180916d9f2SMaya Erez 		}
1019e00243faSLior David 		vif->bss = NULL;
10202be7d22fSVladimir Kondratiev 	} else if ((wdev->iftype == NL80211_IFTYPE_AP) ||
10212be7d22fSVladimir Kondratiev 		   (wdev->iftype == NL80211_IFTYPE_P2P_GO)) {
102241bd3d58SToke Høiland-Jørgensen 
1023849a564bSDedy Lansky 		if (rc) {
1024849a564bSDedy Lansky 			if (disable_ap_sme)
1025849a564bSDedy Lansky 				/* notify new_sta has failed */
1026849a564bSDedy Lansky 				cfg80211_del_sta(ndev, evt->bssid, GFP_KERNEL);
10270916d9f2SMaya Erez 			goto out;
1028849a564bSDedy Lansky 		}
10290916d9f2SMaya Erez 
103041bd3d58SToke Høiland-Jørgensen 		sinfo = kzalloc(sizeof(*sinfo), GFP_KERNEL);
103141bd3d58SToke Høiland-Jørgensen 		if (!sinfo) {
103241bd3d58SToke Høiland-Jørgensen 			rc = -ENOMEM;
103341bd3d58SToke Høiland-Jørgensen 			goto out;
10342be7d22fSVladimir Kondratiev 		}
10352be7d22fSVladimir Kondratiev 
103641bd3d58SToke Høiland-Jørgensen 		sinfo->generation = wil->sinfo_gen++;
103741bd3d58SToke Høiland-Jørgensen 
103841bd3d58SToke Høiland-Jørgensen 		if (assoc_req_ie) {
103941bd3d58SToke Høiland-Jørgensen 			sinfo->assoc_req_ies = assoc_req_ie;
104041bd3d58SToke Høiland-Jørgensen 			sinfo->assoc_req_ies_len = assoc_req_ielen;
104141bd3d58SToke Høiland-Jørgensen 		}
104241bd3d58SToke Høiland-Jørgensen 
104341bd3d58SToke Høiland-Jørgensen 		cfg80211_new_sta(ndev, evt->bssid, sinfo, GFP_KERNEL);
104441bd3d58SToke Høiland-Jørgensen 
104541bd3d58SToke Høiland-Jørgensen 		kfree(sinfo);
10460916d9f2SMaya Erez 	} else {
1047af3db60aSLazar Alexei 		wil_err(wil, "unhandled iftype %d for CID %d\n", wdev->iftype,
1048af3db60aSLazar Alexei 			evt->cid);
10490916d9f2SMaya Erez 		goto out;
10502be7d22fSVladimir Kondratiev 	}
10510916d9f2SMaya Erez 
10520916d9f2SMaya Erez 	wil->sta[evt->cid].status = wil_sta_connected;
10539d865ee2SLior David 	wil->sta[evt->cid].aid = evt->aid;
10545bd60982SLior David 	if (!test_and_set_bit(wil_vif_fwconnected, vif->status))
10555bd60982SLior David 		atomic_inc(&wil->connected_vifs);
10565bd60982SLior David 	wil_update_net_queues_bh(wil, vif, NULL, false);
10572be7d22fSVladimir Kondratiev 
10580916d9f2SMaya Erez out:
1059e00243faSLior David 	if (rc) {
10600916d9f2SMaya Erez 		wil->sta[evt->cid].status = wil_sta_unused;
1061e00243faSLior David 		wil->sta[evt->cid].mid = U8_MAX;
1062e00243faSLior David 	}
10635bd60982SLior David 	clear_bit(wil_vif_fwconnecting, vif->status);
10640916d9f2SMaya Erez 	mutex_unlock(&wil->mutex);
10652be7d22fSVladimir Kondratiev }
10662be7d22fSVladimir Kondratiev 
1067e00243faSLior David static void wmi_evt_disconnect(struct wil6210_vif *vif, int id,
10682be7d22fSVladimir Kondratiev 			       void *d, int len)
10692be7d22fSVladimir Kondratiev {
1070e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
10712be7d22fSVladimir Kondratiev 	struct wmi_disconnect_event *evt = d;
10724821e6d8SVladimir Kondratiev 	u16 reason_code = le16_to_cpu(evt->protocol_reason_status);
10732be7d22fSVladimir Kondratiev 
10740916d9f2SMaya Erez 	wil_info(wil, "Disconnect %pM reason [proto %d wmi %d]\n",
10754821e6d8SVladimir Kondratiev 		 evt->bssid, reason_code, evt->disconnect_reason);
10762be7d22fSVladimir Kondratiev 
10772be7d22fSVladimir Kondratiev 	wil->sinfo_gen++;
10782be7d22fSVladimir Kondratiev 
1079b819447dSHamad Kadmany 	if (test_bit(wil_status_resetting, wil->status) ||
1080b819447dSHamad Kadmany 	    !test_bit(wil_status_fwready, wil->status)) {
1081b819447dSHamad Kadmany 		wil_err(wil, "status_resetting, cancel disconnect event\n");
1082b819447dSHamad Kadmany 		/* no need for cleanup, wil_reset will do that */
1083b819447dSHamad Kadmany 		return;
1084b819447dSHamad Kadmany 	}
1085b819447dSHamad Kadmany 
1086097638a0SVladimir Kondratiev 	mutex_lock(&wil->mutex);
1087e00243faSLior David 	wil6210_disconnect(vif, evt->bssid, reason_code, true);
1088097638a0SVladimir Kondratiev 	mutex_unlock(&wil->mutex);
10892be7d22fSVladimir Kondratiev }
10902be7d22fSVladimir Kondratiev 
10912be7d22fSVladimir Kondratiev /*
10922be7d22fSVladimir Kondratiev  * Firmware reports EAPOL frame using WME event.
10932be7d22fSVladimir Kondratiev  * Reconstruct Ethernet frame and deliver it via normal Rx
10942be7d22fSVladimir Kondratiev  */
1095e00243faSLior David static void wmi_evt_eapol_rx(struct wil6210_vif *vif, int id, void *d, int len)
10962be7d22fSVladimir Kondratiev {
1097e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1098e00243faSLior David 	struct net_device *ndev = vif_to_ndev(vif);
10992be7d22fSVladimir Kondratiev 	struct wmi_eapol_rx_event *evt = d;
11002be7d22fSVladimir Kondratiev 	u16 eapol_len = le16_to_cpu(evt->eapol_len);
11012be7d22fSVladimir Kondratiev 	int sz = eapol_len + ETH_HLEN;
11022be7d22fSVladimir Kondratiev 	struct sk_buff *skb;
11032be7d22fSVladimir Kondratiev 	struct ethhdr *eth;
1104c8b78b5fSVladimir Kondratiev 	int cid;
1105c8b78b5fSVladimir Kondratiev 	struct wil_net_stats *stats = NULL;
11062be7d22fSVladimir Kondratiev 
1107e00243faSLior David 	wil_dbg_wmi(wil, "EAPOL len %d from %pM MID %d\n", eapol_len,
1108e00243faSLior David 		    evt->src_mac, vif->mid);
11092be7d22fSVladimir Kondratiev 
1110e00243faSLior David 	cid = wil_find_cid(wil, vif->mid, evt->src_mac);
1111c8b78b5fSVladimir Kondratiev 	if (cid >= 0)
1112c8b78b5fSVladimir Kondratiev 		stats = &wil->sta[cid].stats;
1113c8b78b5fSVladimir Kondratiev 
11142be7d22fSVladimir Kondratiev 	if (eapol_len > 196) { /* TODO: revisit size limit */
11152be7d22fSVladimir Kondratiev 		wil_err(wil, "EAPOL too large\n");
11162be7d22fSVladimir Kondratiev 		return;
11172be7d22fSVladimir Kondratiev 	}
11182be7d22fSVladimir Kondratiev 
11192be7d22fSVladimir Kondratiev 	skb = alloc_skb(sz, GFP_KERNEL);
11202be7d22fSVladimir Kondratiev 	if (!skb) {
11212be7d22fSVladimir Kondratiev 		wil_err(wil, "Failed to allocate skb\n");
11222be7d22fSVladimir Kondratiev 		return;
11232be7d22fSVladimir Kondratiev 	}
1124c8b78b5fSVladimir Kondratiev 
11254df864c1SJohannes Berg 	eth = skb_put(skb, ETH_HLEN);
1126a82553bbSVladimir Kondratiev 	ether_addr_copy(eth->h_dest, ndev->dev_addr);
1127a82553bbSVladimir Kondratiev 	ether_addr_copy(eth->h_source, evt->src_mac);
11282be7d22fSVladimir Kondratiev 	eth->h_proto = cpu_to_be16(ETH_P_PAE);
112959ae1d12SJohannes Berg 	skb_put_data(skb, evt->eapol, eapol_len);
11302be7d22fSVladimir Kondratiev 	skb->protocol = eth_type_trans(skb, ndev);
11312be7d22fSVladimir Kondratiev 	if (likely(netif_rx_ni(skb) == NET_RX_SUCCESS)) {
11322be7d22fSVladimir Kondratiev 		ndev->stats.rx_packets++;
1133c8b78b5fSVladimir Kondratiev 		ndev->stats.rx_bytes += sz;
1134c8b78b5fSVladimir Kondratiev 		if (stats) {
1135c8b78b5fSVladimir Kondratiev 			stats->rx_packets++;
1136c8b78b5fSVladimir Kondratiev 			stats->rx_bytes += sz;
1137c8b78b5fSVladimir Kondratiev 		}
11382be7d22fSVladimir Kondratiev 	} else {
11392be7d22fSVladimir Kondratiev 		ndev->stats.rx_dropped++;
1140c8b78b5fSVladimir Kondratiev 		if (stats)
1141c8b78b5fSVladimir Kondratiev 			stats->rx_dropped++;
11422be7d22fSVladimir Kondratiev 	}
11432be7d22fSVladimir Kondratiev }
11442be7d22fSVladimir Kondratiev 
114596c93589SGidon Studinski static void wmi_evt_ring_en(struct wil6210_vif *vif, int id, void *d, int len)
11463a124ed6SVladimir Kondratiev {
1147e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
114896c93589SGidon Studinski 	struct wmi_ring_en_event *evt = d;
114996c93589SGidon Studinski 	u8 vri = evt->ring_index;
1150e00243faSLior David 	struct wireless_dev *wdev = vif_to_wdev(vif);
11513a124ed6SVladimir Kondratiev 
1152e00243faSLior David 	wil_dbg_wmi(wil, "Enable vring %d MID %d\n", vri, vif->mid);
11533a124ed6SVladimir Kondratiev 
115410590c6aSGidon Studinski 	if (vri >= ARRAY_SIZE(wil->ring_tx)) {
1155230d8442SVladimir Kondratiev 		wil_err(wil, "Enable for invalid vring %d\n", vri);
1156e58c9f70SVladimir Kondratiev 		return;
1157e58c9f70SVladimir Kondratiev 	}
1158849a564bSDedy Lansky 
1159849a564bSDedy Lansky 	if (wdev->iftype != NL80211_IFTYPE_AP || !disable_ap_sme)
1160849a564bSDedy Lansky 		/* in AP mode with disable_ap_sme, this is done by
1161849a564bSDedy Lansky 		 * wil_cfg80211_change_station()
1162849a564bSDedy Lansky 		 */
116310590c6aSGidon Studinski 		wil->ring_tx_data[vri].dot1x_open = true;
116410590c6aSGidon Studinski 	if (vri == vif->bcast_ring) /* no BA for bcast */
1165230d8442SVladimir Kondratiev 		return;
11663a3def8dSVladimir Kondratiev 	if (agg_wsize >= 0)
1167230d8442SVladimir Kondratiev 		wil_addba_tx_request(wil, vri, agg_wsize);
11683442a504SVladimir Kondratiev }
11693442a504SVladimir Kondratiev 
1170e00243faSLior David static void wmi_evt_ba_status(struct wil6210_vif *vif, int id,
1171e00243faSLior David 			      void *d, int len)
1172249a382bSVladimir Kondratiev {
1173e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1174b874ddecSLior David 	struct wmi_ba_status_event *evt = d;
117510590c6aSGidon Studinski 	struct wil_ring_tx_data *txdata;
1176249a382bSVladimir Kondratiev 
1177cbcf5866SVladimir Kondratiev 	wil_dbg_wmi(wil, "BACK[%d] %s {%d} timeout %d AMSDU%s\n",
11787b05b0abSVladimir Kondratiev 		    evt->ringid,
11797b05b0abSVladimir Kondratiev 		    evt->status == WMI_BA_AGREED ? "OK" : "N/A",
1180cbcf5866SVladimir Kondratiev 		    evt->agg_wsize, __le16_to_cpu(evt->ba_timeout),
1181cbcf5866SVladimir Kondratiev 		    evt->amsdu ? "+" : "-");
1182b4490f42SVladimir Kondratiev 
11837b05b0abSVladimir Kondratiev 	if (evt->ringid >= WIL6210_MAX_TX_RINGS) {
11847b05b0abSVladimir Kondratiev 		wil_err(wil, "invalid ring id %d\n", evt->ringid);
11857b05b0abSVladimir Kondratiev 		return;
11867b05b0abSVladimir Kondratiev 	}
11877b05b0abSVladimir Kondratiev 
11883277213fSVladimir Kondratiev 	if (evt->status != WMI_BA_AGREED) {
11893277213fSVladimir Kondratiev 		evt->ba_timeout = 0;
11903277213fSVladimir Kondratiev 		evt->agg_wsize = 0;
1191cbcf5866SVladimir Kondratiev 		evt->amsdu = 0;
11927b05b0abSVladimir Kondratiev 	}
11937b05b0abSVladimir Kondratiev 
119410590c6aSGidon Studinski 	txdata = &wil->ring_tx_data[evt->ringid];
11953277213fSVladimir Kondratiev 
11963277213fSVladimir Kondratiev 	txdata->agg_timeout = le16_to_cpu(evt->ba_timeout);
11973277213fSVladimir Kondratiev 	txdata->agg_wsize = evt->agg_wsize;
1198cbcf5866SVladimir Kondratiev 	txdata->agg_amsdu = evt->amsdu;
11993a124ed6SVladimir Kondratiev 	txdata->addba_in_progress = false;
12007b05b0abSVladimir Kondratiev }
12017b05b0abSVladimir Kondratiev 
1202e00243faSLior David static void wmi_evt_addba_rx_req(struct wil6210_vif *vif, int id,
1203e00243faSLior David 				 void *d, int len)
12043277213fSVladimir Kondratiev {
1205e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
12063277213fSVladimir Kondratiev 	struct wmi_rcp_addba_req_event *evt = d;
12073277213fSVladimir Kondratiev 
1208e00243faSLior David 	wil_addba_rx_request(wil, vif->mid, evt->cidxtid, evt->dialog_token,
12093277213fSVladimir Kondratiev 			     evt->ba_param_set, evt->ba_timeout,
12103277213fSVladimir Kondratiev 			     evt->ba_seq_ctrl);
12113277213fSVladimir Kondratiev }
12123277213fSVladimir Kondratiev 
1213e00243faSLior David static void wmi_evt_delba(struct wil6210_vif *vif, int id, void *d, int len)
1214bd33273bSVladimir Kondratiev __acquires(&sta->tid_rx_lock) __releases(&sta->tid_rx_lock)
12153277213fSVladimir Kondratiev {
1216e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
12173277213fSVladimir Kondratiev 	struct wmi_delba_event *evt = d;
12183277213fSVladimir Kondratiev 	u8 cid, tid;
12193277213fSVladimir Kondratiev 	u16 reason = __le16_to_cpu(evt->reason);
12203277213fSVladimir Kondratiev 	struct wil_sta_info *sta;
1221ec81b5adSDedy Lansky 	struct wil_tid_ampdu_rx *r;
1222ec81b5adSDedy Lansky 
1223bd33273bSVladimir Kondratiev 	might_sleep();
12243277213fSVladimir Kondratiev 	parse_cidxtid(evt->cidxtid, &cid, &tid);
1225e00243faSLior David 	wil_dbg_wmi(wil, "DELBA MID %d CID %d TID %d from %s reason %d\n",
1226e00243faSLior David 		    vif->mid, cid, tid,
12273277213fSVladimir Kondratiev 		    evt->from_initiator ? "originator" : "recipient",
12283277213fSVladimir Kondratiev 		    reason);
12293277213fSVladimir Kondratiev 	if (!evt->from_initiator) {
12303277213fSVladimir Kondratiev 		int i;
12313277213fSVladimir Kondratiev 		/* find Tx vring it belongs to */
123210590c6aSGidon Studinski 		for (i = 0; i < ARRAY_SIZE(wil->ring2cid_tid); i++) {
123310590c6aSGidon Studinski 			if (wil->ring2cid_tid[i][0] == cid &&
123410590c6aSGidon Studinski 			    wil->ring2cid_tid[i][1] == tid) {
123510590c6aSGidon Studinski 				struct wil_ring_tx_data *txdata =
123610590c6aSGidon Studinski 					&wil->ring_tx_data[i];
12373277213fSVladimir Kondratiev 
12383277213fSVladimir Kondratiev 				wil_dbg_wmi(wil, "DELBA Tx vring %d\n", i);
12393277213fSVladimir Kondratiev 				txdata->agg_timeout = 0;
12403277213fSVladimir Kondratiev 				txdata->agg_wsize = 0;
12413a124ed6SVladimir Kondratiev 				txdata->addba_in_progress = false;
12423277213fSVladimir Kondratiev 
12433277213fSVladimir Kondratiev 				break; /* max. 1 matching ring */
12443277213fSVladimir Kondratiev 			}
12453277213fSVladimir Kondratiev 		}
124610590c6aSGidon Studinski 		if (i >= ARRAY_SIZE(wil->ring2cid_tid))
12473277213fSVladimir Kondratiev 			wil_err(wil, "DELBA: unable to find Tx vring\n");
12483277213fSVladimir Kondratiev 		return;
12493277213fSVladimir Kondratiev 	}
12503277213fSVladimir Kondratiev 
12513277213fSVladimir Kondratiev 	sta = &wil->sta[cid];
12523277213fSVladimir Kondratiev 
1253bd33273bSVladimir Kondratiev 	spin_lock_bh(&sta->tid_rx_lock);
1254ec81b5adSDedy Lansky 
12553277213fSVladimir Kondratiev 	r = sta->tid_rx[tid];
12563277213fSVladimir Kondratiev 	sta->tid_rx[tid] = NULL;
1257b4490f42SVladimir Kondratiev 	wil_tid_ampdu_rx_free(wil, r);
1258ec81b5adSDedy Lansky 
1259bd33273bSVladimir Kondratiev 	spin_unlock_bh(&sta->tid_rx_lock);
1260b4490f42SVladimir Kondratiev }
1261b4490f42SVladimir Kondratiev 
1262a5dc6883SDedy Lansky static void
1263e00243faSLior David wmi_evt_sched_scan_result(struct wil6210_vif *vif, int id, void *d, int len)
1264a5dc6883SDedy Lansky {
1265e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1266a5dc6883SDedy Lansky 	struct wmi_sched_scan_result_event *data = d;
1267a5dc6883SDedy Lansky 	struct wiphy *wiphy = wil_to_wiphy(wil);
1268a5dc6883SDedy Lansky 	struct ieee80211_mgmt *rx_mgmt_frame =
1269a5dc6883SDedy Lansky 		(struct ieee80211_mgmt *)data->payload;
1270a5dc6883SDedy Lansky 	int flen = len - offsetof(struct wmi_sched_scan_result_event, payload);
1271a5dc6883SDedy Lansky 	int ch_no;
1272a5dc6883SDedy Lansky 	u32 freq;
1273a5dc6883SDedy Lansky 	struct ieee80211_channel *channel;
1274a5dc6883SDedy Lansky 	s32 signal;
1275a5dc6883SDedy Lansky 	__le16 fc;
1276a5dc6883SDedy Lansky 	u32 d_len;
1277a5dc6883SDedy Lansky 	struct cfg80211_bss *bss;
1278a5dc6883SDedy Lansky 
1279a5dc6883SDedy Lansky 	if (flen < 0) {
1280a5dc6883SDedy Lansky 		wil_err(wil, "sched scan result event too short, len %d\n",
1281a5dc6883SDedy Lansky 			len);
1282a5dc6883SDedy Lansky 		return;
1283a5dc6883SDedy Lansky 	}
1284a5dc6883SDedy Lansky 
1285a5dc6883SDedy Lansky 	d_len = le32_to_cpu(data->info.len);
1286a5dc6883SDedy Lansky 	if (d_len != flen) {
1287a5dc6883SDedy Lansky 		wil_err(wil,
1288a5dc6883SDedy Lansky 			"sched scan result length mismatch, d_len %d should be %d\n",
1289a5dc6883SDedy Lansky 			d_len, flen);
1290a5dc6883SDedy Lansky 		return;
1291a5dc6883SDedy Lansky 	}
1292a5dc6883SDedy Lansky 
1293a5dc6883SDedy Lansky 	fc = rx_mgmt_frame->frame_control;
1294a5dc6883SDedy Lansky 	if (!ieee80211_is_probe_resp(fc)) {
1295a5dc6883SDedy Lansky 		wil_err(wil, "sched scan result invalid frame, fc 0x%04x\n",
1296a5dc6883SDedy Lansky 			fc);
1297a5dc6883SDedy Lansky 		return;
1298a5dc6883SDedy Lansky 	}
1299a5dc6883SDedy Lansky 
1300a5dc6883SDedy Lansky 	ch_no = data->info.channel + 1;
1301a5dc6883SDedy Lansky 	freq = ieee80211_channel_to_frequency(ch_no, NL80211_BAND_60GHZ);
1302a5dc6883SDedy Lansky 	channel = ieee80211_get_channel(wiphy, freq);
1303a5dc6883SDedy Lansky 	if (test_bit(WMI_FW_CAPABILITY_RSSI_REPORTING, wil->fw_capabilities))
1304a5dc6883SDedy Lansky 		signal = 100 * data->info.rssi;
1305a5dc6883SDedy Lansky 	else
1306a5dc6883SDedy Lansky 		signal = data->info.sqi;
1307a5dc6883SDedy Lansky 
1308a5dc6883SDedy Lansky 	wil_dbg_wmi(wil, "sched scan result: channel %d MCS %d RSSI %d\n",
1309a5dc6883SDedy Lansky 		    data->info.channel, data->info.mcs, data->info.rssi);
1310a5dc6883SDedy Lansky 	wil_dbg_wmi(wil, "len %d qid %d mid %d cid %d\n",
1311a5dc6883SDedy Lansky 		    d_len, data->info.qid, data->info.mid, data->info.cid);
1312a5dc6883SDedy Lansky 	wil_hex_dump_wmi("PROBE ", DUMP_PREFIX_OFFSET, 16, 1, rx_mgmt_frame,
1313a5dc6883SDedy Lansky 			 d_len, true);
1314a5dc6883SDedy Lansky 
1315a5dc6883SDedy Lansky 	if (!channel) {
1316a5dc6883SDedy Lansky 		wil_err(wil, "Frame on unsupported channel\n");
1317a5dc6883SDedy Lansky 		return;
1318a5dc6883SDedy Lansky 	}
1319a5dc6883SDedy Lansky 
1320a5dc6883SDedy Lansky 	bss = cfg80211_inform_bss_frame(wiphy, channel, rx_mgmt_frame,
1321a5dc6883SDedy Lansky 					d_len, signal, GFP_KERNEL);
1322a5dc6883SDedy Lansky 	if (bss) {
1323a5dc6883SDedy Lansky 		wil_dbg_wmi(wil, "Added BSS %pM\n", rx_mgmt_frame->bssid);
1324a5dc6883SDedy Lansky 		cfg80211_put_bss(wiphy, bss);
1325a5dc6883SDedy Lansky 	} else {
1326a5dc6883SDedy Lansky 		wil_err(wil, "cfg80211_inform_bss_frame() failed\n");
1327a5dc6883SDedy Lansky 	}
1328a5dc6883SDedy Lansky 
1329a5dc6883SDedy Lansky 	cfg80211_sched_scan_results(wiphy, 0);
1330a5dc6883SDedy Lansky }
1331a5dc6883SDedy Lansky 
1332b03fbab0SVladimir Kondratiev /**
1333b03fbab0SVladimir Kondratiev  * Some events are ignored for purpose; and need not be interpreted as
1334b03fbab0SVladimir Kondratiev  * "unhandled events"
1335b03fbab0SVladimir Kondratiev  */
1336e00243faSLior David static void wmi_evt_ignore(struct wil6210_vif *vif, int id, void *d, int len)
1337b03fbab0SVladimir Kondratiev {
1338e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1339e00243faSLior David 
1340b03fbab0SVladimir Kondratiev 	wil_dbg_wmi(wil, "Ignore event 0x%04x len %d\n", id, len);
1341b03fbab0SVladimir Kondratiev }
1342b03fbab0SVladimir Kondratiev 
13432be7d22fSVladimir Kondratiev static const struct {
13442be7d22fSVladimir Kondratiev 	int eventid;
1345e00243faSLior David 	void (*handler)(struct wil6210_vif *vif,
1346e00243faSLior David 			int eventid, void *data, int data_len);
13472be7d22fSVladimir Kondratiev } wmi_evt_handlers[] = {
13482be7d22fSVladimir Kondratiev 	{WMI_READY_EVENTID,		wmi_evt_ready},
1349817f1853SVladimir Kondratiev 	{WMI_FW_READY_EVENTID,			wmi_evt_ignore},
13502be7d22fSVladimir Kondratiev 	{WMI_RX_MGMT_PACKET_EVENTID,	wmi_evt_rx_mgmt},
135190d89e9aSVladimir Kondratiev 	{WMI_TX_MGMT_PACKET_EVENTID,		wmi_evt_tx_mgmt},
13522be7d22fSVladimir Kondratiev 	{WMI_SCAN_COMPLETE_EVENTID,	wmi_evt_scan_complete},
13532be7d22fSVladimir Kondratiev 	{WMI_CONNECT_EVENTID,		wmi_evt_connect},
13542be7d22fSVladimir Kondratiev 	{WMI_DISCONNECT_EVENTID,	wmi_evt_disconnect},
13552be7d22fSVladimir Kondratiev 	{WMI_EAPOL_RX_EVENTID,		wmi_evt_eapol_rx},
1356249a382bSVladimir Kondratiev 	{WMI_BA_STATUS_EVENTID,		wmi_evt_ba_status},
13573277213fSVladimir Kondratiev 	{WMI_RCP_ADDBA_REQ_EVENTID,	wmi_evt_addba_rx_req},
13583277213fSVladimir Kondratiev 	{WMI_DELBA_EVENTID,		wmi_evt_delba},
135996c93589SGidon Studinski 	{WMI_RING_EN_EVENTID,		wmi_evt_ring_en},
1360b03fbab0SVladimir Kondratiev 	{WMI_DATA_PORT_OPEN_EVENTID,		wmi_evt_ignore},
1361a5dc6883SDedy Lansky 	{WMI_SCHED_SCAN_RESULT_EVENTID,		wmi_evt_sched_scan_result},
13622be7d22fSVladimir Kondratiev };
13632be7d22fSVladimir Kondratiev 
13642be7d22fSVladimir Kondratiev /*
13652be7d22fSVladimir Kondratiev  * Run in IRQ context
13662be7d22fSVladimir Kondratiev  * Extract WMI command from mailbox. Queue it to the @wil->pending_wmi_ev
13672be7d22fSVladimir Kondratiev  * that will be eventually handled by the @wmi_event_worker in the thread
13682be7d22fSVladimir Kondratiev  * context of thread "wil6210_wmi"
13692be7d22fSVladimir Kondratiev  */
13702be7d22fSVladimir Kondratiev void wmi_recv_cmd(struct wil6210_priv *wil)
13712be7d22fSVladimir Kondratiev {
13722be7d22fSVladimir Kondratiev 	struct wil6210_mbox_ring_desc d_tail;
13732be7d22fSVladimir Kondratiev 	struct wil6210_mbox_hdr hdr;
13742be7d22fSVladimir Kondratiev 	struct wil6210_mbox_ring *r = &wil->mbox_ctl.rx;
13752be7d22fSVladimir Kondratiev 	struct pending_wmi_event *evt;
13762be7d22fSVladimir Kondratiev 	u8 *cmd;
13772be7d22fSVladimir Kondratiev 	void __iomem *src;
13782be7d22fSVladimir Kondratiev 	ulong flags;
1379a715c7ddSVladimir Kondratiev 	unsigned n;
13800916d9f2SMaya Erez 	unsigned int num_immed_reply = 0;
13812be7d22fSVladimir Kondratiev 
1382817f1853SVladimir Kondratiev 	if (!test_bit(wil_status_mbox_ready, wil->status)) {
13834cf99c93SDedy Lansky 		wil_err(wil, "Reset in progress. Cannot handle WMI event\n");
138455f7acddSVladimir Kondratiev 		return;
138555f7acddSVladimir Kondratiev 	}
138655f7acddSVladimir Kondratiev 
1387fe9ee51eSMaya Erez 	if (test_bit(wil_status_suspended, wil->status)) {
1388fe9ee51eSMaya Erez 		wil_err(wil, "suspended. cannot handle WMI event\n");
1389fe9ee51eSMaya Erez 		return;
1390fe9ee51eSMaya Erez 	}
1391fe9ee51eSMaya Erez 
1392a715c7ddSVladimir Kondratiev 	for (n = 0;; n++) {
13932be7d22fSVladimir Kondratiev 		u16 len;
139495266dc0SVladimir Kondratiev 		bool q;
13950916d9f2SMaya Erez 		bool immed_reply = false;
13962be7d22fSVladimir Kondratiev 
1397b9eeb512SVladimir Kondratiev 		r->head = wil_r(wil, RGF_MBOX +
13982be7d22fSVladimir Kondratiev 				offsetof(struct wil6210_mbox_ctl, rx.head));
139995266dc0SVladimir Kondratiev 		if (r->tail == r->head)
140095266dc0SVladimir Kondratiev 			break;
14012be7d22fSVladimir Kondratiev 
1402a715c7ddSVladimir Kondratiev 		wil_dbg_wmi(wil, "Mbox head %08x tail %08x\n",
1403a715c7ddSVladimir Kondratiev 			    r->head, r->tail);
1404a715c7ddSVladimir Kondratiev 		/* read cmd descriptor from tail */
14052be7d22fSVladimir Kondratiev 		wil_memcpy_fromio_32(&d_tail, wil->csr + HOSTADDR(r->tail),
14062be7d22fSVladimir Kondratiev 				     sizeof(struct wil6210_mbox_ring_desc));
14072be7d22fSVladimir Kondratiev 		if (d_tail.sync == 0) {
14082be7d22fSVladimir Kondratiev 			wil_err(wil, "Mbox evt not owned by FW?\n");
140995266dc0SVladimir Kondratiev 			break;
14102be7d22fSVladimir Kondratiev 		}
14112be7d22fSVladimir Kondratiev 
1412a715c7ddSVladimir Kondratiev 		/* read cmd header from descriptor */
14132be7d22fSVladimir Kondratiev 		if (0 != wmi_read_hdr(wil, d_tail.addr, &hdr)) {
14142be7d22fSVladimir Kondratiev 			wil_err(wil, "Mbox evt at 0x%08x?\n",
14152be7d22fSVladimir Kondratiev 				le32_to_cpu(d_tail.addr));
141695266dc0SVladimir Kondratiev 			break;
14172be7d22fSVladimir Kondratiev 		}
14182be7d22fSVladimir Kondratiev 		len = le16_to_cpu(hdr.len);
1419a715c7ddSVladimir Kondratiev 		wil_dbg_wmi(wil, "Mbox evt %04x %04x %04x %02x\n",
1420a715c7ddSVladimir Kondratiev 			    le16_to_cpu(hdr.seq), len, le16_to_cpu(hdr.type),
1421a715c7ddSVladimir Kondratiev 			    hdr.flags);
1422a715c7ddSVladimir Kondratiev 
1423a715c7ddSVladimir Kondratiev 		/* read cmd buffer from descriptor */
14242be7d22fSVladimir Kondratiev 		src = wmi_buffer(wil, d_tail.addr) +
14252be7d22fSVladimir Kondratiev 		      sizeof(struct wil6210_mbox_hdr);
14262be7d22fSVladimir Kondratiev 		evt = kmalloc(ALIGN(offsetof(struct pending_wmi_event,
14272be7d22fSVladimir Kondratiev 					     event.wmi) + len, 4),
14282be7d22fSVladimir Kondratiev 			      GFP_KERNEL);
142914f8dc49SJoe Perches 		if (!evt)
143095266dc0SVladimir Kondratiev 			break;
143114f8dc49SJoe Perches 
14322be7d22fSVladimir Kondratiev 		evt->event.hdr = hdr;
14332be7d22fSVladimir Kondratiev 		cmd = (void *)&evt->event.wmi;
14342be7d22fSVladimir Kondratiev 		wil_memcpy_fromio_32(cmd, src, len);
14352be7d22fSVladimir Kondratiev 		/* mark entry as empty */
1436b9eeb512SVladimir Kondratiev 		wil_w(wil, r->tail +
1437b9eeb512SVladimir Kondratiev 		      offsetof(struct wil6210_mbox_ring_desc, sync), 0);
14382be7d22fSVladimir Kondratiev 		/* indicate */
14392be7d22fSVladimir Kondratiev 		if ((hdr.type == WIL_MBOX_HDR_TYPE_WMI) &&
1440b874ddecSLior David 		    (len >= sizeof(struct wmi_cmd_hdr))) {
1441b874ddecSLior David 			struct wmi_cmd_hdr *wmi = &evt->event.wmi;
1442b874ddecSLior David 			u16 id = le16_to_cpu(wmi->command_id);
1443e00243faSLior David 			u8 mid = wmi->mid;
1444b874ddecSLior David 			u32 tstamp = le32_to_cpu(wmi->fw_timestamp);
1445fe9ee51eSMaya Erez 			if (test_bit(wil_status_resuming, wil->status)) {
1446fe9ee51eSMaya Erez 				if (id == WMI_TRAFFIC_RESUME_EVENTID)
1447fe9ee51eSMaya Erez 					clear_bit(wil_status_resuming,
1448fe9ee51eSMaya Erez 						  wil->status);
1449fe9ee51eSMaya Erez 				else
1450fe9ee51eSMaya Erez 					wil_err(wil,
1451fe9ee51eSMaya Erez 						"WMI evt %d while resuming\n",
1452fe9ee51eSMaya Erez 						id);
1453fe9ee51eSMaya Erez 			}
1454fe5c271eSMaya Erez 			spin_lock_irqsave(&wil->wmi_ev_lock, flags);
1455e00243faSLior David 			if (wil->reply_id && wil->reply_id == id &&
1456e00243faSLior David 			    wil->reply_mid == mid) {
14570916d9f2SMaya Erez 				if (wil->reply_buf) {
14580916d9f2SMaya Erez 					memcpy(wil->reply_buf, wmi,
14590916d9f2SMaya Erez 					       min(len, wil->reply_size));
14600916d9f2SMaya Erez 					immed_reply = true;
14610916d9f2SMaya Erez 				}
1462fe9ee51eSMaya Erez 				if (id == WMI_TRAFFIC_SUSPEND_EVENTID) {
1463fe9ee51eSMaya Erez 					wil_dbg_wmi(wil,
1464fe9ee51eSMaya Erez 						    "set suspend_resp_rcvd\n");
1465fe9ee51eSMaya Erez 					wil->suspend_resp_rcvd = true;
1466fe9ee51eSMaya Erez 				}
14670916d9f2SMaya Erez 			}
1468fe5c271eSMaya Erez 			spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
14698fe59627SVladimir Kondratiev 
14705fad7241SDedy Lansky 			wil_dbg_wmi(wil, "recv %s (0x%04x) MID %d @%d msec\n",
14715fad7241SDedy Lansky 				    eventid2name(id), id, wmi->mid, tstamp);
1472f988b23fSVladimir Kondratiev 			trace_wil6210_wmi_event(wmi, &wmi[1],
1473f988b23fSVladimir Kondratiev 						len - sizeof(*wmi));
14742be7d22fSVladimir Kondratiev 		}
14757743882dSVladimir Kondratiev 		wil_hex_dump_wmi("evt ", DUMP_PREFIX_OFFSET, 16, 1,
14762be7d22fSVladimir Kondratiev 				 &evt->event.hdr, sizeof(hdr) + len, true);
14772be7d22fSVladimir Kondratiev 
14782be7d22fSVladimir Kondratiev 		/* advance tail */
14792be7d22fSVladimir Kondratiev 		r->tail = r->base + ((r->tail - r->base +
14802be7d22fSVladimir Kondratiev 			  sizeof(struct wil6210_mbox_ring_desc)) % r->size);
1481b9eeb512SVladimir Kondratiev 		wil_w(wil, RGF_MBOX +
1482b9eeb512SVladimir Kondratiev 		      offsetof(struct wil6210_mbox_ctl, rx.tail), r->tail);
14832be7d22fSVladimir Kondratiev 
14840916d9f2SMaya Erez 		if (immed_reply) {
1485af3db60aSLazar Alexei 			wil_dbg_wmi(wil, "recv_cmd: Complete WMI 0x%04x\n",
1486af3db60aSLazar Alexei 				    wil->reply_id);
14870916d9f2SMaya Erez 			kfree(evt);
14880916d9f2SMaya Erez 			num_immed_reply++;
14890916d9f2SMaya Erez 			complete(&wil->wmi_call);
14900916d9f2SMaya Erez 		} else {
14912be7d22fSVladimir Kondratiev 			/* add to the pending list */
14922be7d22fSVladimir Kondratiev 			spin_lock_irqsave(&wil->wmi_ev_lock, flags);
14932be7d22fSVladimir Kondratiev 			list_add_tail(&evt->list, &wil->pending_wmi_ev);
14942be7d22fSVladimir Kondratiev 			spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
149595266dc0SVladimir Kondratiev 			q = queue_work(wil->wmi_wq, &wil->wmi_event_worker);
14967743882dSVladimir Kondratiev 			wil_dbg_wmi(wil, "queue_work -> %d\n", q);
14972be7d22fSVladimir Kondratiev 		}
14980916d9f2SMaya Erez 	}
149995266dc0SVladimir Kondratiev 	/* normally, 1 event per IRQ should be processed */
1500af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "recv_cmd: -> %d events queued, %d completed\n",
15010916d9f2SMaya Erez 		    n - num_immed_reply, num_immed_reply);
15022be7d22fSVladimir Kondratiev }
15032be7d22fSVladimir Kondratiev 
1504e00243faSLior David int wmi_call(struct wil6210_priv *wil, u16 cmdid, u8 mid, void *buf, u16 len,
15055f85c7e7SLior David 	     u16 reply_id, void *reply, u16 reply_size, int to_msec)
15062be7d22fSVladimir Kondratiev {
15072be7d22fSVladimir Kondratiev 	int rc;
1508f4bbb829SNicholas Mc Guire 	unsigned long remain;
15092be7d22fSVladimir Kondratiev 
15102be7d22fSVladimir Kondratiev 	mutex_lock(&wil->wmi_mutex);
15112be7d22fSVladimir Kondratiev 
1512fe5c271eSMaya Erez 	spin_lock(&wil->wmi_ev_lock);
1513fe5c271eSMaya Erez 	wil->reply_id = reply_id;
1514e00243faSLior David 	wil->reply_mid = mid;
1515fe5c271eSMaya Erez 	wil->reply_buf = reply;
1516fe5c271eSMaya Erez 	wil->reply_size = reply_size;
15174d4c4dc3SLior David 	reinit_completion(&wil->wmi_call);
1518fe5c271eSMaya Erez 	spin_unlock(&wil->wmi_ev_lock);
1519fe5c271eSMaya Erez 
1520e00243faSLior David 	rc = __wmi_send(wil, cmdid, mid, buf, len);
15212be7d22fSVladimir Kondratiev 	if (rc)
15222be7d22fSVladimir Kondratiev 		goto out;
15232be7d22fSVladimir Kondratiev 
152459502647SDedy Lansky 	remain = wait_for_completion_timeout(&wil->wmi_call,
15252be7d22fSVladimir Kondratiev 					     msecs_to_jiffies(to_msec));
15262be7d22fSVladimir Kondratiev 	if (0 == remain) {
15272be7d22fSVladimir Kondratiev 		wil_err(wil, "wmi_call(0x%04x->0x%04x) timeout %d msec\n",
15282be7d22fSVladimir Kondratiev 			cmdid, reply_id, to_msec);
15292be7d22fSVladimir Kondratiev 		rc = -ETIME;
15302be7d22fSVladimir Kondratiev 	} else {
15317743882dSVladimir Kondratiev 		wil_dbg_wmi(wil,
15322be7d22fSVladimir Kondratiev 			    "wmi_call(0x%04x->0x%04x) completed in %d msec\n",
15332be7d22fSVladimir Kondratiev 			    cmdid, reply_id,
15342be7d22fSVladimir Kondratiev 			    to_msec - jiffies_to_msecs(remain));
15352be7d22fSVladimir Kondratiev 	}
1536fe5c271eSMaya Erez 
1537fe5c271eSMaya Erez out:
1538fe5c271eSMaya Erez 	spin_lock(&wil->wmi_ev_lock);
15392be7d22fSVladimir Kondratiev 	wil->reply_id = 0;
1540e00243faSLior David 	wil->reply_mid = U8_MAX;
15412be7d22fSVladimir Kondratiev 	wil->reply_buf = NULL;
15422be7d22fSVladimir Kondratiev 	wil->reply_size = 0;
1543fe5c271eSMaya Erez 	spin_unlock(&wil->wmi_ev_lock);
1544fe5c271eSMaya Erez 
15452be7d22fSVladimir Kondratiev 	mutex_unlock(&wil->wmi_mutex);
15462be7d22fSVladimir Kondratiev 
15472be7d22fSVladimir Kondratiev 	return rc;
15482be7d22fSVladimir Kondratiev }
15492be7d22fSVladimir Kondratiev 
15502be7d22fSVladimir Kondratiev int wmi_echo(struct wil6210_priv *wil)
15512be7d22fSVladimir Kondratiev {
1552e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
15532be7d22fSVladimir Kondratiev 	struct wmi_echo_cmd cmd = {
15542be7d22fSVladimir Kondratiev 		.value = cpu_to_le32(0x12345678),
15552be7d22fSVladimir Kondratiev 	};
15562be7d22fSVladimir Kondratiev 
1557e00243faSLior David 	return wmi_call(wil, WMI_ECHO_CMDID, vif->mid, &cmd, sizeof(cmd),
1558a54a40daSVladimir Kondratiev 			WMI_ECHO_RSP_EVENTID, NULL, 0, 50);
15592be7d22fSVladimir Kondratiev }
15602be7d22fSVladimir Kondratiev 
15612be7d22fSVladimir Kondratiev int wmi_set_mac_address(struct wil6210_priv *wil, void *addr)
15622be7d22fSVladimir Kondratiev {
1563e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
15642be7d22fSVladimir Kondratiev 	struct wmi_set_mac_address_cmd cmd;
15652be7d22fSVladimir Kondratiev 
1566a82553bbSVladimir Kondratiev 	ether_addr_copy(cmd.mac, addr);
15672be7d22fSVladimir Kondratiev 
15687743882dSVladimir Kondratiev 	wil_dbg_wmi(wil, "Set MAC %pM\n", addr);
15692be7d22fSVladimir Kondratiev 
1570e00243faSLior David 	return wmi_send(wil, WMI_SET_MAC_ADDRESS_CMDID, vif->mid,
1571e00243faSLior David 			&cmd, sizeof(cmd));
15722be7d22fSVladimir Kondratiev }
15732be7d22fSVladimir Kondratiev 
157410d599adSMaya Erez int wmi_led_cfg(struct wil6210_priv *wil, bool enable)
157510d599adSMaya Erez {
1576e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
157710d599adSMaya Erez 	int rc = 0;
157810d599adSMaya Erez 	struct wmi_led_cfg_cmd cmd = {
157910d599adSMaya Erez 		.led_mode = enable,
158010d599adSMaya Erez 		.id = led_id,
158110d599adSMaya Erez 		.slow_blink_cfg.blink_on =
158210d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_SLOW].on_ms),
158310d599adSMaya Erez 		.slow_blink_cfg.blink_off =
158410d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_SLOW].off_ms),
158510d599adSMaya Erez 		.medium_blink_cfg.blink_on =
158610d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_MED].on_ms),
158710d599adSMaya Erez 		.medium_blink_cfg.blink_off =
158810d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_MED].off_ms),
158910d599adSMaya Erez 		.fast_blink_cfg.blink_on =
159010d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_FAST].on_ms),
159110d599adSMaya Erez 		.fast_blink_cfg.blink_off =
159210d599adSMaya Erez 			cpu_to_le32(led_blink_time[WIL_LED_TIME_FAST].off_ms),
159310d599adSMaya Erez 		.led_polarity = led_polarity,
159410d599adSMaya Erez 	};
159510d599adSMaya Erez 	struct {
159610d599adSMaya Erez 		struct wmi_cmd_hdr wmi;
159710d599adSMaya Erez 		struct wmi_led_cfg_done_event evt;
1598807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1599807b0860SAlexei Avshalom Lazar 		.evt = {.status = cpu_to_le32(WMI_FW_STATUS_FAILURE)},
1600807b0860SAlexei Avshalom Lazar 	};
160110d599adSMaya Erez 
160210d599adSMaya Erez 	if (led_id == WIL_LED_INVALID_ID)
160310d599adSMaya Erez 		goto out;
160410d599adSMaya Erez 
160510d599adSMaya Erez 	if (led_id > WIL_LED_MAX_ID) {
160610d599adSMaya Erez 		wil_err(wil, "Invalid led id %d\n", led_id);
160710d599adSMaya Erez 		rc = -EINVAL;
160810d599adSMaya Erez 		goto out;
160910d599adSMaya Erez 	}
161010d599adSMaya Erez 
161110d599adSMaya Erez 	wil_dbg_wmi(wil,
161210d599adSMaya Erez 		    "%s led %d\n",
161310d599adSMaya Erez 		    enable ? "enabling" : "disabling", led_id);
161410d599adSMaya Erez 
1615e00243faSLior David 	rc = wmi_call(wil, WMI_LED_CFG_CMDID, vif->mid, &cmd, sizeof(cmd),
161610d599adSMaya Erez 		      WMI_LED_CFG_DONE_EVENTID, &reply, sizeof(reply),
161710d599adSMaya Erez 		      100);
161810d599adSMaya Erez 	if (rc)
161910d599adSMaya Erez 		goto out;
162010d599adSMaya Erez 
162110d599adSMaya Erez 	if (reply.evt.status) {
162210d599adSMaya Erez 		wil_err(wil, "led %d cfg failed with status %d\n",
162310d599adSMaya Erez 			led_id, le32_to_cpu(reply.evt.status));
162410d599adSMaya Erez 		rc = -EINVAL;
162510d599adSMaya Erez 	}
162610d599adSMaya Erez 
162710d599adSMaya Erez out:
162810d599adSMaya Erez 	return rc;
162910d599adSMaya Erez }
163010d599adSMaya Erez 
1631e00243faSLior David int wmi_pcp_start(struct wil6210_vif *vif,
1632e00243faSLior David 		  int bi, u8 wmi_nettype, u8 chan, u8 hidden_ssid, u8 is_go)
16332be7d22fSVladimir Kondratiev {
1634e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1635b8023177SVladimir Kondratiev 	int rc;
1636b8023177SVladimir Kondratiev 
1637b8023177SVladimir Kondratiev 	struct wmi_pcp_start_cmd cmd = {
16382be7d22fSVladimir Kondratiev 		.bcon_interval = cpu_to_le16(bi),
16392be7d22fSVladimir Kondratiev 		.network_type = wmi_nettype,
16402be7d22fSVladimir Kondratiev 		.disable_sec_offload = 1,
1641adc2d122SVladimir Kondratiev 		.channel = chan - 1,
16421eb9d1e5SDedy Lansky 		.pcp_max_assoc_sta = max_assoc_sta,
16438e52fe30SHamad Kadmany 		.hidden_ssid = hidden_ssid,
1644b4944f2cSLior David 		.is_go = is_go,
16458a4fa214SAhmad Masri 		.ap_sme_offload_mode = disable_ap_sme ?
16468a4fa214SAhmad Masri 				       WMI_AP_SME_OFFLOAD_PARTIAL :
16478a4fa214SAhmad Masri 				       WMI_AP_SME_OFFLOAD_FULL,
1648c3bfea05SLior David 		.abft_len = wil->abft_len,
16492be7d22fSVladimir Kondratiev 	};
1650b8023177SVladimir Kondratiev 	struct {
1651b874ddecSLior David 		struct wmi_cmd_hdr wmi;
1652b8023177SVladimir Kondratiev 		struct wmi_pcp_started_event evt;
1653807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1654807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1655807b0860SAlexei Avshalom Lazar 	};
16562be7d22fSVladimir Kondratiev 
1657e00243faSLior David 	if (!vif->privacy)
16582be7d22fSVladimir Kondratiev 		cmd.disable_sec = 1;
16592be7d22fSVladimir Kondratiev 
16601eb9d1e5SDedy Lansky 	if ((cmd.pcp_max_assoc_sta > WIL6210_MAX_CID) ||
16611eb9d1e5SDedy Lansky 	    (cmd.pcp_max_assoc_sta <= 0)) {
16621eb9d1e5SDedy Lansky 		wil_info(wil,
16631eb9d1e5SDedy Lansky 			 "Requested connection limit %u, valid values are 1 - %d. Setting to %d\n",
16641eb9d1e5SDedy Lansky 			 max_assoc_sta, WIL6210_MAX_CID, WIL6210_MAX_CID);
16651eb9d1e5SDedy Lansky 		cmd.pcp_max_assoc_sta = WIL6210_MAX_CID;
16661eb9d1e5SDedy Lansky 	}
16671eb9d1e5SDedy Lansky 
1668849a564bSDedy Lansky 	if (disable_ap_sme &&
16698a4fa214SAhmad Masri 	    !test_bit(WMI_FW_CAPABILITY_AP_SME_OFFLOAD_PARTIAL,
1670849a564bSDedy Lansky 		      wil->fw_capabilities)) {
1671849a564bSDedy Lansky 		wil_err(wil, "disable_ap_sme not supported by FW\n");
1672849a564bSDedy Lansky 		return -EOPNOTSUPP;
1673849a564bSDedy Lansky 	}
1674849a564bSDedy Lansky 
16758b5c7f6cSVladimir Kondratiev 	/*
16768b5c7f6cSVladimir Kondratiev 	 * Processing time may be huge, in case of secure AP it takes about
16778b5c7f6cSVladimir Kondratiev 	 * 3500ms for FW to start AP
16788b5c7f6cSVladimir Kondratiev 	 */
1679e00243faSLior David 	rc = wmi_call(wil, WMI_PCP_START_CMDID, vif->mid, &cmd, sizeof(cmd),
16808b5c7f6cSVladimir Kondratiev 		      WMI_PCP_STARTED_EVENTID, &reply, sizeof(reply), 5000);
1681b8023177SVladimir Kondratiev 	if (rc)
1682b8023177SVladimir Kondratiev 		return rc;
1683b8023177SVladimir Kondratiev 
1684b8023177SVladimir Kondratiev 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS)
1685b8023177SVladimir Kondratiev 		rc = -EINVAL;
1686b8023177SVladimir Kondratiev 
168710d599adSMaya Erez 	if (wmi_nettype != WMI_NETTYPE_P2P)
168810d599adSMaya Erez 		/* Don't fail due to error in the led configuration */
168910d599adSMaya Erez 		wmi_led_cfg(wil, true);
169010d599adSMaya Erez 
1691b8023177SVladimir Kondratiev 	return rc;
1692b8023177SVladimir Kondratiev }
1693b8023177SVladimir Kondratiev 
1694e00243faSLior David int wmi_pcp_stop(struct wil6210_vif *vif)
1695b8023177SVladimir Kondratiev {
1696e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
169710d599adSMaya Erez 	int rc;
169810d599adSMaya Erez 
169910d599adSMaya Erez 	rc = wmi_led_cfg(wil, false);
170010d599adSMaya Erez 	if (rc)
170110d599adSMaya Erez 		return rc;
170210d599adSMaya Erez 
1703e00243faSLior David 	return wmi_call(wil, WMI_PCP_STOP_CMDID, vif->mid, NULL, 0,
1704b8023177SVladimir Kondratiev 			WMI_PCP_STOPPED_EVENTID, NULL, 0, 20);
17052be7d22fSVladimir Kondratiev }
17062be7d22fSVladimir Kondratiev 
1707e00243faSLior David int wmi_set_ssid(struct wil6210_vif *vif, u8 ssid_len, const void *ssid)
17082be7d22fSVladimir Kondratiev {
1709e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
17102be7d22fSVladimir Kondratiev 	struct wmi_set_ssid_cmd cmd = {
17112be7d22fSVladimir Kondratiev 		.ssid_len = cpu_to_le32(ssid_len),
17122be7d22fSVladimir Kondratiev 	};
17132be7d22fSVladimir Kondratiev 
17142be7d22fSVladimir Kondratiev 	if (ssid_len > sizeof(cmd.ssid))
17152be7d22fSVladimir Kondratiev 		return -EINVAL;
17162be7d22fSVladimir Kondratiev 
17172be7d22fSVladimir Kondratiev 	memcpy(cmd.ssid, ssid, ssid_len);
17182be7d22fSVladimir Kondratiev 
1719e00243faSLior David 	return wmi_send(wil, WMI_SET_SSID_CMDID, vif->mid, &cmd, sizeof(cmd));
17202be7d22fSVladimir Kondratiev }
17212be7d22fSVladimir Kondratiev 
1722e00243faSLior David int wmi_get_ssid(struct wil6210_vif *vif, u8 *ssid_len, void *ssid)
17232be7d22fSVladimir Kondratiev {
1724e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
17252be7d22fSVladimir Kondratiev 	int rc;
17262be7d22fSVladimir Kondratiev 	struct {
1727b874ddecSLior David 		struct wmi_cmd_hdr wmi;
17282be7d22fSVladimir Kondratiev 		struct wmi_set_ssid_cmd cmd;
17292be7d22fSVladimir Kondratiev 	} __packed reply;
17302be7d22fSVladimir Kondratiev 	int len; /* reply.cmd.ssid_len in CPU order */
17312be7d22fSVladimir Kondratiev 
1732807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
1733807b0860SAlexei Avshalom Lazar 
1734e00243faSLior David 	rc = wmi_call(wil, WMI_GET_SSID_CMDID, vif->mid, NULL, 0,
1735e00243faSLior David 		      WMI_GET_SSID_EVENTID, &reply, sizeof(reply), 20);
17362be7d22fSVladimir Kondratiev 	if (rc)
17372be7d22fSVladimir Kondratiev 		return rc;
17382be7d22fSVladimir Kondratiev 
17392be7d22fSVladimir Kondratiev 	len = le32_to_cpu(reply.cmd.ssid_len);
17402be7d22fSVladimir Kondratiev 	if (len > sizeof(reply.cmd.ssid))
17412be7d22fSVladimir Kondratiev 		return -EINVAL;
17422be7d22fSVladimir Kondratiev 
17432be7d22fSVladimir Kondratiev 	*ssid_len = len;
17442be7d22fSVladimir Kondratiev 	memcpy(ssid, reply.cmd.ssid, len);
17452be7d22fSVladimir Kondratiev 
17462be7d22fSVladimir Kondratiev 	return 0;
17472be7d22fSVladimir Kondratiev }
17482be7d22fSVladimir Kondratiev 
17492be7d22fSVladimir Kondratiev int wmi_set_channel(struct wil6210_priv *wil, int channel)
17502be7d22fSVladimir Kondratiev {
1751e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
17522be7d22fSVladimir Kondratiev 	struct wmi_set_pcp_channel_cmd cmd = {
17532be7d22fSVladimir Kondratiev 		.channel = channel - 1,
17542be7d22fSVladimir Kondratiev 	};
17552be7d22fSVladimir Kondratiev 
1756e00243faSLior David 	return wmi_send(wil, WMI_SET_PCP_CHANNEL_CMDID, vif->mid,
1757e00243faSLior David 			&cmd, sizeof(cmd));
17582be7d22fSVladimir Kondratiev }
17592be7d22fSVladimir Kondratiev 
17602be7d22fSVladimir Kondratiev int wmi_get_channel(struct wil6210_priv *wil, int *channel)
17612be7d22fSVladimir Kondratiev {
1762e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
17632be7d22fSVladimir Kondratiev 	int rc;
17642be7d22fSVladimir Kondratiev 	struct {
1765b874ddecSLior David 		struct wmi_cmd_hdr wmi;
17662be7d22fSVladimir Kondratiev 		struct wmi_set_pcp_channel_cmd cmd;
17672be7d22fSVladimir Kondratiev 	} __packed reply;
17682be7d22fSVladimir Kondratiev 
1769807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
1770807b0860SAlexei Avshalom Lazar 
1771e00243faSLior David 	rc = wmi_call(wil, WMI_GET_PCP_CHANNEL_CMDID, vif->mid, NULL, 0,
17722be7d22fSVladimir Kondratiev 		      WMI_GET_PCP_CHANNEL_EVENTID, &reply, sizeof(reply), 20);
17732be7d22fSVladimir Kondratiev 	if (rc)
17742be7d22fSVladimir Kondratiev 		return rc;
17752be7d22fSVladimir Kondratiev 
17762be7d22fSVladimir Kondratiev 	if (reply.cmd.channel > 3)
17772be7d22fSVladimir Kondratiev 		return -EINVAL;
17782be7d22fSVladimir Kondratiev 
17792be7d22fSVladimir Kondratiev 	*channel = reply.cmd.channel + 1;
17802be7d22fSVladimir Kondratiev 
17812be7d22fSVladimir Kondratiev 	return 0;
17822be7d22fSVladimir Kondratiev }
17832be7d22fSVladimir Kondratiev 
1784e00243faSLior David int wmi_p2p_cfg(struct wil6210_vif *vif, int channel, int bi)
1785b8023177SVladimir Kondratiev {
1786e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1787e6d68341SDedy Lansky 	int rc;
1788b8023177SVladimir Kondratiev 	struct wmi_p2p_cfg_cmd cmd = {
1789e6d68341SDedy Lansky 		.discovery_mode = WMI_DISCOVERY_MODE_PEER2PEER,
1790e6d68341SDedy Lansky 		.bcon_interval = cpu_to_le16(bi),
1791b8023177SVladimir Kondratiev 		.channel = channel - 1,
1792b8023177SVladimir Kondratiev 	};
1793e6d68341SDedy Lansky 	struct {
1794e6d68341SDedy Lansky 		struct wmi_cmd_hdr wmi;
1795e6d68341SDedy Lansky 		struct wmi_p2p_cfg_done_event evt;
1796807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1797807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1798807b0860SAlexei Avshalom Lazar 	};
1799b8023177SVladimir Kondratiev 
1800e6d68341SDedy Lansky 	wil_dbg_wmi(wil, "sending WMI_P2P_CFG_CMDID\n");
1801e6d68341SDedy Lansky 
1802e00243faSLior David 	rc = wmi_call(wil, WMI_P2P_CFG_CMDID, vif->mid, &cmd, sizeof(cmd),
1803e6d68341SDedy Lansky 		      WMI_P2P_CFG_DONE_EVENTID, &reply, sizeof(reply), 300);
1804e6d68341SDedy Lansky 	if (!rc && reply.evt.status != WMI_FW_STATUS_SUCCESS) {
1805e6d68341SDedy Lansky 		wil_err(wil, "P2P_CFG failed. status %d\n", reply.evt.status);
1806e6d68341SDedy Lansky 		rc = -EINVAL;
1807e6d68341SDedy Lansky 	}
1808e6d68341SDedy Lansky 
1809e6d68341SDedy Lansky 	return rc;
1810e6d68341SDedy Lansky }
1811e6d68341SDedy Lansky 
1812e00243faSLior David int wmi_start_listen(struct wil6210_vif *vif)
1813e6d68341SDedy Lansky {
1814e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1815e6d68341SDedy Lansky 	int rc;
1816e6d68341SDedy Lansky 	struct {
1817e6d68341SDedy Lansky 		struct wmi_cmd_hdr wmi;
1818e6d68341SDedy Lansky 		struct wmi_listen_started_event evt;
1819807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1820807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1821807b0860SAlexei Avshalom Lazar 	};
1822e6d68341SDedy Lansky 
1823e6d68341SDedy Lansky 	wil_dbg_wmi(wil, "sending WMI_START_LISTEN_CMDID\n");
1824e6d68341SDedy Lansky 
1825e00243faSLior David 	rc = wmi_call(wil, WMI_START_LISTEN_CMDID, vif->mid, NULL, 0,
1826e6d68341SDedy Lansky 		      WMI_LISTEN_STARTED_EVENTID, &reply, sizeof(reply), 300);
1827e6d68341SDedy Lansky 	if (!rc && reply.evt.status != WMI_FW_STATUS_SUCCESS) {
1828e6d68341SDedy Lansky 		wil_err(wil, "device failed to start listen. status %d\n",
1829e6d68341SDedy Lansky 			reply.evt.status);
1830e6d68341SDedy Lansky 		rc = -EINVAL;
1831e6d68341SDedy Lansky 	}
1832e6d68341SDedy Lansky 
1833e6d68341SDedy Lansky 	return rc;
1834e6d68341SDedy Lansky }
1835e6d68341SDedy Lansky 
1836e00243faSLior David int wmi_start_search(struct wil6210_vif *vif)
1837e6d68341SDedy Lansky {
1838e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1839e6d68341SDedy Lansky 	int rc;
1840e6d68341SDedy Lansky 	struct {
1841e6d68341SDedy Lansky 		struct wmi_cmd_hdr wmi;
1842e6d68341SDedy Lansky 		struct wmi_search_started_event evt;
1843807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1844807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1845807b0860SAlexei Avshalom Lazar 	};
1846e6d68341SDedy Lansky 
1847e6d68341SDedy Lansky 	wil_dbg_wmi(wil, "sending WMI_START_SEARCH_CMDID\n");
1848e6d68341SDedy Lansky 
1849e00243faSLior David 	rc = wmi_call(wil, WMI_START_SEARCH_CMDID, vif->mid, NULL, 0,
1850e6d68341SDedy Lansky 		      WMI_SEARCH_STARTED_EVENTID, &reply, sizeof(reply), 300);
1851e6d68341SDedy Lansky 	if (!rc && reply.evt.status != WMI_FW_STATUS_SUCCESS) {
1852e6d68341SDedy Lansky 		wil_err(wil, "device failed to start search. status %d\n",
1853e6d68341SDedy Lansky 			reply.evt.status);
1854e6d68341SDedy Lansky 		rc = -EINVAL;
1855e6d68341SDedy Lansky 	}
1856e6d68341SDedy Lansky 
1857e6d68341SDedy Lansky 	return rc;
1858e6d68341SDedy Lansky }
1859e6d68341SDedy Lansky 
1860e00243faSLior David int wmi_stop_discovery(struct wil6210_vif *vif)
1861e6d68341SDedy Lansky {
1862e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
1863e6d68341SDedy Lansky 	int rc;
1864e6d68341SDedy Lansky 
1865e6d68341SDedy Lansky 	wil_dbg_wmi(wil, "sending WMI_DISCOVERY_STOP_CMDID\n");
1866e6d68341SDedy Lansky 
1867e00243faSLior David 	rc = wmi_call(wil, WMI_DISCOVERY_STOP_CMDID, vif->mid, NULL, 0,
1868e6d68341SDedy Lansky 		      WMI_DISCOVERY_STOPPED_EVENTID, NULL, 0, 100);
1869e6d68341SDedy Lansky 
1870e6d68341SDedy Lansky 	if (rc)
1871e6d68341SDedy Lansky 		wil_err(wil, "Failed to stop discovery\n");
1872e6d68341SDedy Lansky 
1873e6d68341SDedy Lansky 	return rc;
1874b8023177SVladimir Kondratiev }
1875b8023177SVladimir Kondratiev 
1876e00243faSLior David int wmi_del_cipher_key(struct wil6210_vif *vif, u8 key_index,
1877230d8442SVladimir Kondratiev 		       const void *mac_addr, int key_usage)
18782be7d22fSVladimir Kondratiev {
1879e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
18802be7d22fSVladimir Kondratiev 	struct wmi_delete_cipher_key_cmd cmd = {
18812be7d22fSVladimir Kondratiev 		.key_index = key_index,
18822be7d22fSVladimir Kondratiev 	};
18832be7d22fSVladimir Kondratiev 
18842be7d22fSVladimir Kondratiev 	if (mac_addr)
18852be7d22fSVladimir Kondratiev 		memcpy(cmd.mac, mac_addr, WMI_MAC_LEN);
18862be7d22fSVladimir Kondratiev 
1887e00243faSLior David 	return wmi_send(wil, WMI_DELETE_CIPHER_KEY_CMDID, vif->mid,
1888e00243faSLior David 			&cmd, sizeof(cmd));
18892be7d22fSVladimir Kondratiev }
18902be7d22fSVladimir Kondratiev 
1891e00243faSLior David int wmi_add_cipher_key(struct wil6210_vif *vif, u8 key_index,
1892230d8442SVladimir Kondratiev 		       const void *mac_addr, int key_len, const void *key,
1893230d8442SVladimir Kondratiev 		       int key_usage)
18942be7d22fSVladimir Kondratiev {
1895e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
18962be7d22fSVladimir Kondratiev 	struct wmi_add_cipher_key_cmd cmd = {
18972be7d22fSVladimir Kondratiev 		.key_index = key_index,
1898230d8442SVladimir Kondratiev 		.key_usage = key_usage,
18992be7d22fSVladimir Kondratiev 		.key_len = key_len,
19002be7d22fSVladimir Kondratiev 	};
19012be7d22fSVladimir Kondratiev 
19022be7d22fSVladimir Kondratiev 	if (!key || (key_len > sizeof(cmd.key)))
19032be7d22fSVladimir Kondratiev 		return -EINVAL;
19042be7d22fSVladimir Kondratiev 
19052be7d22fSVladimir Kondratiev 	memcpy(cmd.key, key, key_len);
19062be7d22fSVladimir Kondratiev 	if (mac_addr)
19072be7d22fSVladimir Kondratiev 		memcpy(cmd.mac, mac_addr, WMI_MAC_LEN);
19082be7d22fSVladimir Kondratiev 
1909e00243faSLior David 	return wmi_send(wil, WMI_ADD_CIPHER_KEY_CMDID, vif->mid,
1910e00243faSLior David 			&cmd, sizeof(cmd));
19112be7d22fSVladimir Kondratiev }
19122be7d22fSVladimir Kondratiev 
1913e00243faSLior David int wmi_set_ie(struct wil6210_vif *vif, u8 type, u16 ie_len, const void *ie)
19142be7d22fSVladimir Kondratiev {
1915e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
19165421bf0cSVladimir Kondratiev 	static const char *const names[] = {
19175421bf0cSVladimir Kondratiev 		[WMI_FRAME_BEACON]	= "BEACON",
19185421bf0cSVladimir Kondratiev 		[WMI_FRAME_PROBE_REQ]	= "PROBE_REQ",
19195421bf0cSVladimir Kondratiev 		[WMI_FRAME_PROBE_RESP]	= "WMI_FRAME_PROBE_RESP",
19205421bf0cSVladimir Kondratiev 		[WMI_FRAME_ASSOC_REQ]	= "WMI_FRAME_ASSOC_REQ",
19215421bf0cSVladimir Kondratiev 		[WMI_FRAME_ASSOC_RESP]	= "WMI_FRAME_ASSOC_RESP",
19225421bf0cSVladimir Kondratiev 	};
19232be7d22fSVladimir Kondratiev 	int rc;
19242be7d22fSVladimir Kondratiev 	u16 len = sizeof(struct wmi_set_appie_cmd) + ie_len;
1925b5a8ffcaSLior David 	struct wmi_set_appie_cmd *cmd;
19268fe59627SVladimir Kondratiev 
1927b5a8ffcaSLior David 	if (len < ie_len) {
1928b5a8ffcaSLior David 		rc = -EINVAL;
1929b5a8ffcaSLior David 		goto out;
1930b5a8ffcaSLior David 	}
1931b5a8ffcaSLior David 
1932b5a8ffcaSLior David 	cmd = kzalloc(len, GFP_KERNEL);
19335421bf0cSVladimir Kondratiev 	if (!cmd) {
19345421bf0cSVladimir Kondratiev 		rc = -ENOMEM;
19355421bf0cSVladimir Kondratiev 		goto out;
19365421bf0cSVladimir Kondratiev 	}
1937ac4acdb7SVladimir Kondratiev 	if (!ie)
1938ac4acdb7SVladimir Kondratiev 		ie_len = 0;
19392be7d22fSVladimir Kondratiev 
19402be7d22fSVladimir Kondratiev 	cmd->mgmt_frm_type = type;
19412be7d22fSVladimir Kondratiev 	/* BUG: FW API define ieLen as u8. Will fix FW */
19422be7d22fSVladimir Kondratiev 	cmd->ie_len = cpu_to_le16(ie_len);
19432be7d22fSVladimir Kondratiev 	memcpy(cmd->ie_info, ie, ie_len);
1944e00243faSLior David 	rc = wmi_send(wil, WMI_SET_APPIE_CMDID, vif->mid, cmd, len);
19452be7d22fSVladimir Kondratiev 	kfree(cmd);
19465421bf0cSVladimir Kondratiev out:
19475421bf0cSVladimir Kondratiev 	if (rc) {
19485421bf0cSVladimir Kondratiev 		const char *name = type < ARRAY_SIZE(names) ?
19495421bf0cSVladimir Kondratiev 				   names[type] : "??";
19505421bf0cSVladimir Kondratiev 		wil_err(wil, "set_ie(%d %s) failed : %d\n", type, name, rc);
19515421bf0cSVladimir Kondratiev 	}
19522be7d22fSVladimir Kondratiev 
19532be7d22fSVladimir Kondratiev 	return rc;
19542be7d22fSVladimir Kondratiev }
19552be7d22fSVladimir Kondratiev 
19561647f12fSVladimir Kondratiev /**
19571647f12fSVladimir Kondratiev  * wmi_rxon - turn radio on/off
19581647f12fSVladimir Kondratiev  * @on:		turn on if true, off otherwise
19591647f12fSVladimir Kondratiev  *
19601647f12fSVladimir Kondratiev  * Only switch radio. Channel should be set separately.
19611647f12fSVladimir Kondratiev  * No timeout for rxon - radio turned on forever unless some other call
19621647f12fSVladimir Kondratiev  * turns it off
19631647f12fSVladimir Kondratiev  */
19641647f12fSVladimir Kondratiev int wmi_rxon(struct wil6210_priv *wil, bool on)
19651647f12fSVladimir Kondratiev {
1966e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
19671647f12fSVladimir Kondratiev 	int rc;
19681647f12fSVladimir Kondratiev 	struct {
1969b874ddecSLior David 		struct wmi_cmd_hdr wmi;
19701647f12fSVladimir Kondratiev 		struct wmi_listen_started_event evt;
1971807b0860SAlexei Avshalom Lazar 	} __packed reply = {
1972807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
1973807b0860SAlexei Avshalom Lazar 	};
19741647f12fSVladimir Kondratiev 
1975af3db60aSLazar Alexei 	wil_info(wil, "(%s)\n", on ? "on" : "off");
19761647f12fSVladimir Kondratiev 
19771647f12fSVladimir Kondratiev 	if (on) {
1978e00243faSLior David 		rc = wmi_call(wil, WMI_START_LISTEN_CMDID, vif->mid, NULL, 0,
19791647f12fSVladimir Kondratiev 			      WMI_LISTEN_STARTED_EVENTID,
19801647f12fSVladimir Kondratiev 			      &reply, sizeof(reply), 100);
19811647f12fSVladimir Kondratiev 		if ((rc == 0) && (reply.evt.status != WMI_FW_STATUS_SUCCESS))
19821647f12fSVladimir Kondratiev 			rc = -EINVAL;
19831647f12fSVladimir Kondratiev 	} else {
1984e00243faSLior David 		rc = wmi_call(wil, WMI_DISCOVERY_STOP_CMDID, vif->mid, NULL, 0,
19851647f12fSVladimir Kondratiev 			      WMI_DISCOVERY_STOPPED_EVENTID, NULL, 0, 20);
19861647f12fSVladimir Kondratiev 	}
19871647f12fSVladimir Kondratiev 
19881647f12fSVladimir Kondratiev 	return rc;
19891647f12fSVladimir Kondratiev }
19901647f12fSVladimir Kondratiev 
199110590c6aSGidon Studinski int wmi_rx_chain_add(struct wil6210_priv *wil, struct wil_ring *vring)
199247e19af9SVladimir Kondratiev {
1993e00243faSLior David 	struct net_device *ndev = wil->main_ndev;
1994e00243faSLior David 	struct wireless_dev *wdev = ndev->ieee80211_ptr;
1995e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(ndev);
199647e19af9SVladimir Kondratiev 	struct wmi_cfg_rx_chain_cmd cmd = {
199747e19af9SVladimir Kondratiev 		.action = WMI_RX_CHAIN_ADD,
199847e19af9SVladimir Kondratiev 		.rx_sw_ring = {
199952a45702SLior David 			.max_mpdu_size = cpu_to_le16(
200052a45702SLior David 				wil_mtu2macbuf(wil->rx_buf_len)),
200147e19af9SVladimir Kondratiev 			.ring_mem_base = cpu_to_le64(vring->pa),
200247e19af9SVladimir Kondratiev 			.ring_size = cpu_to_le16(vring->size),
200347e19af9SVladimir Kondratiev 		},
200447e19af9SVladimir Kondratiev 		.mid = 0, /* TODO - what is it? */
200547e19af9SVladimir Kondratiev 		.decap_trans_type = WMI_DECAP_TYPE_802_3,
2006b4490f42SVladimir Kondratiev 		.reorder_type = WMI_RX_SW_REORDER,
2007ab954628SVladimir Kondratiev 		.host_thrsh = cpu_to_le16(rx_ring_overflow_thrsh),
200847e19af9SVladimir Kondratiev 	};
200947e19af9SVladimir Kondratiev 	struct {
2010b874ddecSLior David 		struct wmi_cmd_hdr wmi;
201147e19af9SVladimir Kondratiev 		struct wmi_cfg_rx_chain_done_event evt;
201247e19af9SVladimir Kondratiev 	} __packed evt;
201347e19af9SVladimir Kondratiev 	int rc;
201447e19af9SVladimir Kondratiev 
2015807b0860SAlexei Avshalom Lazar 	memset(&evt, 0, sizeof(evt));
2016807b0860SAlexei Avshalom Lazar 
201747e19af9SVladimir Kondratiev 	if (wdev->iftype == NL80211_IFTYPE_MONITOR) {
20187d3e4dbeSLior David 		struct ieee80211_channel *ch = wil->monitor_chandef.chan;
201947e19af9SVladimir Kondratiev 
202047e19af9SVladimir Kondratiev 		cmd.sniffer_cfg.mode = cpu_to_le32(WMI_SNIFFER_ON);
202147e19af9SVladimir Kondratiev 		if (ch)
202247e19af9SVladimir Kondratiev 			cmd.sniffer_cfg.channel = ch->hw_value - 1;
202347e19af9SVladimir Kondratiev 		cmd.sniffer_cfg.phy_info_mode =
202447e19af9SVladimir Kondratiev 			cpu_to_le32(ndev->type == ARPHRD_IEEE80211_RADIOTAP);
202547e19af9SVladimir Kondratiev 		cmd.sniffer_cfg.phy_support =
202647e19af9SVladimir Kondratiev 			cpu_to_le32((wil->monitor_flags & MONITOR_FLAG_CONTROL)
20274765332dSVladimir Kondratiev 				    ? WMI_SNIFFER_CP : WMI_SNIFFER_BOTH_PHYS);
2028504937d4SKirshenbaum Erez 	} else {
2029504937d4SKirshenbaum Erez 		/* Initialize offload (in non-sniffer mode).
2030504937d4SKirshenbaum Erez 		 * Linux IP stack always calculates IP checksum
2031504937d4SKirshenbaum Erez 		 * HW always calculate TCP/UDP checksum
2032504937d4SKirshenbaum Erez 		 */
2033504937d4SKirshenbaum Erez 		cmd.l3_l4_ctrl |= (1 << L3_L4_CTRL_TCPIP_CHECKSUM_EN_POS);
203447e19af9SVladimir Kondratiev 	}
2035c406ea7cSVladimir Kondratiev 
2036c406ea7cSVladimir Kondratiev 	if (rx_align_2)
2037c406ea7cSVladimir Kondratiev 		cmd.l2_802_3_offload_ctrl |=
2038c406ea7cSVladimir Kondratiev 				L2_802_3_OFFLOAD_CTRL_SNAP_KEEP_MSK;
2039c406ea7cSVladimir Kondratiev 
204047e19af9SVladimir Kondratiev 	/* typical time for secure PCP is 840ms */
2041e00243faSLior David 	rc = wmi_call(wil, WMI_CFG_RX_CHAIN_CMDID, vif->mid, &cmd, sizeof(cmd),
204247e19af9SVladimir Kondratiev 		      WMI_CFG_RX_CHAIN_DONE_EVENTID, &evt, sizeof(evt), 2000);
204347e19af9SVladimir Kondratiev 	if (rc)
204447e19af9SVladimir Kondratiev 		return rc;
204547e19af9SVladimir Kondratiev 
2046807b0860SAlexei Avshalom Lazar 	if (le32_to_cpu(evt.evt.status) != WMI_CFG_RX_CHAIN_SUCCESS)
2047807b0860SAlexei Avshalom Lazar 		rc = -EINVAL;
2048807b0860SAlexei Avshalom Lazar 
204947e19af9SVladimir Kondratiev 	vring->hwtail = le32_to_cpu(evt.evt.rx_ring_tail_ptr);
205047e19af9SVladimir Kondratiev 
20517743882dSVladimir Kondratiev 	wil_dbg_misc(wil, "Rx init: status %d tail 0x%08x\n",
205247e19af9SVladimir Kondratiev 		     le32_to_cpu(evt.evt.status), vring->hwtail);
205347e19af9SVladimir Kondratiev 
205447e19af9SVladimir Kondratiev 	return rc;
205547e19af9SVladimir Kondratiev }
205647e19af9SVladimir Kondratiev 
20578c679675SVladimir Kondratiev int wmi_get_temperature(struct wil6210_priv *wil, u32 *t_bb, u32 *t_rf)
20581a2780e0SVladimir Kondratiev {
2059e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
20601a2780e0SVladimir Kondratiev 	int rc;
20611a2780e0SVladimir Kondratiev 	struct wmi_temp_sense_cmd cmd = {
20628c679675SVladimir Kondratiev 		.measure_baseband_en = cpu_to_le32(!!t_bb),
20638c679675SVladimir Kondratiev 		.measure_rf_en = cpu_to_le32(!!t_rf),
20648c679675SVladimir Kondratiev 		.measure_mode = cpu_to_le32(TEMPERATURE_MEASURE_NOW),
20651a2780e0SVladimir Kondratiev 	};
20661a2780e0SVladimir Kondratiev 	struct {
2067b874ddecSLior David 		struct wmi_cmd_hdr wmi;
20681a2780e0SVladimir Kondratiev 		struct wmi_temp_sense_done_event evt;
20691a2780e0SVladimir Kondratiev 	} __packed reply;
20701a2780e0SVladimir Kondratiev 
2071807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
2072807b0860SAlexei Avshalom Lazar 
2073e00243faSLior David 	rc = wmi_call(wil, WMI_TEMP_SENSE_CMDID, vif->mid, &cmd, sizeof(cmd),
20741a2780e0SVladimir Kondratiev 		      WMI_TEMP_SENSE_DONE_EVENTID, &reply, sizeof(reply), 100);
20751a2780e0SVladimir Kondratiev 	if (rc)
20761a2780e0SVladimir Kondratiev 		return rc;
20771a2780e0SVladimir Kondratiev 
20788c679675SVladimir Kondratiev 	if (t_bb)
20798c679675SVladimir Kondratiev 		*t_bb = le32_to_cpu(reply.evt.baseband_t1000);
20808c679675SVladimir Kondratiev 	if (t_rf)
20818c679675SVladimir Kondratiev 		*t_rf = le32_to_cpu(reply.evt.rf_t1000);
20821a2780e0SVladimir Kondratiev 
20831a2780e0SVladimir Kondratiev 	return 0;
20841a2780e0SVladimir Kondratiev }
20851a2780e0SVladimir Kondratiev 
2086e00243faSLior David int wmi_disconnect_sta(struct wil6210_vif *vif, const u8 *mac,
2087849a564bSDedy Lansky 		       u16 reason, bool full_disconnect, bool del_sta)
20884d55a0a1SVladimir Kondratiev {
2089e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
20903e9191fcSVladimir Kondratiev 	int rc;
20913e9191fcSVladimir Kondratiev 	u16 reason_code;
2092849a564bSDedy Lansky 	struct wmi_disconnect_sta_cmd disc_sta_cmd = {
2093849a564bSDedy Lansky 		.disconnect_reason = cpu_to_le16(reason),
2094849a564bSDedy Lansky 	};
2095849a564bSDedy Lansky 	struct wmi_del_sta_cmd del_sta_cmd = {
20964d55a0a1SVladimir Kondratiev 		.disconnect_reason = cpu_to_le16(reason),
20974d55a0a1SVladimir Kondratiev 	};
20983e9191fcSVladimir Kondratiev 	struct {
2099b874ddecSLior David 		struct wmi_cmd_hdr wmi;
21003e9191fcSVladimir Kondratiev 		struct wmi_disconnect_event evt;
21013e9191fcSVladimir Kondratiev 	} __packed reply;
2102a82553bbSVladimir Kondratiev 
2103af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "disconnect_sta: (%pM, reason %d)\n", mac, reason);
21044d55a0a1SVladimir Kondratiev 
2105807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
2106e00243faSLior David 	vif->locally_generated_disc = true;
2107849a564bSDedy Lansky 	if (del_sta) {
2108849a564bSDedy Lansky 		ether_addr_copy(del_sta_cmd.dst_mac, mac);
2109e00243faSLior David 		rc = wmi_call(wil, WMI_DEL_STA_CMDID, vif->mid, &del_sta_cmd,
2110849a564bSDedy Lansky 			      sizeof(del_sta_cmd), WMI_DISCONNECT_EVENTID,
2111849a564bSDedy Lansky 			      &reply, sizeof(reply), 1000);
2112849a564bSDedy Lansky 	} else {
2113849a564bSDedy Lansky 		ether_addr_copy(disc_sta_cmd.dst_mac, mac);
2114e00243faSLior David 		rc = wmi_call(wil, WMI_DISCONNECT_STA_CMDID, vif->mid,
2115e00243faSLior David 			      &disc_sta_cmd, sizeof(disc_sta_cmd),
2116e00243faSLior David 			      WMI_DISCONNECT_EVENTID,
2117849a564bSDedy Lansky 			      &reply, sizeof(reply), 1000);
2118849a564bSDedy Lansky 	}
21193e9191fcSVladimir Kondratiev 	/* failure to disconnect in reasonable time treated as FW error */
21203e9191fcSVladimir Kondratiev 	if (rc) {
21213e9191fcSVladimir Kondratiev 		wil_fw_error_recovery(wil);
21223e9191fcSVladimir Kondratiev 		return rc;
21233e9191fcSVladimir Kondratiev 	}
21243e9191fcSVladimir Kondratiev 
21250916d9f2SMaya Erez 	if (full_disconnect) {
21263e9191fcSVladimir Kondratiev 		/* call event handler manually after processing wmi_call,
21270916d9f2SMaya Erez 		 * to avoid deadlock - disconnect event handler acquires
21280916d9f2SMaya Erez 		 * wil->mutex while it is already held here
21293e9191fcSVladimir Kondratiev 		 */
21303e9191fcSVladimir Kondratiev 		reason_code = le16_to_cpu(reply.evt.protocol_reason_status);
21313e9191fcSVladimir Kondratiev 
21323e9191fcSVladimir Kondratiev 		wil_dbg_wmi(wil, "Disconnect %pM reason [proto %d wmi %d]\n",
21333e9191fcSVladimir Kondratiev 			    reply.evt.bssid, reason_code,
21343e9191fcSVladimir Kondratiev 			    reply.evt.disconnect_reason);
21353e9191fcSVladimir Kondratiev 
21363e9191fcSVladimir Kondratiev 		wil->sinfo_gen++;
2137e00243faSLior David 		wil6210_disconnect(vif, reply.evt.bssid, reason_code, true);
21380916d9f2SMaya Erez 	}
21393e9191fcSVladimir Kondratiev 	return 0;
21404d55a0a1SVladimir Kondratiev }
21414d55a0a1SVladimir Kondratiev 
2142e00243faSLior David int wmi_addba(struct wil6210_priv *wil, u8 mid,
2143e00243faSLior David 	      u8 ringid, u8 size, u16 timeout)
21443277213fSVladimir Kondratiev {
21457be13fc3SGidon Studinski 	u8 amsdu = wil->use_enhanced_dma_hw && wil->use_rx_hw_reordering &&
21467be13fc3SGidon Studinski 		test_bit(WMI_FW_CAPABILITY_AMSDU, wil->fw_capabilities) &&
21477be13fc3SGidon Studinski 		wil->amsdu_en;
214896c93589SGidon Studinski 	struct wmi_ring_ba_en_cmd cmd = {
214996c93589SGidon Studinski 		.ring_id = ringid,
21503277213fSVladimir Kondratiev 		.agg_max_wsize = size,
21513277213fSVladimir Kondratiev 		.ba_timeout = cpu_to_le16(timeout),
21527be13fc3SGidon Studinski 		.amsdu = amsdu,
21533277213fSVladimir Kondratiev 	};
21543277213fSVladimir Kondratiev 
21557be13fc3SGidon Studinski 	wil_dbg_wmi(wil, "addba: (ring %d size %d timeout %d amsdu %d)\n",
21567be13fc3SGidon Studinski 		    ringid, size, timeout, amsdu);
21573277213fSVladimir Kondratiev 
215896c93589SGidon Studinski 	return wmi_send(wil, WMI_RING_BA_EN_CMDID, mid, &cmd, sizeof(cmd));
21593277213fSVladimir Kondratiev }
21603277213fSVladimir Kondratiev 
2161e00243faSLior David int wmi_delba_tx(struct wil6210_priv *wil, u8 mid, u8 ringid, u16 reason)
21623277213fSVladimir Kondratiev {
216396c93589SGidon Studinski 	struct wmi_ring_ba_dis_cmd cmd = {
216496c93589SGidon Studinski 		.ring_id = ringid,
21653277213fSVladimir Kondratiev 		.reason = cpu_to_le16(reason),
21663277213fSVladimir Kondratiev 	};
21673277213fSVladimir Kondratiev 
2168af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "delba_tx: (ring %d reason %d)\n", ringid, reason);
21693277213fSVladimir Kondratiev 
217096c93589SGidon Studinski 	return wmi_send(wil, WMI_RING_BA_DIS_CMDID, mid, &cmd, sizeof(cmd));
21713277213fSVladimir Kondratiev }
21723277213fSVladimir Kondratiev 
2173e00243faSLior David int wmi_delba_rx(struct wil6210_priv *wil, u8 mid, u8 cidxtid, u16 reason)
217426a359d9SVladimir Kondratiev {
217526a359d9SVladimir Kondratiev 	struct wmi_rcp_delba_cmd cmd = {
217626a359d9SVladimir Kondratiev 		.cidxtid = cidxtid,
217726a359d9SVladimir Kondratiev 		.reason = cpu_to_le16(reason),
217826a359d9SVladimir Kondratiev 	};
217926a359d9SVladimir Kondratiev 
2180af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "delba_rx: (CID %d TID %d reason %d)\n", cidxtid & 0xf,
2181af3db60aSLazar Alexei 		    (cidxtid >> 4) & 0xf, reason);
218226a359d9SVladimir Kondratiev 
2183e00243faSLior David 	return wmi_send(wil, WMI_RCP_DELBA_CMDID, mid, &cmd, sizeof(cmd));
218426a359d9SVladimir Kondratiev }
218526a359d9SVladimir Kondratiev 
2186e00243faSLior David int wmi_addba_rx_resp(struct wil6210_priv *wil,
2187e00243faSLior David 		      u8 mid, u8 cid, u8 tid, u8 token,
21883277213fSVladimir Kondratiev 		      u16 status, bool amsdu, u16 agg_wsize, u16 timeout)
21893277213fSVladimir Kondratiev {
21903277213fSVladimir Kondratiev 	int rc;
21913277213fSVladimir Kondratiev 	struct wmi_rcp_addba_resp_cmd cmd = {
21923277213fSVladimir Kondratiev 		.cidxtid = mk_cidxtid(cid, tid),
21933277213fSVladimir Kondratiev 		.dialog_token = token,
21943277213fSVladimir Kondratiev 		.status_code = cpu_to_le16(status),
21953277213fSVladimir Kondratiev 		/* bit 0: A-MSDU supported
21963277213fSVladimir Kondratiev 		 * bit 1: policy (should be 0 for us)
21973277213fSVladimir Kondratiev 		 * bits 2..5: TID
21983277213fSVladimir Kondratiev 		 * bits 6..15: buffer size
21993277213fSVladimir Kondratiev 		 */
22003277213fSVladimir Kondratiev 		.ba_param_set = cpu_to_le16((amsdu ? 1 : 0) | (tid << 2) |
22013277213fSVladimir Kondratiev 					    (agg_wsize << 6)),
22023277213fSVladimir Kondratiev 		.ba_timeout = cpu_to_le16(timeout),
22033277213fSVladimir Kondratiev 	};
22043277213fSVladimir Kondratiev 	struct {
2205b874ddecSLior David 		struct wmi_cmd_hdr wmi;
22063277213fSVladimir Kondratiev 		struct wmi_rcp_addba_resp_sent_event evt;
2207807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2208807b0860SAlexei Avshalom Lazar 		.evt = {.status = cpu_to_le16(WMI_FW_STATUS_FAILURE)},
2209807b0860SAlexei Avshalom Lazar 	};
22103277213fSVladimir Kondratiev 
22113277213fSVladimir Kondratiev 	wil_dbg_wmi(wil,
2212e00243faSLior David 		    "ADDBA response for MID %d CID %d TID %d size %d timeout %d status %d AMSDU%s\n",
2213e00243faSLior David 		    mid, cid, tid, agg_wsize,
2214e00243faSLior David 		    timeout, status, amsdu ? "+" : "-");
22153277213fSVladimir Kondratiev 
2216e00243faSLior David 	rc = wmi_call(wil, WMI_RCP_ADDBA_RESP_CMDID, mid, &cmd, sizeof(cmd),
2217230d8442SVladimir Kondratiev 		      WMI_RCP_ADDBA_RESP_SENT_EVENTID, &reply, sizeof(reply),
2218230d8442SVladimir Kondratiev 		      100);
22193277213fSVladimir Kondratiev 	if (rc)
22203277213fSVladimir Kondratiev 		return rc;
22213277213fSVladimir Kondratiev 
22223277213fSVladimir Kondratiev 	if (reply.evt.status) {
22233277213fSVladimir Kondratiev 		wil_err(wil, "ADDBA response failed with status %d\n",
22243277213fSVladimir Kondratiev 			le16_to_cpu(reply.evt.status));
22253277213fSVladimir Kondratiev 		rc = -EINVAL;
22263277213fSVladimir Kondratiev 	}
22273277213fSVladimir Kondratiev 
22283277213fSVladimir Kondratiev 	return rc;
22293277213fSVladimir Kondratiev }
22303277213fSVladimir Kondratiev 
22317be13fc3SGidon Studinski int wmi_addba_rx_resp_edma(struct wil6210_priv *wil, u8 mid, u8 cid, u8 tid,
22327be13fc3SGidon Studinski 			   u8 token, u16 status, bool amsdu, u16 agg_wsize,
22337be13fc3SGidon Studinski 			   u16 timeout)
22347be13fc3SGidon Studinski {
22357be13fc3SGidon Studinski 	int rc;
22367be13fc3SGidon Studinski 	struct wmi_rcp_addba_resp_edma_cmd cmd = {
22377be13fc3SGidon Studinski 		.cid = cid,
22387be13fc3SGidon Studinski 		.tid = tid,
22397be13fc3SGidon Studinski 		.dialog_token = token,
22407be13fc3SGidon Studinski 		.status_code = cpu_to_le16(status),
22417be13fc3SGidon Studinski 		/* bit 0: A-MSDU supported
22427be13fc3SGidon Studinski 		 * bit 1: policy (should be 0 for us)
22437be13fc3SGidon Studinski 		 * bits 2..5: TID
22447be13fc3SGidon Studinski 		 * bits 6..15: buffer size
22457be13fc3SGidon Studinski 		 */
22467be13fc3SGidon Studinski 		.ba_param_set = cpu_to_le16((amsdu ? 1 : 0) | (tid << 2) |
22477be13fc3SGidon Studinski 					    (agg_wsize << 6)),
22487be13fc3SGidon Studinski 		.ba_timeout = cpu_to_le16(timeout),
22497be13fc3SGidon Studinski 		/* route all the connections to status ring 0 */
22507be13fc3SGidon Studinski 		.status_ring_id = WIL_DEFAULT_RX_STATUS_RING_ID,
22517be13fc3SGidon Studinski 	};
22527be13fc3SGidon Studinski 	struct {
22537be13fc3SGidon Studinski 		struct wmi_cmd_hdr wmi;
22547be13fc3SGidon Studinski 		struct wmi_rcp_addba_resp_sent_event evt;
22557be13fc3SGidon Studinski 	} __packed reply = {
22567be13fc3SGidon Studinski 		.evt = {.status = cpu_to_le16(WMI_FW_STATUS_FAILURE)},
22577be13fc3SGidon Studinski 	};
22587be13fc3SGidon Studinski 
22597be13fc3SGidon Studinski 	wil_dbg_wmi(wil,
22607be13fc3SGidon Studinski 		    "ADDBA response for CID %d TID %d size %d timeout %d status %d AMSDU%s, sring_id %d\n",
22617be13fc3SGidon Studinski 		    cid, tid, agg_wsize, timeout, status, amsdu ? "+" : "-",
22627be13fc3SGidon Studinski 		    WIL_DEFAULT_RX_STATUS_RING_ID);
22637be13fc3SGidon Studinski 
22647be13fc3SGidon Studinski 	rc = wmi_call(wil, WMI_RCP_ADDBA_RESP_EDMA_CMDID, mid, &cmd,
22657be13fc3SGidon Studinski 		      sizeof(cmd), WMI_RCP_ADDBA_RESP_SENT_EVENTID, &reply,
22667be13fc3SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
22677be13fc3SGidon Studinski 	if (rc)
22687be13fc3SGidon Studinski 		return rc;
22697be13fc3SGidon Studinski 
22707be13fc3SGidon Studinski 	if (reply.evt.status) {
22717be13fc3SGidon Studinski 		wil_err(wil, "ADDBA response failed with status %d\n",
22727be13fc3SGidon Studinski 			le16_to_cpu(reply.evt.status));
22737be13fc3SGidon Studinski 		rc = -EINVAL;
22747be13fc3SGidon Studinski 	}
22757be13fc3SGidon Studinski 
22767be13fc3SGidon Studinski 	return rc;
22777be13fc3SGidon Studinski }
22787be13fc3SGidon Studinski 
22792c207eb8SMaya Erez int wmi_ps_dev_profile_cfg(struct wil6210_priv *wil,
22802c207eb8SMaya Erez 			   enum wmi_ps_profile_type ps_profile)
22812c207eb8SMaya Erez {
2282e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
22832c207eb8SMaya Erez 	int rc;
22842c207eb8SMaya Erez 	struct wmi_ps_dev_profile_cfg_cmd cmd = {
22852c207eb8SMaya Erez 		.ps_profile = ps_profile,
22862c207eb8SMaya Erez 	};
22872c207eb8SMaya Erez 	struct {
22882c207eb8SMaya Erez 		struct wmi_cmd_hdr wmi;
22892c207eb8SMaya Erez 		struct wmi_ps_dev_profile_cfg_event evt;
2290807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2291807b0860SAlexei Avshalom Lazar 		.evt = {.status = cpu_to_le32(WMI_PS_CFG_CMD_STATUS_ERROR)},
2292807b0860SAlexei Avshalom Lazar 	};
22932c207eb8SMaya Erez 	u32 status;
22942c207eb8SMaya Erez 
22952c207eb8SMaya Erez 	wil_dbg_wmi(wil, "Setting ps dev profile %d\n", ps_profile);
22962c207eb8SMaya Erez 
2297e00243faSLior David 	rc = wmi_call(wil, WMI_PS_DEV_PROFILE_CFG_CMDID, vif->mid,
2298e00243faSLior David 		      &cmd, sizeof(cmd),
22992c207eb8SMaya Erez 		      WMI_PS_DEV_PROFILE_CFG_EVENTID, &reply, sizeof(reply),
23002c207eb8SMaya Erez 		      100);
23012c207eb8SMaya Erez 	if (rc)
23022c207eb8SMaya Erez 		return rc;
23032c207eb8SMaya Erez 
23042c207eb8SMaya Erez 	status = le32_to_cpu(reply.evt.status);
23052c207eb8SMaya Erez 
23062c207eb8SMaya Erez 	if (status != WMI_PS_CFG_CMD_STATUS_SUCCESS) {
23072c207eb8SMaya Erez 		wil_err(wil, "ps dev profile cfg failed with status %d\n",
23082c207eb8SMaya Erez 			status);
23092c207eb8SMaya Erez 		rc = -EINVAL;
23102c207eb8SMaya Erez 	}
23112c207eb8SMaya Erez 
23122c207eb8SMaya Erez 	return rc;
23132c207eb8SMaya Erez }
23142c207eb8SMaya Erez 
23153fea18d0SLior David int wmi_set_mgmt_retry(struct wil6210_priv *wil, u8 retry_short)
23163fea18d0SLior David {
2317e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
23183fea18d0SLior David 	int rc;
23193fea18d0SLior David 	struct wmi_set_mgmt_retry_limit_cmd cmd = {
23203fea18d0SLior David 		.mgmt_retry_limit = retry_short,
23213fea18d0SLior David 	};
23223fea18d0SLior David 	struct {
23233fea18d0SLior David 		struct wmi_cmd_hdr wmi;
23243fea18d0SLior David 		struct wmi_set_mgmt_retry_limit_event evt;
2325807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2326807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
2327807b0860SAlexei Avshalom Lazar 	};
23283fea18d0SLior David 
23293fea18d0SLior David 	wil_dbg_wmi(wil, "Setting mgmt retry short %d\n", retry_short);
23303fea18d0SLior David 
23313fea18d0SLior David 	if (!test_bit(WMI_FW_CAPABILITY_MGMT_RETRY_LIMIT, wil->fw_capabilities))
23323fea18d0SLior David 		return -ENOTSUPP;
23333fea18d0SLior David 
2334e00243faSLior David 	rc = wmi_call(wil, WMI_SET_MGMT_RETRY_LIMIT_CMDID, vif->mid,
2335e00243faSLior David 		      &cmd, sizeof(cmd),
23363fea18d0SLior David 		      WMI_SET_MGMT_RETRY_LIMIT_EVENTID, &reply, sizeof(reply),
23373fea18d0SLior David 		      100);
23383fea18d0SLior David 	if (rc)
23393fea18d0SLior David 		return rc;
23403fea18d0SLior David 
23413fea18d0SLior David 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
23423fea18d0SLior David 		wil_err(wil, "set mgmt retry limit failed with status %d\n",
23433fea18d0SLior David 			reply.evt.status);
23443fea18d0SLior David 		rc = -EINVAL;
23453fea18d0SLior David 	}
23463fea18d0SLior David 
23473fea18d0SLior David 	return rc;
23483fea18d0SLior David }
23493fea18d0SLior David 
23503fea18d0SLior David int wmi_get_mgmt_retry(struct wil6210_priv *wil, u8 *retry_short)
23513fea18d0SLior David {
2352e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
23533fea18d0SLior David 	int rc;
23543fea18d0SLior David 	struct {
23553fea18d0SLior David 		struct wmi_cmd_hdr wmi;
23563fea18d0SLior David 		struct wmi_get_mgmt_retry_limit_event evt;
23573fea18d0SLior David 	} __packed reply;
23583fea18d0SLior David 
23593fea18d0SLior David 	wil_dbg_wmi(wil, "getting mgmt retry short\n");
23603fea18d0SLior David 
23613fea18d0SLior David 	if (!test_bit(WMI_FW_CAPABILITY_MGMT_RETRY_LIMIT, wil->fw_capabilities))
23623fea18d0SLior David 		return -ENOTSUPP;
23633fea18d0SLior David 
2364807b0860SAlexei Avshalom Lazar 	memset(&reply, 0, sizeof(reply));
2365e00243faSLior David 	rc = wmi_call(wil, WMI_GET_MGMT_RETRY_LIMIT_CMDID, vif->mid, NULL, 0,
23663fea18d0SLior David 		      WMI_GET_MGMT_RETRY_LIMIT_EVENTID, &reply, sizeof(reply),
23673fea18d0SLior David 		      100);
23683fea18d0SLior David 	if (rc)
23693fea18d0SLior David 		return rc;
23703fea18d0SLior David 
23713fea18d0SLior David 	if (retry_short)
23723fea18d0SLior David 		*retry_short = reply.evt.mgmt_retry_limit;
23733fea18d0SLior David 
23743fea18d0SLior David 	return 0;
23753fea18d0SLior David }
23763fea18d0SLior David 
2377e00243faSLior David int wmi_abort_scan(struct wil6210_vif *vif)
2378035859a5SMaya Erez {
2379e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
2380035859a5SMaya Erez 	int rc;
2381035859a5SMaya Erez 
2382035859a5SMaya Erez 	wil_dbg_wmi(wil, "sending WMI_ABORT_SCAN_CMDID\n");
2383035859a5SMaya Erez 
2384e00243faSLior David 	rc = wmi_send(wil, WMI_ABORT_SCAN_CMDID, vif->mid, NULL, 0);
2385035859a5SMaya Erez 	if (rc)
2386035859a5SMaya Erez 		wil_err(wil, "Failed to abort scan (%d)\n", rc);
2387035859a5SMaya Erez 
2388035859a5SMaya Erez 	return rc;
2389035859a5SMaya Erez }
2390035859a5SMaya Erez 
2391e00243faSLior David int wmi_new_sta(struct wil6210_vif *vif, const u8 *mac, u8 aid)
2392849a564bSDedy Lansky {
2393e00243faSLior David 	struct wil6210_priv *wil = vif_to_wil(vif);
2394849a564bSDedy Lansky 	int rc;
2395849a564bSDedy Lansky 	struct wmi_new_sta_cmd cmd = {
2396849a564bSDedy Lansky 		.aid = aid,
2397849a564bSDedy Lansky 	};
2398849a564bSDedy Lansky 
2399849a564bSDedy Lansky 	wil_dbg_wmi(wil, "new sta %pM, aid %d\n", mac, aid);
2400849a564bSDedy Lansky 
2401849a564bSDedy Lansky 	ether_addr_copy(cmd.dst_mac, mac);
2402849a564bSDedy Lansky 
2403e00243faSLior David 	rc = wmi_send(wil, WMI_NEW_STA_CMDID, vif->mid, &cmd, sizeof(cmd));
2404849a564bSDedy Lansky 	if (rc)
2405849a564bSDedy Lansky 		wil_err(wil, "Failed to send new sta (%d)\n", rc);
2406849a564bSDedy Lansky 
2407849a564bSDedy Lansky 	return rc;
2408849a564bSDedy Lansky }
2409849a564bSDedy Lansky 
24102be7d22fSVladimir Kondratiev void wmi_event_flush(struct wil6210_priv *wil)
24112be7d22fSVladimir Kondratiev {
2412f6b29b65SHamad Kadmany 	ulong flags;
24132be7d22fSVladimir Kondratiev 	struct pending_wmi_event *evt, *t;
24142be7d22fSVladimir Kondratiev 
2415af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "event_flush\n");
24162be7d22fSVladimir Kondratiev 
2417f6b29b65SHamad Kadmany 	spin_lock_irqsave(&wil->wmi_ev_lock, flags);
2418f6b29b65SHamad Kadmany 
24192be7d22fSVladimir Kondratiev 	list_for_each_entry_safe(evt, t, &wil->pending_wmi_ev, list) {
24202be7d22fSVladimir Kondratiev 		list_del(&evt->list);
24212be7d22fSVladimir Kondratiev 		kfree(evt);
24222be7d22fSVladimir Kondratiev 	}
2423f6b29b65SHamad Kadmany 
2424f6b29b65SHamad Kadmany 	spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
24252be7d22fSVladimir Kondratiev }
24262be7d22fSVladimir Kondratiev 
24276804cd10SLazar Alexei static const char *suspend_status2name(u8 status)
24286804cd10SLazar Alexei {
24296804cd10SLazar Alexei 	switch (status) {
24306804cd10SLazar Alexei 	case WMI_TRAFFIC_SUSPEND_REJECTED_LINK_NOT_IDLE:
24316804cd10SLazar Alexei 		return "LINK_NOT_IDLE";
24326804cd10SLazar Alexei 	default:
24336804cd10SLazar Alexei 		return "Untracked status";
24346804cd10SLazar Alexei 	}
24356804cd10SLazar Alexei }
24366804cd10SLazar Alexei 
2437fe9ee51eSMaya Erez int wmi_suspend(struct wil6210_priv *wil)
2438fe9ee51eSMaya Erez {
2439e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
2440fe9ee51eSMaya Erez 	int rc;
2441fe9ee51eSMaya Erez 	struct wmi_traffic_suspend_cmd cmd = {
2442fe9ee51eSMaya Erez 		.wakeup_trigger = wil->wakeup_trigger,
2443fe9ee51eSMaya Erez 	};
2444fe9ee51eSMaya Erez 	struct {
2445fe9ee51eSMaya Erez 		struct wmi_cmd_hdr wmi;
2446fe9ee51eSMaya Erez 		struct wmi_traffic_suspend_event evt;
2447807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2448807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_TRAFFIC_SUSPEND_REJECTED_LINK_NOT_IDLE},
2449807b0860SAlexei Avshalom Lazar 	};
2450807b0860SAlexei Avshalom Lazar 
2451fe9ee51eSMaya Erez 	u32 suspend_to = WIL_WAIT_FOR_SUSPEND_RESUME_COMP;
2452fe9ee51eSMaya Erez 
2453fe9ee51eSMaya Erez 	wil->suspend_resp_rcvd = false;
2454fe9ee51eSMaya Erez 	wil->suspend_resp_comp = false;
2455fe9ee51eSMaya Erez 
2456e00243faSLior David 	rc = wmi_call(wil, WMI_TRAFFIC_SUSPEND_CMDID, vif->mid,
2457e00243faSLior David 		      &cmd, sizeof(cmd),
2458fe9ee51eSMaya Erez 		      WMI_TRAFFIC_SUSPEND_EVENTID, &reply, sizeof(reply),
2459fe9ee51eSMaya Erez 		      suspend_to);
2460fe9ee51eSMaya Erez 	if (rc) {
2461fe9ee51eSMaya Erez 		wil_err(wil, "wmi_call for suspend req failed, rc=%d\n", rc);
2462fe9ee51eSMaya Erez 		if (rc == -ETIME)
2463fe9ee51eSMaya Erez 			/* wmi_call TO */
2464fe9ee51eSMaya Erez 			wil->suspend_stats.rejected_by_device++;
2465fe9ee51eSMaya Erez 		else
2466fe9ee51eSMaya Erez 			wil->suspend_stats.rejected_by_host++;
2467fe9ee51eSMaya Erez 		goto out;
2468fe9ee51eSMaya Erez 	}
2469fe9ee51eSMaya Erez 
2470fe9ee51eSMaya Erez 	wil_dbg_wmi(wil, "waiting for suspend_response_completed\n");
2471fe9ee51eSMaya Erez 
2472fe9ee51eSMaya Erez 	rc = wait_event_interruptible_timeout(wil->wq,
2473fe9ee51eSMaya Erez 					      wil->suspend_resp_comp,
2474fe9ee51eSMaya Erez 					      msecs_to_jiffies(suspend_to));
2475fe9ee51eSMaya Erez 	if (rc == 0) {
2476fe9ee51eSMaya Erez 		wil_err(wil, "TO waiting for suspend_response_completed\n");
2477fe9ee51eSMaya Erez 		if (wil->suspend_resp_rcvd)
2478fe9ee51eSMaya Erez 			/* Device responded but we TO due to another reason */
2479fe9ee51eSMaya Erez 			wil->suspend_stats.rejected_by_host++;
2480fe9ee51eSMaya Erez 		else
2481fe9ee51eSMaya Erez 			wil->suspend_stats.rejected_by_device++;
2482fe9ee51eSMaya Erez 		rc = -EBUSY;
2483fe9ee51eSMaya Erez 		goto out;
2484fe9ee51eSMaya Erez 	}
2485fe9ee51eSMaya Erez 
2486fe9ee51eSMaya Erez 	wil_dbg_wmi(wil, "suspend_response_completed rcvd\n");
24876804cd10SLazar Alexei 	if (reply.evt.status != WMI_TRAFFIC_SUSPEND_APPROVED) {
24886804cd10SLazar Alexei 		wil_dbg_pm(wil, "device rejected the suspend, %s\n",
24896804cd10SLazar Alexei 			   suspend_status2name(reply.evt.status));
2490fe9ee51eSMaya Erez 		wil->suspend_stats.rejected_by_device++;
2491fe9ee51eSMaya Erez 	}
2492fe9ee51eSMaya Erez 	rc = reply.evt.status;
2493fe9ee51eSMaya Erez 
2494fe9ee51eSMaya Erez out:
2495fe9ee51eSMaya Erez 	wil->suspend_resp_rcvd = false;
2496fe9ee51eSMaya Erez 	wil->suspend_resp_comp = false;
2497fe9ee51eSMaya Erez 
2498fe9ee51eSMaya Erez 	return rc;
2499fe9ee51eSMaya Erez }
2500fe9ee51eSMaya Erez 
25016804cd10SLazar Alexei static void resume_triggers2string(u32 triggers, char *string, int str_size)
25026804cd10SLazar Alexei {
25036804cd10SLazar Alexei 	string[0] = '\0';
25046804cd10SLazar Alexei 
25056804cd10SLazar Alexei 	if (!triggers) {
25066804cd10SLazar Alexei 		strlcat(string, " UNKNOWN", str_size);
25076804cd10SLazar Alexei 		return;
25086804cd10SLazar Alexei 	}
25096804cd10SLazar Alexei 
25106804cd10SLazar Alexei 	if (triggers & WMI_RESUME_TRIGGER_HOST)
25116804cd10SLazar Alexei 		strlcat(string, " HOST", str_size);
25126804cd10SLazar Alexei 
25136804cd10SLazar Alexei 	if (triggers & WMI_RESUME_TRIGGER_UCAST_RX)
25146804cd10SLazar Alexei 		strlcat(string, " UCAST_RX", str_size);
25156804cd10SLazar Alexei 
25166804cd10SLazar Alexei 	if (triggers & WMI_RESUME_TRIGGER_BCAST_RX)
25176804cd10SLazar Alexei 		strlcat(string, " BCAST_RX", str_size);
25186804cd10SLazar Alexei 
25196804cd10SLazar Alexei 	if (triggers & WMI_RESUME_TRIGGER_WMI_EVT)
25206804cd10SLazar Alexei 		strlcat(string, " WMI_EVT", str_size);
25216804cd10SLazar Alexei }
25226804cd10SLazar Alexei 
2523fe9ee51eSMaya Erez int wmi_resume(struct wil6210_priv *wil)
2524fe9ee51eSMaya Erez {
2525e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
2526fe9ee51eSMaya Erez 	int rc;
25276804cd10SLazar Alexei 	char string[100];
2528fe9ee51eSMaya Erez 	struct {
2529fe9ee51eSMaya Erez 		struct wmi_cmd_hdr wmi;
2530fe9ee51eSMaya Erez 		struct wmi_traffic_resume_event evt;
2531807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2532807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_TRAFFIC_RESUME_FAILED,
2533807b0860SAlexei Avshalom Lazar 			.resume_triggers =
2534807b0860SAlexei Avshalom Lazar 				cpu_to_le32(WMI_RESUME_TRIGGER_UNKNOWN)},
2535807b0860SAlexei Avshalom Lazar 	};
2536fe9ee51eSMaya Erez 
2537e00243faSLior David 	rc = wmi_call(wil, WMI_TRAFFIC_RESUME_CMDID, vif->mid, NULL, 0,
2538fe9ee51eSMaya Erez 		      WMI_TRAFFIC_RESUME_EVENTID, &reply, sizeof(reply),
2539fe9ee51eSMaya Erez 		      WIL_WAIT_FOR_SUSPEND_RESUME_COMP);
2540fe9ee51eSMaya Erez 	if (rc)
2541fe9ee51eSMaya Erez 		return rc;
25426804cd10SLazar Alexei 	resume_triggers2string(le32_to_cpu(reply.evt.resume_triggers), string,
25436804cd10SLazar Alexei 			       sizeof(string));
25446804cd10SLazar Alexei 	wil_dbg_pm(wil, "device resume %s, resume triggers:%s (0x%x)\n",
25456804cd10SLazar Alexei 		   reply.evt.status ? "failed" : "passed", string,
25466804cd10SLazar Alexei 		   le32_to_cpu(reply.evt.resume_triggers));
2547fe9ee51eSMaya Erez 
2548fe9ee51eSMaya Erez 	return reply.evt.status;
2549fe9ee51eSMaya Erez }
2550fe9ee51eSMaya Erez 
25514aebd3bdSLior David int wmi_port_allocate(struct wil6210_priv *wil, u8 mid,
25524aebd3bdSLior David 		      const u8 *mac, enum nl80211_iftype iftype)
25534aebd3bdSLior David {
25544aebd3bdSLior David 	int rc;
25554aebd3bdSLior David 	struct wmi_port_allocate_cmd cmd = {
25564aebd3bdSLior David 		.mid = mid,
25574aebd3bdSLior David 	};
25584aebd3bdSLior David 	struct {
25594aebd3bdSLior David 		struct wmi_cmd_hdr wmi;
25604aebd3bdSLior David 		struct wmi_port_allocated_event evt;
2561807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2562807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
2563807b0860SAlexei Avshalom Lazar 	};
25644aebd3bdSLior David 
25654aebd3bdSLior David 	wil_dbg_misc(wil, "port allocate, mid %d iftype %d, mac %pM\n",
25664aebd3bdSLior David 		     mid, iftype, mac);
25674aebd3bdSLior David 
25684aebd3bdSLior David 	ether_addr_copy(cmd.mac, mac);
25694aebd3bdSLior David 	switch (iftype) {
25704aebd3bdSLior David 	case NL80211_IFTYPE_STATION:
25714aebd3bdSLior David 		cmd.port_role = WMI_PORT_STA;
25724aebd3bdSLior David 		break;
25734aebd3bdSLior David 	case NL80211_IFTYPE_AP:
25744aebd3bdSLior David 		cmd.port_role = WMI_PORT_AP;
25754aebd3bdSLior David 		break;
25764aebd3bdSLior David 	case NL80211_IFTYPE_P2P_CLIENT:
25774aebd3bdSLior David 		cmd.port_role = WMI_PORT_P2P_CLIENT;
25784aebd3bdSLior David 		break;
25794aebd3bdSLior David 	case NL80211_IFTYPE_P2P_GO:
25804aebd3bdSLior David 		cmd.port_role = WMI_PORT_P2P_GO;
25814aebd3bdSLior David 		break;
25824aebd3bdSLior David 	/* what about monitor??? */
25834aebd3bdSLior David 	default:
25844aebd3bdSLior David 		wil_err(wil, "unsupported iftype: %d\n", iftype);
25854aebd3bdSLior David 		return -EINVAL;
25864aebd3bdSLior David 	}
25874aebd3bdSLior David 
25884aebd3bdSLior David 	rc = wmi_call(wil, WMI_PORT_ALLOCATE_CMDID, mid,
25894aebd3bdSLior David 		      &cmd, sizeof(cmd),
25904aebd3bdSLior David 		      WMI_PORT_ALLOCATED_EVENTID, &reply,
25914aebd3bdSLior David 		      sizeof(reply), 300);
25924aebd3bdSLior David 	if (rc) {
25934aebd3bdSLior David 		wil_err(wil, "failed to allocate port, status %d\n", rc);
25944aebd3bdSLior David 		return rc;
25954aebd3bdSLior David 	}
25964aebd3bdSLior David 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
25974aebd3bdSLior David 		wil_err(wil, "WMI_PORT_ALLOCATE returned status %d\n",
25984aebd3bdSLior David 			reply.evt.status);
25994aebd3bdSLior David 		return -EINVAL;
26004aebd3bdSLior David 	}
26014aebd3bdSLior David 
26024aebd3bdSLior David 	return 0;
26034aebd3bdSLior David }
26044aebd3bdSLior David 
26054aebd3bdSLior David int wmi_port_delete(struct wil6210_priv *wil, u8 mid)
26064aebd3bdSLior David {
26074aebd3bdSLior David 	int rc;
26084aebd3bdSLior David 	struct wmi_port_delete_cmd cmd = {
26094aebd3bdSLior David 		.mid = mid,
26104aebd3bdSLior David 	};
26114aebd3bdSLior David 	struct {
26124aebd3bdSLior David 		struct wmi_cmd_hdr wmi;
26134aebd3bdSLior David 		struct wmi_port_deleted_event evt;
2614807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2615807b0860SAlexei Avshalom Lazar 		.evt = {.status = WMI_FW_STATUS_FAILURE},
2616807b0860SAlexei Avshalom Lazar 	};
26174aebd3bdSLior David 
26184aebd3bdSLior David 	wil_dbg_misc(wil, "port delete, mid %d\n", mid);
26194aebd3bdSLior David 
26204aebd3bdSLior David 	rc = wmi_call(wil, WMI_PORT_DELETE_CMDID, mid,
26214aebd3bdSLior David 		      &cmd, sizeof(cmd),
26224aebd3bdSLior David 		      WMI_PORT_DELETED_EVENTID, &reply,
26234aebd3bdSLior David 		      sizeof(reply), 2000);
26244aebd3bdSLior David 	if (rc) {
26254aebd3bdSLior David 		wil_err(wil, "failed to delete port, status %d\n", rc);
26264aebd3bdSLior David 		return rc;
26274aebd3bdSLior David 	}
26284aebd3bdSLior David 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
26294aebd3bdSLior David 		wil_err(wil, "WMI_PORT_DELETE returned status %d\n",
26304aebd3bdSLior David 			reply.evt.status);
26314aebd3bdSLior David 		return -EINVAL;
26324aebd3bdSLior David 	}
26334aebd3bdSLior David 
26344aebd3bdSLior David 	return 0;
26354aebd3bdSLior David }
26364aebd3bdSLior David 
2637e00243faSLior David static bool wmi_evt_call_handler(struct wil6210_vif *vif, int id,
26382be7d22fSVladimir Kondratiev 				 void *d, int len)
26392be7d22fSVladimir Kondratiev {
26402be7d22fSVladimir Kondratiev 	uint i;
26412be7d22fSVladimir Kondratiev 
26422be7d22fSVladimir Kondratiev 	for (i = 0; i < ARRAY_SIZE(wmi_evt_handlers); i++) {
26432be7d22fSVladimir Kondratiev 		if (wmi_evt_handlers[i].eventid == id) {
2644e00243faSLior David 			wmi_evt_handlers[i].handler(vif, id, d, len);
26452be7d22fSVladimir Kondratiev 			return true;
26462be7d22fSVladimir Kondratiev 		}
26472be7d22fSVladimir Kondratiev 	}
26482be7d22fSVladimir Kondratiev 
26492be7d22fSVladimir Kondratiev 	return false;
26502be7d22fSVladimir Kondratiev }
26512be7d22fSVladimir Kondratiev 
26522be7d22fSVladimir Kondratiev static void wmi_event_handle(struct wil6210_priv *wil,
26532be7d22fSVladimir Kondratiev 			     struct wil6210_mbox_hdr *hdr)
26542be7d22fSVladimir Kondratiev {
26552be7d22fSVladimir Kondratiev 	u16 len = le16_to_cpu(hdr->len);
26564aebd3bdSLior David 	struct wil6210_vif *vif;
26572be7d22fSVladimir Kondratiev 
26582be7d22fSVladimir Kondratiev 	if ((hdr->type == WIL_MBOX_HDR_TYPE_WMI) &&
2659b874ddecSLior David 	    (len >= sizeof(struct wmi_cmd_hdr))) {
2660b874ddecSLior David 		struct wmi_cmd_hdr *wmi = (void *)(&hdr[1]);
26612be7d22fSVladimir Kondratiev 		void *evt_data = (void *)(&wmi[1]);
2662b874ddecSLior David 		u16 id = le16_to_cpu(wmi->command_id);
2663e00243faSLior David 		u8 mid = wmi->mid;
2664028e1836SVladimir Kondratiev 
2665e00243faSLior David 		wil_dbg_wmi(wil, "Handle %s (0x%04x) (reply_id 0x%04x,%d)\n",
2666e00243faSLior David 			    eventid2name(id), id, wil->reply_id,
2667e00243faSLior David 			    wil->reply_mid);
2668e00243faSLior David 
26694aebd3bdSLior David 		if (mid == MID_BROADCAST)
26704aebd3bdSLior David 			mid = 0;
26714aebd3bdSLior David 		if (mid >= wil->max_vifs) {
26724aebd3bdSLior David 			wil_dbg_wmi(wil, "invalid mid %d, event skipped\n",
26734aebd3bdSLior David 				    mid);
26744aebd3bdSLior David 			return;
26754aebd3bdSLior David 		}
26764aebd3bdSLior David 		vif = wil->vifs[mid];
26774aebd3bdSLior David 		if (!vif) {
26784aebd3bdSLior David 			wil_dbg_wmi(wil, "event for empty VIF(%d), skipped\n",
26794aebd3bdSLior David 				    mid);
26804aebd3bdSLior David 			return;
26814aebd3bdSLior David 		}
26824aebd3bdSLior David 
26832be7d22fSVladimir Kondratiev 		/* check if someone waits for this event */
2684e00243faSLior David 		if (wil->reply_id && wil->reply_id == id &&
2685e00243faSLior David 		    wil->reply_mid == mid) {
26860916d9f2SMaya Erez 			WARN_ON(wil->reply_buf);
2687e00243faSLior David 
2688e00243faSLior David 			wmi_evt_call_handler(vif, id, evt_data,
26892be7d22fSVladimir Kondratiev 					     len - sizeof(*wmi));
2690af3db60aSLazar Alexei 			wil_dbg_wmi(wil, "event_handle: Complete WMI 0x%04x\n",
2691af3db60aSLazar Alexei 				    id);
269259502647SDedy Lansky 			complete(&wil->wmi_call);
26932be7d22fSVladimir Kondratiev 			return;
26942be7d22fSVladimir Kondratiev 		}
26952be7d22fSVladimir Kondratiev 		/* unsolicited event */
26962be7d22fSVladimir Kondratiev 		/* search for handler */
2697e00243faSLior David 		if (!wmi_evt_call_handler(vif, id, evt_data,
26982be7d22fSVladimir Kondratiev 					  len - sizeof(*wmi))) {
2699a3ce5ccdSDedy Lansky 			wil_info(wil, "Unhandled event 0x%04x\n", id);
27002be7d22fSVladimir Kondratiev 		}
27012be7d22fSVladimir Kondratiev 	} else {
27022be7d22fSVladimir Kondratiev 		wil_err(wil, "Unknown event type\n");
27032be7d22fSVladimir Kondratiev 		print_hex_dump(KERN_ERR, "evt?? ", DUMP_PREFIX_OFFSET, 16, 1,
27042be7d22fSVladimir Kondratiev 			       hdr, sizeof(*hdr) + len, true);
27052be7d22fSVladimir Kondratiev 	}
27062be7d22fSVladimir Kondratiev }
27072be7d22fSVladimir Kondratiev 
27082be7d22fSVladimir Kondratiev /*
27092be7d22fSVladimir Kondratiev  * Retrieve next WMI event from the pending list
27102be7d22fSVladimir Kondratiev  */
27112be7d22fSVladimir Kondratiev static struct list_head *next_wmi_ev(struct wil6210_priv *wil)
27122be7d22fSVladimir Kondratiev {
27132be7d22fSVladimir Kondratiev 	ulong flags;
27142be7d22fSVladimir Kondratiev 	struct list_head *ret = NULL;
27152be7d22fSVladimir Kondratiev 
27162be7d22fSVladimir Kondratiev 	spin_lock_irqsave(&wil->wmi_ev_lock, flags);
27172be7d22fSVladimir Kondratiev 
27182be7d22fSVladimir Kondratiev 	if (!list_empty(&wil->pending_wmi_ev)) {
27192be7d22fSVladimir Kondratiev 		ret = wil->pending_wmi_ev.next;
27202be7d22fSVladimir Kondratiev 		list_del(ret);
27212be7d22fSVladimir Kondratiev 	}
27222be7d22fSVladimir Kondratiev 
27232be7d22fSVladimir Kondratiev 	spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
27242be7d22fSVladimir Kondratiev 
27252be7d22fSVladimir Kondratiev 	return ret;
27262be7d22fSVladimir Kondratiev }
27272be7d22fSVladimir Kondratiev 
27282be7d22fSVladimir Kondratiev /*
27292be7d22fSVladimir Kondratiev  * Handler for the WMI events
27302be7d22fSVladimir Kondratiev  */
27312be7d22fSVladimir Kondratiev void wmi_event_worker(struct work_struct *work)
27322be7d22fSVladimir Kondratiev {
27332be7d22fSVladimir Kondratiev 	struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
27342be7d22fSVladimir Kondratiev 						 wmi_event_worker);
27352be7d22fSVladimir Kondratiev 	struct pending_wmi_event *evt;
27362be7d22fSVladimir Kondratiev 	struct list_head *lh;
27372be7d22fSVladimir Kondratiev 
2738af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "event_worker: Start\n");
27392be7d22fSVladimir Kondratiev 	while ((lh = next_wmi_ev(wil)) != NULL) {
27402be7d22fSVladimir Kondratiev 		evt = list_entry(lh, struct pending_wmi_event, list);
27412be7d22fSVladimir Kondratiev 		wmi_event_handle(wil, &evt->event.hdr);
27422be7d22fSVladimir Kondratiev 		kfree(evt);
27432be7d22fSVladimir Kondratiev 	}
2744af3db60aSLazar Alexei 	wil_dbg_wmi(wil, "event_worker: Finished\n");
27452be7d22fSVladimir Kondratiev }
2746fe9ee51eSMaya Erez 
2747fe9ee51eSMaya Erez bool wil_is_wmi_idle(struct wil6210_priv *wil)
2748fe9ee51eSMaya Erez {
2749fe9ee51eSMaya Erez 	ulong flags;
2750fe9ee51eSMaya Erez 	struct wil6210_mbox_ring *r = &wil->mbox_ctl.rx;
2751fe9ee51eSMaya Erez 	bool rc = false;
2752fe9ee51eSMaya Erez 
2753fe9ee51eSMaya Erez 	spin_lock_irqsave(&wil->wmi_ev_lock, flags);
2754fe9ee51eSMaya Erez 
2755fe9ee51eSMaya Erez 	/* Check if there are pending WMI events in the events queue */
2756fe9ee51eSMaya Erez 	if (!list_empty(&wil->pending_wmi_ev)) {
2757fe9ee51eSMaya Erez 		wil_dbg_pm(wil, "Pending WMI events in queue\n");
2758fe9ee51eSMaya Erez 		goto out;
2759fe9ee51eSMaya Erez 	}
2760fe9ee51eSMaya Erez 
2761fe9ee51eSMaya Erez 	/* Check if there is a pending WMI call */
2762fe9ee51eSMaya Erez 	if (wil->reply_id) {
2763fe9ee51eSMaya Erez 		wil_dbg_pm(wil, "Pending WMI call\n");
2764fe9ee51eSMaya Erez 		goto out;
2765fe9ee51eSMaya Erez 	}
2766fe9ee51eSMaya Erez 
2767fe9ee51eSMaya Erez 	/* Check if there are pending RX events in mbox */
2768fe9ee51eSMaya Erez 	r->head = wil_r(wil, RGF_MBOX +
2769fe9ee51eSMaya Erez 			offsetof(struct wil6210_mbox_ctl, rx.head));
2770fe9ee51eSMaya Erez 	if (r->tail != r->head)
2771fe9ee51eSMaya Erez 		wil_dbg_pm(wil, "Pending WMI mbox events\n");
2772fe9ee51eSMaya Erez 	else
2773fe9ee51eSMaya Erez 		rc = true;
2774fe9ee51eSMaya Erez 
2775fe9ee51eSMaya Erez out:
2776fe9ee51eSMaya Erez 	spin_unlock_irqrestore(&wil->wmi_ev_lock, flags);
2777fe9ee51eSMaya Erez 	return rc;
2778fe9ee51eSMaya Erez }
2779a5dc6883SDedy Lansky 
2780a5dc6883SDedy Lansky static void
2781a5dc6883SDedy Lansky wmi_sched_scan_set_ssids(struct wil6210_priv *wil,
2782a5dc6883SDedy Lansky 			 struct wmi_start_sched_scan_cmd *cmd,
2783a5dc6883SDedy Lansky 			 struct cfg80211_ssid *ssids, int n_ssids,
2784a5dc6883SDedy Lansky 			 struct cfg80211_match_set *match_sets,
2785a5dc6883SDedy Lansky 			 int n_match_sets)
2786a5dc6883SDedy Lansky {
2787a5dc6883SDedy Lansky 	int i;
2788a5dc6883SDedy Lansky 
2789a5dc6883SDedy Lansky 	if (n_match_sets > WMI_MAX_PNO_SSID_NUM) {
2790a5dc6883SDedy Lansky 		wil_dbg_wmi(wil, "too many match sets (%d), use first %d\n",
2791a5dc6883SDedy Lansky 			    n_match_sets, WMI_MAX_PNO_SSID_NUM);
2792a5dc6883SDedy Lansky 		n_match_sets = WMI_MAX_PNO_SSID_NUM;
2793a5dc6883SDedy Lansky 	}
2794a5dc6883SDedy Lansky 	cmd->num_of_ssids = n_match_sets;
2795a5dc6883SDedy Lansky 
2796a5dc6883SDedy Lansky 	for (i = 0; i < n_match_sets; i++) {
2797a5dc6883SDedy Lansky 		struct wmi_sched_scan_ssid_match *wmi_match =
2798a5dc6883SDedy Lansky 			&cmd->ssid_for_match[i];
2799a5dc6883SDedy Lansky 		struct cfg80211_match_set *cfg_match = &match_sets[i];
2800a5dc6883SDedy Lansky 		int j;
2801a5dc6883SDedy Lansky 
2802a5dc6883SDedy Lansky 		wmi_match->ssid_len = cfg_match->ssid.ssid_len;
2803a5dc6883SDedy Lansky 		memcpy(wmi_match->ssid, cfg_match->ssid.ssid,
2804a5dc6883SDedy Lansky 		       min_t(u8, wmi_match->ssid_len, WMI_MAX_SSID_LEN));
2805a5dc6883SDedy Lansky 		wmi_match->rssi_threshold = S8_MIN;
2806a5dc6883SDedy Lansky 		if (cfg_match->rssi_thold >= S8_MIN &&
2807a5dc6883SDedy Lansky 		    cfg_match->rssi_thold <= S8_MAX)
2808a5dc6883SDedy Lansky 			wmi_match->rssi_threshold = cfg_match->rssi_thold;
2809a5dc6883SDedy Lansky 
2810a5dc6883SDedy Lansky 		for (j = 0; j < n_ssids; j++)
2811a5dc6883SDedy Lansky 			if (wmi_match->ssid_len == ssids[j].ssid_len &&
2812a5dc6883SDedy Lansky 			    memcmp(wmi_match->ssid, ssids[j].ssid,
2813a5dc6883SDedy Lansky 				   wmi_match->ssid_len) == 0)
2814a5dc6883SDedy Lansky 				wmi_match->add_ssid_to_probe = true;
2815a5dc6883SDedy Lansky 	}
2816a5dc6883SDedy Lansky }
2817a5dc6883SDedy Lansky 
2818a5dc6883SDedy Lansky static void
2819a5dc6883SDedy Lansky wmi_sched_scan_set_channels(struct wil6210_priv *wil,
2820a5dc6883SDedy Lansky 			    struct wmi_start_sched_scan_cmd *cmd,
2821a5dc6883SDedy Lansky 			    u32 n_channels,
2822a5dc6883SDedy Lansky 			    struct ieee80211_channel **channels)
2823a5dc6883SDedy Lansky {
2824a5dc6883SDedy Lansky 	int i;
2825a5dc6883SDedy Lansky 
2826a5dc6883SDedy Lansky 	if (n_channels > WMI_MAX_CHANNEL_NUM) {
2827a5dc6883SDedy Lansky 		wil_dbg_wmi(wil, "too many channels (%d), use first %d\n",
2828a5dc6883SDedy Lansky 			    n_channels, WMI_MAX_CHANNEL_NUM);
2829a5dc6883SDedy Lansky 		n_channels = WMI_MAX_CHANNEL_NUM;
2830a5dc6883SDedy Lansky 	}
2831a5dc6883SDedy Lansky 	cmd->num_of_channels = n_channels;
2832a5dc6883SDedy Lansky 
2833a5dc6883SDedy Lansky 	for (i = 0; i < n_channels; i++) {
2834a5dc6883SDedy Lansky 		struct ieee80211_channel *cfg_chan = channels[i];
2835a5dc6883SDedy Lansky 
2836a5dc6883SDedy Lansky 		cmd->channel_list[i] = cfg_chan->hw_value - 1;
2837a5dc6883SDedy Lansky 	}
2838a5dc6883SDedy Lansky }
2839a5dc6883SDedy Lansky 
2840a5dc6883SDedy Lansky static void
2841a5dc6883SDedy Lansky wmi_sched_scan_set_plans(struct wil6210_priv *wil,
2842a5dc6883SDedy Lansky 			 struct wmi_start_sched_scan_cmd *cmd,
2843a5dc6883SDedy Lansky 			 struct cfg80211_sched_scan_plan *scan_plans,
2844a5dc6883SDedy Lansky 			 int n_scan_plans)
2845a5dc6883SDedy Lansky {
2846a5dc6883SDedy Lansky 	int i;
2847a5dc6883SDedy Lansky 
2848a5dc6883SDedy Lansky 	if (n_scan_plans > WMI_MAX_PLANS_NUM) {
2849a5dc6883SDedy Lansky 		wil_dbg_wmi(wil, "too many plans (%d), use first %d\n",
2850a5dc6883SDedy Lansky 			    n_scan_plans, WMI_MAX_PLANS_NUM);
2851a5dc6883SDedy Lansky 		n_scan_plans = WMI_MAX_PLANS_NUM;
2852a5dc6883SDedy Lansky 	}
2853a5dc6883SDedy Lansky 
2854a5dc6883SDedy Lansky 	for (i = 0; i < n_scan_plans; i++) {
2855a5dc6883SDedy Lansky 		struct cfg80211_sched_scan_plan *cfg_plan = &scan_plans[i];
2856a5dc6883SDedy Lansky 
2857a5dc6883SDedy Lansky 		cmd->scan_plans[i].interval_sec =
2858a5dc6883SDedy Lansky 			cpu_to_le16(cfg_plan->interval);
2859a5dc6883SDedy Lansky 		cmd->scan_plans[i].num_of_iterations =
2860a5dc6883SDedy Lansky 			cpu_to_le16(cfg_plan->iterations);
2861a5dc6883SDedy Lansky 	}
2862a5dc6883SDedy Lansky }
2863a5dc6883SDedy Lansky 
2864a5dc6883SDedy Lansky int wmi_start_sched_scan(struct wil6210_priv *wil,
2865a5dc6883SDedy Lansky 			 struct cfg80211_sched_scan_request *request)
2866a5dc6883SDedy Lansky {
2867e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
2868a5dc6883SDedy Lansky 	int rc;
2869a5dc6883SDedy Lansky 	struct wmi_start_sched_scan_cmd cmd = {
2870a5dc6883SDedy Lansky 		.min_rssi_threshold = S8_MIN,
2871a5dc6883SDedy Lansky 		.initial_delay_sec = cpu_to_le16(request->delay),
2872a5dc6883SDedy Lansky 	};
2873a5dc6883SDedy Lansky 	struct {
2874a5dc6883SDedy Lansky 		struct wmi_cmd_hdr wmi;
2875a5dc6883SDedy Lansky 		struct wmi_start_sched_scan_event evt;
2876807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2877807b0860SAlexei Avshalom Lazar 		.evt = {.result = WMI_PNO_REJECT},
2878807b0860SAlexei Avshalom Lazar 	};
2879a5dc6883SDedy Lansky 
2880a5dc6883SDedy Lansky 	if (!test_bit(WMI_FW_CAPABILITY_PNO, wil->fw_capabilities))
2881a5dc6883SDedy Lansky 		return -ENOTSUPP;
2882a5dc6883SDedy Lansky 
2883a5dc6883SDedy Lansky 	if (request->min_rssi_thold >= S8_MIN &&
2884a5dc6883SDedy Lansky 	    request->min_rssi_thold <= S8_MAX)
2885a5dc6883SDedy Lansky 		cmd.min_rssi_threshold = request->min_rssi_thold;
2886a5dc6883SDedy Lansky 
2887a5dc6883SDedy Lansky 	wmi_sched_scan_set_ssids(wil, &cmd, request->ssids, request->n_ssids,
2888a5dc6883SDedy Lansky 				 request->match_sets, request->n_match_sets);
2889a5dc6883SDedy Lansky 	wmi_sched_scan_set_channels(wil, &cmd,
2890a5dc6883SDedy Lansky 				    request->n_channels, request->channels);
2891a5dc6883SDedy Lansky 	wmi_sched_scan_set_plans(wil, &cmd,
2892a5dc6883SDedy Lansky 				 request->scan_plans, request->n_scan_plans);
2893a5dc6883SDedy Lansky 
2894e00243faSLior David 	rc = wmi_call(wil, WMI_START_SCHED_SCAN_CMDID, vif->mid,
2895e00243faSLior David 		      &cmd, sizeof(cmd),
2896a5dc6883SDedy Lansky 		      WMI_START_SCHED_SCAN_EVENTID, &reply, sizeof(reply),
2897a5dc6883SDedy Lansky 		      WIL_WMI_CALL_GENERAL_TO_MS);
2898a5dc6883SDedy Lansky 	if (rc)
2899a5dc6883SDedy Lansky 		return rc;
2900a5dc6883SDedy Lansky 
2901a5dc6883SDedy Lansky 	if (reply.evt.result != WMI_PNO_SUCCESS) {
2902a5dc6883SDedy Lansky 		wil_err(wil, "start sched scan failed, result %d\n",
2903a5dc6883SDedy Lansky 			reply.evt.result);
2904a5dc6883SDedy Lansky 		return -EINVAL;
2905a5dc6883SDedy Lansky 	}
2906a5dc6883SDedy Lansky 
2907a5dc6883SDedy Lansky 	return 0;
2908a5dc6883SDedy Lansky }
2909a5dc6883SDedy Lansky 
2910a5dc6883SDedy Lansky int wmi_stop_sched_scan(struct wil6210_priv *wil)
2911a5dc6883SDedy Lansky {
2912e00243faSLior David 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
2913a5dc6883SDedy Lansky 	int rc;
2914a5dc6883SDedy Lansky 	struct {
2915a5dc6883SDedy Lansky 		struct wmi_cmd_hdr wmi;
2916a5dc6883SDedy Lansky 		struct wmi_stop_sched_scan_event evt;
2917807b0860SAlexei Avshalom Lazar 	} __packed reply = {
2918807b0860SAlexei Avshalom Lazar 		.evt = {.result = WMI_PNO_REJECT},
2919807b0860SAlexei Avshalom Lazar 	};
2920a5dc6883SDedy Lansky 
2921a5dc6883SDedy Lansky 	if (!test_bit(WMI_FW_CAPABILITY_PNO, wil->fw_capabilities))
2922a5dc6883SDedy Lansky 		return -ENOTSUPP;
2923a5dc6883SDedy Lansky 
2924e00243faSLior David 	rc = wmi_call(wil, WMI_STOP_SCHED_SCAN_CMDID, vif->mid, NULL, 0,
2925a5dc6883SDedy Lansky 		      WMI_STOP_SCHED_SCAN_EVENTID, &reply, sizeof(reply),
2926a5dc6883SDedy Lansky 		      WIL_WMI_CALL_GENERAL_TO_MS);
2927a5dc6883SDedy Lansky 	if (rc)
2928a5dc6883SDedy Lansky 		return rc;
2929a5dc6883SDedy Lansky 
2930a5dc6883SDedy Lansky 	if (reply.evt.result != WMI_PNO_SUCCESS) {
2931a5dc6883SDedy Lansky 		wil_err(wil, "stop sched scan failed, result %d\n",
2932a5dc6883SDedy Lansky 			reply.evt.result);
2933a5dc6883SDedy Lansky 		return -EINVAL;
2934a5dc6883SDedy Lansky 	}
2935a5dc6883SDedy Lansky 
2936a5dc6883SDedy Lansky 	return 0;
2937a5dc6883SDedy Lansky }
29381c21cc5fSDedy Lansky 
29391c21cc5fSDedy Lansky int wmi_mgmt_tx(struct wil6210_vif *vif, const u8 *buf, size_t len)
29401c21cc5fSDedy Lansky {
29411c21cc5fSDedy Lansky 	size_t total;
29421c21cc5fSDedy Lansky 	struct wil6210_priv *wil = vif_to_wil(vif);
29431c21cc5fSDedy Lansky 	struct ieee80211_mgmt *mgmt_frame = (void *)buf;
29441c21cc5fSDedy Lansky 	struct wmi_sw_tx_req_cmd *cmd;
29451c21cc5fSDedy Lansky 	struct {
29461c21cc5fSDedy Lansky 		struct wmi_cmd_hdr wmi;
29471c21cc5fSDedy Lansky 		struct wmi_sw_tx_complete_event evt;
29481c21cc5fSDedy Lansky 	} __packed evt = {
29491c21cc5fSDedy Lansky 		.evt = {.status = WMI_FW_STATUS_FAILURE},
29501c21cc5fSDedy Lansky 	};
29511c21cc5fSDedy Lansky 	int rc;
29521c21cc5fSDedy Lansky 
29531c21cc5fSDedy Lansky 	wil_dbg_misc(wil, "mgmt_tx mid %d\n", vif->mid);
29541c21cc5fSDedy Lansky 	wil_hex_dump_misc("mgmt tx frame ", DUMP_PREFIX_OFFSET, 16, 1, buf,
29551c21cc5fSDedy Lansky 			  len, true);
29561c21cc5fSDedy Lansky 
29571c21cc5fSDedy Lansky 	if (len < sizeof(struct ieee80211_hdr_3addr))
29581c21cc5fSDedy Lansky 		return -EINVAL;
29591c21cc5fSDedy Lansky 
29601c21cc5fSDedy Lansky 	total = sizeof(*cmd) + len;
29611c21cc5fSDedy Lansky 	if (total < len) {
29621c21cc5fSDedy Lansky 		wil_err(wil, "mgmt_tx invalid len %zu\n", len);
29631c21cc5fSDedy Lansky 		return -EINVAL;
29641c21cc5fSDedy Lansky 	}
29651c21cc5fSDedy Lansky 
29661c21cc5fSDedy Lansky 	cmd = kmalloc(total, GFP_KERNEL);
29671c21cc5fSDedy Lansky 	if (!cmd)
29681c21cc5fSDedy Lansky 		return -ENOMEM;
29691c21cc5fSDedy Lansky 
29701c21cc5fSDedy Lansky 	memcpy(cmd->dst_mac, mgmt_frame->da, WMI_MAC_LEN);
29711c21cc5fSDedy Lansky 	cmd->len = cpu_to_le16(len);
29721c21cc5fSDedy Lansky 	memcpy(cmd->payload, buf, len);
29731c21cc5fSDedy Lansky 
29741c21cc5fSDedy Lansky 	rc = wmi_call(wil, WMI_SW_TX_REQ_CMDID, vif->mid, cmd, total,
29751c21cc5fSDedy Lansky 		      WMI_SW_TX_COMPLETE_EVENTID, &evt, sizeof(evt), 2000);
29761c21cc5fSDedy Lansky 	if (!rc && evt.evt.status != WMI_FW_STATUS_SUCCESS) {
29771c21cc5fSDedy Lansky 		wil_err(wil, "mgmt_tx failed with status %d\n", evt.evt.status);
29781c21cc5fSDedy Lansky 		rc = -EINVAL;
29791c21cc5fSDedy Lansky 	}
29801c21cc5fSDedy Lansky 
29811c21cc5fSDedy Lansky 	kfree(cmd);
29821c21cc5fSDedy Lansky 
29831c21cc5fSDedy Lansky 	return rc;
29841c21cc5fSDedy Lansky }
298596c93589SGidon Studinski 
298696c93589SGidon Studinski int wil_wmi_tx_sring_cfg(struct wil6210_priv *wil, int ring_id)
298796c93589SGidon Studinski {
298896c93589SGidon Studinski 	int rc;
298996c93589SGidon Studinski 	struct wil6210_vif *vif = ndev_to_vif(wil->main_ndev);
299096c93589SGidon Studinski 	struct wil_status_ring *sring = &wil->srings[ring_id];
299196c93589SGidon Studinski 	struct wmi_tx_status_ring_add_cmd cmd = {
299296c93589SGidon Studinski 		.ring_cfg = {
299396c93589SGidon Studinski 			.ring_size = cpu_to_le16(sring->size),
299496c93589SGidon Studinski 		},
299596c93589SGidon Studinski 		.irq_index = WIL_TX_STATUS_IRQ_IDX
299696c93589SGidon Studinski 	};
299796c93589SGidon Studinski 	struct {
299896c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
299996c93589SGidon Studinski 		struct wmi_tx_status_ring_cfg_done_event evt;
300096c93589SGidon Studinski 	} __packed reply = {
300196c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
300296c93589SGidon Studinski 	};
300396c93589SGidon Studinski 
300496c93589SGidon Studinski 	cmd.ring_cfg.ring_id = ring_id;
300596c93589SGidon Studinski 
300696c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(sring->pa);
300796c93589SGidon Studinski 	rc = wmi_call(wil, WMI_TX_STATUS_RING_ADD_CMDID, vif->mid, &cmd,
300896c93589SGidon Studinski 		      sizeof(cmd), WMI_TX_STATUS_RING_CFG_DONE_EVENTID,
300996c93589SGidon Studinski 		      &reply, sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
301096c93589SGidon Studinski 	if (rc) {
301196c93589SGidon Studinski 		wil_err(wil, "TX_STATUS_RING_ADD_CMD failed, rc %d\n", rc);
301296c93589SGidon Studinski 		return rc;
301396c93589SGidon Studinski 	}
301496c93589SGidon Studinski 
301596c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
301696c93589SGidon Studinski 		wil_err(wil, "TX_STATUS_RING_ADD_CMD failed, status %d\n",
301796c93589SGidon Studinski 			reply.evt.status);
301896c93589SGidon Studinski 		return -EINVAL;
301996c93589SGidon Studinski 	}
302096c93589SGidon Studinski 
302196c93589SGidon Studinski 	sring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
302296c93589SGidon Studinski 
302396c93589SGidon Studinski 	return 0;
302496c93589SGidon Studinski }
302596c93589SGidon Studinski 
302696c93589SGidon Studinski int wil_wmi_cfg_def_rx_offload(struct wil6210_priv *wil, u16 max_rx_pl_per_desc)
302796c93589SGidon Studinski {
302896c93589SGidon Studinski 	struct net_device *ndev = wil->main_ndev;
302996c93589SGidon Studinski 	struct wil6210_vif *vif = ndev_to_vif(ndev);
303096c93589SGidon Studinski 	int rc;
303196c93589SGidon Studinski 	struct wmi_cfg_def_rx_offload_cmd cmd = {
303296c93589SGidon Studinski 		.max_msdu_size = cpu_to_le16(wil_mtu2macbuf(WIL_MAX_ETH_MTU)),
303396c93589SGidon Studinski 		.max_rx_pl_per_desc = cpu_to_le16(max_rx_pl_per_desc),
303496c93589SGidon Studinski 		.decap_trans_type = WMI_DECAP_TYPE_802_3,
303596c93589SGidon Studinski 		.l2_802_3_offload_ctrl = 0,
303696c93589SGidon Studinski 		.l3_l4_ctrl = 1 << L3_L4_CTRL_TCPIP_CHECKSUM_EN_POS,
303796c93589SGidon Studinski 	};
303896c93589SGidon Studinski 	struct {
303996c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
304096c93589SGidon Studinski 		struct wmi_cfg_def_rx_offload_done_event evt;
304196c93589SGidon Studinski 	} __packed reply = {
304296c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
304396c93589SGidon Studinski 	};
304496c93589SGidon Studinski 
304596c93589SGidon Studinski 	rc = wmi_call(wil, WMI_CFG_DEF_RX_OFFLOAD_CMDID, vif->mid, &cmd,
304696c93589SGidon Studinski 		      sizeof(cmd), WMI_CFG_DEF_RX_OFFLOAD_DONE_EVENTID, &reply,
304796c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
304896c93589SGidon Studinski 	if (rc) {
304996c93589SGidon Studinski 		wil_err(wil, "WMI_CFG_DEF_RX_OFFLOAD_CMD failed, rc %d\n", rc);
305096c93589SGidon Studinski 		return rc;
305196c93589SGidon Studinski 	}
305296c93589SGidon Studinski 
305396c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
305496c93589SGidon Studinski 		wil_err(wil, "WMI_CFG_DEF_RX_OFFLOAD_CMD failed, status %d\n",
305596c93589SGidon Studinski 			reply.evt.status);
305696c93589SGidon Studinski 		return -EINVAL;
305796c93589SGidon Studinski 	}
305896c93589SGidon Studinski 
305996c93589SGidon Studinski 	return 0;
306096c93589SGidon Studinski }
306196c93589SGidon Studinski 
306296c93589SGidon Studinski int wil_wmi_rx_sring_add(struct wil6210_priv *wil, u16 ring_id)
306396c93589SGidon Studinski {
306496c93589SGidon Studinski 	struct net_device *ndev = wil->main_ndev;
306596c93589SGidon Studinski 	struct wil6210_vif *vif = ndev_to_vif(ndev);
306696c93589SGidon Studinski 	struct wil_status_ring *sring = &wil->srings[ring_id];
306796c93589SGidon Studinski 	int rc;
306896c93589SGidon Studinski 	struct wmi_rx_status_ring_add_cmd cmd = {
306996c93589SGidon Studinski 		.ring_cfg = {
307096c93589SGidon Studinski 			.ring_size = cpu_to_le16(sring->size),
307196c93589SGidon Studinski 			.ring_id = ring_id,
307296c93589SGidon Studinski 		},
307396c93589SGidon Studinski 		.rx_msg_type = wil->use_compressed_rx_status ?
307496c93589SGidon Studinski 			WMI_RX_MSG_TYPE_COMPRESSED :
307596c93589SGidon Studinski 			WMI_RX_MSG_TYPE_EXTENDED,
307696c93589SGidon Studinski 		.irq_index = WIL_RX_STATUS_IRQ_IDX,
307796c93589SGidon Studinski 	};
307896c93589SGidon Studinski 	struct {
307996c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
308096c93589SGidon Studinski 		struct wmi_rx_status_ring_cfg_done_event evt;
308196c93589SGidon Studinski 	} __packed reply = {
308296c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
308396c93589SGidon Studinski 	};
308496c93589SGidon Studinski 
308596c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(sring->pa);
308696c93589SGidon Studinski 	rc = wmi_call(wil, WMI_RX_STATUS_RING_ADD_CMDID, vif->mid, &cmd,
308796c93589SGidon Studinski 		      sizeof(cmd), WMI_RX_STATUS_RING_CFG_DONE_EVENTID, &reply,
308896c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
308996c93589SGidon Studinski 	if (rc) {
309096c93589SGidon Studinski 		wil_err(wil, "RX_STATUS_RING_ADD_CMD failed, rc %d\n", rc);
309196c93589SGidon Studinski 		return rc;
309296c93589SGidon Studinski 	}
309396c93589SGidon Studinski 
309496c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
309596c93589SGidon Studinski 		wil_err(wil, "RX_STATUS_RING_ADD_CMD failed, status %d\n",
309696c93589SGidon Studinski 			reply.evt.status);
309796c93589SGidon Studinski 		return -EINVAL;
309896c93589SGidon Studinski 	}
309996c93589SGidon Studinski 
310096c93589SGidon Studinski 	sring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
310196c93589SGidon Studinski 
310296c93589SGidon Studinski 	return 0;
310396c93589SGidon Studinski }
310496c93589SGidon Studinski 
310596c93589SGidon Studinski int wil_wmi_rx_desc_ring_add(struct wil6210_priv *wil, int status_ring_id)
310696c93589SGidon Studinski {
310796c93589SGidon Studinski 	struct net_device *ndev = wil->main_ndev;
310896c93589SGidon Studinski 	struct wil6210_vif *vif = ndev_to_vif(ndev);
310996c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_rx;
311096c93589SGidon Studinski 	int rc;
311196c93589SGidon Studinski 	struct wmi_rx_desc_ring_add_cmd cmd = {
311296c93589SGidon Studinski 		.ring_cfg = {
311396c93589SGidon Studinski 			.ring_size = cpu_to_le16(ring->size),
311496c93589SGidon Studinski 			.ring_id = WIL_RX_DESC_RING_ID,
311596c93589SGidon Studinski 		},
311696c93589SGidon Studinski 		.status_ring_id = status_ring_id,
311796c93589SGidon Studinski 		.irq_index = WIL_RX_STATUS_IRQ_IDX,
311896c93589SGidon Studinski 	};
311996c93589SGidon Studinski 	struct {
312096c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
312196c93589SGidon Studinski 		struct wmi_rx_desc_ring_cfg_done_event evt;
312296c93589SGidon Studinski 	} __packed reply = {
312396c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
312496c93589SGidon Studinski 	};
312596c93589SGidon Studinski 
312696c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(ring->pa);
312796c93589SGidon Studinski 	cmd.sw_tail_host_addr = cpu_to_le64(ring->edma_rx_swtail.pa);
312896c93589SGidon Studinski 	rc = wmi_call(wil, WMI_RX_DESC_RING_ADD_CMDID, vif->mid, &cmd,
312996c93589SGidon Studinski 		      sizeof(cmd), WMI_RX_DESC_RING_CFG_DONE_EVENTID, &reply,
313096c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
313196c93589SGidon Studinski 	if (rc) {
313296c93589SGidon Studinski 		wil_err(wil, "WMI_RX_DESC_RING_ADD_CMD failed, rc %d\n", rc);
313396c93589SGidon Studinski 		return rc;
313496c93589SGidon Studinski 	}
313596c93589SGidon Studinski 
313696c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
313796c93589SGidon Studinski 		wil_err(wil, "WMI_RX_DESC_RING_ADD_CMD failed, status %d\n",
313896c93589SGidon Studinski 			reply.evt.status);
313996c93589SGidon Studinski 		return -EINVAL;
314096c93589SGidon Studinski 	}
314196c93589SGidon Studinski 
314296c93589SGidon Studinski 	ring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
314396c93589SGidon Studinski 
314496c93589SGidon Studinski 	return 0;
314596c93589SGidon Studinski }
314696c93589SGidon Studinski 
314796c93589SGidon Studinski int wil_wmi_tx_desc_ring_add(struct wil6210_vif *vif, int ring_id, int cid,
314896c93589SGidon Studinski 			     int tid)
314996c93589SGidon Studinski {
315096c93589SGidon Studinski 	struct wil6210_priv *wil = vif_to_wil(vif);
315196c93589SGidon Studinski 	int sring_id = wil->tx_sring_idx; /* there is only one TX sring */
315296c93589SGidon Studinski 	int rc;
315396c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_tx[ring_id];
315496c93589SGidon Studinski 	struct wil_ring_tx_data *txdata = &wil->ring_tx_data[ring_id];
315596c93589SGidon Studinski 	struct wmi_tx_desc_ring_add_cmd cmd = {
315696c93589SGidon Studinski 		.ring_cfg = {
315796c93589SGidon Studinski 			.ring_size = cpu_to_le16(ring->size),
315896c93589SGidon Studinski 			.ring_id = ring_id,
315996c93589SGidon Studinski 		},
316096c93589SGidon Studinski 		.status_ring_id = sring_id,
316196c93589SGidon Studinski 		.cid = cid,
316296c93589SGidon Studinski 		.tid = tid,
316396c93589SGidon Studinski 		.encap_trans_type = WMI_VRING_ENC_TYPE_802_3,
316496c93589SGidon Studinski 		.max_msdu_size = cpu_to_le16(wil_mtu2macbuf(mtu_max)),
316596c93589SGidon Studinski 		.schd_params = {
316696c93589SGidon Studinski 			.priority = cpu_to_le16(0),
316796c93589SGidon Studinski 			.timeslot_us = cpu_to_le16(0xfff),
316896c93589SGidon Studinski 		}
316996c93589SGidon Studinski 	};
317096c93589SGidon Studinski 	struct {
317196c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
317296c93589SGidon Studinski 		struct wmi_tx_desc_ring_cfg_done_event evt;
317396c93589SGidon Studinski 	} __packed reply = {
317496c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
317596c93589SGidon Studinski 	};
317696c93589SGidon Studinski 
317796c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(ring->pa);
317896c93589SGidon Studinski 	rc = wmi_call(wil, WMI_TX_DESC_RING_ADD_CMDID, vif->mid, &cmd,
317996c93589SGidon Studinski 		      sizeof(cmd), WMI_TX_DESC_RING_CFG_DONE_EVENTID, &reply,
318096c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
318196c93589SGidon Studinski 	if (rc) {
318296c93589SGidon Studinski 		wil_err(wil, "WMI_TX_DESC_RING_ADD_CMD failed, rc %d\n", rc);
318396c93589SGidon Studinski 		return rc;
318496c93589SGidon Studinski 	}
318596c93589SGidon Studinski 
318696c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
318796c93589SGidon Studinski 		wil_err(wil, "WMI_TX_DESC_RING_ADD_CMD failed, status %d\n",
318896c93589SGidon Studinski 			reply.evt.status);
318996c93589SGidon Studinski 		return -EINVAL;
319096c93589SGidon Studinski 	}
319196c93589SGidon Studinski 
319296c93589SGidon Studinski 	spin_lock_bh(&txdata->lock);
319396c93589SGidon Studinski 	ring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
319496c93589SGidon Studinski 	txdata->mid = vif->mid;
319596c93589SGidon Studinski 	txdata->enabled = 1;
319696c93589SGidon Studinski 	spin_unlock_bh(&txdata->lock);
319796c93589SGidon Studinski 
319896c93589SGidon Studinski 	return 0;
319996c93589SGidon Studinski }
320096c93589SGidon Studinski 
320196c93589SGidon Studinski int wil_wmi_bcast_desc_ring_add(struct wil6210_vif *vif, int ring_id)
320296c93589SGidon Studinski {
320396c93589SGidon Studinski 	struct wil6210_priv *wil = vif_to_wil(vif);
320496c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_tx[ring_id];
320596c93589SGidon Studinski 	int rc;
320696c93589SGidon Studinski 	struct wmi_bcast_desc_ring_add_cmd cmd = {
320796c93589SGidon Studinski 		.ring_cfg = {
320896c93589SGidon Studinski 			.ring_size = cpu_to_le16(ring->size),
320996c93589SGidon Studinski 			.ring_id = ring_id,
321096c93589SGidon Studinski 		},
321196c93589SGidon Studinski 		.status_ring_id = wil->tx_sring_idx,
321296c93589SGidon Studinski 		.encap_trans_type = WMI_VRING_ENC_TYPE_802_3,
321396c93589SGidon Studinski 	};
321496c93589SGidon Studinski 	struct {
321596c93589SGidon Studinski 		struct wmi_cmd_hdr hdr;
321696c93589SGidon Studinski 		struct wmi_rx_desc_ring_cfg_done_event evt;
321796c93589SGidon Studinski 	} __packed reply = {
321896c93589SGidon Studinski 		.evt = {.status = WMI_FW_STATUS_FAILURE},
321996c93589SGidon Studinski 	};
322096c93589SGidon Studinski 	struct wil_ring_tx_data *txdata = &wil->ring_tx_data[ring_id];
322196c93589SGidon Studinski 
322296c93589SGidon Studinski 	cmd.ring_cfg.ring_mem_base = cpu_to_le64(ring->pa);
322396c93589SGidon Studinski 	rc = wmi_call(wil, WMI_BCAST_DESC_RING_ADD_CMDID, vif->mid, &cmd,
322496c93589SGidon Studinski 		      sizeof(cmd), WMI_TX_DESC_RING_CFG_DONE_EVENTID, &reply,
322596c93589SGidon Studinski 		      sizeof(reply), WIL_WMI_CALL_GENERAL_TO_MS);
322696c93589SGidon Studinski 	if (rc) {
322796c93589SGidon Studinski 		wil_err(wil, "WMI_BCAST_DESC_RING_ADD_CMD failed, rc %d\n", rc);
322896c93589SGidon Studinski 		return rc;
322996c93589SGidon Studinski 	}
323096c93589SGidon Studinski 
323196c93589SGidon Studinski 	if (reply.evt.status != WMI_FW_STATUS_SUCCESS) {
323296c93589SGidon Studinski 		wil_err(wil, "Broadcast Tx config failed, status %d\n",
323396c93589SGidon Studinski 			reply.evt.status);
323496c93589SGidon Studinski 		return -EINVAL;
323596c93589SGidon Studinski 	}
323696c93589SGidon Studinski 
323796c93589SGidon Studinski 	spin_lock_bh(&txdata->lock);
323896c93589SGidon Studinski 	ring->hwtail = le32_to_cpu(reply.evt.ring_tail_ptr);
323996c93589SGidon Studinski 	txdata->mid = vif->mid;
324096c93589SGidon Studinski 	txdata->enabled = 1;
324196c93589SGidon Studinski 	spin_unlock_bh(&txdata->lock);
324296c93589SGidon Studinski 
324396c93589SGidon Studinski 	return 0;
324496c93589SGidon Studinski }
3245