mwl8k.c revision 42574ea2274ec0a2a9c58ab01be91b65e60a2291
1a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
2ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek * drivers/net/wireless/mwl8k.c
3ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek * Driver for Marvell TOPDOG 802.11 Wireless cards
4a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek *
5a145d575833ff47330125364cb49304db7308825Lennert Buytenhek * Copyright (C) 2008-2009 Marvell Semiconductor Inc.
6a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek *
7a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * This file is licensed under the terms of the GNU General Public
8a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * License version 2.  This program is licensed "as is" without any
9a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * warranty of any kind, whether express or implied.
10a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
11a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
12a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/init.h>
13a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/module.h>
14a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/kernel.h>
153d76e82c9538d8104e578ca460d35f214bfddfd3Lennert Buytenhek#include <linux/sched.h>
16a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/spinlock.h>
17a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/list.h>
18a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/pci.h>
19a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/delay.h>
20a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/completion.h>
21a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/etherdevice.h>
22a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <net/mac80211.h>
23a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/moduleparam.h>
24a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/firmware.h>
25a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#include <linux/workqueue.h>
26a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
27a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_DESC	"Marvell TOPDOG(R) 802.11 Wireless Network Driver"
28a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_NAME	KBUILD_MODNAME
296976b665fc2b19900659b964bba3b55de08f264fLennert Buytenhek#define MWL8K_VERSION	"0.11"
30a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
31a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Register definitions */
32a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_GEN_PTR			0x00000c10
33ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_MODE_STA				 0x0000005a
34ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_MODE_AP				 0x000000a5
35a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_INT_CODE			0x00000c14
36ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_FWSTA_READY			 0xf0f1f2f4
37ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_FWAP_READY			 0xf1f2f4a5
38ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_INT_CODE_CMD_FINISHED		 0x00000005
39a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_SCRATCH			0x00000c40
40a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
41a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Host->device communications */
42a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_H2A_INTERRUPT_EVENTS		0x00000c18
43a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_H2A_INTERRUPT_STATUS		0x00000c1c
44a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_H2A_INTERRUPT_MASK		0x00000c20
45a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_H2A_INTERRUPT_CLEAR_SEL	0x00000c24
46a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_H2A_INTERRUPT_STATUS_MASK	0x00000c28
47ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_H2A_INT_DUMMY			 (1 << 20)
48ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_H2A_INT_RESET			 (1 << 15)
49ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_H2A_INT_DOORBELL			 (1 << 1)
50ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_H2A_INT_PPA_READY		 (1 << 0)
51a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
52a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Device->host communications */
53a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_A2H_INTERRUPT_EVENTS		0x00000c2c
54a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_A2H_INTERRUPT_STATUS		0x00000c30
55a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_A2H_INTERRUPT_MASK		0x00000c34
56a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_A2H_INTERRUPT_CLEAR_SEL	0x00000c38
57a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_HIU_A2H_INTERRUPT_STATUS_MASK	0x00000c3c
58ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_DUMMY			 (1 << 20)
59ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_CHNL_SWITCHED		 (1 << 11)
60ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_QUEUE_EMPTY		 (1 << 10)
61ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_RADAR_DETECT		 (1 << 7)
62ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_RADIO_ON			 (1 << 6)
63ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_RADIO_OFF		 (1 << 5)
64ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_MAC_EVENT		 (1 << 3)
65ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_OPC_DONE			 (1 << 2)
66ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_RX_READY			 (1 << 1)
67ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek#define  MWL8K_A2H_INT_TX_DONE			 (1 << 0)
68a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
69a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_A2H_EVENTS	(MWL8K_A2H_INT_DUMMY | \
70a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_CHNL_SWITCHED | \
71a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_QUEUE_EMPTY | \
72a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_RADAR_DETECT | \
73a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_RADIO_ON | \
74a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_RADIO_OFF | \
75a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_MAC_EVENT | \
76a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_OPC_DONE | \
77a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_RX_READY | \
78a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_A2H_INT_TX_DONE)
79a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
80a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_RX_QUEUES		1
81a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_TX_QUEUES		4
82a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
8354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhekstruct rxd_ops {
8454bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	int rxd_size;
8554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	void (*rxd_init)(void *rxd, dma_addr_t next_dma_addr);
8654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	void (*rxd_refill)(void *rxd, dma_addr_t addr, int len);
8720f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	int (*rxd_process)(void *rxd, struct ieee80211_rx_status *status,
8820f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek			   __le16 *qos);
8954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek};
9054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
9145a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhekstruct mwl8k_device_info {
92a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek	char *part_name;
93a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek	char *helper_image;
94a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek	char *fw_image;
9589a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	struct rxd_ops *ap_rxd_ops;
9645a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek};
9745a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek
98a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_rx_queue {
9945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	int rxd_count;
100a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
101a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* hw receives here */
10245eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	int head;
103a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
104a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* refill descs here */
10545eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	int tail;
106a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
10754bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	void *rxd;
10845eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	dma_addr_t rxd_dma;
109788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek	struct {
110788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		struct sk_buff *skb;
111788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		DECLARE_PCI_UNMAP_ADDR(dma)
112788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek	} *buf;
113a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek};
114a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
115a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_tx_queue {
116a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* hw transmits here */
11745eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	int head;
118a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
119a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* sw appends here */
12045eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	int tail;
121a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
12245eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	struct ieee80211_tx_queue_stats stats;
12345eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	struct mwl8k_tx_desc *txd;
12445eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	dma_addr_t txd_dma;
12545eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	struct sk_buff **skb;
126a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek};
127a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
128a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_priv {
129a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_hw *hw;
130a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct pci_dev *pdev;
131a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
13245a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek	struct mwl8k_device_info *device_info;
13345a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek
134be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	void __iomem *sram;
135be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	void __iomem *regs;
136be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
137be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	/* firmware */
13822be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek	struct firmware *fw_helper;
13922be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek	struct firmware *fw_ucode;
140a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
141be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	/* hardware/firmware parameters */
142be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	bool ap_fw;
143be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	struct rxd_ops *rxd_ops;
144777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek	struct ieee80211_supported_band band_24;
145777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek	struct ieee80211_channel channels_24[14];
146777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek	struct ieee80211_rate rates_24[14];
1474eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	struct ieee80211_supported_band band_50;
1484eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	struct ieee80211_channel channels_50[4];
1494eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	struct ieee80211_rate rates_50[9];
150be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
151618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	/* firmware access */
152618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	struct mutex fw_mutex;
153618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	struct task_struct *fw_mutex_owner;
154618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	int fw_mutex_depth;
155618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	struct completion *hostcmd_wait;
156618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
157a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* lock held over TX and TX reap */
158a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	spinlock_t tx_lock;
159a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
16088de754ad59025eba797e7a8375807755577f450Lennert Buytenhek	/* TX quiesce completion, protected by fw_mutex and tx_lock */
16188de754ad59025eba797e7a8375807755577f450Lennert Buytenhek	struct completion *tx_wait;
16288de754ad59025eba797e7a8375807755577f450Lennert Buytenhek
163a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_vif *vif;
164a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
165a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* power management status cookie from firmware */
166a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	u32 *cookie;
167a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dma_addr_t cookie_dma;
168a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
169a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	u16 num_mcaddrs;
170a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	u8 hw_rev;
1712aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek	u32 fw_rev;
172a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
173a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/*
174a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * Running count of TX packets in flight, to avoid
175a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * iterating over the transmit rings each time.
176a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 */
177a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int pending_tx_pkts;
178a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
179a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_rx_queue rxq[MWL8K_RX_QUEUES];
180a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_tx_queue txq[MWL8K_TX_QUEUES];
181a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
182c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek	bool radio_on;
18368ce38845c23443b15e374fb7362916c1231278eLennert Buytenhek	bool radio_short_preamble;
184a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	bool sniffer_enabled;
1850439b1f55646ea944b0d58337f5065b79a1c1be0Lennert Buytenhek	bool wmm_enabled;
186a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
187bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	struct work_struct sta_notify_worker;
188bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	spinlock_t sta_notify_list_lock;
189bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	struct list_head sta_notify_list;
190bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
191a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* XXX need to convert this to handle multiple interfaces */
192a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	bool capture_beacon;
193d89173f25228b8795af2d4b53e985cc44c729332Lennert Buytenhek	u8 capture_bssid[ETH_ALEN];
194a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct sk_buff *beacon_skb;
195a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
196a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/*
197a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * This FJ worker has to be global as it is scheduled from the
198a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * RX handler.  At this point we don't know which interface it
199a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * belongs to until the list of bssids waiting to complete join
200a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * is checked.
201a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 */
202a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct work_struct finalize_join_worker;
203a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2041e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	/* Tasklet to perform TX reclaim.  */
2051e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	struct tasklet_struct poll_tx_task;
20667e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek
20767e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	/* Tasklet to perform RX.  */
20867e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	struct tasklet_struct poll_rx_task;
209a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek};
210a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
211a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Per interface specific private data */
212a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_vif {
213c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhek	/* Non AMPDU sequence number assigned by driver.  */
214a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	u16 seqno;
215a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek};
216a94cc97e14c5750ec2b50b2e4ecdfb0f369ed0f4Lennert Buytenhek#define MWL8K_VIF(_vif) ((struct mwl8k_vif *)&((_vif)->drv_priv))
217a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
218a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhekstruct mwl8k_sta {
219a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	/* Index into station database. Returned by UPDATE_STADB.  */
220a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	u8 peer_id;
221a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek};
222a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek#define MWL8K_STA(_sta) ((struct mwl8k_sta *)&((_sta)->drv_priv))
223a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek
224777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhekstatic const struct ieee80211_channel mwl8k_channels_24[] = {
225a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2412, .hw_value = 1, },
226a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2417, .hw_value = 2, },
227a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2422, .hw_value = 3, },
228a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2427, .hw_value = 4, },
229a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2432, .hw_value = 5, },
230a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2437, .hw_value = 6, },
231a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2442, .hw_value = 7, },
232a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2447, .hw_value = 8, },
233a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2452, .hw_value = 9, },
234a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2457, .hw_value = 10, },
235a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .center_freq = 2462, .hw_value = 11, },
236647ca6b01a5289948e970ea7c1f656f9d90b0a27Lennert Buytenhek	{ .center_freq = 2467, .hw_value = 12, },
237647ca6b01a5289948e970ea7c1f656f9d90b0a27Lennert Buytenhek	{ .center_freq = 2472, .hw_value = 13, },
238647ca6b01a5289948e970ea7c1f656f9d90b0a27Lennert Buytenhek	{ .center_freq = 2484, .hw_value = 14, },
239a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek};
240a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
241777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhekstatic const struct ieee80211_rate mwl8k_rates_24[] = {
242a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 10, .hw_value = 2, },
243a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 20, .hw_value = 4, },
244a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 55, .hw_value = 11, },
2455dfd3e2c6fb69cf4295ec139107f4ebd3f7fbff0Lennert Buytenhek	{ .bitrate = 110, .hw_value = 22, },
2465dfd3e2c6fb69cf4295ec139107f4ebd3f7fbff0Lennert Buytenhek	{ .bitrate = 220, .hw_value = 44, },
247a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 60, .hw_value = 12, },
248a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 90, .hw_value = 18, },
249a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 120, .hw_value = 24, },
250a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 180, .hw_value = 36, },
251a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 240, .hw_value = 48, },
252a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 360, .hw_value = 72, },
253a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 480, .hw_value = 96, },
254a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	{ .bitrate = 540, .hw_value = 108, },
255140eb5e2c1978622d7cd979d59a1c0586fe3bbdbLennert Buytenhek	{ .bitrate = 720, .hw_value = 144, },
256140eb5e2c1978622d7cd979d59a1c0586fe3bbdbLennert Buytenhek};
257140eb5e2c1978622d7cd979d59a1c0586fe3bbdbLennert Buytenhek
2584eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhekstatic const struct ieee80211_channel mwl8k_channels_50[] = {
2594eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .center_freq = 5180, .hw_value = 36, },
2604eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .center_freq = 5200, .hw_value = 40, },
2614eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .center_freq = 5220, .hw_value = 44, },
2624eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .center_freq = 5240, .hw_value = 48, },
2634eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek};
2644eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek
2654eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhekstatic const struct ieee80211_rate mwl8k_rates_50[] = {
2664eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 60, .hw_value = 12, },
2674eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 90, .hw_value = 18, },
2684eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 120, .hw_value = 24, },
2694eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 180, .hw_value = 36, },
2704eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 240, .hw_value = 48, },
2714eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 360, .hw_value = 72, },
2724eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 480, .hw_value = 96, },
2734eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 540, .hw_value = 108, },
2744eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	{ .bitrate = 720, .hw_value = 144, },
2754eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek};
2764eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek
277a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Set or get info from Firmware */
278a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_SET			0x0001
279a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_GET			0x0000
280a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
281a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Firmware command codes */
282a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_CODE_DNLD		0x0001
283a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_GET_HW_SPEC		0x0003
28442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek#define MWL8K_CMD_SET_HW_SPEC		0x0004
285a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_MAC_MULTICAST_ADR	0x0010
286a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_GET_STAT		0x0014
287ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_RADIO_CONTROL		0x001c
288ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_RF_TX_POWER		0x001e
28908b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek#define MWL8K_CMD_RF_ANTENNA		0x0020
290b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek#define MWL8K_CMD_SET_BEACON		0x0100
291a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_SET_PRE_SCAN		0x0107
292a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_SET_POST_SCAN		0x0108
293ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_SET_RF_CHANNEL	0x010a
294ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_SET_AID		0x010d
295ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_SET_RATE		0x0110
296ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_SET_FINALIZE_JOIN	0x0111
297ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_RTS_THRESHOLD		0x0113
298a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_SET_SLOT		0x0114
299ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_SET_EDCA_PARAMS	0x0115
300ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_SET_WMM_MODE		0x0123
301a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_MIMO_CONFIG		0x0125
302ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_USE_FIXED_RATE	0x0126
303a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_ENABLE_SNIFFER	0x0150
30432060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek#define MWL8K_CMD_SET_MAC_ADDR		0x0202
305a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMD_SET_RATEADAPT_MODE	0x0203
306b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek#define MWL8K_CMD_BSS_START		0x1100
3073f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek#define MWL8K_CMD_SET_NEW_STN		0x1111
308ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek#define MWL8K_CMD_UPDATE_STADB		0x1123
309a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
310a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic const char *mwl8k_cmd_name(u16 cmd, char *buf, int bufsize)
311a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
312a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_CMDNAME(x)	case MWL8K_CMD_##x: do {\
313a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek					snprintf(buf, bufsize, "%s", #x);\
314a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek					return buf;\
315a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek					} while (0)
316ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek	switch (cmd & ~0x8000) {
317a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(CODE_DNLD);
318a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(GET_HW_SPEC);
31942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		MWL8K_CMDNAME(SET_HW_SPEC);
320a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(MAC_MULTICAST_ADR);
321a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(GET_STAT);
322a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(RADIO_CONTROL);
323a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(RF_TX_POWER);
32408b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek		MWL8K_CMDNAME(RF_ANTENNA);
325b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		MWL8K_CMDNAME(SET_BEACON);
326a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(SET_PRE_SCAN);
327a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(SET_POST_SCAN);
328a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(SET_RF_CHANNEL);
329ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek		MWL8K_CMDNAME(SET_AID);
330ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek		MWL8K_CMDNAME(SET_RATE);
331ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek		MWL8K_CMDNAME(SET_FINALIZE_JOIN);
332ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek		MWL8K_CMDNAME(RTS_THRESHOLD);
333a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(SET_SLOT);
334ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek		MWL8K_CMDNAME(SET_EDCA_PARAMS);
335ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek		MWL8K_CMDNAME(SET_WMM_MODE);
336a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(MIMO_CONFIG);
337ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek		MWL8K_CMDNAME(USE_FIXED_RATE);
338a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(ENABLE_SNIFFER);
33932060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek		MWL8K_CMDNAME(SET_MAC_ADDR);
340a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		MWL8K_CMDNAME(SET_RATEADAPT_MODE);
341b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		MWL8K_CMDNAME(BSS_START);
3423f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		MWL8K_CMDNAME(SET_NEW_STN);
343ff45fc60ad583f45ecf10a41f7dbecf78519bcc1Lennert Buytenhek		MWL8K_CMDNAME(UPDATE_STADB);
344a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	default:
345a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		snprintf(buf, bufsize, "0x%x", cmd);
346a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
347a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#undef MWL8K_CMDNAME
348a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
349a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return buf;
350a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
351a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
352a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Hardware and firmware reset */
353a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void mwl8k_hw_reset(struct mwl8k_priv *priv)
354a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
355a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(MWL8K_H2A_INT_RESET,
356a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->regs + MWL8K_HIU_H2A_INTERRUPT_EVENTS);
357a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(MWL8K_H2A_INT_RESET,
358a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->regs + MWL8K_HIU_H2A_INTERRUPT_EVENTS);
359a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	msleep(20);
360a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
361a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
362a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Release fw image */
363a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void mwl8k_release_fw(struct firmware **fw)
364a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
365a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (*fw == NULL)
366a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return;
367a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	release_firmware(*fw);
368a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	*fw = NULL;
369a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
370a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
371a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void mwl8k_release_firmware(struct mwl8k_priv *priv)
372a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
37322be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek	mwl8k_release_fw(&priv->fw_ucode);
37422be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek	mwl8k_release_fw(&priv->fw_helper);
375a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
376a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
377a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Request fw image */
378a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_request_fw(struct mwl8k_priv *priv,
379c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek			    const char *fname, struct firmware **fw)
380a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
381a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* release current image */
382a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (*fw != NULL)
383a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		mwl8k_release_fw(fw);
384a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
385a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return request_firmware((const struct firmware **)fw,
386c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek				fname, &priv->pdev->dev);
387a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
388a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
38945a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhekstatic int mwl8k_request_firmware(struct mwl8k_priv *priv)
390a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
391a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek	struct mwl8k_device_info *di = priv->device_info;
392a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
393a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
394a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek	if (di->helper_image != NULL) {
39522be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek		rc = mwl8k_request_fw(priv, di->helper_image, &priv->fw_helper);
396a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek		if (rc) {
397a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek			printk(KERN_ERR "%s: Error requesting helper "
398a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek			       "firmware file %s\n", pci_name(priv->pdev),
399a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek			       di->helper_image);
400a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek			return rc;
401a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek		}
402a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
403a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
40422be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek	rc = mwl8k_request_fw(priv, di->fw_image, &priv->fw_ucode);
405a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
406c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		printk(KERN_ERR "%s: Error requesting firmware file %s\n",
407a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek		       pci_name(priv->pdev), di->fw_image);
40822be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek		mwl8k_release_fw(&priv->fw_helper);
409a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return rc;
410a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
411a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
412a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return 0;
413a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
414a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
415a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_cmd_pkt {
416a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16	code;
417a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16	length;
418a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16	seq_num;
419a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16	result;
420a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	char	payload[0];
421a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
422a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
423a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
424a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * Firmware loading.
425a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
426a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int
427a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekmwl8k_send_fw_load_cmd(struct mwl8k_priv *priv, void *data, int length)
428a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
429a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	void __iomem *regs = priv->regs;
430a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dma_addr_t dma_addr;
431a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int loops;
432a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
433a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dma_addr = pci_map_single(priv->pdev, data, length, PCI_DMA_TODEVICE);
434a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (pci_dma_mapping_error(priv->pdev, dma_addr))
435a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
436a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
437a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(dma_addr, regs + MWL8K_HIU_GEN_PTR);
438a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(0, regs + MWL8K_HIU_INT_CODE);
439a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(MWL8K_H2A_INT_DOORBELL,
440a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		regs + MWL8K_HIU_H2A_INTERRUPT_EVENTS);
441a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(MWL8K_H2A_INT_DUMMY,
442a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		regs + MWL8K_HIU_H2A_INTERRUPT_EVENTS);
443a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
444a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	loops = 1000;
445a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	do {
446a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		u32 int_code;
447a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
448a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		int_code = ioread32(regs + MWL8K_HIU_INT_CODE);
449a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (int_code == MWL8K_INT_CODE_CMD_FINISHED) {
450a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			iowrite32(0, regs + MWL8K_HIU_INT_CODE);
451a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			break;
452a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
453a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4543d76e82c9538d8104e578ca460d35f214bfddfd3Lennert Buytenhek		cond_resched();
455a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		udelay(1);
456a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	} while (--loops);
457a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
458a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_unmap_single(priv->pdev, dma_addr, length, PCI_DMA_TODEVICE);
459a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
460d4b7057052236e81ab0788cc8df306dc02b0e7beLennert Buytenhek	return loops ? 0 : -ETIMEDOUT;
461a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
462a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
463a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_load_fw_image(struct mwl8k_priv *priv,
464a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				const u8 *data, size_t length)
465a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
466a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt *cmd;
467a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int done;
468a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc = 0;
469a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
470a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kmalloc(sizeof(*cmd) + 256, GFP_KERNEL);
471a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
472a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
473a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
474a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->code = cpu_to_le16(MWL8K_CMD_CODE_DNLD);
475a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->seq_num = 0;
476a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->result = 0;
477a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
478a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	done = 0;
479a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	while (length) {
480a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		int block_size = length > 256 ? 256 : length;
481a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
482a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		memcpy(cmd->payload, data + done, block_size);
483a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		cmd->length = cpu_to_le16(block_size);
484a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
485a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		rc = mwl8k_send_fw_load_cmd(priv, cmd,
486a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek						sizeof(*cmd) + block_size);
487a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (rc)
488a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			break;
489a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
490a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		done += block_size;
491a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		length -= block_size;
492a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
493a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
494a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (!rc) {
495a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		cmd->length = 0;
496a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		rc = mwl8k_send_fw_load_cmd(priv, cmd, sizeof(*cmd));
497a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
498a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
499a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
500a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
501a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
502a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
503a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
504a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_feed_fw_image(struct mwl8k_priv *priv,
505a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				const u8 *data, size_t length)
506a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
507a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	unsigned char *buffer;
508a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int may_continue, rc = 0;
509a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	u32 done, prev_block_size;
510a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
511a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	buffer = kmalloc(1024, GFP_KERNEL);
512a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (buffer == NULL)
513a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
514a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
515a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	done = 0;
516a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	prev_block_size = 0;
517a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	may_continue = 1000;
518a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	while (may_continue > 0) {
519a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		u32 block_size;
520a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
521a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		block_size = ioread32(priv->regs + MWL8K_HIU_SCRATCH);
522a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (block_size & 1) {
523a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			block_size &= ~1;
524a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			may_continue--;
525a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		} else {
526a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			done += prev_block_size;
527a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			length -= prev_block_size;
528a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
529a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
530a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (block_size > 1024 || block_size > length) {
531a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			rc = -EOVERFLOW;
532a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			break;
533a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
534a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
535a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (length == 0) {
536a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			rc = 0;
537a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			break;
538a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
539a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
540a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (block_size == 0) {
541a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			rc = -EPROTO;
542a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			may_continue--;
543a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			udelay(1);
544a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			continue;
545a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
546a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
547a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		prev_block_size = block_size;
548a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		memcpy(buffer, data + done, block_size);
549a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
550a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		rc = mwl8k_send_fw_load_cmd(priv, buffer, block_size);
551a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (rc)
552a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			break;
553a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
554a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
555a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (!rc && length != 0)
556a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		rc = -EREMOTEIO;
557a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
558a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(buffer);
559a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
560a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
561a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
562a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
563c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhekstatic int mwl8k_load_firmware(struct ieee80211_hw *hw)
564a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
565c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
56622be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek	struct firmware *fw = priv->fw_ucode;
567c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek	int rc;
568c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek	int loops;
569c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek
570c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek	if (!memcmp(fw->data, "\x01\x00\x00\x00", 4)) {
57122be40d9c53faa10d03a679160e0854ad115b610Lennert Buytenhek		struct firmware *helper = priv->fw_helper;
572a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
573c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		if (helper == NULL) {
574c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek			printk(KERN_ERR "%s: helper image needed but none "
575c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek			       "given\n", pci_name(priv->pdev));
576c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek			return -EINVAL;
577c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		}
578a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
579c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		rc = mwl8k_load_fw_image(priv, helper->data, helper->size);
580a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (rc) {
581a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			printk(KERN_ERR "%s: unable to load firmware "
582c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek			       "helper image\n", pci_name(priv->pdev));
583a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			return rc;
584a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
58589b872e2e476833cde8aaac658c75817f67e8f81Lennert Buytenhek		msleep(5);
586a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
587c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		rc = mwl8k_feed_fw_image(priv, fw->data, fw->size);
588a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	} else {
589c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		rc = mwl8k_load_fw_image(priv, fw->data, fw->size);
590a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
591a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
592a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
593c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		printk(KERN_ERR "%s: unable to load firmware image\n",
594c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       pci_name(priv->pdev));
595a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return rc;
596a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
597a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
59889a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	iowrite32(MWL8K_MODE_STA, priv->regs + MWL8K_HIU_GEN_PTR);
599a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
60089b872e2e476833cde8aaac658c75817f67e8f81Lennert Buytenhek	loops = 500000;
601a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	do {
602eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek		u32 ready_code;
603eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek
604eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek		ready_code = ioread32(priv->regs + MWL8K_HIU_INT_CODE);
605eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek		if (ready_code == MWL8K_FWAP_READY) {
606eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek			priv->ap_fw = 1;
607eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek			break;
608eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek		} else if (ready_code == MWL8K_FWSTA_READY) {
609eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek			priv->ap_fw = 0;
610a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			break;
611eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek		}
612eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek
613eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek		cond_resched();
614a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		udelay(1);
615a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	} while (--loops);
616a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
617a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return loops ? 0 : -ETIMEDOUT;
618a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
619a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
620a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
621a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* DMA header used by firmware and hardware.  */
622a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_dma_data {
623a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 fwlen;
624a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_hdr wh;
62520f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	char data[0];
626a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
627a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
628a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Routines to add/remove DMA header from skb.  */
62920f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhekstatic inline void mwl8k_remove_dma_header(struct sk_buff *skb, __le16 qos)
630a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
63120f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	struct mwl8k_dma_data *tr;
63220f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	int hdrlen;
63320f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek
63420f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	tr = (struct mwl8k_dma_data *)skb->data;
63520f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	hdrlen = ieee80211_hdrlen(tr->wh.frame_control);
63620f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek
63720f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	if (hdrlen != sizeof(tr->wh)) {
63820f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		if (ieee80211_is_data_qos(tr->wh.frame_control)) {
63920f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek			memmove(tr->data - hdrlen, &tr->wh, hdrlen - 2);
64020f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek			*((__le16 *)(tr->data - 2)) = qos;
64120f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		} else {
64220f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek			memmove(tr->data - hdrlen, &tr->wh, hdrlen);
64320f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		}
644a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
64520f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek
64620f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	if (hdrlen != sizeof(*tr))
64720f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		skb_pull(skb, sizeof(*tr) - hdrlen);
648a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
649a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
65076266b2ad38c33fb2c1475cfeb35ed070adaba2bLennert Buytenhekstatic inline void mwl8k_add_dma_header(struct sk_buff *skb)
651a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
652a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_hdr *wh;
653ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	int hdrlen;
654a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_dma_data *tr;
655a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
656ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	/*
657ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	 * Add a firmware DMA header; the firmware requires that we
658ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	 * present a 2-byte payload length followed by a 4-address
659ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	 * header (without QoS field), followed (optionally) by any
660ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	 * WEP/ExtIV header (but only filled in for CCMP).
661ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	 */
662a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	wh = (struct ieee80211_hdr *)skb->data;
663ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek
664a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	hdrlen = ieee80211_hdrlen(wh->frame_control);
665ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	if (hdrlen != sizeof(*tr))
666ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek		skb_push(skb, sizeof(*tr) - hdrlen);
667a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
668ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	if (ieee80211_is_data_qos(wh->frame_control))
669ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek		hdrlen -= 2;
670a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
671a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	tr = (struct mwl8k_dma_data *)skb->data;
672a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (wh != &tr->wh)
673a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		memmove(&tr->wh, wh, hdrlen);
674ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	if (hdrlen != sizeof(tr->wh))
675ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek		memset(((void *)&tr->wh) + hdrlen, 0, sizeof(tr->wh) - hdrlen);
676a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
677a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/*
678a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * Firmware length is the length of the fully formed "802.11
679a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * payload".  That is, everything except for the 802.11 header.
680a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * This includes all crypto material including the MIC.
681a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 */
682ca00930153c14b323c31b97623ac5c4f7855ed6aLennert Buytenhek	tr->fwlen = cpu_to_le16(skb->len - sizeof(*tr));
683a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
684a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
685a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
686a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
68789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek * Packet reception for 88w8366 AP firmware.
6886f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek */
68989a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekstruct mwl8k_rxd_8366_ap {
6906f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__le16 pkt_len;
6916f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__u8 sq2;
6926f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__u8 rate;
6936f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__le32 pkt_phys_addr;
6946f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__le32 next_rxd_phys_addr;
6956f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__le16 qos_control;
6966f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__le16 htsig2;
6976f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__le32 hw_rssi_info;
6986f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__le32 hw_noise_floor_info;
6996f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__u8 noise_floor;
7006f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__u8 pad0[3];
7016f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__u8 rssi;
7026f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__u8 rx_status;
7036f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__u8 channel;
7046f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	__u8 rx_ctrl;
7056f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek} __attribute__((packed));
7066f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
70789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_8366_AP_RATE_INFO_MCS_FORMAT	0x80
70889a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_8366_AP_RATE_INFO_40MHZ		0x40
70989a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_8366_AP_RATE_INFO_RATEID(x)	((x) & 0x3f)
7108e9f33f0ced82a797d285b233e1c956cbd5c7de3Lennert Buytenhek
71189a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_8366_AP_RX_CTRL_OWNED_BY_HOST	0x80
7126f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
71389a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekstatic void mwl8k_rxd_8366_ap_init(void *_rxd, dma_addr_t next_dma_addr)
7146f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek{
71589a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	struct mwl8k_rxd_8366_ap *rxd = _rxd;
7166f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
7176f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	rxd->next_rxd_phys_addr = cpu_to_le32(next_dma_addr);
71889a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	rxd->rx_ctrl = MWL8K_8366_AP_RX_CTRL_OWNED_BY_HOST;
7196f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek}
7206f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
72189a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekstatic void mwl8k_rxd_8366_ap_refill(void *_rxd, dma_addr_t addr, int len)
7226f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek{
72389a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	struct mwl8k_rxd_8366_ap *rxd = _rxd;
7246f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
7256f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	rxd->pkt_len = cpu_to_le16(len);
7266f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	rxd->pkt_phys_addr = cpu_to_le32(addr);
7276f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	wmb();
7286f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	rxd->rx_ctrl = 0;
7296f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek}
7306f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
7316f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhekstatic int
73289a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekmwl8k_rxd_8366_ap_process(void *_rxd, struct ieee80211_rx_status *status,
73389a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek			  __le16 *qos)
7346f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek{
73589a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	struct mwl8k_rxd_8366_ap *rxd = _rxd;
7366f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
73789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	if (!(rxd->rx_ctrl & MWL8K_8366_AP_RX_CTRL_OWNED_BY_HOST))
7386f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek		return -1;
7396f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	rmb();
7406f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
7416f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	memset(status, 0, sizeof(*status));
7426f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
7436f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	status->signal = -rxd->rssi;
7446f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	status->noise = -rxd->noise_floor;
7456f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
74689a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	if (rxd->rate & MWL8K_8366_AP_RATE_INFO_MCS_FORMAT) {
7476f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek		status->flag |= RX_FLAG_HT;
74889a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek		if (rxd->rate & MWL8K_8366_AP_RATE_INFO_40MHZ)
7498e9f33f0ced82a797d285b233e1c956cbd5c7de3Lennert Buytenhek			status->flag |= RX_FLAG_40MHZ;
75089a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek		status->rate_idx = MWL8K_8366_AP_RATE_INFO_RATEID(rxd->rate);
7516f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	} else {
7526f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek		int i;
7536f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
754777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		for (i = 0; i < ARRAY_SIZE(mwl8k_rates_24); i++) {
755777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek			if (mwl8k_rates_24[i].hw_value == rxd->rate) {
7566f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek				status->rate_idx = i;
7576f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek				break;
7586f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek			}
7596f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek		}
7606f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	}
7616f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
762854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek	if (rxd->channel > 14) {
763854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek		status->band = IEEE80211_BAND_5GHZ;
764854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek		if (!(status->flag & RX_FLAG_HT))
765854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek			status->rate_idx -= 5;
766854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek	} else {
767854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek		status->band = IEEE80211_BAND_2GHZ;
768854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek	}
7696f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	status->freq = ieee80211_channel_to_frequency(rxd->channel);
7706f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
77120f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	*qos = rxd->qos_control;
77220f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek
7736f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek	return le16_to_cpu(rxd->pkt_len);
7746f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek}
7756f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
77689a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekstatic struct rxd_ops rxd_8366_ap_ops = {
77789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	.rxd_size	= sizeof(struct mwl8k_rxd_8366_ap),
77889a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	.rxd_init	= mwl8k_rxd_8366_ap_init,
77989a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	.rxd_refill	= mwl8k_rxd_8366_ap_refill,
78089a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	.rxd_process	= mwl8k_rxd_8366_ap_process,
7816f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek};
7826f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
7836f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek/*
78489a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek * Packet reception for STA firmware.
785a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
78689a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekstruct mwl8k_rxd_sta {
787a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 pkt_len;
788a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 link_quality;
789a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 noise_level;
790a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 pkt_phys_addr;
79145eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	__le32 next_rxd_phys_addr;
792a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 qos_control;
793a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 rate_info;
794a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 pad0[4];
795a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 rssi;
796a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 channel;
797a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 pad1;
798a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 rx_ctrl;
799a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 rx_status;
800a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 pad2[2];
801a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
802a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
80389a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_STA_RATE_INFO_SHORTPRE		0x8000
80489a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_STA_RATE_INFO_ANTSELECT(x)	(((x) >> 11) & 0x3)
80589a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_STA_RATE_INFO_RATEID(x)		(((x) >> 3) & 0x3f)
80689a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_STA_RATE_INFO_40MHZ		0x0004
80789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_STA_RATE_INFO_SHORTGI		0x0002
80889a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_STA_RATE_INFO_MCS_FORMAT		0x0001
80954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
81089a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek#define MWL8K_STA_RX_CTRL_OWNED_BY_HOST		0x02
81154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
81289a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekstatic void mwl8k_rxd_sta_init(void *_rxd, dma_addr_t next_dma_addr)
81354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek{
81489a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	struct mwl8k_rxd_sta *rxd = _rxd;
81554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
81654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	rxd->next_rxd_phys_addr = cpu_to_le32(next_dma_addr);
81789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	rxd->rx_ctrl = MWL8K_STA_RX_CTRL_OWNED_BY_HOST;
81854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek}
81954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
82089a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekstatic void mwl8k_rxd_sta_refill(void *_rxd, dma_addr_t addr, int len)
82154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek{
82289a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	struct mwl8k_rxd_sta *rxd = _rxd;
82354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
82454bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	rxd->pkt_len = cpu_to_le16(len);
82554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	rxd->pkt_phys_addr = cpu_to_le32(addr);
82654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	wmb();
82754bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	rxd->rx_ctrl = 0;
82854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek}
82954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
83054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhekstatic int
83189a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekmwl8k_rxd_sta_process(void *_rxd, struct ieee80211_rx_status *status,
83220f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		       __le16 *qos)
83354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek{
83489a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	struct mwl8k_rxd_sta *rxd = _rxd;
83554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	u16 rate_info;
83654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
83789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	if (!(rxd->rx_ctrl & MWL8K_STA_RX_CTRL_OWNED_BY_HOST))
83854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		return -1;
83954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	rmb();
84054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
84154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	rate_info = le16_to_cpu(rxd->rate_info);
84254bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
84354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	memset(status, 0, sizeof(*status));
84454bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
84554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	status->signal = -rxd->rssi;
84654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	status->noise = -rxd->noise_level;
84789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	status->antenna = MWL8K_STA_RATE_INFO_ANTSELECT(rate_info);
84889a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	status->rate_idx = MWL8K_STA_RATE_INFO_RATEID(rate_info);
84954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
85089a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	if (rate_info & MWL8K_STA_RATE_INFO_SHORTPRE)
85154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		status->flag |= RX_FLAG_SHORTPRE;
85289a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	if (rate_info & MWL8K_STA_RATE_INFO_40MHZ)
85354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		status->flag |= RX_FLAG_40MHZ;
85489a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	if (rate_info & MWL8K_STA_RATE_INFO_SHORTGI)
85554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		status->flag |= RX_FLAG_SHORT_GI;
85689a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	if (rate_info & MWL8K_STA_RATE_INFO_MCS_FORMAT)
85754bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		status->flag |= RX_FLAG_HT;
85854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
859854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek	if (rxd->channel > 14) {
860854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek		status->band = IEEE80211_BAND_5GHZ;
861854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek		if (!(status->flag & RX_FLAG_HT))
862854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek			status->rate_idx -= 5;
863854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek	} else {
864854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek		status->band = IEEE80211_BAND_2GHZ;
865854783444bab0024556c0aefdb0a860f2f1da286Lennert Buytenhek	}
86654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	status->freq = ieee80211_channel_to_frequency(rxd->channel);
86754bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
86820f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek	*qos = rxd->qos_control;
86920f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek
87054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	return le16_to_cpu(rxd->pkt_len);
87154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek}
87254bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
87389a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhekstatic struct rxd_ops rxd_sta_ops = {
87489a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	.rxd_size	= sizeof(struct mwl8k_rxd_sta),
87589a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	.rxd_init	= mwl8k_rxd_sta_init,
87689a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	.rxd_refill	= mwl8k_rxd_sta_refill,
87789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek	.rxd_process	= mwl8k_rxd_sta_process,
87854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek};
87954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
88054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
881a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_RX_DESCS		256
882a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_RX_MAXSZ		3800
883a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
884a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_rxq_init(struct ieee80211_hw *hw, int index)
885a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
886a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
887a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_rx_queue *rxq = priv->rxq + index;
888a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int size;
889a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int i;
890a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
89145eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	rxq->rxd_count = 0;
89245eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	rxq->head = 0;
89345eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	rxq->tail = 0;
894a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
89554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek	size = MWL8K_RX_DESCS * priv->rxd_ops->rxd_size;
896a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
89745eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	rxq->rxd = pci_alloc_consistent(priv->pdev, size, &rxq->rxd_dma);
89845eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	if (rxq->rxd == NULL) {
899a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: failed to alloc RX descriptors\n",
900c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
901a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
902a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
90345eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	memset(rxq->rxd, 0, size);
904a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
905788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek	rxq->buf = kmalloc(MWL8K_RX_DESCS * sizeof(*rxq->buf), GFP_KERNEL);
906788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek	if (rxq->buf == NULL) {
907a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: failed to alloc RX skbuff list\n",
908c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
90945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		pci_free_consistent(priv->pdev, size, rxq->rxd, rxq->rxd_dma);
910a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
911a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
912788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek	memset(rxq->buf, 0, MWL8K_RX_DESCS * sizeof(*rxq->buf));
913a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
914a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_RX_DESCS; i++) {
91554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		int desc_size;
91654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		void *rxd;
917a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		int nexti;
91854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		dma_addr_t next_dma_addr;
91954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
92054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		desc_size = priv->rxd_ops->rxd_size;
92154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		rxd = rxq->rxd + (i * priv->rxd_ops->rxd_size);
922a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
92354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		nexti = i + 1;
92454bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		if (nexti == MWL8K_RX_DESCS)
92554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek			nexti = 0;
92654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		next_dma_addr = rxq->rxd_dma + (nexti * desc_size);
927a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
92854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		priv->rxd_ops->rxd_init(rxd, next_dma_addr);
929a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
930a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
931a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return 0;
932a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
933a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
934a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int rxq_refill(struct ieee80211_hw *hw, int index, int limit)
935a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
936a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
937a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_rx_queue *rxq = priv->rxq + index;
938a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int refilled;
939a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
940a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	refilled = 0;
94145eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	while (rxq->rxd_count < MWL8K_RX_DESCS && limit--) {
942a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		struct sk_buff *skb;
943788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		dma_addr_t addr;
944a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		int rx;
94554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		void *rxd;
946a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
947a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		skb = dev_alloc_skb(MWL8K_RX_MAXSZ);
948a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (skb == NULL)
949a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			break;
950a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
951788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		addr = pci_map_single(priv->pdev, skb->data,
952788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek				      MWL8K_RX_MAXSZ, DMA_FROM_DEVICE);
953a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
95454bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		rxq->rxd_count++;
95554bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		rx = rxq->tail++;
95654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		if (rxq->tail == MWL8K_RX_DESCS)
95754bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek			rxq->tail = 0;
958788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		rxq->buf[rx].skb = skb;
959788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		pci_unmap_addr_set(&rxq->buf[rx], dma, addr);
96054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
96154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		rxd = rxq->rxd + (rx * priv->rxd_ops->rxd_size);
96254bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		priv->rxd_ops->rxd_refill(rxd, addr, MWL8K_RX_MAXSZ);
963a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
964a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		refilled++;
965a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
966a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
967a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return refilled;
968a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
969a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
970a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* Must be called only when the card's reception is completely halted */
971a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void mwl8k_rxq_deinit(struct ieee80211_hw *hw, int index)
972a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
973a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
974a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_rx_queue *rxq = priv->rxq + index;
975a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int i;
976a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
977a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_RX_DESCS; i++) {
978788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		if (rxq->buf[i].skb != NULL) {
979788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek			pci_unmap_single(priv->pdev,
980788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek					 pci_unmap_addr(&rxq->buf[i], dma),
981788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek					 MWL8K_RX_MAXSZ, PCI_DMA_FROMDEVICE);
982788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek			pci_unmap_addr_set(&rxq->buf[i], dma, 0);
983788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek
984788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek			kfree_skb(rxq->buf[i].skb);
985788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek			rxq->buf[i].skb = NULL;
986a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
987a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
988a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
989788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek	kfree(rxq->buf);
990788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek	rxq->buf = NULL;
991a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
992a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_free_consistent(priv->pdev,
99354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek			    MWL8K_RX_DESCS * priv->rxd_ops->rxd_size,
99445eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek			    rxq->rxd, rxq->rxd_dma);
99545eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	rxq->rxd = NULL;
996a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
997a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
998a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
999a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
1000a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * Scan a list of BSSIDs to process for finalize join.
1001a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * Allows for extension to process multiple BSSIDs.
1002a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
1003a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic inline int
1004a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekmwl8k_capture_bssid(struct mwl8k_priv *priv, struct ieee80211_hdr *wh)
1005a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1006a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return priv->capture_beacon &&
1007a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		ieee80211_is_beacon(wh->frame_control) &&
1008a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		!compare_ether_addr(wh->addr3, priv->capture_bssid);
1009a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1010a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
10113779752d764b86077375510b1fd13d8fb2c7c3a5Lennert Buytenhekstatic inline void mwl8k_save_beacon(struct ieee80211_hw *hw,
10123779752d764b86077375510b1fd13d8fb2c7c3a5Lennert Buytenhek				     struct sk_buff *skb)
1013a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
10143779752d764b86077375510b1fd13d8fb2c7c3a5Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
10153779752d764b86077375510b1fd13d8fb2c7c3a5Lennert Buytenhek
1016a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->capture_beacon = false;
1017d89173f25228b8795af2d4b53e985cc44c729332Lennert Buytenhek	memset(priv->capture_bssid, 0, ETH_ALEN);
1018a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1019a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/*
1020a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * Use GFP_ATOMIC as rxq_process is called from
1021a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * the primary interrupt handler, memory allocation call
1022a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * must not sleep.
1023a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 */
1024a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->beacon_skb = skb_copy(skb, GFP_ATOMIC);
1025a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (priv->beacon_skb != NULL)
10263779752d764b86077375510b1fd13d8fb2c7c3a5Lennert Buytenhek		ieee80211_queue_work(hw, &priv->finalize_join_worker);
1027a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1028a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1029a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int rxq_process(struct ieee80211_hw *hw, int index, int limit)
1030a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1031a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1032a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_rx_queue *rxq = priv->rxq + index;
1033a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int processed;
1034a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1035a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	processed = 0;
103645eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	while (rxq->rxd_count && limit--) {
1037a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		struct sk_buff *skb;
103854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		void *rxd;
103954bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		int pkt_len;
1040a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		struct ieee80211_rx_status status;
104120f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		__le16 qos;
1042a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1043788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		skb = rxq->buf[rxq->head].skb;
1044d25f9f1357139bbdc79bc960ea84909a7c22ec2bLennert Buytenhek		if (skb == NULL)
1045d25f9f1357139bbdc79bc960ea84909a7c22ec2bLennert Buytenhek			break;
104654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
104754bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		rxd = rxq->rxd + (rxq->head * priv->rxd_ops->rxd_size);
104854bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
104920f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		pkt_len = priv->rxd_ops->rxd_process(rxd, &status, &qos);
105054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		if (pkt_len < 0)
105154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek			break;
105254bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
1053788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		rxq->buf[rxq->head].skb = NULL;
1054788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek
1055788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		pci_unmap_single(priv->pdev,
1056788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek				 pci_unmap_addr(&rxq->buf[rxq->head], dma),
1057788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek				 MWL8K_RX_MAXSZ, PCI_DMA_FROMDEVICE);
1058788838ebe8a4caca93a91982c7bbf393edf24c08Lennert Buytenhek		pci_unmap_addr_set(&rxq->buf[rxq->head], dma, 0);
1059a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
106054bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		rxq->head++;
106154bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		if (rxq->head == MWL8K_RX_DESCS)
106254bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek			rxq->head = 0;
106354bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek
106445eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		rxq->rxd_count--;
1065a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
106654bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		skb_put(skb, pkt_len);
106720f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		mwl8k_remove_dma_header(skb, qos);
1068a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1069a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		/*
1070c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		 * Check for a pending join operation.  Save a
1071c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		 * copy of the beacon and schedule a tasklet to
1072c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		 * send a FINALIZE_JOIN command to the firmware.
1073a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		 */
107454bc3a0d7a0c9a13da31183609c42cf7786138e1Lennert Buytenhek		if (mwl8k_capture_bssid(priv, (void *)skb->data))
10753779752d764b86077375510b1fd13d8fb2c7c3a5Lennert Buytenhek			mwl8k_save_beacon(hw, skb);
1076a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1077f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg		memcpy(IEEE80211_SKB_RXCB(skb), &status, sizeof(status));
1078f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg		ieee80211_rx_irqsafe(hw, skb);
1079a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1080a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		processed++;
1081a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1082a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1083a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return processed;
1084a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1085a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1086a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1087a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
1088a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * Packet transmission.
1089a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
1090a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1091a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_TXD_STATUS_OK			0x00000001
1092a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_TXD_STATUS_OK_RETRY		0x00000002
1093a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_TXD_STATUS_OK_MORE_RETRY		0x00000004
1094a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_TXD_STATUS_MULTICAST_TX		0x00000008
1095a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_TXD_STATUS_FW_OWNED		0x80000000
1096a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1097e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek#define MWL8K_QOS_QLEN_UNSPEC			0xff00
1098e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek#define MWL8K_QOS_ACK_POLICY_MASK		0x0060
1099e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek#define MWL8K_QOS_ACK_POLICY_NORMAL		0x0000
1100e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek#define MWL8K_QOS_ACK_POLICY_BLOCKACK		0x0060
1101e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek#define MWL8K_QOS_EOSP				0x0010
1102e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek
1103a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_tx_desc {
1104a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 status;
1105a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 data_rate;
1106a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 tx_priority;
1107a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 qos_control;
1108a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 pkt_phys_addr;
1109a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 pkt_len;
1110d89173f25228b8795af2d4b53e985cc44c729332Lennert Buytenhek	__u8 dest_MAC_addr[ETH_ALEN];
111145eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	__le32 next_txd_phys_addr;
1112a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 reserved;
1113a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 rate_info;
1114a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 peer_id;
1115a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 tx_frag_cnt;
1116a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
1117a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1118a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_TX_DESCS		128
1119a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1120a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_txq_init(struct ieee80211_hw *hw, int index)
1121a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1122a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1123a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_tx_queue *txq = priv->txq + index;
1124a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int size;
1125a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int i;
1126a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
112745eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	memset(&txq->stats, 0, sizeof(struct ieee80211_tx_queue_stats));
112845eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->stats.limit = MWL8K_TX_DESCS;
112945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->head = 0;
113045eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->tail = 0;
1131a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1132a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	size = MWL8K_TX_DESCS * sizeof(struct mwl8k_tx_desc);
1133a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
113445eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->txd = pci_alloc_consistent(priv->pdev, size, &txq->txd_dma);
113545eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	if (txq->txd == NULL) {
1136a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: failed to alloc TX descriptors\n",
1137c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
1138a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
1139a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
114045eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	memset(txq->txd, 0, size);
1141a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
114245eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->skb = kmalloc(MWL8K_TX_DESCS * sizeof(*txq->skb), GFP_KERNEL);
114345eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	if (txq->skb == NULL) {
1144a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: failed to alloc TX skbuff list\n",
1145c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
114645eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		pci_free_consistent(priv->pdev, size, txq->txd, txq->txd_dma);
1147a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
1148a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
114945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	memset(txq->skb, 0, MWL8K_TX_DESCS * sizeof(*txq->skb));
1150a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1151a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_TX_DESCS; i++) {
1152a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		struct mwl8k_tx_desc *tx_desc;
1153a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		int nexti;
1154a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
115545eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		tx_desc = txq->txd + i;
1156a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		nexti = (i + 1) % MWL8K_TX_DESCS;
1157a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1158a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		tx_desc->status = 0;
115945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		tx_desc->next_txd_phys_addr =
116045eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek			cpu_to_le32(txq->txd_dma + nexti * sizeof(*tx_desc));
1161a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1162a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1163a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return 0;
1164a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1165a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1166a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic inline void mwl8k_tx_start(struct mwl8k_priv *priv)
1167a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1168a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(MWL8K_H2A_INT_PPA_READY,
1169a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->regs + MWL8K_HIU_H2A_INTERRUPT_EVENTS);
1170a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(MWL8K_H2A_INT_DUMMY,
1171a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->regs + MWL8K_HIU_H2A_INTERRUPT_EVENTS);
1172a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	ioread32(priv->regs + MWL8K_HIU_INT_CODE);
1173a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1174a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
11757e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhekstatic void mwl8k_dump_tx_rings(struct ieee80211_hw *hw)
1176a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
11777e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
11787e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	int i;
11797e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
11807e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++) {
11817e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		struct mwl8k_tx_queue *txq = priv->txq + i;
11827e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		int fw_owned = 0;
11837e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		int drv_owned = 0;
11847e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		int unused = 0;
11857e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		int desc;
11867e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
1187a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		for (desc = 0; desc < MWL8K_TX_DESCS; desc++) {
11887e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			struct mwl8k_tx_desc *tx_desc = txq->txd + desc;
11897e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			u32 status;
1190a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
11917e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			status = le32_to_cpu(tx_desc->status);
1192a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			if (status & MWL8K_TXD_STATUS_FW_OWNED)
11937e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek				fw_owned++;
1194a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			else
11957e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek				drv_owned++;
1196a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1197a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			if (tx_desc->pkt_len == 0)
11987e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek				unused++;
1199a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
1200a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
12017e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		printk(KERN_ERR "%s: txq[%d] len=%d head=%d tail=%d "
12027e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		       "fw_owned=%d drv_owned=%d unused=%d\n",
12037e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		       wiphy_name(hw->wiphy), i,
12047e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		       txq->stats.len, txq->head, txq->tail,
12057e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		       fw_owned, drv_owned, unused);
12067e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	}
1207a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1208a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1209618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek/*
121088de754ad59025eba797e7a8375807755577f450Lennert Buytenhek * Must be called with priv->fw_mutex held and tx queues stopped.
1211618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek */
121262abd3cfb2f1a0ab1963ac4c4087c477da6b1f2aLennert Buytenhek#define MWL8K_TX_WAIT_TIMEOUT_MS	5000
12137e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
1214950d5b0191dc3e71017f336017f75f6189f39f08Lennert Buytenhekstatic int mwl8k_tx_wait_empty(struct ieee80211_hw *hw)
1215a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1216a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
121788de754ad59025eba797e7a8375807755577f450Lennert Buytenhek	DECLARE_COMPLETION_ONSTACK(tx_wait);
12187e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	int retry;
12197e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	int rc;
1220a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1221a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	might_sleep();
1222a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
12237e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	/*
12247e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	 * The TX queues are stopped at this point, so this test
12257e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	 * doesn't need to take ->tx_lock.
12267e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	 */
12277e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	if (!priv->pending_tx_pkts)
12287e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		return 0;
12297e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
12307e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	retry = 0;
12317e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	rc = 0;
12327e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
1233a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	spin_lock_bh(&priv->tx_lock);
12347e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	priv->tx_wait = &tx_wait;
12357e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	while (!rc) {
12367e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		int oldcount;
12377e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		unsigned long timeout;
1238a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
12397e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		oldcount = priv->pending_tx_pkts;
1240a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
12417e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		spin_unlock_bh(&priv->tx_lock);
124288de754ad59025eba797e7a8375807755577f450Lennert Buytenhek		timeout = wait_for_completion_timeout(&tx_wait,
12437e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			    msecs_to_jiffies(MWL8K_TX_WAIT_TIMEOUT_MS));
1244a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		spin_lock_bh(&priv->tx_lock);
12457e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
12467e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		if (timeout) {
12477e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			WARN_ON(priv->pending_tx_pkts);
12487e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			if (retry) {
12497e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek				printk(KERN_NOTICE "%s: tx rings drained\n",
12507e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek				       wiphy_name(hw->wiphy));
12517e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			}
12527e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			break;
12537e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		}
12547e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
12557e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		if (priv->pending_tx_pkts < oldcount) {
12569a2303b93039d0f3dd578cd75fe20ebaf075f1cbLennert Buytenhek			printk(KERN_NOTICE "%s: waiting for tx rings "
12579a2303b93039d0f3dd578cd75fe20ebaf075f1cbLennert Buytenhek			       "to drain (%d -> %d pkts)\n",
12587e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			       wiphy_name(hw->wiphy), oldcount,
12597e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			       priv->pending_tx_pkts);
12607e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			retry = 1;
12617e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek			continue;
12627e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		}
12637e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
1264a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->tx_wait = NULL;
1265a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
12667e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		printk(KERN_ERR "%s: tx rings stuck for %d ms\n",
12677e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		       wiphy_name(hw->wiphy), MWL8K_TX_WAIT_TIMEOUT_MS);
12687e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		mwl8k_dump_tx_rings(hw);
12697e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek
12707e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek		rc = -ETIMEDOUT;
1271a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
12727e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	spin_unlock_bh(&priv->tx_lock);
1273a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
12747e1112d34aea10fdd689422e6bdc918309043bf3Lennert Buytenhek	return rc;
1275a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1276a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1277c23b5a699471ea2ef9d146eae80e64836cfbf001Lennert Buytenhek#define MWL8K_TXD_SUCCESS(status)				\
1278c23b5a699471ea2ef9d146eae80e64836cfbf001Lennert Buytenhek	((status) & (MWL8K_TXD_STATUS_OK |			\
1279c23b5a699471ea2ef9d146eae80e64836cfbf001Lennert Buytenhek		     MWL8K_TXD_STATUS_OK_RETRY |		\
1280c23b5a699471ea2ef9d146eae80e64836cfbf001Lennert Buytenhek		     MWL8K_TXD_STATUS_OK_MORE_RETRY))
1281a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1282efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhekstatic int
1283efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhekmwl8k_txq_reclaim(struct ieee80211_hw *hw, int index, int limit, int force)
1284a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1285a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1286a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_tx_queue *txq = priv->txq + index;
1287efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek	int processed;
1288a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1289efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek	processed = 0;
1290efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek	while (txq->stats.len > 0 && limit--) {
1291a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		int tx;
1292a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		struct mwl8k_tx_desc *tx_desc;
1293a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		unsigned long addr;
1294ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek		int size;
1295a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		struct sk_buff *skb;
1296a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		struct ieee80211_tx_info *info;
1297a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		u32 status;
1298a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
129945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		tx = txq->head;
130045eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		tx_desc = txq->txd + tx;
1301a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1302a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		status = le32_to_cpu(tx_desc->status);
1303a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1304a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (status & MWL8K_TXD_STATUS_FW_OWNED) {
1305a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			if (!force)
1306a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				break;
1307a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			tx_desc->status &=
1308a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				~cpu_to_le32(MWL8K_TXD_STATUS_FW_OWNED);
1309a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
1310a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
131145eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		txq->head = (tx + 1) % MWL8K_TX_DESCS;
131245eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		BUG_ON(txq->stats.len == 0);
131345eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		txq->stats.len--;
1314a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->pending_tx_pkts--;
1315a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1316a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		addr = le32_to_cpu(tx_desc->pkt_phys_addr);
1317ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek		size = le16_to_cpu(tx_desc->pkt_len);
131845eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		skb = txq->skb[tx];
131945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		txq->skb[tx] = NULL;
1320a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1321a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		BUG_ON(skb == NULL);
1322a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		pci_unmap_single(priv->pdev, addr, size, PCI_DMA_TODEVICE);
1323a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
132420f09c3df7a8a623c290f62596c1a6b0da088030Lennert Buytenhek		mwl8k_remove_dma_header(skb, tx_desc->qos_control);
1325a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1326a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		/* Mark descriptor as unused */
1327a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		tx_desc->pkt_phys_addr = 0;
1328a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		tx_desc->pkt_len = 0;
1329a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1330a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		info = IEEE80211_SKB_CB(skb);
1331a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		ieee80211_tx_info_clear_status(info);
1332ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek		if (MWL8K_TXD_SUCCESS(status))
1333a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			info->flags |= IEEE80211_TX_STAT_ACK;
1334a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1335a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		ieee80211_tx_status_irqsafe(hw, skb);
1336a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1337efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek		processed++;
1338a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1339a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1340efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek	if (processed && priv->radio_on && !mutex_is_locked(&priv->fw_mutex))
1341a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		ieee80211_wake_queue(hw, index);
1342efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek
1343efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek	return processed;
1344a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1345a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1346a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/* must be called only when the card's transmit is completely halted */
1347a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void mwl8k_txq_deinit(struct ieee80211_hw *hw, int index)
1348a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1349a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1350a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_tx_queue *txq = priv->txq + index;
1351a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1352efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek	mwl8k_txq_reclaim(hw, index, INT_MAX, 1);
1353a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
135445eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	kfree(txq->skb);
135545eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->skb = NULL;
1356a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1357a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_free_consistent(priv->pdev,
1358a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			    MWL8K_TX_DESCS * sizeof(struct mwl8k_tx_desc),
135945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek			    txq->txd, txq->txd_dma);
136045eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->txd = NULL;
1361a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1362a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1363a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int
1364a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekmwl8k_txq_xmit(struct ieee80211_hw *hw, int index, struct sk_buff *skb)
1365a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1366a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1367a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_tx_info *tx_info;
136823b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	struct mwl8k_vif *mwl8k_vif;
1369a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_hdr *wh;
1370a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_tx_queue *txq;
1371a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_tx_desc *tx;
1372a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dma_addr_t dma;
137323b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	u32 txstatus;
137423b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	u8 txdatarate;
137523b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	u16 qos;
1376a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
137723b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	wh = (struct ieee80211_hdr *)skb->data;
137823b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	if (ieee80211_is_data_qos(wh->frame_control))
137923b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek		qos = le16_to_cpu(*((__le16 *)ieee80211_get_qos_ctl(wh)));
138023b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	else
138123b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek		qos = 0;
1382a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
138376266b2ad38c33fb2c1475cfeb35ed070adaba2bLennert Buytenhek	mwl8k_add_dma_header(skb);
138423b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	wh = &((struct mwl8k_dma_data *)skb->data)->wh;
1385a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1386a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	tx_info = IEEE80211_SKB_CB(skb);
1387a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	mwl8k_vif = MWL8K_VIF(tx_info->control.vif);
1388a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1389a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (tx_info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) {
1390a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		wh->seq_ctrl &= cpu_to_le16(IEEE80211_SCTL_FRAG);
1391657232b625890f202867ede0ed67ecf15827ff80Lennert Buytenhek		wh->seq_ctrl |= cpu_to_le16(mwl8k_vif->seqno);
1392657232b625890f202867ede0ed67ecf15827ff80Lennert Buytenhek		mwl8k_vif->seqno += 0x10;
1393a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1394a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
139523b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	/* Setup firmware control bit fields for each frame type.  */
139623b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	txstatus = 0;
139723b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	txdatarate = 0;
139823b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	if (ieee80211_is_mgmt(wh->frame_control) ||
139923b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	    ieee80211_is_ctl(wh->frame_control)) {
140023b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek		txdatarate = 0;
1401e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek		qos |= MWL8K_QOS_QLEN_UNSPEC | MWL8K_QOS_EOSP;
140223b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	} else if (ieee80211_is_data(wh->frame_control)) {
140323b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek		txdatarate = 1;
140423b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek		if (is_multicast_ether_addr(wh->addr1))
140523b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek			txstatus |= MWL8K_TXD_STATUS_MULTICAST_TX;
140623b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek
1407e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek		qos &= ~MWL8K_QOS_ACK_POLICY_MASK;
140823b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek		if (tx_info->flags & IEEE80211_TX_CTL_AMPDU)
1409e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek			qos |= MWL8K_QOS_ACK_POLICY_BLOCKACK;
141023b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek		else
1411e0493a8dd6351a114b53790dda6bd855ae73a85cLennert Buytenhek			qos |= MWL8K_QOS_ACK_POLICY_NORMAL;
141223b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	}
1413a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1414a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dma = pci_map_single(priv->pdev, skb->data,
1415a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				skb->len, PCI_DMA_TODEVICE);
1416a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1417a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (pci_dma_mapping_error(priv->pdev, dma)) {
1418a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_DEBUG "%s: failed to dma map skb, "
1419c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       "dropping TX frame.\n", wiphy_name(hw->wiphy));
142023b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek		dev_kfree_skb(skb);
1421a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return NETDEV_TX_OK;
1422a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1423a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
142423b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	spin_lock_bh(&priv->tx_lock);
1425a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
142623b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	txq = priv->txq + index;
1427a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
142845eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	BUG_ON(txq->skb[txq->tail] != NULL);
142945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->skb[txq->tail] = skb;
1430a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
143145eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	tx = txq->txd + txq->tail;
143223b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	tx->data_rate = txdatarate;
143323b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	tx->tx_priority = index;
1434a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	tx->qos_control = cpu_to_le16(qos);
1435a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	tx->pkt_phys_addr = cpu_to_le32(dma);
1436a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	tx->pkt_len = cpu_to_le16(skb->len);
143723b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	tx->rate_info = 0;
1438a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	if (!priv->ap_fw && tx_info->control.sta != NULL)
1439a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek		tx->peer_id = MWL8K_STA(tx_info->control.sta)->peer_id;
1440a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	else
1441a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek		tx->peer_id = 0;
1442a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	wmb();
144323b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	tx->status = cpu_to_le32(MWL8K_TXD_STATUS_FW_OWNED | txstatus);
144423b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek
144545eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->stats.count++;
144645eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->stats.len++;
1447a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->pending_tx_pkts++;
1448a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
144945eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	txq->tail++;
145045eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	if (txq->tail == MWL8K_TX_DESCS)
145145eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		txq->tail = 0;
145223b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek
145345eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	if (txq->head == txq->tail)
1454a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		ieee80211_stop_queue(hw, index);
1455a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
145623b339062f247e0be84eaabb15e17b403c4388b6Lennert Buytenhek	mwl8k_tx_start(priv);
1457a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1458a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	spin_unlock_bh(&priv->tx_lock);
1459a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1460a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return NETDEV_TX_OK;
1461a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1462a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1463a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1464a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
1465618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * Firmware access.
1466618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek *
1467618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * We have the following requirements for issuing firmware commands:
1468618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * - Some commands require that the packet transmit path is idle when
1469618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek *   the command is issued.  (For simplicity, we'll just quiesce the
1470618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek *   transmit path for every command.)
1471618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * - There are certain sequences of commands that need to be issued to
1472618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek *   the hardware sequentially, with no other intervening commands.
1473618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek *
1474618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * This leads to an implementation of a "firmware lock" as a mutex that
1475618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * can be taken recursively, and which is taken by both the low-level
1476618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * command submission function (mwl8k_post_cmd) as well as any users of
1477618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * that function that require issuing of an atomic sequence of commands,
1478618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek * and quiesces the transmit path whenever it's taken.
1479618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek */
1480618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhekstatic int mwl8k_fw_lock(struct ieee80211_hw *hw)
1481618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek{
1482618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1483618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1484618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	if (priv->fw_mutex_owner != current) {
1485618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		int rc;
1486618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1487618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		mutex_lock(&priv->fw_mutex);
1488618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		ieee80211_stop_queues(hw);
1489618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1490618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		rc = mwl8k_tx_wait_empty(hw);
1491618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		if (rc) {
1492618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek			ieee80211_wake_queues(hw);
1493618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek			mutex_unlock(&priv->fw_mutex);
1494618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1495618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek			return rc;
1496618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		}
1497618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1498618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		priv->fw_mutex_owner = current;
1499618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	}
1500618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1501618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	priv->fw_mutex_depth++;
1502618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1503618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	return 0;
1504618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek}
1505618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1506618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhekstatic void mwl8k_fw_unlock(struct ieee80211_hw *hw)
1507618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek{
1508618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1509618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1510618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	if (!--priv->fw_mutex_depth) {
1511618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		ieee80211_wake_queues(hw);
1512618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		priv->fw_mutex_owner = NULL;
1513618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		mutex_unlock(&priv->fw_mutex);
1514618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	}
1515618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek}
1516618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1517618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1518618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek/*
1519a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * Command processing.
1520a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
1521a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
15220c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek/* Timeout firmware commands after 10s */
15230c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek#define MWL8K_CMD_TIMEOUT_MS	10000
1524a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1525a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_post_cmd(struct ieee80211_hw *hw, struct mwl8k_cmd_pkt *cmd)
1526a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1527a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	DECLARE_COMPLETION_ONSTACK(cmd_wait);
1528a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1529a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	void __iomem *regs = priv->regs;
1530a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dma_addr_t dma_addr;
1531a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	unsigned int dma_size;
1532a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
1533a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	unsigned long timeout = 0;
1534a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	u8 buf[32];
1535a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1536c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek	cmd->result = 0xffff;
1537a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dma_size = le16_to_cpu(cmd->length);
1538a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dma_addr = pci_map_single(priv->pdev, cmd, dma_size,
1539a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				  PCI_DMA_BIDIRECTIONAL);
1540a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (pci_dma_mapping_error(priv->pdev, dma_addr))
1541a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
1542a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1543618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	rc = mwl8k_fw_lock(hw);
154439a1e42eb4d0a2bc3f1211e9012bd23734ab86dbLennert Buytenhek	if (rc) {
154539a1e42eb4d0a2bc3f1211e9012bd23734ab86dbLennert Buytenhek		pci_unmap_single(priv->pdev, dma_addr, dma_size,
154639a1e42eb4d0a2bc3f1211e9012bd23734ab86dbLennert Buytenhek						PCI_DMA_BIDIRECTIONAL);
1547618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		return rc;
154839a1e42eb4d0a2bc3f1211e9012bd23734ab86dbLennert Buytenhek	}
1549a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1550a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->hostcmd_wait = &cmd_wait;
1551a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(dma_addr, regs + MWL8K_HIU_GEN_PTR);
1552a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(MWL8K_H2A_INT_DOORBELL,
1553a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		regs + MWL8K_HIU_H2A_INTERRUPT_EVENTS);
1554a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(MWL8K_H2A_INT_DUMMY,
1555a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		regs + MWL8K_HIU_H2A_INTERRUPT_EVENTS);
1556a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1557a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	timeout = wait_for_completion_timeout(&cmd_wait,
1558a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				msecs_to_jiffies(MWL8K_CMD_TIMEOUT_MS));
1559a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1560618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	priv->hostcmd_wait = NULL;
1561618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
1562618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	mwl8k_fw_unlock(hw);
1563618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
156437055bd455b31b8220c35a1ede9c6aceb791cc88Lennert Buytenhek	pci_unmap_single(priv->pdev, dma_addr, dma_size,
156537055bd455b31b8220c35a1ede9c6aceb791cc88Lennert Buytenhek					PCI_DMA_BIDIRECTIONAL);
156637055bd455b31b8220c35a1ede9c6aceb791cc88Lennert Buytenhek
1567a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (!timeout) {
1568a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: Command %s timeout after %u ms\n",
1569c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy),
1570a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		       mwl8k_cmd_name(cmd->code, buf, sizeof(buf)),
1571a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		       MWL8K_CMD_TIMEOUT_MS);
1572a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		rc = -ETIMEDOUT;
1573a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	} else {
15740c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek		int ms;
15750c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek
15760c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek		ms = MWL8K_CMD_TIMEOUT_MS - jiffies_to_msecs(timeout);
15770c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek
1578ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek		rc = cmd->result ? -EINVAL : 0;
1579a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (rc)
1580a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			printk(KERN_ERR "%s: Command %s error 0x%x\n",
1581c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek			       wiphy_name(hw->wiphy),
1582a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			       mwl8k_cmd_name(cmd->code, buf, sizeof(buf)),
158376c962a204f8d36b762440aa941fcea3d44e2fd2Lennert Buytenhek			       le16_to_cpu(cmd->result));
15840c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek		else if (ms > 2000)
15850c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek			printk(KERN_NOTICE "%s: Command %s took %d ms\n",
15860c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek			       wiphy_name(hw->wiphy),
15870c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek			       mwl8k_cmd_name(cmd->code, buf, sizeof(buf)),
15880c9cc640225f4bd7c9aad87b1431bd8d9a29b338Lennert Buytenhek			       ms);
1589a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1590a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1591a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
1592a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1593a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1594a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
15951349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek * Setup code shared between STA and AP firmware images.
15961349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek */
15971349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhekstatic void mwl8k_setup_2ghz_band(struct ieee80211_hw *hw)
15981349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek{
15991349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
16001349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek
16011349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	BUILD_BUG_ON(sizeof(priv->channels_24) != sizeof(mwl8k_channels_24));
16021349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	memcpy(priv->channels_24, mwl8k_channels_24, sizeof(mwl8k_channels_24));
16031349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek
16041349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	BUILD_BUG_ON(sizeof(priv->rates_24) != sizeof(mwl8k_rates_24));
16051349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	memcpy(priv->rates_24, mwl8k_rates_24, sizeof(mwl8k_rates_24));
16061349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek
16071349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	priv->band_24.band = IEEE80211_BAND_2GHZ;
16081349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	priv->band_24.channels = priv->channels_24;
16091349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	priv->band_24.n_channels = ARRAY_SIZE(mwl8k_channels_24);
16101349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	priv->band_24.bitrates = priv->rates_24;
16111349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	priv->band_24.n_bitrates = ARRAY_SIZE(mwl8k_rates_24);
16121349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek
16131349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek	hw->wiphy->bands[IEEE80211_BAND_2GHZ] = &priv->band_24;
16141349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek}
16151349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek
16164eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhekstatic void mwl8k_setup_5ghz_band(struct ieee80211_hw *hw)
16174eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek{
16184eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
16194eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek
16204eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	BUILD_BUG_ON(sizeof(priv->channels_50) != sizeof(mwl8k_channels_50));
16214eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	memcpy(priv->channels_50, mwl8k_channels_50, sizeof(mwl8k_channels_50));
16224eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek
16234eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	BUILD_BUG_ON(sizeof(priv->rates_50) != sizeof(mwl8k_rates_50));
16244eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	memcpy(priv->rates_50, mwl8k_rates_50, sizeof(mwl8k_rates_50));
16254eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek
16264eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	priv->band_50.band = IEEE80211_BAND_5GHZ;
16274eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	priv->band_50.channels = priv->channels_50;
16284eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	priv->band_50.n_channels = ARRAY_SIZE(mwl8k_channels_50);
16294eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	priv->band_50.bitrates = priv->rates_50;
16304eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	priv->band_50.n_bitrates = ARRAY_SIZE(mwl8k_rates_50);
16314eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek
16324eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek	hw->wiphy->bands[IEEE80211_BAND_5GHZ] = &priv->band_50;
16334eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek}
16344eae9edd38c0a9ce34e39100ccc69ff520bc1224Lennert Buytenhek
16351349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek/*
163604b147b19303724aac5ee8e56f113f1935a5c255Lennert Buytenhek * CMD_GET_HW_SPEC (STA version).
1637a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
163804b147b19303724aac5ee8e56f113f1935a5c255Lennert Buytenhekstruct mwl8k_cmd_get_hw_spec_sta {
1639a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
1640a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 hw_rev;
1641a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 host_interface;
1642a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 num_mcaddrs;
1643d89173f25228b8795af2d4b53e985cc44c729332Lennert Buytenhek	__u8 perm_addr[ETH_ALEN];
1644a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 region_code;
1645a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 fw_rev;
1646a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 ps_cookie;
1647a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 caps;
1648a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 mcs_bitmap[16];
1649a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 rx_queue_ptr;
1650a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 num_tx_queues;
1651a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 tx_queue_ptrs[MWL8K_TX_QUEUES];
1652a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 caps2;
1653a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 num_tx_desc_per_queue;
165445eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	__le32 total_rxd;
1655a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
1656a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1657341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_MAX_AMSDU		0x20000000
1658341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_GREENFIELD		0x08000000
1659341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_AMPDU			0x04000000
1660341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_RX_STBC		0x01000000
1661341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_TX_STBC		0x00800000
1662341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_SHORTGI_40MHZ		0x00400000
1663341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_SHORTGI_20MHZ		0x00200000
1664341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_RX_ANTENNA_MASK	0x000e0000
1665341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_TX_ANTENNA_MASK	0x0001c000
1666341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_DELAY_BA		0x00003000
1667341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_MIMO			0x00000200
1668341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek#define MWL8K_CAP_40MHZ			0x00000100
1669341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek
1670341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhekstatic void mwl8k_set_ht_caps(struct ieee80211_hw *hw, u32 cap)
1671341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek{
1672341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1673777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek	struct ieee80211_supported_band *band = &priv->band_24;
1674341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	int rx_streams;
1675341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	int tx_streams;
1676341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek
1677777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek	band->ht_cap.ht_supported = 1;
1678341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek
1679341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_MAX_AMSDU)
1680777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.cap |= IEEE80211_HT_CAP_MAX_AMSDU;
1681341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_GREENFIELD)
1682777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.cap |= IEEE80211_HT_CAP_GRN_FLD;
1683341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_AMPDU) {
1684341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek		hw->flags |= IEEE80211_HW_AMPDU_AGGREGATION;
1685777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
1686777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.ampdu_density = IEEE80211_HT_MPDU_DENSITY_NONE;
1687341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	}
1688341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_RX_STBC)
1689777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.cap |= IEEE80211_HT_CAP_RX_STBC;
1690341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_TX_STBC)
1691777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.cap |= IEEE80211_HT_CAP_TX_STBC;
1692341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_SHORTGI_40MHZ)
1693777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.cap |= IEEE80211_HT_CAP_SGI_40;
1694341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_SHORTGI_20MHZ)
1695777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.cap |= IEEE80211_HT_CAP_SGI_20;
1696341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_DELAY_BA)
1697777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.cap |= IEEE80211_HT_CAP_DELAY_BA;
1698341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (cap & MWL8K_CAP_40MHZ)
1699777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
1700341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek
1701341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	rx_streams = hweight32(cap & MWL8K_CAP_RX_ANTENNA_MASK);
1702341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	tx_streams = hweight32(cap & MWL8K_CAP_TX_ANTENNA_MASK);
1703341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek
1704777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek	band->ht_cap.mcs.rx_mask[0] = 0xff;
1705341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (rx_streams >= 2)
1706777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.mcs.rx_mask[1] = 0xff;
1707341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (rx_streams >= 3)
1708777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.mcs.rx_mask[2] = 0xff;
1709777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek	band->ht_cap.mcs.rx_mask[4] = 0x01;
1710777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek	band->ht_cap.mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
1711341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek
1712341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	if (rx_streams != tx_streams) {
1713777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.mcs.tx_params |= IEEE80211_HT_MCS_TX_RX_DIFF;
1714777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek		band->ht_cap.mcs.tx_params |= (tx_streams - 1) <<
1715341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek				IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT;
1716341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek	}
1717341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek}
1718341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek
171904b147b19303724aac5ee8e56f113f1935a5c255Lennert Buytenhekstatic int mwl8k_cmd_get_hw_spec_sta(struct ieee80211_hw *hw)
1720a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1721a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
172204b147b19303724aac5ee8e56f113f1935a5c255Lennert Buytenhek	struct mwl8k_cmd_get_hw_spec_sta *cmd;
1723a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
1724a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int i;
1725a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1726a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
1727a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
1728a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
1729a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1730a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_GET_HW_SPEC);
1731a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
1732a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1733a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	memset(cmd->perm_addr, 0xff, sizeof(cmd->perm_addr));
1734a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->ps_cookie = cpu_to_le32(priv->cookie_dma);
173545eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	cmd->rx_queue_ptr = cpu_to_le32(priv->rxq[0].rxd_dma);
17364ff6432ea620ba467e50ec04b8271ea0eb94e62eLennert Buytenhek	cmd->num_tx_queues = cpu_to_le32(MWL8K_TX_QUEUES);
1737a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++)
173845eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		cmd->tx_queue_ptrs[i] = cpu_to_le32(priv->txq[i].txd_dma);
17394ff6432ea620ba467e50ec04b8271ea0eb94e62eLennert Buytenhek	cmd->num_tx_desc_per_queue = cpu_to_le32(MWL8K_TX_DESCS);
174045eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek	cmd->total_rxd = cpu_to_le32(MWL8K_RX_DESCS);
1741a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1742a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
1743a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1744a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (!rc) {
1745a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		SET_IEEE80211_PERM_ADDR(hw, cmd->perm_addr);
1746a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->num_mcaddrs = le16_to_cpu(cmd->num_mcaddrs);
17474ff6432ea620ba467e50ec04b8271ea0eb94e62eLennert Buytenhek		priv->fw_rev = le32_to_cpu(cmd->fw_rev);
1748a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->hw_rev = cmd->hw_rev;
17491349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek		mwl8k_setup_2ghz_band(hw);
1750341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek		if (cmd->caps & cpu_to_le32(MWL8K_CAP_MIMO))
1751341c97918ab7e84a155ea8b18759425304d213b6Lennert Buytenhek			mwl8k_set_ht_caps(hw, le32_to_cpu(cmd->caps));
1752a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1753a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1754a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
1755a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
1756a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1757a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1758a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
175942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek * CMD_GET_HW_SPEC (AP version).
176042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek */
176142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhekstruct mwl8k_cmd_get_hw_spec_ap {
176242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	struct mwl8k_cmd_pkt header;
176342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__u8 hw_rev;
176442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__u8 host_interface;
176542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le16 num_wcb;
176642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le16 num_mcaddrs;
176742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__u8 perm_addr[ETH_ALEN];
176842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le16 region_code;
176942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le16 num_antenna;
177042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 fw_rev;
177142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 wcbbase0;
177242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 rxwrptr;
177342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 rxrdptr;
177442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 ps_cookie;
177542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 wcbbase1;
177642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 wcbbase2;
177742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 wcbbase3;
177842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek} __attribute__((packed));
177942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
178042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhekstatic int mwl8k_cmd_get_hw_spec_ap(struct ieee80211_hw *hw)
178142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek{
178242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
178342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	struct mwl8k_cmd_get_hw_spec_ap *cmd;
178442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	int rc;
178542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
178642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
178742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	if (cmd == NULL)
178842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		return -ENOMEM;
178942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
179042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_GET_HW_SPEC);
179142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
179242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
179342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	memset(cmd->perm_addr, 0xff, sizeof(cmd->perm_addr));
179442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->ps_cookie = cpu_to_le32(priv->cookie_dma);
179542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
179642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
179742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
179842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	if (!rc) {
179942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		int off;
180042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
180142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		SET_IEEE80211_PERM_ADDR(hw, cmd->perm_addr);
180242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		priv->num_mcaddrs = le16_to_cpu(cmd->num_mcaddrs);
180342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		priv->fw_rev = le32_to_cpu(cmd->fw_rev);
180442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		priv->hw_rev = cmd->hw_rev;
18051349ad2f06f86f41415cf7ffa9e068fd4f89be87Lennert Buytenhek		mwl8k_setup_2ghz_band(hw);
180642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
180742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		off = le32_to_cpu(cmd->wcbbase0) & 0xffff;
180842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		iowrite32(cpu_to_le32(priv->txq[0].txd_dma), priv->sram + off);
180942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
181042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		off = le32_to_cpu(cmd->rxwrptr) & 0xffff;
181142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		iowrite32(cpu_to_le32(priv->rxq[0].rxd_dma), priv->sram + off);
181242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
181342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		off = le32_to_cpu(cmd->rxrdptr) & 0xffff;
181442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		iowrite32(cpu_to_le32(priv->rxq[0].rxd_dma), priv->sram + off);
181542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
181642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		off = le32_to_cpu(cmd->wcbbase1) & 0xffff;
181742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		iowrite32(cpu_to_le32(priv->txq[1].txd_dma), priv->sram + off);
181842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
181942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		off = le32_to_cpu(cmd->wcbbase2) & 0xffff;
182042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		iowrite32(cpu_to_le32(priv->txq[2].txd_dma), priv->sram + off);
182142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
182242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		off = le32_to_cpu(cmd->wcbbase3) & 0xffff;
182342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		iowrite32(cpu_to_le32(priv->txq[3].txd_dma), priv->sram + off);
182442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	}
182542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
182642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	kfree(cmd);
182742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	return rc;
182842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek}
182942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
183042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek/*
183142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek * CMD_SET_HW_SPEC.
183242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek */
183342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhekstruct mwl8k_cmd_set_hw_spec {
183442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	struct mwl8k_cmd_pkt header;
183542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__u8 hw_rev;
183642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__u8 host_interface;
183742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le16 num_mcaddrs;
183842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__u8 perm_addr[ETH_ALEN];
183942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le16 region_code;
184042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 fw_rev;
184142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 ps_cookie;
184242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 caps;
184342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 rx_queue_ptr;
184442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 num_tx_queues;
184542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 tx_queue_ptrs[MWL8K_TX_QUEUES];
184642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 flags;
184742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 num_tx_desc_per_queue;
184842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	__le32 total_rxd;
184942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek} __attribute__((packed));
185042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
1851b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek#define MWL8K_SET_HW_SPEC_FLAG_HOST_DECR_MGMT		0x00000080
1852b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek#define MWL8K_SET_HW_SPEC_FLAG_HOSTFORM_PROBERESP	0x00000020
1853b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek#define MWL8K_SET_HW_SPEC_FLAG_HOSTFORM_BEACON		0x00000010
185442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
185542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhekstatic int mwl8k_cmd_set_hw_spec(struct ieee80211_hw *hw)
185642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek{
185742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
185842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	struct mwl8k_cmd_set_hw_spec *cmd;
185942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	int rc;
186042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	int i;
186142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
186242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
186342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	if (cmd == NULL)
186442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		return -ENOMEM;
186542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
186642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_HW_SPEC);
186742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
186842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
186942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->ps_cookie = cpu_to_le32(priv->cookie_dma);
187042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->rx_queue_ptr = cpu_to_le32(priv->rxq[0].rxd_dma);
187142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->num_tx_queues = cpu_to_le32(MWL8K_TX_QUEUES);
187242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++)
187342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		cmd->tx_queue_ptrs[i] = cpu_to_le32(priv->txq[i].txd_dma);
1874b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->flags = cpu_to_le32(MWL8K_SET_HW_SPEC_FLAG_HOST_DECR_MGMT |
1875b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek				 MWL8K_SET_HW_SPEC_FLAG_HOSTFORM_PROBERESP |
1876b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek				 MWL8K_SET_HW_SPEC_FLAG_HOSTFORM_BEACON);
187742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->num_tx_desc_per_queue = cpu_to_le32(MWL8K_TX_DESCS);
187842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	cmd->total_rxd = cpu_to_le32(MWL8K_RX_DESCS);
187942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
188042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
188142fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	kfree(cmd);
188242fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
188342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	return rc;
188442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek}
188542fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek
188642fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek/*
1887a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * CMD_MAC_MULTICAST_ADR.
1888a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
1889a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_cmd_mac_multicast_adr {
1890a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
1891a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 action;
1892a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 numaddr;
1893ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek	__u8 addr[0][ETH_ALEN];
1894a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek};
1895a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1896d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek#define MWL8K_ENABLE_RX_DIRECTED	0x0001
1897d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek#define MWL8K_ENABLE_RX_MULTICAST	0x0002
1898d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek#define MWL8K_ENABLE_RX_ALL_MULTICAST	0x0004
1899d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek#define MWL8K_ENABLE_RX_BROADCAST	0x0008
1900ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek
1901e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhekstatic struct mwl8k_cmd_pkt *
1902447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek__mwl8k_cmd_mac_multicast_adr(struct ieee80211_hw *hw, int allmulti,
1903e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek			      int mc_count, struct dev_addr_list *mclist)
1904a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
1905e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
1906a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_mac_multicast_adr *cmd;
1907e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek	int size;
1908e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek
1909447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	if (allmulti || mc_count > priv->num_mcaddrs) {
1910d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek		allmulti = 1;
1911d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek		mc_count = 0;
1912d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek	}
1913e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek
1914e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek	size = sizeof(*cmd) + mc_count * ETH_ALEN;
1915ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek
1916e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek	cmd = kzalloc(size, GFP_ATOMIC);
1917a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
1918e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek		return NULL;
1919a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1920a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_MAC_MULTICAST_ADR);
1921a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(size);
1922d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_ENABLE_RX_DIRECTED |
1923d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek				  MWL8K_ENABLE_RX_BROADCAST);
1924d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek
1925d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek	if (allmulti) {
1926d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek		cmd->action |= cpu_to_le16(MWL8K_ENABLE_RX_ALL_MULTICAST);
1927d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek	} else if (mc_count) {
1928d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek		int i;
1929d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek
1930d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek		cmd->action |= cpu_to_le16(MWL8K_ENABLE_RX_MULTICAST);
1931d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek		cmd->numaddr = cpu_to_le16(mc_count);
1932d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek		for (i = 0; i < mc_count && mclist; i++) {
1933d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek			if (mclist->da_addrlen != ETH_ALEN) {
1934d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek				kfree(cmd);
1935d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek				return NULL;
1936d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek			}
1937d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek			memcpy(cmd->addr[i], mclist->da_addr, ETH_ALEN);
1938d5e308457e8e9b4988fbd69d38c30782125b3f65Lennert Buytenhek			mclist = mclist->next;
1939a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
1940a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1941a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1942e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek	return &cmd->header;
1943a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1944a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1945a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
194655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_GET_STAT.
1947a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
194855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_get_stat {
1949a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
1950a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 stats[64];
1951a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
1952a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1953a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_STAT_ACK_FAILURE	9
1954a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_STAT_RTS_FAILURE	12
1955a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_STAT_FCS_ERROR	24
1956a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_STAT_RTS_SUCCESS	11
1957a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
195855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_get_stat(struct ieee80211_hw *hw,
195955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			      struct ieee80211_low_level_stats *stats)
1960a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
196155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_get_stat *cmd;
1962a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
1963a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1964a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
1965a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
1966a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
1967a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1968a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_GET_STAT);
1969a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
1970a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1971a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
1972a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (!rc) {
1973a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		stats->dot11ACKFailureCount =
1974a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			le32_to_cpu(cmd->stats[MWL8K_STAT_ACK_FAILURE]);
1975a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		stats->dot11RTSFailureCount =
1976a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			le32_to_cpu(cmd->stats[MWL8K_STAT_RTS_FAILURE]);
1977a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		stats->dot11FCSErrorCount =
1978a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			le32_to_cpu(cmd->stats[MWL8K_STAT_FCS_ERROR]);
1979a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		stats->dot11RTSSuccessCount =
1980a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			le32_to_cpu(cmd->stats[MWL8K_STAT_RTS_SUCCESS]);
1981a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
1982a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
1983a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1984a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
1985a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
1986a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1987a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
198855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_RADIO_CONTROL.
1989a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
199055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_radio_control {
1991a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
1992a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 action;
1993a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 control;
1994a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 radio_on;
1995a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
1996a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
1997c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhekstatic int
199855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekmwl8k_cmd_radio_control(struct ieee80211_hw *hw, bool enable, bool force)
1999a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
2000a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
200155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_radio_control *cmd;
2002a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2003a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2004c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek	if (enable == priv->radio_on && !force)
2005a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return 0;
2006a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2007a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2008a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2009a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2010a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2011a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_RADIO_CONTROL);
2012a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2013a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_CMD_SET);
201468ce38845c23443b15e374fb7362916c1231278eLennert Buytenhek	cmd->control = cpu_to_le16(priv->radio_short_preamble ? 3 : 1);
2015a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->radio_on = cpu_to_le16(enable ? 0x0001 : 0x0000);
2016a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2017a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2018a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2019a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2020a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (!rc)
2021c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek		priv->radio_on = enable;
2022a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2023a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2024a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2025a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
202655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_radio_disable(struct ieee80211_hw *hw)
2027c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek{
202855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	return mwl8k_cmd_radio_control(hw, 0, 0);
2029c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek}
2030c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek
203155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_radio_enable(struct ieee80211_hw *hw)
2032c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek{
203355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	return mwl8k_cmd_radio_control(hw, 1, 0);
2034c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek}
2035c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek
2036a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int
2037a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekmwl8k_set_radio_preamble(struct ieee80211_hw *hw, bool short_preamble)
2038a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
203999200a992e365a73dc67a6570524e5f3af4386ddLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
2040a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
204168ce38845c23443b15e374fb7362916c1231278eLennert Buytenhek	priv->radio_short_preamble = short_preamble;
2042a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
204355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	return mwl8k_cmd_radio_control(hw, 1, 1);
2044a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2045a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2046a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
204755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_RF_TX_POWER.
2048a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
2049a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_TX_POWER_LEVEL_TOTAL	8
2050a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
205155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_rf_tx_power {
2052a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
2053a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 action;
2054a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 support_level;
2055a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 current_level;
2056a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 reserved;
2057a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 power_level_list[MWL8K_TX_POWER_LEVEL_TOTAL];
2058a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2059a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
206055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_rf_tx_power(struct ieee80211_hw *hw, int dBm)
2061a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
206255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_rf_tx_power *cmd;
2063a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2064a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2065a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2066a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2067a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2068a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2069a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_RF_TX_POWER);
2070a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2071a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_CMD_SET);
2072a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->support_level = cpu_to_le16(dBm);
2073a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2074a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2075a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2076a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2077a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2078a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2079a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2080a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
208108b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek * CMD_RF_ANTENNA.
208208b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek */
208308b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhekstruct mwl8k_cmd_rf_antenna {
208408b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	struct mwl8k_cmd_pkt header;
208508b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	__le16 antenna;
208608b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	__le16 mode;
208708b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek} __attribute__((packed));
208808b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek
208908b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek#define MWL8K_RF_ANTENNA_RX		1
209008b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek#define MWL8K_RF_ANTENNA_TX		2
209108b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek
209208b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhekstatic int
209308b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhekmwl8k_cmd_rf_antenna(struct ieee80211_hw *hw, int antenna, int mask)
209408b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek{
209508b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	struct mwl8k_cmd_rf_antenna *cmd;
209608b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	int rc;
209708b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek
209808b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
209908b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	if (cmd == NULL)
210008b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek		return -ENOMEM;
210108b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek
210208b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_RF_ANTENNA);
210308b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
210408b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	cmd->antenna = cpu_to_le16(antenna);
210508b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	cmd->mode = cpu_to_le16(mask);
210608b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek
210708b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
210808b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	kfree(cmd);
210908b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek
211008b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	return rc;
211108b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek}
211208b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek
211308b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek/*
2114b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek * CMD_SET_BEACON.
2115b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek */
2116b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekstruct mwl8k_cmd_set_beacon {
2117b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	struct mwl8k_cmd_pkt header;
2118b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	__le16 beacon_len;
2119b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	__u8 beacon[0];
2120b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek};
2121b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2122b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekstatic int mwl8k_cmd_set_beacon(struct ieee80211_hw *hw, u8 *beacon, int len)
2123b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek{
2124b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	struct mwl8k_cmd_set_beacon *cmd;
2125b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	int rc;
2126b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2127b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd) + len, GFP_KERNEL);
2128b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (cmd == NULL)
2129b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		return -ENOMEM;
2130b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2131b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_BEACON);
2132b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd) + len);
2133b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->beacon_len = cpu_to_le16(len);
2134b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	memcpy(cmd->beacon, beacon, len);
2135b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2136b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2137b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	kfree(cmd);
2138b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2139b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	return rc;
2140b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek}
2141b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2142b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek/*
2143a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * CMD_SET_PRE_SCAN.
2144a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
2145a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_cmd_set_pre_scan {
2146a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
2147a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2148a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2149a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_cmd_set_pre_scan(struct ieee80211_hw *hw)
2150a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
2151a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_set_pre_scan *cmd;
2152a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2153a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2154a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2155a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2156a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2157a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2158a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_PRE_SCAN);
2159a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2160a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2161a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2162a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2163a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2164a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2165a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2166a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2167a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
2168a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * CMD_SET_POST_SCAN.
2169a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
2170a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_cmd_set_post_scan {
2171a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
2172a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 isibss;
2173d89173f25228b8795af2d4b53e985cc44c729332Lennert Buytenhek	__u8 bssid[ETH_ALEN];
2174a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2175a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2176a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int
21770a11dfc36604d9b24deda17461b7ea69851846aaLennert Buytenhekmwl8k_cmd_set_post_scan(struct ieee80211_hw *hw, const __u8 *mac)
2178a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
2179a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_set_post_scan *cmd;
2180a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2181a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2182a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2183a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2184a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2185a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2186a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_POST_SCAN);
2187a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2188a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->isibss = 0;
2189d89173f25228b8795af2d4b53e985cc44c729332Lennert Buytenhek	memcpy(cmd->bssid, mac, ETH_ALEN);
2190a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2191a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2192a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2193a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2194a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2195a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2196a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2197a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
2198a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * CMD_SET_RF_CHANNEL.
2199a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
2200a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_cmd_set_rf_channel {
2201a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
2202a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 action;
2203a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__u8 current_channel;
2204a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le32 channel_flags;
2205a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2206a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2207a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_cmd_set_rf_channel(struct ieee80211_hw *hw,
2208610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek				    struct ieee80211_conf *conf)
2209a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
2210610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek	struct ieee80211_channel *channel = conf->channel;
2211a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_set_rf_channel *cmd;
2212a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2213a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2214a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2215a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2216a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2217a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2218a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_RF_CHANNEL);
2219a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2220a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_CMD_SET);
2221a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->current_channel = channel->hw_value;
2222610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek
2223a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (channel->band == IEEE80211_BAND_2GHZ)
2224610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek		cmd->channel_flags |= cpu_to_le32(0x00000001);
222542574ea2274ec0a2a9c58ab01be91b65e60a2291Lennert Buytenhek	else if (channel->band == IEEE80211_BAND_5GHZ)
222642574ea2274ec0a2a9c58ab01be91b65e60a2291Lennert Buytenhek		cmd->channel_flags |= cpu_to_le32(0x00000004);
2227610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek
2228610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek	if (conf->channel_type == NL80211_CHAN_NO_HT ||
2229610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek	    conf->channel_type == NL80211_CHAN_HT20)
2230610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek		cmd->channel_flags |= cpu_to_le32(0x00000080);
2231610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek	else if (conf->channel_type == NL80211_CHAN_HT40MINUS)
2232610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek		cmd->channel_flags |= cpu_to_le32(0x000001900);
2233610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek	else if (conf->channel_type == NL80211_CHAN_HT40PLUS)
2234610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek		cmd->channel_flags |= cpu_to_le32(0x000000900);
2235a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2236a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2237a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2238a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2239a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2240a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2241a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2242a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
224355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_SET_AID.
2244a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
224555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek#define MWL8K_FRAME_PROT_DISABLED			0x00
224655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek#define MWL8K_FRAME_PROT_11G				0x07
224755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek#define MWL8K_FRAME_PROT_11N_HT_40MHZ_ONLY		0x02
224855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek#define MWL8K_FRAME_PROT_11N_HT_ALL			0x06
2249a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
225055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_update_set_aid {
225155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct	mwl8k_cmd_pkt header;
225255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le16	aid;
2253a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
225455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	 /* AP's MAC address (BSSID) */
225555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8	bssid[ETH_ALEN];
225655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le16	protection_mode;
225755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8	supp_rates[14];
2258a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2259a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2260c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhekstatic void legacy_rate_mask_to_array(u8 *rates, u32 mask)
2261c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek{
2262c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	int i;
2263c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	int j;
2264c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek
2265c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	/*
2266c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	 * Clear nonstandard rates 4 and 13.
2267c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	 */
2268c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	mask &= 0x1fef;
2269c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek
2270c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	for (i = 0, j = 0; i < 14; i++) {
2271c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek		if (mask & (1 << i))
2272777ad375d5960e0d2a945a34032b182eb2952d45Lennert Buytenhek			rates[j++] = mwl8k_rates_24[i].hw_value;
2273c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	}
2274c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek}
2275c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek
227655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int
2277c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhekmwl8k_cmd_set_aid(struct ieee80211_hw *hw,
2278c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek		  struct ieee80211_vif *vif, u32 legacy_rate_mask)
2279a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
228055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_update_set_aid *cmd;
228155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	u16 prot_mode;
2282a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2283a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2284a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2285a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2286a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2287a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
228855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_AID);
2289a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
22907dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek	cmd->aid = cpu_to_le16(vif->bss_conf.aid);
22910a11dfc36604d9b24deda17461b7ea69851846aaLennert Buytenhek	memcpy(cmd->bssid, vif->bss_conf.bssid, ETH_ALEN);
2292a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
22937dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek	if (vif->bss_conf.use_cts_prot) {
229455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		prot_mode = MWL8K_FRAME_PROT_11G;
229555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	} else {
22967dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek		switch (vif->bss_conf.ht_operation_mode &
229755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			IEEE80211_HT_OP_MODE_PROTECTION) {
229855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		case IEEE80211_HT_OP_MODE_PROTECTION_20MHZ:
229955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			prot_mode = MWL8K_FRAME_PROT_11N_HT_40MHZ_ONLY;
230055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			break;
230155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		case IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED:
230255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			prot_mode = MWL8K_FRAME_PROT_11N_HT_ALL;
230355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			break;
230455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		default:
230555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			prot_mode = MWL8K_FRAME_PROT_DISABLED;
230655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			break;
230755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		}
230855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	}
230955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->protection_mode = cpu_to_le16(prot_mode);
2310a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2311c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	legacy_rate_mask_to_array(cmd->supp_rates, legacy_rate_mask);
2312a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2313a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2314a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2315a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2316a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2317a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2318a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2319a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
232055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_SET_RATE.
232132060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek */
232255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_set_rate {
232355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct	mwl8k_cmd_pkt header;
232455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8	legacy_rates[14];
232555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
232655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	/* Bitmap for supported MCS codes.  */
232755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8	mcs_set[16];
232855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8	reserved[16];
232932060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek} __attribute__((packed));
233032060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek
233155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int
2332c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhekmwl8k_cmd_set_rate(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
233313935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek		   u32 legacy_rate_mask, u8 *mcs_rates)
233432060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek{
233555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_set_rate *cmd;
233632060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	int rc;
233732060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek
233832060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
233932060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	if (cmd == NULL)
234032060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek		return -ENOMEM;
234132060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek
234255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_RATE);
234332060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2344c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek	legacy_rate_mask_to_array(cmd->legacy_rates, legacy_rate_mask);
234513935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	memcpy(cmd->mcs_set, mcs_rates, 16);
234632060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek
234732060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
234832060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	kfree(cmd);
234932060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek
235032060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	return rc;
235132060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek}
235232060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek
235332060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek/*
235455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_FINALIZE_JOIN.
2355a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
235655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek#define MWL8K_FJ_BEACON_MAXLEN	128
235755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
235855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_finalize_join {
2359a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
236055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le32 sleep_interval;	/* Number of beacon periods to sleep */
236155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8 beacon_data[MWL8K_FJ_BEACON_MAXLEN];
2362a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2363a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
236455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_finalize_join(struct ieee80211_hw *hw, void *frame,
236555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek				   int framelen, int dtim)
2366a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
236755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_finalize_join *cmd;
236855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct ieee80211_mgmt *payload = frame;
236955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	int payload_len;
2370a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2371a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2372a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2373a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2374a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2375a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
237655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_FINALIZE_JOIN);
2377a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
237855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->sleep_interval = cpu_to_le32(dtim ? dtim : 1);
237955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
238055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	payload_len = framelen - ieee80211_hdrlen(payload->frame_control);
238155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	if (payload_len < 0)
238255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		payload_len = 0;
238355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	else if (payload_len > MWL8K_FJ_BEACON_MAXLEN)
238455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		payload_len = MWL8K_FJ_BEACON_MAXLEN;
238555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
238655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	memcpy(cmd->beacon_data, &payload->u.beacon, payload_len);
2387a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2388a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2389a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2390a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2391a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2392a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2393a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2394a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
239555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_SET_RTS_THRESHOLD.
2396a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
239755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_set_rts_threshold {
2398a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
2399a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 action;
240055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le16 threshold;
2401a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2402a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2403c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhekstatic int
2404c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhekmwl8k_cmd_set_rts_threshold(struct ieee80211_hw *hw, int rts_thresh)
2405a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
240655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_set_rts_threshold *cmd;
2407a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2408a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2409a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2410a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2411a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2412a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
241355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_RTS_THRESHOLD);
2414a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2415c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_CMD_SET);
2416c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhek	cmd->threshold = cpu_to_le16(rts_thresh);
2417a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2418a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2419a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2420a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2421a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2422a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2423a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2424a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
242555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_SET_SLOT.
2426a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
242755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_set_slot {
2428a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
2429a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 action;
243055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8 short_slot;
2431a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2432a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
243355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_set_slot(struct ieee80211_hw *hw, bool short_slot_time)
2434a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
243555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_set_slot *cmd;
2436a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2437a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2438a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2439a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2440a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2441a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
244255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_SLOT);
2443a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
244455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_CMD_SET);
244555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->short_slot = short_slot_time;
2446a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2447a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2448a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2449a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2450a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2451a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2452a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2453a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
2454a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * CMD_SET_EDCA_PARAMS.
2455a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
2456a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstruct mwl8k_cmd_set_edca_params {
2457a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
2458a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2459a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* See MWL8K_SET_EDCA_XXX below */
2460a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 action;
2461a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2462a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* TX opportunity in units of 32 us */
2463a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	__le16 txop;
2464a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
24652e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek	union {
24662e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		struct {
24672e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			/* Log exponent of max contention period: 0...15 */
24682e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			__le32 log_cw_max;
24692e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek
24702e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			/* Log exponent of min contention period: 0...15 */
24712e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			__le32 log_cw_min;
24722e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek
24732e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			/* Adaptive interframe spacing in units of 32us */
24742e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			__u8 aifs;
24752e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek
24762e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			/* TX queue to configure */
24772e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			__u8 txq;
24782e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		} ap;
24792e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		struct {
24802e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			/* Log exponent of max contention period: 0...15 */
24812e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			__u8 log_cw_max;
2482a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
24832e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			/* Log exponent of min contention period: 0...15 */
24842e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			__u8 log_cw_min;
2485a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
24862e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			/* Adaptive interframe spacing in units of 32us */
24872e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			__u8 aifs;
2488a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
24892e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			/* TX queue to configure */
24902e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek			__u8 txq;
24912e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		} sta;
24922e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek	};
2493a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2494a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2495a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_SET_EDCA_CW	0x01
2496a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_SET_EDCA_TXOP	0x02
2497a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_SET_EDCA_AIFS	0x04
2498a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2499a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek#define MWL8K_SET_EDCA_ALL	(MWL8K_SET_EDCA_CW | \
2500a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_SET_EDCA_TXOP | \
2501a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 MWL8K_SET_EDCA_AIFS)
2502a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2503a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int
250455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekmwl8k_cmd_set_edca_params(struct ieee80211_hw *hw, __u8 qnum,
250555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			  __u16 cw_min, __u16 cw_max,
250655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			  __u8 aifs, __u16 txop)
2507a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
25082e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
2509a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_set_edca_params *cmd;
2510a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2511a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2512a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2513a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2514a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2515a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2516a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_EDCA_PARAMS);
2517a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2518a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_SET_EDCA_ALL);
2519a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->txop = cpu_to_le16(txop);
25202e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek	if (priv->ap_fw) {
25212e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		cmd->ap.log_cw_max = cpu_to_le32(ilog2(cw_max + 1));
25222e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		cmd->ap.log_cw_min = cpu_to_le32(ilog2(cw_min + 1));
25232e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		cmd->ap.aifs = aifs;
25242e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		cmd->ap.txq = qnum;
25252e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek	} else {
25262e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		cmd->sta.log_cw_max = (u8)ilog2(cw_max + 1);
25272e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		cmd->sta.log_cw_min = (u8)ilog2(cw_min + 1);
25282e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		cmd->sta.aifs = aifs;
25292e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek		cmd->sta.txq = qnum;
25302e484c8964f7845d320eb1161c514dbfcafdda78Lennert Buytenhek	}
2531a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2532a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2533a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2534a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2535a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2536a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2537a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2538a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
253955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_SET_WMM_MODE.
2540a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
254155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_set_wmm_mode {
2542a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_cmd_pkt header;
254355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le16 action;
2544a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2545a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
254655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_set_wmm_mode(struct ieee80211_hw *hw, bool enable)
2547a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
254855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
254955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_set_wmm_mode *cmd;
2550a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2551a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2552a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2553a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2554a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2555a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
255655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_WMM_MODE);
2557a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
255855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->action = cpu_to_le16(!!enable);
2559a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2560a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2561a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
256216cec43da50c4b4702653ca710549fd3457a4e6cLennert Buytenhek
256355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	if (!rc)
256455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		priv->wmm_enabled = enable;
2565a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2566a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2567a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2568a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2569a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
257055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_MIMO_CONFIG.
2571a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
257255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_mimo_config {
257355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_pkt header;
257455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le32 action;
257555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8 rx_antenna_map;
257655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8 tx_antenna_map;
2577a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2578a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
257955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_mimo_config(struct ieee80211_hw *hw, __u8 rx, __u8 tx)
2580a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
258155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_mimo_config *cmd;
2582a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2583a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2584a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2585a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2586a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2587a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
258855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_MIMO_CONFIG);
2589a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
259055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->action = cpu_to_le32((u32)MWL8K_CMD_SET);
259155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->rx_antenna_map = rx;
259255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->tx_antenna_map = tx;
2593a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2594a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2595a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2596a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2597a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2598a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2599a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2600a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
2601b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek * CMD_USE_FIXED_RATE (STA version).
2602a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
2603b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhekstruct mwl8k_cmd_use_fixed_rate_sta {
2604b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	struct mwl8k_cmd_pkt header;
2605b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	__le32 action;
2606b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	__le32 allow_rate_drop;
2607b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	__le32 num_rates;
2608b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	struct {
2609b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek		__le32 is_ht_rate;
2610b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek		__le32 enable_retry;
2611b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek		__le32 rate;
2612b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek		__le32 retry_count;
2613b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	} rate_entry[8];
2614b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	__le32 rate_type;
2615b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	__le32 reserved1;
2616b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	__le32 reserved2;
2617a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek} __attribute__((packed));
2618a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2619b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek#define MWL8K_USE_AUTO_RATE	0x0002
2620b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek#define MWL8K_UCAST_RATE	0
2621a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2622b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhekstatic int mwl8k_cmd_use_fixed_rate_sta(struct ieee80211_hw *hw)
2623a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
2624b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	struct mwl8k_cmd_use_fixed_rate_sta *cmd;
2625a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
2626a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2627a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2628a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (cmd == NULL)
2629a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -ENOMEM;
2630a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2631a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_USE_FIXED_RATE);
2632a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2633b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	cmd->action = cpu_to_le32(MWL8K_USE_AUTO_RATE);
2634b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek	cmd->rate_type = cpu_to_le32(MWL8K_UCAST_RATE);
2635a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2636a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2637a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	kfree(cmd);
2638a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
2639a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
2640a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
2641a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
264255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek/*
2643088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek * CMD_USE_FIXED_RATE (AP version).
2644088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek */
2645088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhekstruct mwl8k_cmd_use_fixed_rate_ap {
2646088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	struct mwl8k_cmd_pkt header;
2647088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	__le32 action;
2648088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	__le32 allow_rate_drop;
2649088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	__le32 num_rates;
2650088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	struct mwl8k_rate_entry_ap {
2651088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek		__le32 is_ht_rate;
2652088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek		__le32 enable_retry;
2653088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek		__le32 rate;
2654088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek		__le32 retry_count;
2655088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	} rate_entry[4];
2656088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	u8 multicast_rate;
2657088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	u8 multicast_rate_type;
2658088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	u8 management_rate;
2659088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek} __attribute__((packed));
2660088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek
2661088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhekstatic int
2662088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhekmwl8k_cmd_use_fixed_rate_ap(struct ieee80211_hw *hw, int mcast, int mgmt)
2663088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek{
2664088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	struct mwl8k_cmd_use_fixed_rate_ap *cmd;
2665088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	int rc;
2666088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek
2667088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2668088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	if (cmd == NULL)
2669088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek		return -ENOMEM;
2670088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek
2671088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_USE_FIXED_RATE);
2672088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2673088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	cmd->action = cpu_to_le32(MWL8K_USE_AUTO_RATE);
2674088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	cmd->multicast_rate = mcast;
2675088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	cmd->management_rate = mgmt;
2676088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek
2677088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2678088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	kfree(cmd);
2679088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek
2680088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek	return rc;
2681088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek}
2682088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek
2683088aab8b62666a002907c912cd346ae6dc9f42b7Lennert Buytenhek/*
268455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_ENABLE_SNIFFER.
268555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek */
268655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_enable_sniffer {
268755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_pkt header;
268855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le32 action;
268955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek} __attribute__((packed));
269055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
269155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_enable_sniffer(struct ieee80211_hw *hw, bool enable)
269255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek{
269355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_enable_sniffer *cmd;
269455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	int rc;
269555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
269655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
269755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	if (cmd == NULL)
269855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		return -ENOMEM;
269955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
270055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_ENABLE_SNIFFER);
270155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
270255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->action = cpu_to_le32(!!enable);
270355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
270455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
270555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	kfree(cmd);
270655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
270755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	return rc;
270855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek}
270955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
271055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek/*
271155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_SET_MAC_ADDR.
271255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek */
271355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_set_mac_addr {
271455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_pkt header;
271555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	union {
271655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		struct {
271755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			__le16 mac_type;
271855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			__u8 mac_addr[ETH_ALEN];
271955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		} mbss;
272055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		__u8 mac_addr[ETH_ALEN];
272155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	};
272255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek} __attribute__((packed));
272355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
2724a9e00b151ec2121b7ae09d84a2b5a68b6461e98aLennert Buytenhek#define MWL8K_MAC_TYPE_PRIMARY_CLIENT	0
2725a9e00b151ec2121b7ae09d84a2b5a68b6461e98aLennert Buytenhek#define MWL8K_MAC_TYPE_PRIMARY_AP	2
2726a9e00b151ec2121b7ae09d84a2b5a68b6461e98aLennert Buytenhek
272755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_set_mac_addr(struct ieee80211_hw *hw, u8 *mac)
272855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek{
272955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
273055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_set_mac_addr *cmd;
273155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	int rc;
273255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
273355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
273455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	if (cmd == NULL)
273555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		return -ENOMEM;
273655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
273755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_MAC_ADDR);
273855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
273955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	if (priv->ap_fw) {
2740a9e00b151ec2121b7ae09d84a2b5a68b6461e98aLennert Buytenhek		cmd->mbss.mac_type = cpu_to_le16(MWL8K_MAC_TYPE_PRIMARY_AP);
274155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		memcpy(cmd->mbss.mac_addr, mac, ETH_ALEN);
274255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	} else {
274355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		memcpy(cmd->mac_addr, mac, ETH_ALEN);
274455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	}
274555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
274655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
274755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	kfree(cmd);
274855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
274955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	return rc;
275055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek}
275155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
275255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek/*
275355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_SET_RATEADAPT_MODE.
275455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek */
275555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_set_rate_adapt_mode {
275655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_pkt header;
275755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le16 action;
275855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le16 mode;
275955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek} __attribute__((packed));
276055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
276155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstatic int mwl8k_cmd_set_rateadapt_mode(struct ieee80211_hw *hw, __u16 mode)
276255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek{
276355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_set_rate_adapt_mode *cmd;
276455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	int rc;
276555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
276655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
276755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	if (cmd == NULL)
276855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		return -ENOMEM;
276955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
277055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_RATEADAPT_MODE);
277155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
277255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_CMD_SET);
277355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->mode = cpu_to_le16(mode);
277455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
277555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
277655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	kfree(cmd);
277755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
277855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	return rc;
277955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek}
278055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
278155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek/*
2782b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek * CMD_BSS_START.
2783b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek */
2784b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekstruct mwl8k_cmd_bss_start {
2785b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	struct mwl8k_cmd_pkt header;
2786b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	__le32 enable;
2787b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek} __attribute__((packed));
2788b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2789b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekstatic int mwl8k_cmd_bss_start(struct ieee80211_hw *hw, int enable)
2790b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek{
2791b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	struct mwl8k_cmd_bss_start *cmd;
2792b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	int rc;
2793b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2794b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2795b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (cmd == NULL)
2796b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		return -ENOMEM;
2797b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2798b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_BSS_START);
2799b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2800b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->enable = cpu_to_le32(enable);
2801b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2802b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2803b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	kfree(cmd);
2804b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2805b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	return rc;
2806b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek}
2807b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2808b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek/*
28093f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek * CMD_SET_NEW_STN.
28103f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek */
28113f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhekstruct mwl8k_cmd_set_new_stn {
28123f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	struct mwl8k_cmd_pkt header;
28133f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le16 aid;
28143f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__u8 mac_addr[6];
28153f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le16 stn_id;
28163f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le16 action;
28173f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le16 rsvd;
28183f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le32 legacy_rates;
28193f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__u8 ht_rates[4];
28203f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le16 cap_info;
28213f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le16 ht_capabilities_info;
28223f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__u8 mac_ht_param_info;
28233f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__u8 rev;
28243f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__u8 control_channel;
28253f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__u8 add_channel;
28263f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le16 op_mode;
28273f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le16 stbc;
28283f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__u8 add_qos_info;
28293f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__u8 is_qos_sta;
28303f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	__le32 fw_sta_ptr;
28313f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek} __attribute__((packed));
28323f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
28333f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek#define MWL8K_STA_ACTION_ADD		0
28343f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek#define MWL8K_STA_ACTION_REMOVE		2
28353f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
28363f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhekstatic int mwl8k_cmd_set_new_stn_add(struct ieee80211_hw *hw,
28373f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek				     struct ieee80211_vif *vif,
28383f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek				     struct ieee80211_sta *sta)
28393f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek{
28403f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	struct mwl8k_cmd_set_new_stn *cmd;
28418707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek	u32 rates;
28423f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	int rc;
28433f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
28443f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
28453f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	if (cmd == NULL)
28463f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		return -ENOMEM;
28473f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
28483f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_NEW_STN);
28493f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
28503f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd->aid = cpu_to_le16(sta->aid);
28513f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	memcpy(cmd->mac_addr, sta->addr, ETH_ALEN);
28523f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd->stn_id = cpu_to_le16(sta->aid);
28533f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_STA_ACTION_ADD);
28548707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek	if (hw->conf.channel->band == IEEE80211_BAND_2GHZ)
28558707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		rates = sta->supp_rates[IEEE80211_BAND_2GHZ];
28568707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek	else
28578707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		rates = sta->supp_rates[IEEE80211_BAND_5GHZ] << 5;
28588707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek	cmd->legacy_rates = cpu_to_le32(rates);
28593f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	if (sta->ht_cap.ht_supported) {
28603f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		cmd->ht_rates[0] = sta->ht_cap.mcs.rx_mask[0];
28613f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		cmd->ht_rates[1] = sta->ht_cap.mcs.rx_mask[1];
28623f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		cmd->ht_rates[2] = sta->ht_cap.mcs.rx_mask[2];
28633f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		cmd->ht_rates[3] = sta->ht_cap.mcs.rx_mask[3];
28643f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		cmd->ht_capabilities_info = cpu_to_le16(sta->ht_cap.cap);
28653f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		cmd->mac_ht_param_info = (sta->ht_cap.ampdu_factor & 3) |
28663f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek			((sta->ht_cap.ampdu_density & 7) << 2);
28673f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		cmd->is_qos_sta = 1;
28683f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	}
28693f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
28703f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
28713f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	kfree(cmd);
28723f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
28733f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	return rc;
28743f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek}
28753f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
2876b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekstatic int mwl8k_cmd_set_new_stn_add_self(struct ieee80211_hw *hw,
2877b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek					  struct ieee80211_vif *vif)
2878b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek{
2879b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	struct mwl8k_cmd_set_new_stn *cmd;
2880b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	int rc;
2881b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2882b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
2883b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (cmd == NULL)
2884b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		return -ENOMEM;
2885b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2886b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_NEW_STN);
2887b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2888b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	memcpy(cmd->mac_addr, vif->addr, ETH_ALEN);
2889b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2890b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
2891b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	kfree(cmd);
2892b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
2893b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	return rc;
2894b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek}
2895b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
28963f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhekstatic int mwl8k_cmd_set_new_stn_del(struct ieee80211_hw *hw,
28973f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek				     struct ieee80211_vif *vif, u8 *addr)
28983f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek{
28993f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	struct mwl8k_cmd_set_new_stn *cmd;
29003f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	int rc;
29013f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
29023f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
29033f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	if (cmd == NULL)
29043f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		return -ENOMEM;
29053f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
29063f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_SET_NEW_STN);
29073f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
29083f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	memcpy(cmd->mac_addr, addr, ETH_ALEN);
29093f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	cmd->action = cpu_to_le16(MWL8K_STA_ACTION_REMOVE);
29103f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
29113f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
29123f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	kfree(cmd);
29133f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
29143f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	return rc;
29153f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek}
29163f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
29173f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek/*
291855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek * CMD_UPDATE_STADB.
291955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek */
292025d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhekstruct ewc_ht_info {
292125d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__le16	control1;
292225d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__le16	control2;
292325d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__le16	control3;
292425d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek} __attribute__((packed));
292525d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek
292625d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhekstruct peer_capability_info {
292725d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	/* Peer type - AP vs. STA.  */
292825d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	peer_type;
292925d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek
293025d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	/* Basic 802.11 capabilities from assoc resp.  */
293125d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__le16	basic_caps;
293225d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek
293325d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	/* Set if peer supports 802.11n high throughput (HT).  */
293425d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	ht_support;
293525d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek
293625d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	/* Valid if HT is supported.  */
293725d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__le16	ht_caps;
293825d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	extended_ht_caps;
293925d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	struct ewc_ht_info	ewc_info;
294025d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek
294125d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	/* Legacy rate table. Intersection of our rates and peer rates.  */
294225d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	legacy_rates[12];
294325d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek
294425d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	/* HT rate table. Intersection of our rates and peer rates.  */
294525d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	ht_rates[16];
294625d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	pad[16];
294725d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek
294825d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	/* If set, interoperability mode, no proprietary extensions.  */
294925d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	interop;
295025d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	pad2;
295125d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__u8	station_id;
295225d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek	__le16	amsdu_enabled;
295325d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek} __attribute__((packed));
295425d81b1e1a0cca41a71a08468a7d3a4c751c8565Lennert Buytenhek
295555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhekstruct mwl8k_cmd_update_stadb {
295655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_pkt header;
295755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
295855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	/* See STADB_ACTION_TYPE */
295955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le32	action;
296055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
296155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	/* Peer MAC address */
296255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__u8	peer_addr[ETH_ALEN];
296355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
296455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	__le32	reserved;
296555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
296655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	/* Peer info - valid during add/update.  */
296755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct peer_capability_info	peer_info;
296855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek} __attribute__((packed));
296955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
2970a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek#define MWL8K_STA_DB_MODIFY_ENTRY	1
2971a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek#define MWL8K_STA_DB_DEL_ENTRY		2
2972a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek
2973a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek/* Peer Entry flags - used to define the type of the peer node */
2974a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek#define MWL8K_PEER_TYPE_ACCESSPOINT	2
2975a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek
2976a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhekstatic int mwl8k_cmd_update_stadb_add(struct ieee80211_hw *hw,
2977c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek				      struct ieee80211_vif *vif,
297813935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek				      struct ieee80211_sta *sta)
297955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek{
298055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	struct mwl8k_cmd_update_stadb *cmd;
2981a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	struct peer_capability_info *p;
29828707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek	u32 rates;
298355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	int rc;
298455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
298555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
298655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	if (cmd == NULL)
298755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		return -ENOMEM;
298855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
298955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_UPDATE_STADB);
299055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
2991a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	cmd->action = cpu_to_le32(MWL8K_STA_DB_MODIFY_ENTRY);
299213935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	memcpy(cmd->peer_addr, sta->addr, ETH_ALEN);
299355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
2994a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	p = &cmd->peer_info;
2995a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	p->peer_type = MWL8K_PEER_TYPE_ACCESSPOINT;
2996a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	p->basic_caps = cpu_to_le16(vif->bss_conf.assoc_capability);
299713935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	p->ht_support = sta->ht_cap.ht_supported;
299813935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	p->ht_caps = sta->ht_cap.cap;
299913935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	p->extended_ht_caps = (sta->ht_cap.ampdu_factor & 3) |
300013935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek		((sta->ht_cap.ampdu_density & 7) << 2);
30018707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek	if (hw->conf.channel->band == IEEE80211_BAND_2GHZ)
30028707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		rates = sta->supp_rates[IEEE80211_BAND_2GHZ];
30038707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek	else
30048707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		rates = sta->supp_rates[IEEE80211_BAND_5GHZ] << 5;
30058707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek	legacy_rate_mask_to_array(p->legacy_rates, rates);
300613935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	memcpy(p->ht_rates, sta->ht_cap.mcs.rx_mask, 16);
3007a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	p->interop = 1;
3008a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	p->amsdu_enabled = 0;
3009a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek
3010a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
3011a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	kfree(cmd);
3012a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek
3013a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	return rc ? rc : p->station_id;
3014a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek}
3015a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek
3016a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhekstatic int mwl8k_cmd_update_stadb_del(struct ieee80211_hw *hw,
3017a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek				      struct ieee80211_vif *vif, u8 *addr)
3018a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek{
3019a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	struct mwl8k_cmd_update_stadb *cmd;
3020a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	int rc;
3021a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek
3022a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
3023a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	if (cmd == NULL)
3024a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek		return -ENOMEM;
3025a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek
3026a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	cmd->header.code = cpu_to_le16(MWL8K_CMD_UPDATE_STADB);
3027a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	cmd->header.length = cpu_to_le16(sizeof(*cmd));
3028a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	cmd->action = cpu_to_le32(MWL8K_STA_DB_DEL_ENTRY);
3029bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	memcpy(cmd->peer_addr, addr, ETH_ALEN);
303055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
3031a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	rc = mwl8k_post_cmd(hw, &cmd->header);
303255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	kfree(cmd);
303355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
303455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	return rc;
303555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek}
303655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek
3037a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3038a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
3039a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * Interrupt handling.
3040a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
3041a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic irqreturn_t mwl8k_interrupt(int irq, void *dev_id)
3042a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3043a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_hw *hw = dev_id;
3044a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3045a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	u32 status;
3046a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3047a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	status = ioread32(priv->regs + MWL8K_HIU_A2H_INTERRUPT_STATUS);
3048a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (!status)
3049a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return IRQ_NONE;
3050a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
30511e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	if (status & MWL8K_A2H_INT_TX_DONE) {
30521e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		status &= ~MWL8K_A2H_INT_TX_DONE;
30531e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		tasklet_schedule(&priv->poll_tx_task);
30541e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	}
30551e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek
3056a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (status & MWL8K_A2H_INT_RX_READY) {
305767e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek		status &= ~MWL8K_A2H_INT_RX_READY;
305867e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek		tasklet_schedule(&priv->poll_rx_task);
3059a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3060a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
306167e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	if (status)
306267e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek		iowrite32(~status, priv->regs + MWL8K_HIU_A2H_INTERRUPT_STATUS);
306367e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek
3064a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (status & MWL8K_A2H_INT_OPC_DONE) {
3065618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		if (priv->hostcmd_wait != NULL)
3066a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			complete(priv->hostcmd_wait);
3067a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3068a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3069a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (status & MWL8K_A2H_INT_QUEUE_EMPTY) {
3070618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek		if (!mutex_is_locked(&priv->fw_mutex) &&
307188de754ad59025eba797e7a8375807755577f450Lennert Buytenhek		    priv->radio_on && priv->pending_tx_pkts)
3072618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek			mwl8k_tx_start(priv);
3073a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3074a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3075a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return IRQ_HANDLED;
3076a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3077a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
30781e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhekstatic void mwl8k_tx_poll(unsigned long data)
30791e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek{
30801e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	struct ieee80211_hw *hw = (struct ieee80211_hw *)data;
30811e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
30821e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	int limit;
30831e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	int i;
30841e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek
30851e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	limit = 32;
30861e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek
30871e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	spin_lock_bh(&priv->tx_lock);
30881e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek
30891e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++)
30901e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		limit -= mwl8k_txq_reclaim(hw, i, limit, 0);
30911e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek
30921e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	if (!priv->pending_tx_pkts && priv->tx_wait != NULL) {
30931e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		complete(priv->tx_wait);
30941e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		priv->tx_wait = NULL;
30951e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	}
30961e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek
30971e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	spin_unlock_bh(&priv->tx_lock);
30981e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek
30991e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	if (limit) {
31001e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		writel(~MWL8K_A2H_INT_TX_DONE,
31011e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		       priv->regs + MWL8K_HIU_A2H_INTERRUPT_STATUS);
31021e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	} else {
31031e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		tasklet_schedule(&priv->poll_tx_task);
31041e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	}
31051e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek}
31061e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek
310767e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhekstatic void mwl8k_rx_poll(unsigned long data)
310867e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek{
310967e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	struct ieee80211_hw *hw = (struct ieee80211_hw *)data;
311067e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
311167e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	int limit;
311267e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek
311367e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	limit = 32;
311467e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	limit -= rxq_process(hw, 0, limit);
311567e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	limit -= rxq_refill(hw, 0, limit);
311667e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek
311767e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	if (limit) {
311867e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek		writel(~MWL8K_A2H_INT_RX_READY,
311967e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek		       priv->regs + MWL8K_HIU_A2H_INTERRUPT_STATUS);
312067e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	} else {
312167e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek		tasklet_schedule(&priv->poll_rx_task);
312267e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	}
312367e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek}
312467e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek
3125a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3126a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek/*
3127a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek * Core driver operations.
3128a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek */
3129a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
3130a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3131a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3132a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int index = skb_get_queue_mapping(skb);
3133a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
3134a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
31359189c10087a738c764046fa27651d332594cd8e6Lennert Buytenhek	if (!priv->radio_on) {
3136a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_DEBUG "%s: dropped TX frame since radio "
3137c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       "disabled\n", wiphy_name(hw->wiphy));
3138a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		dev_kfree_skb(skb);
3139a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return NETDEV_TX_OK;
3140a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3141a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3142a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_txq_xmit(hw, index, skb);
3143a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3144a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
3145a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3146a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3147a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_start(struct ieee80211_hw *hw)
3148a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3149a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3150a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
3151a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3152a0607fd3a25ba1848a63a0d925e36d914735ab47Joe Perches	rc = request_irq(priv->pdev->irq, mwl8k_interrupt,
3153a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			 IRQF_SHARED, MWL8K_NAME, hw);
3154a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
3155a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: failed to register IRQ handler\n",
3156c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
31572ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek		return -EIO;
3158a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3159a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
316067e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	/* Enable TX reclaim and RX tasklets.  */
31611e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	tasklet_enable(&priv->poll_tx_task);
316267e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	tasklet_enable(&priv->poll_rx_task);
31632ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek
3164a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Enable interrupts */
3165c23b5a699471ea2ef9d146eae80e64836cfbf001Lennert Buytenhek	iowrite32(MWL8K_A2H_EVENTS, priv->regs + MWL8K_HIU_A2H_INTERRUPT_MASK);
3166a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
31672ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek	rc = mwl8k_fw_lock(hw);
31682ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek	if (!rc) {
316955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		rc = mwl8k_cmd_radio_enable(hw);
3170a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
31715e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek		if (!priv->ap_fw) {
31725e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek			if (!rc)
317355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek				rc = mwl8k_cmd_enable_sniffer(hw, 0);
3174a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
31755e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek			if (!rc)
31765e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek				rc = mwl8k_cmd_set_pre_scan(hw);
31775e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek
31785e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek			if (!rc)
31795e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek				rc = mwl8k_cmd_set_post_scan(hw,
31805e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek						"\x00\x00\x00\x00\x00\x00");
31815e4cf166f4a9801ea9ca1bab210d763d27538de6Lennert Buytenhek		}
31822ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek
31832ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek		if (!rc)
318455489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			rc = mwl8k_cmd_set_rateadapt_mode(hw, 0);
3185a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
31862ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek		if (!rc)
318755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			rc = mwl8k_cmd_set_wmm_mode(hw, 0);
3188a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
31892ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek		mwl8k_fw_unlock(hw);
31902ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek	}
31912ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek
31922ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek	if (rc) {
31932ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek		iowrite32(0, priv->regs + MWL8K_HIU_A2H_INTERRUPT_MASK);
31942ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek		free_irq(priv->pdev->irq, hw);
31951e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		tasklet_disable(&priv->poll_tx_task);
319667e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek		tasklet_disable(&priv->poll_rx_task);
31972ec610cb6d57032cdab89781e37ed3e442c73367Lennert Buytenhek	}
3198a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3199a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
3200a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3201a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3202a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void mwl8k_stop(struct ieee80211_hw *hw)
3203a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3204a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3205a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int i;
3206a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
320755489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	mwl8k_cmd_radio_disable(hw);
3208a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3209a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	ieee80211_stop_queues(hw);
3210a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3211a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Disable interrupts */
3212a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(0, priv->regs + MWL8K_HIU_A2H_INTERRUPT_MASK);
3213a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	free_irq(priv->pdev->irq, hw);
3214a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3215a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Stop finalize join worker */
3216a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	cancel_work_sync(&priv->finalize_join_worker);
3217a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (priv->beacon_skb != NULL)
3218a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		dev_kfree_skb(priv->beacon_skb);
3219a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
322067e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	/* Stop TX reclaim and RX tasklets.  */
32211e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	tasklet_disable(&priv->poll_tx_task);
322267e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	tasklet_disable(&priv->poll_rx_task);
3223a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3224a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Return all skbs to mac80211 */
3225a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++)
3226efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek		mwl8k_txq_reclaim(hw, i, INT_MAX, 1);
3227a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3228a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3229a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_add_interface(struct ieee80211_hw *hw,
32301ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg				struct ieee80211_vif *vif)
3231a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3232a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3233a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_vif *mwl8k_vif;
3234a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3235a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/*
3236a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * We only support one active interface at a time.
3237a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 */
3238a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (priv->vif != NULL)
3239a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return -EBUSY;
3240a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3241a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/*
3242a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 * Reject interface creation if sniffer mode is active, as
3243a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 * STA operation is mutually exclusive with hardware sniffer
3244b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	 * mode.  (Sniffer mode is only used on STA firmware.)
3245a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 */
3246a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	if (priv->sniffer_enabled) {
3247a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		printk(KERN_INFO "%s: unable to create STA "
3248a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		       "interface due to sniffer mode being enabled\n",
3249a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		       wiphy_name(hw->wiphy));
3250a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		return -EINVAL;
3251a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	}
3252a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek
3253c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhek	/* Set the mac address.  */
3254c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhek	mwl8k_cmd_set_mac_addr(hw, vif->addr);
3255c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhek
3256b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (priv->ap_fw)
3257b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		mwl8k_cmd_set_new_stn_add_self(hw, vif);
3258b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3259a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Clean out driver private area */
32601ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg	mwl8k_vif = MWL8K_VIF(vif);
3261a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	memset(mwl8k_vif, 0, sizeof(*mwl8k_vif));
3262a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3263a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Set Initial sequence number to zero */
3264a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	mwl8k_vif->seqno = 0;
3265a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
32661ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg	priv->vif = vif;
3267a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3268a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return 0;
3269a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3270a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3271a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void mwl8k_remove_interface(struct ieee80211_hw *hw,
32721ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg				   struct ieee80211_vif *vif)
3273a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3274a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3275a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3276b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (priv->ap_fw)
3277b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		mwl8k_cmd_set_new_stn_del(hw, vif, vif->addr);
3278b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
327955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	mwl8k_cmd_set_mac_addr(hw, "\x00\x00\x00\x00\x00\x00");
328032060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek
3281a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->vif = NULL;
3282a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3283a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3284ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhekstatic int mwl8k_config(struct ieee80211_hw *hw, u32 changed)
3285a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3286a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_conf *conf = &hw->conf;
3287a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3288ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek	int rc;
3289a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
32907595d67a06466cc00e3aae1b86544278b57481eeLennert Buytenhek	if (conf->flags & IEEE80211_CONF_IDLE) {
329155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		mwl8k_cmd_radio_disable(hw);
3292ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek		return 0;
32937595d67a06466cc00e3aae1b86544278b57481eeLennert Buytenhek	}
32947595d67a06466cc00e3aae1b86544278b57481eeLennert Buytenhek
3295ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek	rc = mwl8k_fw_lock(hw);
3296ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek	if (rc)
3297ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek		return rc;
3298a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
329955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	rc = mwl8k_cmd_radio_enable(hw);
3300ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek	if (rc)
3301ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek		goto out;
3302a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3303610677d2f0415570a7590790e8be376a946cd08bLennert Buytenhek	rc = mwl8k_cmd_set_rf_channel(hw, conf);
3304ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek	if (rc)
3305ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek		goto out;
3306ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek
3307a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (conf->power_level > 18)
3308a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		conf->power_level = 18;
330955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	rc = mwl8k_cmd_rf_tx_power(hw, conf->power_level);
3310ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek	if (rc)
3311ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek		goto out;
3312a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
331308b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	if (priv->ap_fw) {
331408b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek		rc = mwl8k_cmd_rf_antenna(hw, MWL8K_RF_ANTENNA_RX, 0x7);
331508b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek		if (!rc)
331608b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek			rc = mwl8k_cmd_rf_antenna(hw, MWL8K_RF_ANTENNA_TX, 0x7);
331708b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	} else {
331808b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek		rc = mwl8k_cmd_mimo_config(hw, 0x7, 0x7);
331908b063477e45cb366df7204cbcdc79ff86513ef9Lennert Buytenhek	}
3320a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3321ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhekout:
3322ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek	mwl8k_fw_unlock(hw);
3323a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3324ee03a93241eb954d669fb795b4e5c0eec92eef22Lennert Buytenhek	return rc;
3325a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3326a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3327b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekstatic void
3328b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekmwl8k_bss_info_changed_sta(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
3329b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek			   struct ieee80211_bss_conf *info, u32 changed)
3330a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3331a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3332c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	u32 ap_legacy_rates;
333313935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	u8 ap_mcs_rates[16];
33343a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek	int rc;
33353a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek
3336c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	if (mwl8k_fw_lock(hw))
33373a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek		return;
3338a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3339c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	/*
3340c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	 * No need to capture a beacon if we're no longer associated.
3341c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	 */
3342c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	if ((changed & BSS_CHANGED_ASSOC) && !vif->bss_conf.assoc)
3343c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek		priv->capture_beacon = false;
33443a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek
3345c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	/*
334613935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	 * Get the AP's legacy and MCS rates.
3347c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	 */
33487dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek	if (vif->bss_conf.assoc) {
3349c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek		struct ieee80211_sta *ap;
3350c97470dd253831e880c72ea5d022ed7f3aee45c3Lennert Buytenhek
3351c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek		rcu_read_lock();
3352c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek
3353c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek		ap = ieee80211_find_sta(vif, vif->bss_conf.bssid);
3354c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek		if (ap == NULL) {
3355c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek			rcu_read_unlock();
3356c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek			goto out;
3357c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek		}
3358c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek
33598707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		if (hw->conf.channel->band == IEEE80211_BAND_2GHZ) {
33608707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek			ap_legacy_rates = ap->supp_rates[IEEE80211_BAND_2GHZ];
33618707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		} else {
33628707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek			ap_legacy_rates =
33638707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek				ap->supp_rates[IEEE80211_BAND_5GHZ] << 5;
33648707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		}
336513935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek		memcpy(ap_mcs_rates, ap->ht_cap.mcs.rx_mask, 16);
3366c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek
3367c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek		rcu_read_unlock();
3368c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	}
3369c6e9601071173fed2a77f9c435c41f3b33d1018fLennert Buytenhek
3370c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	if ((changed & BSS_CHANGED_ASSOC) && vif->bss_conf.assoc) {
337113935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek		rc = mwl8k_cmd_set_rate(hw, vif, ap_legacy_rates, ap_mcs_rates);
33723a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek		if (rc)
33733a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek			goto out;
3374a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3375b71ed2c6ce8b5c3782ed70d67dc9adbd7ed07684Lennert Buytenhek		rc = mwl8k_cmd_use_fixed_rate_sta(hw);
33763a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek		if (rc)
33773a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek			goto out;
3378c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	}
3379a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3380c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	if (changed & BSS_CHANGED_ERP_PREAMBLE) {
33817dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek		rc = mwl8k_set_radio_preamble(hw,
33827dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek				vif->bss_conf.use_short_preamble);
33833a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek		if (rc)
33843a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek			goto out;
3385c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	}
3386a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3387c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	if (changed & BSS_CHANGED_ERP_SLOT) {
33887dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek		rc = mwl8k_cmd_set_slot(hw, vif->bss_conf.use_short_slot);
33893a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek		if (rc)
33903a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek			goto out;
3391c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	}
3392a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3393c97470dd253831e880c72ea5d022ed7f3aee45c3Lennert Buytenhek	if (vif->bss_conf.assoc &&
3394c97470dd253831e880c72ea5d022ed7f3aee45c3Lennert Buytenhek	    (changed & (BSS_CHANGED_ASSOC | BSS_CHANGED_ERP_CTS_PROT |
3395c97470dd253831e880c72ea5d022ed7f3aee45c3Lennert Buytenhek			BSS_CHANGED_HT))) {
3396c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek		rc = mwl8k_cmd_set_aid(hw, vif, ap_legacy_rates);
33973a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek		if (rc)
33983a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek			goto out;
3399c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	}
3400a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3401c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	if (vif->bss_conf.assoc &&
3402c3cbbe8a5cd2886e13e9c93e059d9761f3715665Lennert Buytenhek	    (changed & (BSS_CHANGED_ASSOC | BSS_CHANGED_BEACON_INT))) {
3403a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		/*
3404a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		 * Finalize the join.  Tell rx handler to process
3405a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		 * next beacon from our BSSID.
3406a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		 */
34070a11dfc36604d9b24deda17461b7ea69851846aaLennert Buytenhek		memcpy(priv->capture_bssid, vif->bss_conf.bssid, ETH_ALEN);
3408a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		priv->capture_beacon = true;
3409a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3410a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
34113a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhekout:
34123a980d0a505161b99fc936827cb28ec8eb853284Lennert Buytenhek	mwl8k_fw_unlock(hw);
3413a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3414a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3415b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekstatic void
3416b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekmwl8k_bss_info_changed_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
3417b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek			  struct ieee80211_bss_conf *info, u32 changed)
3418b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek{
3419b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	int rc;
3420b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3421b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (mwl8k_fw_lock(hw))
3422b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		return;
3423b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3424b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (changed & BSS_CHANGED_ERP_PREAMBLE) {
3425b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		rc = mwl8k_set_radio_preamble(hw,
3426b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek				vif->bss_conf.use_short_preamble);
3427b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		if (rc)
3428b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek			goto out;
3429b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	}
3430b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3431b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (changed & BSS_CHANGED_BASIC_RATES) {
3432b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		int idx;
3433b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		int rate;
3434b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3435b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		/*
3436b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		 * Use lowest supported basic rate for multicasts
3437b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		 * and management frames (such as probe responses --
3438b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		 * beacons will always go out at 1 Mb/s).
3439b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		 */
3440b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		idx = ffs(vif->bss_conf.basic_rates);
34418707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		if (idx)
34428707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek			idx--;
34438707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek
34448707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		if (hw->conf.channel->band == IEEE80211_BAND_2GHZ)
34458707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek			rate = mwl8k_rates_24[idx].hw_value;
34468707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek		else
34478707d0262585423cdc053bf8db0912e53915e5e4Lennert Buytenhek			rate = mwl8k_rates_50[idx].hw_value;
3448b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3449b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		mwl8k_cmd_use_fixed_rate_ap(hw, rate, rate);
3450b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	}
3451b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3452b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (changed & (BSS_CHANGED_BEACON_INT | BSS_CHANGED_BEACON)) {
3453b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		struct sk_buff *skb;
3454b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3455b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		skb = ieee80211_beacon_get(hw, vif);
3456b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		if (skb != NULL) {
3457b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek			mwl8k_cmd_set_beacon(hw, skb->data, skb->len);
3458b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek			kfree_skb(skb);
3459b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		}
3460b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	}
3461b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3462b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (changed & BSS_CHANGED_BEACON_ENABLED)
3463b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		mwl8k_cmd_bss_start(hw, info->enable_beacon);
3464b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3465b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekout:
3466b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	mwl8k_fw_unlock(hw);
3467b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek}
3468b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3469b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekstatic void
3470b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhekmwl8k_bss_info_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
3471b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		       struct ieee80211_bss_conf *info, u32 changed)
3472b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek{
3473b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3474b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3475b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	if (!priv->ap_fw)
3476b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		mwl8k_bss_info_changed_sta(hw, vif, info, changed);
3477b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek	else
3478b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		mwl8k_bss_info_changed_ap(hw, vif, info, changed);
3479b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek}
3480b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
3481e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhekstatic u64 mwl8k_prepare_multicast(struct ieee80211_hw *hw,
3482e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek				   int mc_count, struct dev_addr_list *mclist)
3483e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek{
3484e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek	struct mwl8k_cmd_pkt *cmd;
3485e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek
3486447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	/*
3487447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * Synthesize and return a command packet that programs the
3488447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * hardware multicast address filter.  At this point we don't
3489447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * know whether FIF_ALLMULTI is being requested, but if it is,
3490447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * we'll end up throwing this packet away and creating a new
3491447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * one in mwl8k_configure_filter().
3492447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 */
3493447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	cmd = __mwl8k_cmd_mac_multicast_adr(hw, 0, mc_count, mclist);
3494e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek
3495e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek	return (unsigned long)cmd;
3496e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek}
3497e81cd2d664fe5b75a0db9bb24b43c0dfbde32319Lennert Buytenhek
3498a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhekstatic int
3499a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhekmwl8k_configure_filter_sniffer(struct ieee80211_hw *hw,
3500a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek			       unsigned int changed_flags,
3501a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek			       unsigned int *total_flags)
3502a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek{
3503a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3504a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek
3505a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	/*
3506a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 * Hardware sniffer mode is mutually exclusive with STA
3507a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 * operation, so refuse to enable sniffer mode if a STA
3508a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 * interface is active.
3509a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 */
3510a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	if (priv->vif != NULL) {
3511a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		if (net_ratelimit())
3512a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek			printk(KERN_INFO "%s: not enabling sniffer "
3513a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek			       "mode because STA interface is active\n",
3514a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek			       wiphy_name(hw->wiphy));
3515a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		return 0;
3516a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	}
3517a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek
3518a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	if (!priv->sniffer_enabled) {
351955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		if (mwl8k_cmd_enable_sniffer(hw, 1))
3520a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek			return 0;
3521a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		priv->sniffer_enabled = true;
3522a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	}
3523a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek
3524a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	*total_flags &=	FIF_PROMISC_IN_BSS | FIF_ALLMULTI |
3525a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek			FIF_BCN_PRBRESP_PROMISC | FIF_CONTROL |
3526a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek			FIF_OTHER_BSS;
3527a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek
3528a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	return 1;
3529a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek}
3530a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek
3531e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhekstatic void mwl8k_configure_filter(struct ieee80211_hw *hw,
3532e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek				   unsigned int changed_flags,
3533e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek				   unsigned int *total_flags,
3534e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek				   u64 multicast)
3535e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek{
3536e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3537a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	struct mwl8k_cmd_pkt *cmd = (void *)(unsigned long)multicast;
3538a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek
3539a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	/*
3540c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek	 * AP firmware doesn't allow fine-grained control over
3541c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek	 * the receive filter.
3542c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek	 */
3543c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek	if (priv->ap_fw) {
3544c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek		*total_flags &= FIF_ALLMULTI | FIF_BCN_PRBRESP_PROMISC;
3545c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek		kfree(cmd);
3546c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek		return;
3547c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek	}
3548c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek
3549c0adae2caa1a152c6ec691c5d1e815e47dac2a0cLennert Buytenhek	/*
3550a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 * Enable hardware sniffer mode if FIF_CONTROL or
3551a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 * FIF_OTHER_BSS is requested.
3552a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	 */
3553a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	if (*total_flags & (FIF_CONTROL | FIF_OTHER_BSS) &&
3554a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	    mwl8k_configure_filter_sniffer(hw, changed_flags, total_flags)) {
3555a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		kfree(cmd);
3556a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		return;
3557a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	}
3558a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3559e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek	/* Clear unsupported feature flags */
3560447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	*total_flags &= FIF_ALLMULTI | FIF_BCN_PRBRESP_PROMISC;
3561a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
356290852f7aed0f90d443efd7e0f9b82d8ac8186848Lennert Buytenhek	if (mwl8k_fw_lock(hw)) {
356390852f7aed0f90d443efd7e0f9b82d8ac8186848Lennert Buytenhek		kfree(cmd);
3564e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek		return;
356590852f7aed0f90d443efd7e0f9b82d8ac8186848Lennert Buytenhek	}
3566a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3567a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	if (priv->sniffer_enabled) {
356855489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek		mwl8k_cmd_enable_sniffer(hw, 0);
3569a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek		priv->sniffer_enabled = false;
3570a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek	}
3571a43c49a817f31ce1accc029239827b108319ecf9Lennert Buytenhek
3572e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek	if (changed_flags & FIF_BCN_PRBRESP_PROMISC) {
357377165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek		if (*total_flags & FIF_BCN_PRBRESP_PROMISC) {
357477165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			/*
357577165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 * Disable the BSS filter.
357677165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 */
3577e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek			mwl8k_cmd_set_pre_scan(hw);
357877165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek		} else {
35790a11dfc36604d9b24deda17461b7ea69851846aaLennert Buytenhek			const u8 *bssid;
3580a94cc97e14c5750ec2b50b2e4ecdfb0f369ed0f4Lennert Buytenhek
358177165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			/*
358277165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 * Enable the BSS filter.
358377165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 *
358477165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 * If there is an active STA interface, use that
358577165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 * interface's BSSID, otherwise use a dummy one
358677165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 * (where the OUI part needs to be nonzero for
358777165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 * the BSSID to be accepted by POST_SCAN).
358877165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			 */
358977165d8809cda1a77bc8752148a6252d7735c12eLennert Buytenhek			bssid = "\x01\x00\x00\x00\x00\x00";
3590a94cc97e14c5750ec2b50b2e4ecdfb0f369ed0f4Lennert Buytenhek			if (priv->vif != NULL)
35910a11dfc36604d9b24deda17461b7ea69851846aaLennert Buytenhek				bssid = priv->vif->bss_conf.bssid;
3592a94cc97e14c5750ec2b50b2e4ecdfb0f369ed0f4Lennert Buytenhek
3593e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek			mwl8k_cmd_set_post_scan(hw, bssid);
3594a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		}
3595a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3596a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3597447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	/*
3598447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * If FIF_ALLMULTI is being requested, throw away the command
3599447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * packet that ->prepare_multicast() built and replace it with
3600447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * a command packet that enables reception of all multicast
3601447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 * packets.
3602447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	 */
3603447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	if (*total_flags & FIF_ALLMULTI) {
3604447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek		kfree(cmd);
3605447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek		cmd = __mwl8k_cmd_mac_multicast_adr(hw, 1, 0, NULL);
3606447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	}
3607447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek
3608447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek	if (cmd != NULL) {
3609447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek		mwl8k_post_cmd(hw, cmd);
3610447ced07d04525218ae586cd70b759b48bcb1fc8Lennert Buytenhek		kfree(cmd);
3611e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek	}
3612a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3613e6935ea10485f34b82d16f8dff9aa2bdf32ab4bfLennert Buytenhek	mwl8k_fw_unlock(hw);
3614a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3615a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3616a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
3617a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3618c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhek	return mwl8k_cmd_set_rts_threshold(hw, value);
3619a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3620a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3621bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhekstruct mwl8k_sta_notify_item
3622bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek{
3623bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	struct list_head list;
3624bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	struct ieee80211_vif *vif;
3625bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	enum sta_notify_cmd cmd;
362613935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek	struct ieee80211_sta sta;
3627bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek};
3628bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
36293f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhekstatic void
36303f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhekmwl8k_do_sta_notify(struct ieee80211_hw *hw, struct mwl8k_sta_notify_item *s)
36313f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek{
36323f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
36333f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
36343f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	/*
36353f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	 * STA firmware uses UPDATE_STADB, AP firmware uses SET_NEW_STN.
36363f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	 */
36373f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	if (!priv->ap_fw && s->cmd == STA_NOTIFY_ADD) {
36383f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		int rc;
36393f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
36403f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		rc = mwl8k_cmd_update_stadb_add(hw, s->vif, &s->sta);
36413f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		if (rc >= 0) {
36423f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek			struct ieee80211_sta *sta;
36433f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
36443f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek			rcu_read_lock();
36453f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek			sta = ieee80211_find_sta(s->vif, s->sta.addr);
36463f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek			if (sta != NULL)
36473f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek				MWL8K_STA(sta)->peer_id = rc;
36483f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek			rcu_read_unlock();
36493f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		}
36503f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	} else if (!priv->ap_fw && s->cmd == STA_NOTIFY_REMOVE) {
36513f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		mwl8k_cmd_update_stadb_del(hw, s->vif, s->sta.addr);
36523f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	} else if (priv->ap_fw && s->cmd == STA_NOTIFY_ADD) {
36533f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		mwl8k_cmd_set_new_stn_add(hw, s->vif, &s->sta);
36543f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	} else if (priv->ap_fw && s->cmd == STA_NOTIFY_REMOVE) {
36553f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		mwl8k_cmd_set_new_stn_del(hw, s->vif, s->sta.addr);
36563f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek	}
36573f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek}
36583f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek
3659bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhekstatic void mwl8k_sta_notify_worker(struct work_struct *work)
3660bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek{
3661bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	struct mwl8k_priv *priv =
3662bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		container_of(work, struct mwl8k_priv, sta_notify_worker);
3663a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	struct ieee80211_hw *hw = priv->hw;
3664bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3665bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	spin_lock_bh(&priv->sta_notify_list_lock);
3666bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	while (!list_empty(&priv->sta_notify_list)) {
3667bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		struct mwl8k_sta_notify_item *s;
3668bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3669bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		s = list_entry(priv->sta_notify_list.next,
3670bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek			       struct mwl8k_sta_notify_item, list);
3671bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		list_del(&s->list);
3672bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3673bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		spin_unlock_bh(&priv->sta_notify_list_lock);
3674bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
36753f5610ff560aeaccf051a6f93f25535c219599a0Lennert Buytenhek		mwl8k_do_sta_notify(hw, s);
3676bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		kfree(s);
3677bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3678bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		spin_lock_bh(&priv->sta_notify_list_lock);
3679bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	}
3680bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	spin_unlock_bh(&priv->sta_notify_list_lock);
3681bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek}
3682bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3683bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhekstatic void
3684bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhekmwl8k_sta_notify(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
3685bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		 enum sta_notify_cmd cmd, struct ieee80211_sta *sta)
3686bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek{
3687bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3688bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	struct mwl8k_sta_notify_item *s;
3689bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3690bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	if (cmd != STA_NOTIFY_ADD && cmd != STA_NOTIFY_REMOVE)
3691bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		return;
3692bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3693bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	s = kmalloc(sizeof(*s), GFP_ATOMIC);
3694bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	if (s != NULL) {
3695bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		s->vif = vif;
3696bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		s->cmd = cmd;
369713935e2cf39b124c9a2ff0349b294e0b1e2e3aefLennert Buytenhek		s->sta = *sta;
3698bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3699bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		spin_lock(&priv->sta_notify_list_lock);
3700bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		list_add_tail(&s->list, &priv->sta_notify_list);
3701bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		spin_unlock(&priv->sta_notify_list_lock);
3702bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3703bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek		ieee80211_queue_work(hw, &priv->sta_notify_worker);
3704bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	}
3705bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek}
3706bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3707a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_conf_tx(struct ieee80211_hw *hw, u16 queue,
3708a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			 const struct ieee80211_tx_queue_params *params)
3709a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
37103e4f542cfbf5a60f2295b2de9a31bdd14beb7b4aLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3711a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
3712a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
37133e4f542cfbf5a60f2295b2de9a31bdd14beb7b4aLennert Buytenhek	rc = mwl8k_fw_lock(hw);
37143e4f542cfbf5a60f2295b2de9a31bdd14beb7b4aLennert Buytenhek	if (!rc) {
37153e4f542cfbf5a60f2295b2de9a31bdd14beb7b4aLennert Buytenhek		if (!priv->wmm_enabled)
371655489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			rc = mwl8k_cmd_set_wmm_mode(hw, 1);
3717a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
37183e4f542cfbf5a60f2295b2de9a31bdd14beb7b4aLennert Buytenhek		if (!rc)
371955489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek			rc = mwl8k_cmd_set_edca_params(hw, queue,
372055489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek						       params->cw_min,
372155489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek						       params->cw_max,
372255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek						       params->aifs,
372355489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek						       params->txop);
37243e4f542cfbf5a60f2295b2de9a31bdd14beb7b4aLennert Buytenhek
37253e4f542cfbf5a60f2295b2de9a31bdd14beb7b4aLennert Buytenhek		mwl8k_fw_unlock(hw);
3726a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
37273e4f542cfbf5a60f2295b2de9a31bdd14beb7b4aLennert Buytenhek
3728a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
3729a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3730a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3731a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_get_tx_stats(struct ieee80211_hw *hw,
3732a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			      struct ieee80211_tx_queue_stats *stats)
3733a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3734a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv = hw->priv;
3735a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_tx_queue *txq;
3736a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int index;
3737a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3738a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	spin_lock_bh(&priv->tx_lock);
3739a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (index = 0; index < MWL8K_TX_QUEUES; index++) {
3740a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		txq = priv->txq + index;
374145eb400d50e1ad84a8e8f9e9a82cd8ae13d7d691Lennert Buytenhek		memcpy(&stats[index], &txq->stats,
3742a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			sizeof(struct ieee80211_tx_queue_stats));
3743a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3744a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	spin_unlock_bh(&priv->tx_lock);
3745a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3746954ef509cc7d795ccd69fa2e01539297e9a003a0Lennert Buytenhek	return 0;
3747a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3748a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3749a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int mwl8k_get_stats(struct ieee80211_hw *hw,
3750a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			   struct ieee80211_low_level_stats *stats)
3751a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
375255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	return mwl8k_cmd_get_stat(hw, stats);
3753a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3754a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3755a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhekstatic int
3756a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhekmwl8k_ampdu_action(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
3757a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek		   enum ieee80211_ampdu_mlme_action action,
3758a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek		   struct ieee80211_sta *sta, u16 tid, u16 *ssn)
3759a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek{
3760a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek	switch (action) {
3761a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek	case IEEE80211_AMPDU_RX_START:
3762a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek	case IEEE80211_AMPDU_RX_STOP:
3763a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek		if (!(hw->flags & IEEE80211_HW_AMPDU_AGGREGATION))
3764a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek			return -ENOTSUPP;
3765a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek		return 0;
3766a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek	default:
3767a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek		return -ENOTSUPP;
3768a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek	}
3769a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek}
3770a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek
3771a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic const struct ieee80211_ops mwl8k_ops = {
3772a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.tx			= mwl8k_tx,
3773a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.start			= mwl8k_start,
3774a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.stop			= mwl8k_stop,
3775a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.add_interface		= mwl8k_add_interface,
3776a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.remove_interface	= mwl8k_remove_interface,
3777a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.config			= mwl8k_config,
3778a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.bss_info_changed	= mwl8k_bss_info_changed,
37793ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	.prepare_multicast	= mwl8k_prepare_multicast,
3780a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.configure_filter	= mwl8k_configure_filter,
3781a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.set_rts_threshold	= mwl8k_set_rts_threshold,
3782bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	.sta_notify		= mwl8k_sta_notify,
3783a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.conf_tx		= mwl8k_conf_tx,
3784a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.get_tx_stats		= mwl8k_get_tx_stats,
3785a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.get_stats		= mwl8k_get_stats,
3786a2292d83b5dcb7f378956a124854d2b17fa53aa3Lennert Buytenhek	.ampdu_action		= mwl8k_ampdu_action,
3787a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek};
3788a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3789a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void mwl8k_finalize_join_worker(struct work_struct *work)
3790a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
3791a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv =
3792a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		container_of(work, struct mwl8k_priv, finalize_join_worker);
3793a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct sk_buff *skb = priv->beacon_skb;
3794a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
37957dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek	mwl8k_cmd_finalize_join(priv->hw, skb->data, skb->len,
37967dc6a7a7635365b140af969e972900866d0bf34bLennert Buytenhek				priv->vif->bss_conf.dtim_period);
3797a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	dev_kfree_skb(skb);
3798a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3799a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->beacon_skb = NULL;
3800a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
3801a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3802bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linvilleenum {
38039e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek	MWL8363 = 0,
38049e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek	MWL8687,
3805bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville	MWL8366,
38066f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek};
38076f6d1e9a8a7fea5e4400cad64bed717e322208e1Lennert Buytenhek
3808bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linvillestatic struct mwl8k_device_info mwl8k_info_tbl[] __devinitdata = {
38099e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek	[MWL8363] = {
38109e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek		.part_name	= "88w8363",
38119e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek		.helper_image	= "mwl8k/helper_8363.fw",
38129e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek		.fw_image	= "mwl8k/fmimage_8363.fw",
38139e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek	},
381449eb691c8f48a29adfdfbdeb82433f1f8cb6524dLennert Buytenhek	[MWL8687] = {
3815bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville		.part_name	= "88w8687",
3816bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville		.helper_image	= "mwl8k/helper_8687.fw",
3817bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville		.fw_image	= "mwl8k/fmimage_8687.fw",
3818bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville	},
381949eb691c8f48a29adfdfbdeb82433f1f8cb6524dLennert Buytenhek	[MWL8366] = {
3820bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville		.part_name	= "88w8366",
3821bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville		.helper_image	= "mwl8k/helper_8366.fw",
3822bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville		.fw_image	= "mwl8k/fmimage_8366.fw",
382389a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek		.ap_rxd_ops	= &rxd_8366_ap_ops,
3824bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville	},
382545a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek};
382645a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek
3827c92d4edecf489dbcbb2e5dd3c513790e57e2ea0eLennert BuytenhekMODULE_FIRMWARE("mwl8k/helper_8363.fw");
3828c92d4edecf489dbcbb2e5dd3c513790e57e2ea0eLennert BuytenhekMODULE_FIRMWARE("mwl8k/fmimage_8363.fw");
3829c92d4edecf489dbcbb2e5dd3c513790e57e2ea0eLennert BuytenhekMODULE_FIRMWARE("mwl8k/helper_8687.fw");
3830c92d4edecf489dbcbb2e5dd3c513790e57e2ea0eLennert BuytenhekMODULE_FIRMWARE("mwl8k/fmimage_8687.fw");
3831c92d4edecf489dbcbb2e5dd3c513790e57e2ea0eLennert BuytenhekMODULE_FIRMWARE("mwl8k/helper_8366.fw");
3832c92d4edecf489dbcbb2e5dd3c513790e57e2ea0eLennert BuytenhekMODULE_FIRMWARE("mwl8k/fmimage_8366.fw");
3833c92d4edecf489dbcbb2e5dd3c513790e57e2ea0eLennert Buytenhek
383445a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhekstatic DEFINE_PCI_DEVICE_TABLE(mwl8k_pci_id_table) = {
38359e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek	{ PCI_VDEVICE(MARVELL, 0x2a0c), .driver_data = MWL8363, },
38369e1b17ead81e72d3db37b4cf15cde1f613603822Lennert Buytenhek	{ PCI_VDEVICE(MARVELL, 0x2a24), .driver_data = MWL8363, },
3837bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville	{ PCI_VDEVICE(MARVELL, 0x2a2b), .driver_data = MWL8687, },
3838bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville	{ PCI_VDEVICE(MARVELL, 0x2a30), .driver_data = MWL8687, },
3839bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville	{ PCI_VDEVICE(MARVELL, 0x2a40), .driver_data = MWL8366, },
3840ca66527c60385dcec878ebd90749d1fdc43bc870Lennert Buytenhek	{ PCI_VDEVICE(MARVELL, 0x2a43), .driver_data = MWL8366, },
3841bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville	{ },
384245a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek};
384345a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert BuytenhekMODULE_DEVICE_TABLE(pci, mwl8k_pci_id_table);
384445a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek
3845a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int __devinit mwl8k_probe(struct pci_dev *pdev,
3846a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				 const struct pci_device_id *id)
3847a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
38482aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek	static int printed_version = 0;
3849a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_hw *hw;
3850a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv;
3851a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int rc;
3852a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int i;
38532aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek
38542aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek	if (!printed_version) {
38552aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek		printk(KERN_INFO "%s version %s\n", MWL8K_DESC, MWL8K_VERSION);
38562aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek		printed_version = 1;
38572aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek	}
3858a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3859be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3860a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = pci_enable_device(pdev);
3861a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
3862a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: Cannot enable new PCI device\n",
3863a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		       MWL8K_NAME);
3864a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return rc;
3865a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3866a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3867a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = pci_request_regions(pdev, MWL8K_NAME);
3868a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
3869a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: Cannot obtain PCI resources\n",
3870a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		       MWL8K_NAME);
38713db95e50c8813d8ed04a1ec7cd7b77dba7c81c80Lennert Buytenhek		goto err_disable_device;
3872a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3873a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3874a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_set_master(pdev);
3875a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3876be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3877a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	hw = ieee80211_alloc_hw(sizeof(*priv), &mwl8k_ops);
3878a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (hw == NULL) {
3879a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: ieee80211 alloc failed\n", MWL8K_NAME);
3880a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		rc = -ENOMEM;
3881a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		goto err_free_reg;
3882a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3883a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3884be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	SET_IEEE80211_DEV(hw, &pdev->dev);
3885be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	pci_set_drvdata(pdev, hw);
3886be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3887a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv = hw->priv;
3888a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->hw = hw;
3889a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->pdev = pdev;
3890bcb628d579a61d0ab0cac4c6cc8a403de5254920John W. Linville	priv->device_info = &mwl8k_info_tbl[id->driver_data];
3891a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3892a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
38935b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	priv->sram = pci_iomap(pdev, 0, 0x10000);
38945b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	if (priv->sram == NULL) {
38955b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek		printk(KERN_ERR "%s: Cannot map device SRAM\n",
3896c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
3897a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		goto err_iounmap;
3898a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
3899a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
39005b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	/*
39015b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	 * If BAR0 is a 32 bit BAR, the register BAR will be BAR1.
39025b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	 * If BAR0 is a 64 bit BAR, the register BAR will be BAR2.
39035b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	 */
39045b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	priv->regs = pci_iomap(pdev, 1, 0x10000);
39055b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	if (priv->regs == NULL) {
39065b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek		priv->regs = pci_iomap(pdev, 2, 0x10000);
39075b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek		if (priv->regs == NULL) {
39085b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek			printk(KERN_ERR "%s: Cannot map device registers\n",
39095b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek			       wiphy_name(hw->wiphy));
39105b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek			goto err_iounmap;
39115b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek		}
39125b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	}
39135b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek
3914be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3915be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	/* Reset firmware and hardware */
3916be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	mwl8k_hw_reset(priv);
3917be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3918be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	/* Ask userland hotplug daemon for the device firmware */
3919be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	rc = mwl8k_request_firmware(priv);
3920be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	if (rc) {
3921be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		printk(KERN_ERR "%s: Firmware files not found\n",
3922be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		       wiphy_name(hw->wiphy));
3923be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		goto err_stop_firmware;
3924be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	}
3925be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3926be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	/* Load firmware into hardware */
3927be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	rc = mwl8k_load_firmware(hw);
3928be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	if (rc) {
3929be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		printk(KERN_ERR "%s: Cannot start firmware\n",
3930be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		       wiphy_name(hw->wiphy));
3931be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		goto err_stop_firmware;
3932be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	}
3933be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3934be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	/* Reclaim memory once firmware is successfully loaded */
3935be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	mwl8k_release_firmware(priv);
3936be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3937be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
393891942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek	if (priv->ap_fw) {
393989a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek		priv->rxd_ops = priv->device_info->ap_rxd_ops;
394091942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek		if (priv->rxd_ops == NULL) {
394191942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek			printk(KERN_ERR "%s: Driver does not have AP "
394291942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek			       "firmware image support for this hardware\n",
394391942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek			       wiphy_name(hw->wiphy));
394491942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek			goto err_stop_firmware;
394591942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek		}
394691942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek	} else {
394789a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek		priv->rxd_ops = &rxd_sta_ops;
394891942230689c1758685499e82e53769d5e7f32ebLennert Buytenhek	}
3949be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3950be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	priv->sniffer_enabled = false;
3951be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	priv->wmm_enabled = false;
3952be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	priv->pending_tx_pkts = 0;
3953be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3954be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
3955a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/*
3956a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * Extra headroom is the size of the required DMA header
3957a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * minus the size of the smallest 802.11 frame (CTS frame).
3958a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 */
3959a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	hw->extra_tx_headroom =
3960a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		sizeof(struct mwl8k_dma_data) - sizeof(struct ieee80211_cts);
3961a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3962a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	hw->channel_change_time = 10;
3963a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3964a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	hw->queues = MWL8K_TX_QUEUES;
3965a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3966a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Set rssi and noise values to dBm */
3967ce9e2e1b8433c8795459a259ee87bc4e424e7c50Lennert Buytenhek	hw->flags |= IEEE80211_HW_SIGNAL_DBM | IEEE80211_HW_NOISE_DBM;
3968a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	hw->vif_data_size = sizeof(struct mwl8k_vif);
3969a680400e8ac32adda81b5e2d7f23dfac63e064feLennert Buytenhek	hw->sta_data_size = sizeof(struct mwl8k_sta);
3970a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->vif = NULL;
3971a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3972a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Set default radio state and preamble */
3973c46563b714b09d44eec4d1fd8a0f53e79ddaa3aaLennert Buytenhek	priv->radio_on = 0;
397468ce38845c23443b15e374fb7362916c1231278eLennert Buytenhek	priv->radio_short_preamble = 0;
3975a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3976bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	/* Station database handling */
3977bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	INIT_WORK(&priv->sta_notify_worker, mwl8k_sta_notify_worker);
3978bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	spin_lock_init(&priv->sta_notify_list_lock);
3979bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek	INIT_LIST_HEAD(&priv->sta_notify_list);
3980bbfd9128d3b4a80bea017ebdd47b31a80dc7eadfLennert Buytenhek
3981a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Finalize join worker */
3982a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	INIT_WORK(&priv->finalize_join_worker, mwl8k_finalize_join_worker);
3983a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
398467e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	/* TX reclaim and RX tasklets.  */
39851e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	tasklet_init(&priv->poll_tx_task, mwl8k_tx_poll, (unsigned long)hw);
39861e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	tasklet_disable(&priv->poll_tx_task);
398767e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	tasklet_init(&priv->poll_rx_task, mwl8k_rx_poll, (unsigned long)hw);
398867e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	tasklet_disable(&priv->poll_rx_task);
3989a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3990a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Power management cookie */
3991a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv->cookie = pci_alloc_consistent(priv->pdev, 4, &priv->cookie_dma);
3992a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (priv->cookie == NULL)
3993be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		goto err_stop_firmware;
3994a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
3995a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = mwl8k_rxq_init(hw, 0);
3996a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc)
3997be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		goto err_free_cookie;
3998a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rxq_refill(hw, 0, INT_MAX);
3999a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4000618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	mutex_init(&priv->fw_mutex);
4001618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	priv->fw_mutex_owner = NULL;
4002618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	priv->fw_mutex_depth = 0;
4003618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek	priv->hostcmd_wait = NULL;
4004618952a7b19b796fce98364fb26551cbe3e16a75Lennert Buytenhek
4005a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	spin_lock_init(&priv->tx_lock);
4006a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
400788de754ad59025eba797e7a8375807755577f450Lennert Buytenhek	priv->tx_wait = NULL;
400888de754ad59025eba797e7a8375807755577f450Lennert Buytenhek
4009a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++) {
4010a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		rc = mwl8k_txq_init(hw, i);
4011a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		if (rc)
4012a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			goto err_free_queues;
4013a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
4014a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4015a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(0, priv->regs + MWL8K_HIU_A2H_INTERRUPT_STATUS);
4016c23b5a699471ea2ef9d146eae80e64836cfbf001Lennert Buytenhek	iowrite32(0, priv->regs + MWL8K_HIU_A2H_INTERRUPT_MASK);
401767e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	iowrite32(MWL8K_A2H_INT_TX_DONE | MWL8K_A2H_INT_RX_READY,
40181e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek		  priv->regs + MWL8K_HIU_A2H_INTERRUPT_CLEAR_SEL);
4019a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(0xffffffff, priv->regs + MWL8K_HIU_A2H_INTERRUPT_STATUS_MASK);
4020a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4021a0607fd3a25ba1848a63a0d925e36d914735ab47Joe Perches	rc = request_irq(priv->pdev->irq, mwl8k_interrupt,
4022a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek			 IRQF_SHARED, MWL8K_NAME, hw);
4023a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
4024a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		printk(KERN_ERR "%s: failed to register IRQ handler\n",
4025c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
4026a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		goto err_free_queues;
4027a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
4028a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4029a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/*
4030a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * Temporarily enable interrupts.  Initial firmware host
4031c2c2b12a8b6cd23d4abbc086642647c656bf406cLennert Buytenhek	 * commands use interrupts and avoid polling.  Disable
4032a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 * interrupts when done.
4033a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	 */
4034c23b5a699471ea2ef9d146eae80e64836cfbf001Lennert Buytenhek	iowrite32(MWL8K_A2H_EVENTS, priv->regs + MWL8K_HIU_A2H_INTERRUPT_MASK);
4035a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4036a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Get config data, mac addrs etc */
403742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	if (priv->ap_fw) {
403842fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		rc = mwl8k_cmd_get_hw_spec_ap(hw);
403942fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		if (!rc)
404042fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek			rc = mwl8k_cmd_set_hw_spec(hw);
4041b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek
4042b64fe619e371fc17d8d686d6d44aef1b41317880Lennert Buytenhek		hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_AP);
404342fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	} else {
404442fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek		rc = mwl8k_cmd_get_hw_spec_sta(hw);
404589a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek
404689a91f4f4cdae92daf3693d4852ae4958abb6c58Lennert Buytenhek		hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
404742fba21d56df644887488a29b158cc8916b9ba99Lennert Buytenhek	}
4048a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
4049c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		printk(KERN_ERR "%s: Cannot initialise firmware\n",
4050c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
4051be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		goto err_free_irq;
4052a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
4053a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4054a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Turn radio off */
405555489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	rc = mwl8k_cmd_radio_disable(hw);
4056a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
4057c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		printk(KERN_ERR "%s: Cannot disable\n", wiphy_name(hw->wiphy));
4058be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		goto err_free_irq;
4059a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
4060a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
406132060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	/* Clear MAC address */
406255489b6ed6801a42636fc3d4594b77dda9c409f2Lennert Buytenhek	rc = mwl8k_cmd_set_mac_addr(hw, "\x00\x00\x00\x00\x00\x00");
406332060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	if (rc) {
406432060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek		printk(KERN_ERR "%s: Cannot clear MAC address\n",
406532060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek		       wiphy_name(hw->wiphy));
4066be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek		goto err_free_irq;
406732060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek	}
406832060e1b64f23fe315a35d2df8c2c7ad010df73eLennert Buytenhek
4069a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Disable interrupts */
4070a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(0, priv->regs + MWL8K_HIU_A2H_INTERRUPT_MASK);
4071a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	free_irq(priv->pdev->irq, hw);
4072a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4073a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	rc = ieee80211_register_hw(hw);
4074a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (rc) {
4075c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		printk(KERN_ERR "%s: Cannot register device\n",
4076c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek		       wiphy_name(hw->wiphy));
4077153458ff7ed5949cd5b07a2355a34aad9891ad98Lennert Buytenhek		goto err_free_queues;
4078a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	}
4079a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4080eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek	printk(KERN_INFO "%s: %s v%d, %pM, %s firmware %u.%u.%u.%u\n",
4081a74b295edb3e2b39d6c03255b24dca862a843c59Lennert Buytenhek	       wiphy_name(hw->wiphy), priv->device_info->part_name,
408245a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek	       priv->hw_rev, hw->wiphy->perm_addr,
4083eae74e6545d995ab0baa8fb07309f714d9616293Lennert Buytenhek	       priv->ap_fw ? "AP" : "STA",
40842aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek	       (priv->fw_rev >> 24) & 0xff, (priv->fw_rev >> 16) & 0xff,
40852aa7b01fe4f2d0978115bfd40364f52d86003606Lennert Buytenhek	       (priv->fw_rev >> 8) & 0xff, priv->fw_rev & 0xff);
4086a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4087a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return 0;
4088a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4089a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekerr_free_irq:
4090a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	iowrite32(0, priv->regs + MWL8K_HIU_A2H_INTERRUPT_MASK);
4091a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	free_irq(priv->pdev->irq, hw);
4092a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4093a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekerr_free_queues:
4094a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++)
4095a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		mwl8k_txq_deinit(hw, i);
4096a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	mwl8k_rxq_deinit(hw, 0);
4097a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4098be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhekerr_free_cookie:
4099a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (priv->cookie != NULL)
4100a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		pci_free_consistent(priv->pdev, 4,
4101a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek				priv->cookie, priv->cookie_dma);
4102a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4103be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhekerr_stop_firmware:
4104be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	mwl8k_hw_reset(priv);
4105be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek	mwl8k_release_firmware(priv);
4106be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhek
4107be695fc4f0a7ff9c9f91d59536b029b781cfea62Lennert Buytenhekerr_iounmap:
4108a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (priv->regs != NULL)
4109a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		pci_iounmap(pdev, priv->regs);
4110a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
41115b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	if (priv->sram != NULL)
41125b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek		pci_iounmap(pdev, priv->sram);
41135b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek
4114a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_set_drvdata(pdev, NULL);
4115a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	ieee80211_free_hw(hw);
4116a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4117a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekerr_free_reg:
4118a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_release_regions(pdev);
41193db95e50c8813d8ed04a1ec7cd7b77dba7c81c80Lennert Buytenhek
41203db95e50c8813d8ed04a1ec7cd7b77dba7c81c80Lennert Buytenhekerr_disable_device:
4121a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_disable_device(pdev);
4122a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4123a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return rc;
4124a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
4125a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4126230f7af0d8f6f2019e64920378b3b66e7d3e99a5Joerg Albertstatic void __devexit mwl8k_shutdown(struct pci_dev *pdev)
4127a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
4128a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	printk(KERN_ERR "===>%s(%u)\n", __func__, __LINE__);
4129a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
4130a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4131230f7af0d8f6f2019e64920378b3b66e7d3e99a5Joerg Albertstatic void __devexit mwl8k_remove(struct pci_dev *pdev)
4132a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
4133a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct ieee80211_hw *hw = pci_get_drvdata(pdev);
4134a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	struct mwl8k_priv *priv;
4135a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	int i;
4136a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4137a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	if (hw == NULL)
4138a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		return;
4139a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	priv = hw->priv;
4140a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4141a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	ieee80211_stop_queues(hw);
4142a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
414360aa569f9212a13382c29cc734f275dec0f55e0bLennert Buytenhek	ieee80211_unregister_hw(hw);
414460aa569f9212a13382c29cc734f275dec0f55e0bLennert Buytenhek
414567e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	/* Remove TX reclaim and RX tasklets.  */
41461e9f9de3b17db3aa358f39d6932662324178350dLennert Buytenhek	tasklet_kill(&priv->poll_tx_task);
414767e2eb27958cae758ccbc86443c360ec285acc3eLennert Buytenhek	tasklet_kill(&priv->poll_rx_task);
4148a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4149a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Stop hardware */
4150a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	mwl8k_hw_reset(priv);
4151a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4152a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	/* Return all skbs to mac80211 */
4153a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++)
4154efb7c49a68cf206f35793d7799608e1d69a209f9Lennert Buytenhek		mwl8k_txq_reclaim(hw, i, INT_MAX, 1);
4155a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4156a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	for (i = 0; i < MWL8K_TX_QUEUES; i++)
4157a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek		mwl8k_txq_deinit(hw, i);
4158a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4159a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	mwl8k_rxq_deinit(hw, 0);
4160a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4161c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek	pci_free_consistent(priv->pdev, 4, priv->cookie, priv->cookie_dma);
4162a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4163a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_iounmap(pdev, priv->regs);
41645b9482dda6dda11dc7050ffa5b4ebfb0c775880fLennert Buytenhek	pci_iounmap(pdev, priv->sram);
4165a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_set_drvdata(pdev, NULL);
4166a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	ieee80211_free_hw(hw);
4167a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_release_regions(pdev);
4168a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_disable_device(pdev);
4169a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
4170a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4171a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic struct pci_driver mwl8k_driver = {
4172a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.name		= MWL8K_NAME,
417345a390ddd70d8bec0b17dd37bc8f77372c9c3d33Lennert Buytenhek	.id_table	= mwl8k_pci_id_table,
4174a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.probe		= mwl8k_probe,
4175a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.remove		= __devexit_p(mwl8k_remove),
4176a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	.shutdown	= __devexit_p(mwl8k_shutdown),
4177a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek};
4178a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4179a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic int __init mwl8k_init(void)
4180a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
4181a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	return pci_register_driver(&mwl8k_driver);
4182a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
4183a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4184a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekstatic void __exit mwl8k_exit(void)
4185a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek{
4186a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek	pci_unregister_driver(&mwl8k_driver);
4187a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek}
4188a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhek
4189a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekmodule_init(mwl8k_init);
4190a66098daacee2f354dab311b58011e7076aa248cLennert Buytenhekmodule_exit(mwl8k_exit);
4191c2c357ce309221b85fd36e50aade66d01a556cdeLennert Buytenhek
4192c2c357ce309221b85fd36e50aade66d01a556cdeLennert BuytenhekMODULE_DESCRIPTION(MWL8K_DESC);
4193c2c357ce309221b85fd36e50aade66d01a556cdeLennert BuytenhekMODULE_VERSION(MWL8K_VERSION);
4194c2c357ce309221b85fd36e50aade66d01a556cdeLennert BuytenhekMODULE_AUTHOR("Lennert Buytenhek <buytenh@marvell.com>");
4195c2c357ce309221b85fd36e50aade66d01a556cdeLennert BuytenhekMODULE_LICENSE("GPL");
4196