projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
ath6kl: Define an initial vif structure and use it
[deliverable/linux.git] / drivers / net / wireless / ath / ath6kl / wmi.c
CommitLineData
bdcd8170
KV		 1/*
2 * Copyright (c) 2004-2011 Atheros Communications Inc.
3 *
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
7 *
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 */
16
17#include <linux/ip.h>
18#include "core.h"
19#include "debug.h"
003353b0 20#include "testmode.h"
06033760
VN		 21#include "../regd.h"
22#include "../regd_common.h"
bdcd8170
KV		 23
24static int ath6kl_wmi_sync_point(struct wmi *wmi);
25
26static const s32 wmi_rate_tbl[][2] = {
27 /* {W/O SGI, with SGI} */
28 {1000, 1000},
29 {2000, 2000},
30 {5500, 5500},
31 {11000, 11000},
32 {6000, 6000},
33 {9000, 9000},
34 {12000, 12000},
35 {18000, 18000},
36 {24000, 24000},
37 {36000, 36000},
38 {48000, 48000},
39 {54000, 54000},
40 {6500, 7200},
41 {13000, 14400},
42 {19500, 21700},
43 {26000, 28900},
44 {39000, 43300},
45 {52000, 57800},
46 {58500, 65000},
47 {65000, 72200},
48 {13500, 15000},
49 {27000, 30000},
50 {40500, 45000},
51 {54000, 60000},
52 {81000, 90000},
53 {108000, 120000},
54 {121500, 135000},
55 {135000, 150000},
56 {0, 0}
57};
58
59/* 802.1d to AC mapping. Refer pg 57 of WMM-test-plan-v1.2 */
60static const u8 up_to_ac[] = {
61 WMM_AC_BE,
62 WMM_AC_BK,
63 WMM_AC_BK,
64 WMM_AC_BE,
65 WMM_AC_VI,
66 WMM_AC_VI,
67 WMM_AC_VO,
68 WMM_AC_VO,
69};
70
71void ath6kl_wmi_set_control_ep(struct wmi *wmi, enum htc_endpoint_id ep_id)
72{
73 if (WARN_ON(ep_id == ENDPOINT_UNUSED || ep_id >= ENDPOINT_MAX))
74 return;
75
76 wmi->ep_id = ep_id;
77}
78
79enum htc_endpoint_id ath6kl_wmi_get_control_ep(struct wmi *wmi)
80{
81 return wmi->ep_id;
82}
83
84/* Performs DIX to 802.3 encapsulation for transmit packets.
85 * Assumes the entire DIX header is contigous and that there is
86 * enough room in the buffer for a 802.3 mac header and LLC+SNAP headers.
87 */
88int ath6kl_wmi_dix_2_dot3(struct wmi *wmi, struct sk_buff *skb)
89{
90 struct ath6kl_llc_snap_hdr *llc_hdr;
91 struct ethhdr *eth_hdr;
92 size_t new_len;
93 __be16 type;
94 u8 *datap;
95 u16 size;
96
97 if (WARN_ON(skb == NULL))
98 return -EINVAL;
99
100 size = sizeof(struct ath6kl_llc_snap_hdr) + sizeof(struct wmi_data_hdr);
101 if (skb_headroom(skb) < size)
102 return -ENOMEM;
103
104 eth_hdr = (struct ethhdr *) skb->data;
105 type = eth_hdr->h_proto;
106
107 if (!is_ethertype(be16_to_cpu(type))) {
108 ath6kl_dbg(ATH6KL_DBG_WMI,
109 "%s: pkt is already in 802.3 format\n", __func__);
110 return 0;
111 }
112
113 new_len = skb->len - sizeof(*eth_hdr) + sizeof(*llc_hdr);
114
115 skb_push(skb, sizeof(struct ath6kl_llc_snap_hdr));
116 datap = skb->data;
117
118 eth_hdr->h_proto = cpu_to_be16(new_len);
119
120 memcpy(datap, eth_hdr, sizeof(*eth_hdr));
121
122 llc_hdr = (struct ath6kl_llc_snap_hdr *)(datap + sizeof(*eth_hdr));
123 llc_hdr->dsap = 0xAA;
124 llc_hdr->ssap = 0xAA;
125 llc_hdr->cntl = 0x03;
126 llc_hdr->org_code[0] = 0x0;
127 llc_hdr->org_code[1] = 0x0;
128 llc_hdr->org_code[2] = 0x0;
129 llc_hdr->eth_type = type;
130
131 return 0;
132}
133
134static int ath6kl_wmi_meta_add(struct wmi *wmi, struct sk_buff *skb,
135 u8 *version, void *tx_meta_info)
136{
137 struct wmi_tx_meta_v1 *v1;
138 struct wmi_tx_meta_v2 *v2;
139
140 if (WARN_ON(skb == NULL || version == NULL))
141 return -EINVAL;
142
143 switch (*version) {
144 case WMI_META_VERSION_1:
145 skb_push(skb, WMI_MAX_TX_META_SZ);
146 v1 = (struct wmi_tx_meta_v1 *) skb->data;
147 v1->pkt_id = 0;
148 v1->rate_plcy_id = 0;
149 *version = WMI_META_VERSION_1;
150 break;
151 case WMI_META_VERSION_2:
152 skb_push(skb, WMI_MAX_TX_META_SZ);
153 v2 = (struct wmi_tx_meta_v2 *) skb->data;
154 memcpy(v2, (struct wmi_tx_meta_v2 *) tx_meta_info,
155 sizeof(struct wmi_tx_meta_v2));
156 break;
157 }
158
159 return 0;
160}
161
162int ath6kl_wmi_data_hdr_add(struct wmi *wmi, struct sk_buff *skb,
163 u8 msg_type, bool more_data,
164 enum wmi_data_hdr_data_type data_type,
165 u8 meta_ver, void *tx_meta_info)
166{
167 struct wmi_data_hdr *data_hdr;
168 int ret;
169
170 if (WARN_ON(skb == NULL))
171 return -EINVAL;
172
3ce6ff50
VT		 173 if (tx_meta_info) {
174 ret = ath6kl_wmi_meta_add(wmi, skb, &meta_ver, tx_meta_info);
175 if (ret)
176 return ret;
177 }
bdcd8170
KV		 178
179 skb_push(skb, sizeof(struct wmi_data_hdr));
180
181 data_hdr = (struct wmi_data_hdr *)skb->data;
182 memset(data_hdr, 0, sizeof(struct wmi_data_hdr));
183
184 data_hdr->info = msg_type << WMI_DATA_HDR_MSG_TYPE_SHIFT;
185 data_hdr->info |= data_type << WMI_DATA_HDR_DATA_TYPE_SHIFT;
186
187 if (more_data)
188 data_hdr->info |=
189 WMI_DATA_HDR_MORE_MASK << WMI_DATA_HDR_MORE_SHIFT;
190
191 data_hdr->info2 = cpu_to_le16(meta_ver << WMI_DATA_HDR_META_SHIFT);
192 data_hdr->info3 = 0;
193
194 return 0;
195}
196
197static u8 ath6kl_wmi_determine_user_priority(u8 *pkt, u32 layer2_pri)
198{
199 struct iphdr *ip_hdr = (struct iphdr *) pkt;
200 u8 ip_pri;
201
202 /*
203 * Determine IPTOS priority
204 *
205 * IP-TOS - 8bits
206 * : DSCP(6-bits) ECN(2-bits)
207 * : DSCP - P2 P1 P0 X X X
208 * where (P2 P1 P0) form 802.1D
209 */
210 ip_pri = ip_hdr->tos >> 5;
211 ip_pri &= 0x7;
212
213 if ((layer2_pri & 0x7) > ip_pri)
214 return (u8) layer2_pri & 0x7;
215 else
216 return ip_pri;
217}
218
219int ath6kl_wmi_implicit_create_pstream(struct wmi *wmi, struct sk_buff *skb,
220 u32 layer2_priority, bool wmm_enabled,
221 u8 *ac)
222{
223 struct wmi_data_hdr *data_hdr;
224 struct ath6kl_llc_snap_hdr *llc_hdr;
225 struct wmi_create_pstream_cmd cmd;
226 u32 meta_size, hdr_size;
227 u16 ip_type = IP_ETHERTYPE;
228 u8 stream_exist, usr_pri;
229 u8 traffic_class = WMM_AC_BE;
230 u8 *datap;
231
232 if (WARN_ON(skb == NULL))
233 return -EINVAL;
234
235 datap = skb->data;
236 data_hdr = (struct wmi_data_hdr *) datap;
237
238 meta_size = ((le16_to_cpu(data_hdr->info2) >> WMI_DATA_HDR_META_SHIFT) &
239 WMI_DATA_HDR_META_MASK) ? WMI_MAX_TX_META_SZ : 0;
240
241 if (!wmm_enabled) {
242 /* If WMM is disabled all traffic goes as BE traffic */
243 usr_pri = 0;
244 } else {
245 hdr_size = sizeof(struct ethhdr);
246
247 llc_hdr = (struct ath6kl_llc_snap_hdr *)(datap +
248 sizeof(struct
249 wmi_data_hdr) +
250 meta_size + hdr_size);
251
252 if (llc_hdr->eth_type == htons(ip_type)) {
253 /*
254 * Extract the endpoint info from the TOS field
255 * in the IP header.
256 */
257 usr_pri =
258 ath6kl_wmi_determine_user_priority(((u8 *) llc_hdr) +
259 sizeof(struct ath6kl_llc_snap_hdr),
260 layer2_priority);
261 } else
262 usr_pri = layer2_priority & 0x7;
263 }
264
a7f0c58b
KV		 265 /*
266 * workaround for WMM S5
267 *
268 * FIXME: wmi->traffic_class is always 100 so this test doesn't
269 * make sense
270 */
bdcd8170
KV		 271 if ((wmi->traffic_class == WMM_AC_VI) &&
272 ((usr_pri == 5) || (usr_pri == 4)))
273 usr_pri = 1;
274
275 /* Convert user priority to traffic class */
276 traffic_class = up_to_ac[usr_pri & 0x7];
277
278 wmi_data_hdr_set_up(data_hdr, usr_pri);
279
280 spin_lock_bh(&wmi->lock);
281 stream_exist = wmi->fat_pipe_exist;
282 spin_unlock_bh(&wmi->lock);
283
284 if (!(stream_exist & (1 << traffic_class))) {
285 memset(&cmd, 0, sizeof(cmd));
286 cmd.traffic_class = traffic_class;
287 cmd.user_pri = usr_pri;
288 cmd.inactivity_int =
289 cpu_to_le32(WMI_IMPLICIT_PSTREAM_INACTIVITY_INT);
290 /* Implicit streams are created with TSID 0xFF */
291 cmd.tsid = WMI_IMPLICIT_PSTREAM;
292 ath6kl_wmi_create_pstream_cmd(wmi, &cmd);
293 }
294
295 *ac = traffic_class;
296
297 return 0;
298}
299
300int ath6kl_wmi_dot11_hdr_remove(struct wmi *wmi, struct sk_buff *skb)
301{
302 struct ieee80211_hdr_3addr *pwh, wh;
303 struct ath6kl_llc_snap_hdr *llc_hdr;
304 struct ethhdr eth_hdr;
305 u32 hdr_size;
306 u8 *datap;
307 __le16 sub_type;
308
309 if (WARN_ON(skb == NULL))
310 return -EINVAL;
311
312 datap = skb->data;
313 pwh = (struct ieee80211_hdr_3addr *) datap;
314
315 sub_type = pwh->frame_control & cpu_to_le16(IEEE80211_FCTL_STYPE);
316
317 memcpy((u8 *) &wh, datap, sizeof(struct ieee80211_hdr_3addr));
318
319 /* Strip off the 802.11 header */
320 if (sub_type == cpu_to_le16(IEEE80211_STYPE_QOS_DATA)) {
321 hdr_size = roundup(sizeof(struct ieee80211_qos_hdr),
322 sizeof(u32));
323 skb_pull(skb, hdr_size);
324 } else if (sub_type == cpu_to_le16(IEEE80211_STYPE_DATA))
325 skb_pull(skb, sizeof(struct ieee80211_hdr_3addr));
326
327 datap = skb->data;
328 llc_hdr = (struct ath6kl_llc_snap_hdr *)(datap);
329
c8790cba 330 memset(&eth_hdr, 0, sizeof(eth_hdr));
bdcd8170 331 eth_hdr.h_proto = llc_hdr->eth_type;
bdcd8170
KV		 332
333 switch ((le16_to_cpu(wh.frame_control)) &
334 (IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS)) {
335 case 0:
336 memcpy(eth_hdr.h_dest, wh.addr1, ETH_ALEN);
337 memcpy(eth_hdr.h_source, wh.addr2, ETH_ALEN);
338 break;
339 case IEEE80211_FCTL_TODS:
340 memcpy(eth_hdr.h_dest, wh.addr3, ETH_ALEN);
341 memcpy(eth_hdr.h_source, wh.addr2, ETH_ALEN);
342 break;
343 case IEEE80211_FCTL_FROMDS:
344 memcpy(eth_hdr.h_dest, wh.addr1, ETH_ALEN);
345 memcpy(eth_hdr.h_source, wh.addr3, ETH_ALEN);
346 break;
347 case IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS:
348 break;
349 }
350
351 skb_pull(skb, sizeof(struct ath6kl_llc_snap_hdr));
352 skb_push(skb, sizeof(eth_hdr));
353
354 datap = skb->data;
355
356 memcpy(datap, &eth_hdr, sizeof(eth_hdr));
357
358 return 0;
359}
360
361/*
362 * Performs 802.3 to DIX encapsulation for received packets.
363 * Assumes the entire 802.3 header is contigous.
364 */
365int ath6kl_wmi_dot3_2_dix(struct sk_buff *skb)
366{
367 struct ath6kl_llc_snap_hdr *llc_hdr;
368 struct ethhdr eth_hdr;
369 u8 *datap;
370
371 if (WARN_ON(skb == NULL))
372 return -EINVAL;
373
374 datap = skb->data;
375
376 memcpy(&eth_hdr, datap, sizeof(eth_hdr));
377
378 llc_hdr = (struct ath6kl_llc_snap_hdr *) (datap + sizeof(eth_hdr));
379 eth_hdr.h_proto = llc_hdr->eth_type;
380
381 skb_pull(skb, sizeof(struct ath6kl_llc_snap_hdr));
382 datap = skb->data;
383
384 memcpy(datap, &eth_hdr, sizeof(eth_hdr));
385
386 return 0;
387}
388
bdcd8170
KV		 389static int ath6kl_wmi_tx_complete_event_rx(u8 *datap, int len)
390{
391 struct tx_complete_msg_v1 *msg_v1;
392 struct wmi_tx_complete_event *evt;
393 int index;
394 u16 size;
395
396 evt = (struct wmi_tx_complete_event *) datap;
397
398 ath6kl_dbg(ATH6KL_DBG_WMI, "comp: %d %d %d\n",
399 evt->num_msg, evt->msg_len, evt->msg_type);
400
401 if (!AR_DBG_LVL_CHECK(ATH6KL_DBG_WMI))
402 return 0;
403
404 for (index = 0; index < evt->num_msg; index++) {
405 size = sizeof(struct wmi_tx_complete_event) +
406 (index * sizeof(struct tx_complete_msg_v1));
407 msg_v1 = (struct tx_complete_msg_v1 *)(datap + size);
408
409 ath6kl_dbg(ATH6KL_DBG_WMI, "msg: %d %d %d %d\n",
410 msg_v1->status, msg_v1->pkt_id,
411 msg_v1->rate_idx, msg_v1->ack_failures);
412 }
413
414 return 0;
415}
416
f9e5f05c
JM		 417static int ath6kl_wmi_remain_on_chnl_event_rx(struct wmi *wmi, u8 *datap,
418 int len)
6465ddcf
JM		 419{
420 struct wmi_remain_on_chnl_event *ev;
421 u32 freq;
422 u32 dur;
f9e5f05c
JM		 423 struct ieee80211_channel *chan;
424 struct ath6kl *ar = wmi->parent_dev;
6465ddcf
JM		 425
426 if (len < sizeof(*ev))
427 return -EINVAL;
428
429 ev = (struct wmi_remain_on_chnl_event *) datap;
430 freq = le32_to_cpu(ev->freq);
431 dur = le32_to_cpu(ev->duration);
432 ath6kl_dbg(ATH6KL_DBG_WMI, "remain_on_chnl: freq=%u dur=%u\n",
433 freq, dur);
be98e3a4 434 chan = ieee80211_get_channel(ar->wiphy, freq);
f9e5f05c
JM		 435 if (!chan) {
436 ath6kl_dbg(ATH6KL_DBG_WMI, "remain_on_chnl: Unknown channel "
437 "(freq=%u)\n", freq);
438 return -EINVAL;
439 }
440 cfg80211_ready_on_channel(ar->net_dev, 1, chan, NL80211_CHAN_NO_HT,
441 dur, GFP_ATOMIC);
6465ddcf
JM		 442
443 return 0;
444}
445
f9e5f05c
JM		 446static int ath6kl_wmi_cancel_remain_on_chnl_event_rx(struct wmi *wmi,
447 u8 *datap, int len)
6465ddcf
JM		 448{
449 struct wmi_cancel_remain_on_chnl_event *ev;
450 u32 freq;
451 u32 dur;
f9e5f05c
JM		 452 struct ieee80211_channel *chan;
453 struct ath6kl *ar = wmi->parent_dev;
6465ddcf
JM		 454
455 if (len < sizeof(*ev))
456 return -EINVAL;
457
458 ev = (struct wmi_cancel_remain_on_chnl_event *) datap;
459 freq = le32_to_cpu(ev->freq);
460 dur = le32_to_cpu(ev->duration);
461 ath6kl_dbg(ATH6KL_DBG_WMI, "cancel_remain_on_chnl: freq=%u dur=%u "
462 "status=%u\n", freq, dur, ev->status);
be98e3a4 463 chan = ieee80211_get_channel(ar->wiphy, freq);
f9e5f05c
JM		 464 if (!chan) {
465 ath6kl_dbg(ATH6KL_DBG_WMI, "cancel_remain_on_chnl: Unknown "
466 "channel (freq=%u)\n", freq);
467 return -EINVAL;
468 }
469 cfg80211_remain_on_channel_expired(ar->net_dev, 1, chan,
470 NL80211_CHAN_NO_HT, GFP_ATOMIC);
6465ddcf
JM		 471
472 return 0;
473}
474
a0df5db1 475static int ath6kl_wmi_tx_status_event_rx(struct wmi *wmi, u8 *datap, int len)
6465ddcf
JM		 476{
477 struct wmi_tx_status_event *ev;
478 u32 id;
a0df5db1 479 struct ath6kl *ar = wmi->parent_dev;
6465ddcf
JM		 480
481 if (len < sizeof(*ev))
482 return -EINVAL;
483
484 ev = (struct wmi_tx_status_event *) datap;
485 id = le32_to_cpu(ev->id);
486 ath6kl_dbg(ATH6KL_DBG_WMI, "tx_status: id=%x ack_status=%u\n",
487 id, ev->ack_status);
a0df5db1
JM		 488 if (wmi->last_mgmt_tx_frame) {
489 cfg80211_mgmt_tx_status(ar->net_dev, id,
490 wmi->last_mgmt_tx_frame,
491 wmi->last_mgmt_tx_frame_len,
492 !!ev->ack_status, GFP_ATOMIC);
493 kfree(wmi->last_mgmt_tx_frame);
494 wmi->last_mgmt_tx_frame = NULL;
495 wmi->last_mgmt_tx_frame_len = 0;
496 }
6465ddcf
JM		 497
498 return 0;
499}
500
ae32c30a 501static int ath6kl_wmi_rx_probe_req_event_rx(struct wmi *wmi, u8 *datap, int len)
6465ddcf
JM		 502{
503 struct wmi_p2p_rx_probe_req_event *ev;
ae32c30a 504 u32 freq;
6465ddcf 505 u16 dlen;
ae32c30a 506 struct ath6kl *ar = wmi->parent_dev;
6465ddcf
JM		 507
508 if (len < sizeof(*ev))
509 return -EINVAL;
510
511 ev = (struct wmi_p2p_rx_probe_req_event *) datap;
ae32c30a 512 freq = le32_to_cpu(ev->freq);
6465ddcf 513 dlen = le16_to_cpu(ev->len);
ae32c30a
JM		 514 if (datap + len < ev->data + dlen) {
515 ath6kl_err("invalid wmi_p2p_rx_probe_req_event: "
516 "len=%d dlen=%u\n", len, dlen);
517 return -EINVAL;
518 }
519 ath6kl_dbg(ATH6KL_DBG_WMI, "rx_probe_req: len=%u freq=%u "
520 "probe_req_report=%d\n",
521 dlen, freq, ar->probe_req_report);
522
523 if (ar->probe_req_report || ar->nw_type == AP_NETWORK)
524 cfg80211_rx_mgmt(ar->net_dev, freq, ev->data, dlen, GFP_ATOMIC);
6465ddcf
JM		 525
526 return 0;
527}
528
529static int ath6kl_wmi_p2p_capabilities_event_rx(u8 *datap, int len)
530{
531 struct wmi_p2p_capabilities_event *ev;
532 u16 dlen;
533
534 if (len < sizeof(*ev))
535 return -EINVAL;
536
537 ev = (struct wmi_p2p_capabilities_event *) datap;
538 dlen = le16_to_cpu(ev->len);
539 ath6kl_dbg(ATH6KL_DBG_WMI, "p2p_capab: len=%u\n", dlen);
540
541 return 0;
542}
543
9809d8ef 544static int ath6kl_wmi_rx_action_event_rx(struct wmi *wmi, u8 *datap, int len)
6465ddcf
JM		 545{
546 struct wmi_rx_action_event *ev;
9809d8ef 547 u32 freq;
6465ddcf 548 u16 dlen;
9809d8ef 549 struct ath6kl *ar = wmi->parent_dev;
6465ddcf
JM		 550
551 if (len < sizeof(*ev))
552 return -EINVAL;
553
554 ev = (struct wmi_rx_action_event *) datap;
9809d8ef 555 freq = le32_to_cpu(ev->freq);
6465ddcf 556 dlen = le16_to_cpu(ev->len);
9809d8ef
JM		 557 if (datap + len < ev->data + dlen) {
558 ath6kl_err("invalid wmi_rx_action_event: "
559 "len=%d dlen=%u\n", len, dlen);
560 return -EINVAL;
561 }
562 ath6kl_dbg(ATH6KL_DBG_WMI, "rx_action: len=%u freq=%u\n", dlen, freq);
563 cfg80211_rx_mgmt(ar->net_dev, freq, ev->data, dlen, GFP_ATOMIC);
6465ddcf
JM		 564
565 return 0;
566}
567
568static int ath6kl_wmi_p2p_info_event_rx(u8 *datap, int len)
569{
570 struct wmi_p2p_info_event *ev;
571 u32 flags;
572 u16 dlen;
573
574 if (len < sizeof(*ev))
575 return -EINVAL;
576
577 ev = (struct wmi_p2p_info_event *) datap;
578 flags = le32_to_cpu(ev->info_req_flags);
579 dlen = le16_to_cpu(ev->len);
580 ath6kl_dbg(ATH6KL_DBG_WMI, "p2p_info: flags=%x len=%d\n", flags, dlen);
581
582 if (flags & P2P_FLAG_CAPABILITIES_REQ) {
583 struct wmi_p2p_capabilities *cap;
584 if (dlen < sizeof(*cap))
585 return -EINVAL;
586 cap = (struct wmi_p2p_capabilities *) ev->data;
587 ath6kl_dbg(ATH6KL_DBG_WMI, "p2p_info: GO Power Save = %d\n",
588 cap->go_power_save);
589 }
590
591 if (flags & P2P_FLAG_MACADDR_REQ) {
592 struct wmi_p2p_macaddr *mac;
593 if (dlen < sizeof(*mac))
594 return -EINVAL;
595 mac = (struct wmi_p2p_macaddr *) ev->data;
596 ath6kl_dbg(ATH6KL_DBG_WMI, "p2p_info: MAC Address = %pM\n",
597 mac->mac_addr);
598 }
599
600 if (flags & P2P_FLAG_HMODEL_REQ) {
601 struct wmi_p2p_hmodel *mod;
602 if (dlen < sizeof(*mod))
603 return -EINVAL;
604 mod = (struct wmi_p2p_hmodel *) ev->data;
605 ath6kl_dbg(ATH6KL_DBG_WMI, "p2p_info: P2P Model = %d (%s)\n",
606 mod->p2p_model,
607 mod->p2p_model ? "host" : "firmware");
608 }
609 return 0;
610}
611
bdcd8170
KV		 612static inline struct sk_buff *ath6kl_wmi_get_new_buf(u32 size)
613{
614 struct sk_buff *skb;
615
616 skb = ath6kl_buf_alloc(size);
617 if (!skb)
618 return NULL;
619
620 skb_put(skb, size);
621 if (size)
622 memset(skb->data, 0, size);
623
624 return skb;
625}
626
627/* Send a "simple" wmi command -- one with no arguments */
628static int ath6kl_wmi_simple_cmd(struct wmi *wmi, enum wmi_cmd_id cmd_id)
629{
630 struct sk_buff *skb;
631 int ret;
632
633 skb = ath6kl_wmi_get_new_buf(0);
634 if (!skb)
635 return -ENOMEM;
636
637 ret = ath6kl_wmi_cmd_send(wmi, skb, cmd_id, NO_SYNC_WMIFLAG);
638
639 return ret;
640}
641
642static int ath6kl_wmi_ready_event_rx(struct wmi *wmi, u8 *datap, int len)
643{
644 struct wmi_ready_event_2 *ev = (struct wmi_ready_event_2 *) datap;
645
646 if (len < sizeof(struct wmi_ready_event_2))
647 return -EINVAL;
648
bdcd8170
KV		 649 ath6kl_ready_event(wmi->parent_dev, ev->mac_addr,
650 le32_to_cpu(ev->sw_version),
651 le32_to_cpu(ev->abi_version));
652
653 return 0;
654}
655
e5090444
VN		 656/*
657 * Mechanism to modify the roaming behavior in the firmware. The lower rssi
658 * at which the station has to roam can be passed with
659 * WMI_SET_LRSSI_SCAN_PARAMS. Subtract 96 from RSSI to get the signal level
660 * in dBm.
661 */
662int ath6kl_wmi_set_roam_lrssi_cmd(struct wmi *wmi, u8 lrssi)
663{
664 struct sk_buff *skb;
665 struct roam_ctrl_cmd *cmd;
666
667 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
668 if (!skb)
669 return -ENOMEM;
670
671 cmd = (struct roam_ctrl_cmd *) skb->data;
672
673 cmd->info.params.lrssi_scan_period = cpu_to_le16(DEF_LRSSI_SCAN_PERIOD);
674 cmd->info.params.lrssi_scan_threshold = a_cpu_to_sle16(lrssi +
675 DEF_SCAN_FOR_ROAM_INTVL);
676 cmd->info.params.lrssi_roam_threshold = a_cpu_to_sle16(lrssi);
677 cmd->info.params.roam_rssi_floor = DEF_LRSSI_ROAM_FLOOR;
678 cmd->roam_ctrl = WMI_SET_LRSSI_SCAN_PARAMS;
679
680 ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_ROAM_CTRL_CMDID, NO_SYNC_WMIFLAG);
681
682 return 0;
683}
684
1261875f
JM		 685int ath6kl_wmi_force_roam_cmd(struct wmi *wmi, const u8 *bssid)
686{
687 struct sk_buff *skb;
688 struct roam_ctrl_cmd *cmd;
689
690 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
691 if (!skb)
692 return -ENOMEM;
693
694 cmd = (struct roam_ctrl_cmd *) skb->data;
695 memset(cmd, 0, sizeof(*cmd));
696
697 memcpy(cmd->info.bssid, bssid, ETH_ALEN);
698 cmd->roam_ctrl = WMI_FORCE_ROAM;
699
700 ath6kl_dbg(ATH6KL_DBG_WMI, "force roam to %pM\n", bssid);
701 return ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_ROAM_CTRL_CMDID,
702 NO_SYNC_WMIFLAG);
703}
704
705int ath6kl_wmi_set_roam_mode_cmd(struct wmi *wmi, enum wmi_roam_mode mode)
706{
707 struct sk_buff *skb;
708 struct roam_ctrl_cmd *cmd;
709
710 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
711 if (!skb)
712 return -ENOMEM;
713
714 cmd = (struct roam_ctrl_cmd *) skb->data;
715 memset(cmd, 0, sizeof(*cmd));
716
717 cmd->info.roam_mode = mode;
718 cmd->roam_ctrl = WMI_SET_ROAM_MODE;
719
720 ath6kl_dbg(ATH6KL_DBG_WMI, "set roam mode %d\n", mode);
721 return ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_ROAM_CTRL_CMDID,
722 NO_SYNC_WMIFLAG);
723}
724
bdcd8170
KV		 725static int ath6kl_wmi_connect_event_rx(struct wmi *wmi, u8 *datap, int len)
726{
727 struct wmi_connect_event *ev;
728 u8 *pie, *peie;
572e27c0 729 struct ath6kl *ar = wmi->parent_dev;
bdcd8170
KV		 730
731 if (len < sizeof(struct wmi_connect_event))
732 return -EINVAL;
733
734 ev = (struct wmi_connect_event *) datap;
735
572e27c0
JM		 736 if (ar->nw_type == AP_NETWORK) {
737 /* AP mode start/STA connected event */
738 struct net_device *dev = ar->net_dev;
739 if (memcmp(dev->dev_addr, ev->u.ap_bss.bssid, ETH_ALEN) == 0) {
740 ath6kl_dbg(ATH6KL_DBG_WMI, "%s: freq %d bssid %pM "
741 "(AP started)\n",
742 __func__, le16_to_cpu(ev->u.ap_bss.ch),
743 ev->u.ap_bss.bssid);
744 ath6kl_connect_ap_mode_bss(
745 ar, le16_to_cpu(ev->u.ap_bss.ch));
746 } else {
747 ath6kl_dbg(ATH6KL_DBG_WMI, "%s: aid %u mac_addr %pM "
748 "auth=%u keymgmt=%u cipher=%u apsd_info=%u "
749 "(STA connected)\n",
750 __func__, ev->u.ap_sta.aid,
751 ev->u.ap_sta.mac_addr,
752 ev->u.ap_sta.auth,
753 ev->u.ap_sta.keymgmt,
754 le16_to_cpu(ev->u.ap_sta.cipher),
755 ev->u.ap_sta.apsd_info);
756 ath6kl_connect_ap_mode_sta(
757 ar, ev->u.ap_sta.aid, ev->u.ap_sta.mac_addr,
758 ev->u.ap_sta.keymgmt,
759 le16_to_cpu(ev->u.ap_sta.cipher),
760 ev->u.ap_sta.auth, ev->assoc_req_len,
761 ev->assoc_info + ev->beacon_ie_len);
762 }
763 return 0;
764 }
765
766 /* STA/IBSS mode connection event */
767
b9b6ee60
KV		 768 ath6kl_dbg(ATH6KL_DBG_WMI,
769 "wmi event connect freq %d bssid %pM listen_intvl %d beacon_intvl %d type %d\n",
770 le16_to_cpu(ev->u.sta.ch), ev->u.sta.bssid,
771 le16_to_cpu(ev->u.sta.listen_intvl),
772 le16_to_cpu(ev->u.sta.beacon_intvl),
773 le32_to_cpu(ev->u.sta.nw_type));
bdcd8170 774
bdcd8170
KV		 775 /* Start of assoc rsp IEs */
776 pie = ev->assoc_info + ev->beacon_ie_len +
777 ev->assoc_req_len + (sizeof(u16) * 3); /* capinfo, status, aid */
778
779 /* End of assoc rsp IEs */
780 peie = ev->assoc_info + ev->beacon_ie_len + ev->assoc_req_len +
781 ev->assoc_resp_len;
782
783 while (pie < peie) {
784 switch (*pie) {
785 case WLAN_EID_VENDOR_SPECIFIC:
786 if (pie[1] > 3 && pie[2] == 0x00 && pie[3] == 0x50 &&
787 pie[4] == 0xf2 && pie[5] == WMM_OUI_TYPE) {
788 /* WMM OUT (00:50:F2) */
789 if (pie[1] > 5
790 && pie[6] == WMM_PARAM_OUI_SUBTYPE)
791 wmi->is_wmm_enabled = true;
792 }
793 break;
794 }
795
796 if (wmi->is_wmm_enabled)
797 break;
798
799 pie += pie[1] + 2;
800 }
801
572e27c0
JM		 802 ath6kl_connect_event(wmi->parent_dev, le16_to_cpu(ev->u.sta.ch),
803 ev->u.sta.bssid,
804 le16_to_cpu(ev->u.sta.listen_intvl),
805 le16_to_cpu(ev->u.sta.beacon_intvl),
806 le32_to_cpu(ev->u.sta.nw_type),
bdcd8170
KV		 807 ev->beacon_ie_len, ev->assoc_req_len,
808 ev->assoc_resp_len, ev->assoc_info);
809
810 return 0;
811}
812
06033760
VN		 813static struct country_code_to_enum_rd *
814ath6kl_regd_find_country(u16 countryCode)
815{
816 int i;
817
818 for (i = 0; i < ARRAY_SIZE(allCountries); i++) {
819 if (allCountries[i].countryCode == countryCode)
820 return &allCountries[i];
821 }
822
823 return NULL;
824}
825
826static struct reg_dmn_pair_mapping *
827ath6kl_get_regpair(u16 regdmn)
828{
829 int i;
830
831 if (regdmn == NO_ENUMRD)
832 return NULL;
833
834 for (i = 0; i < ARRAY_SIZE(regDomainPairs); i++) {
835 if (regDomainPairs[i].regDmnEnum == regdmn)
836 return &regDomainPairs[i];
837 }
838
839 return NULL;
840}
841
842static struct country_code_to_enum_rd *
843ath6kl_regd_find_country_by_rd(u16 regdmn)
844{
845 int i;
846
847 for (i = 0; i < ARRAY_SIZE(allCountries); i++) {
848 if (allCountries[i].regDmnEnum == regdmn)
849 return &allCountries[i];
850 }
851
852 return NULL;
853}
854
855static void ath6kl_wmi_regdomain_event(struct wmi *wmi, u8 *datap, int len)
856{
857
858 struct ath6kl_wmi_regdomain *ev;
859 struct country_code_to_enum_rd *country = NULL;
860 struct reg_dmn_pair_mapping *regpair = NULL;
861 char alpha2[2];
862 u32 reg_code;
863
864 ev = (struct ath6kl_wmi_regdomain *) datap;
865 reg_code = le32_to_cpu(ev->reg_code);
866
867 if ((reg_code >> ATH6KL_COUNTRY_RD_SHIFT) & COUNTRY_ERD_FLAG)
868 country = ath6kl_regd_find_country((u16) reg_code);
869 else if (!(((u16) reg_code & WORLD_SKU_MASK) == WORLD_SKU_PREFIX)) {
870
871 regpair = ath6kl_get_regpair((u16) reg_code);
872 country = ath6kl_regd_find_country_by_rd((u16) reg_code);
b9b6ee60 873 ath6kl_dbg(ATH6KL_DBG_WMI, "Regpair used: 0x%0x\n",
06033760
VN		 874 regpair->regDmnEnum);
875 }
876
877 if (country) {
878 alpha2[0] = country->isoName[0];
879 alpha2[1] = country->isoName[1];
880
be98e3a4 881 regulatory_hint(wmi->parent_dev->wiphy, alpha2);
06033760 882
b9b6ee60 883 ath6kl_dbg(ATH6KL_DBG_WMI, "Country alpha2 being used: %c%c\n",
06033760
VN		 884 alpha2[0], alpha2[1]);
885 }
886}
887
bdcd8170
KV		 888static int ath6kl_wmi_disconnect_event_rx(struct wmi *wmi, u8 *datap, int len)
889{
890 struct wmi_disconnect_event *ev;
891 wmi->traffic_class = 100;
892
893 if (len < sizeof(struct wmi_disconnect_event))
894 return -EINVAL;
895
896 ev = (struct wmi_disconnect_event *) datap;
bdcd8170 897
b9b6ee60
KV		 898 ath6kl_dbg(ATH6KL_DBG_WMI,
899 "wmi event disconnect proto_reason %d bssid %pM wmi_reason %d assoc_resp_len %d\n",
900 le16_to_cpu(ev->proto_reason_status), ev->bssid,
901 ev->disconn_reason, ev->assoc_resp_len);
902
bdcd8170 903 wmi->is_wmm_enabled = false;
bdcd8170
KV		 904
905 ath6kl_disconnect_event(wmi->parent_dev, ev->disconn_reason,
906 ev->bssid, ev->assoc_resp_len, ev->assoc_info,
907 le16_to_cpu(ev->proto_reason_status));
908
909 return 0;
910}
911
912static int ath6kl_wmi_peer_node_event_rx(struct wmi *wmi, u8 *datap, int len)
913{
914 struct wmi_peer_node_event *ev;
915
916 if (len < sizeof(struct wmi_peer_node_event))
917 return -EINVAL;
918
919 ev = (struct wmi_peer_node_event *) datap;
920
921 if (ev->event_code == PEER_NODE_JOIN_EVENT)
922 ath6kl_dbg(ATH6KL_DBG_WMI, "joined node with mac addr: %pM\n",
923 ev->peer_mac_addr);
924 else if (ev->event_code == PEER_NODE_LEAVE_EVENT)
925 ath6kl_dbg(ATH6KL_DBG_WMI, "left node with mac addr: %pM\n",
926 ev->peer_mac_addr);
927
928 return 0;
929}
930
931static int ath6kl_wmi_tkip_micerr_event_rx(struct wmi *wmi, u8 *datap, int len)
932{
933 struct wmi_tkip_micerr_event *ev;
934
935 if (len < sizeof(struct wmi_tkip_micerr_event))
936 return -EINVAL;
937
938 ev = (struct wmi_tkip_micerr_event *) datap;
939
940 ath6kl_tkip_micerr_event(wmi->parent_dev, ev->key_id, ev->is_mcast);
941
942 return 0;
943}
944
bdcd8170
KV		 945static int ath6kl_wmi_bssinfo_event_rx(struct wmi *wmi, u8 *datap, int len)
946{
82e14f56 947 struct wmi_bss_info_hdr2 *bih;
1aaa8c74
JM		 948 u8 *buf;
949 struct ieee80211_channel *channel;
950 struct ath6kl *ar = wmi->parent_dev;
951 struct ieee80211_mgmt *mgmt;
952 struct cfg80211_bss *bss;
bdcd8170 953
82e14f56 954 if (len <= sizeof(struct wmi_bss_info_hdr2))
bdcd8170
KV		 955 return -EINVAL;
956
82e14f56
JM		 957 bih = (struct wmi_bss_info_hdr2 *) datap;
958 buf = datap + sizeof(struct wmi_bss_info_hdr2);
959 len -= sizeof(struct wmi_bss_info_hdr2);
bdcd8170
KV		 960
961 ath6kl_dbg(ATH6KL_DBG_WMI,
1aaa8c74
JM		 962 "bss info evt - ch %u, snr %d, rssi %d, bssid \"%pM\" "
963 "frame_type=%d\n",
82e14f56 964 bih->ch, bih->snr, bih->snr - 95, bih->bssid,
1aaa8c74 965 bih->frame_type);
bdcd8170 966
1aaa8c74
JM		 967 if (bih->frame_type != BEACON_FTYPE &&
968 bih->frame_type != PROBERESP_FTYPE)
969 return 0; /* Only update BSS table for now */
bdcd8170 970
551185ca
JM		 971 if (bih->frame_type == BEACON_FTYPE &&
972 test_bit(CLEAR_BSSFILTER_ON_BEACON, &ar->flag)) {
973 clear_bit(CLEAR_BSSFILTER_ON_BEACON, &ar->flag);
974 ath6kl_wmi_bssfilter_cmd(ar->wmi, NONE_BSS_FILTER, 0);
975 }
976
be98e3a4 977 channel = ieee80211_get_channel(ar->wiphy, le16_to_cpu(bih->ch));
1aaa8c74
JM		 978 if (channel == NULL)
979 return -EINVAL;
bdcd8170 980
1aaa8c74 981 if (len < 8 + 2 + 2)
bdcd8170
KV		 982 return -EINVAL;
983
32c10874
JM		 984 if (bih->frame_type == BEACON_FTYPE && test_bit(CONNECTED, &ar->flag) &&
985 memcmp(bih->bssid, ar->bssid, ETH_ALEN) == 0) {
986 const u8 *tim;
987 tim = cfg80211_find_ie(WLAN_EID_TIM, buf + 8 + 2 + 2,
988 len - 8 - 2 - 2);
989 if (tim && tim[1] >= 2) {
990 ar->assoc_bss_dtim_period = tim[3];
991 set_bit(DTIM_PERIOD_AVAIL, &ar->flag);
992 }
993 }
994
bdcd8170 995 /*
1aaa8c74
JM		 996 * In theory, use of cfg80211_inform_bss() would be more natural here
997 * since we do not have the full frame. However, at least for now,
998 * cfg80211 can only distinguish Beacon and Probe Response frames from
999 * each other when using cfg80211_inform_bss_frame(), so let's build a
1000 * fake IEEE 802.11 header to be able to take benefit of this.
bdcd8170 1001 */
1aaa8c74
JM		 1002 mgmt = kmalloc(24 + len, GFP_ATOMIC);
1003 if (mgmt == NULL)
1004 return -EINVAL;
bdcd8170 1005
1aaa8c74
JM		 1006 if (bih->frame_type == BEACON_FTYPE) {
1007 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
1008 IEEE80211_STYPE_BEACON);
1009 memset(mgmt->da, 0xff, ETH_ALEN);
1010 } else {
1011 struct net_device *dev = ar->net_dev;
bdcd8170 1012
1aaa8c74
JM		 1013 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
1014 IEEE80211_STYPE_PROBE_RESP);
1015 memcpy(mgmt->da, dev->dev_addr, ETH_ALEN);
bdcd8170 1016 }
1aaa8c74
JM		 1017 mgmt->duration = cpu_to_le16(0);
1018 memcpy(mgmt->sa, bih->bssid, ETH_ALEN);
1019 memcpy(mgmt->bssid, bih->bssid, ETH_ALEN);
1020 mgmt->seq_ctrl = cpu_to_le16(0);
bdcd8170 1021
1aaa8c74
JM		 1022 memcpy(&mgmt->u.beacon, buf, len);
1023
be98e3a4 1024 bss = cfg80211_inform_bss_frame(ar->wiphy, channel, mgmt,
82e14f56
JM		 1025 24 + len, (bih->snr - 95) * 100,
1026 GFP_ATOMIC);
1aaa8c74
JM		 1027 kfree(mgmt);
1028 if (bss == NULL)
1029 return -ENOMEM;
1030 cfg80211_put_bss(bss);
bdcd8170
KV		 1031
1032 return 0;
1033}
1034
bdcd8170
KV		 1035/* Inactivity timeout of a fatpipe(pstream) at the target */
1036static int ath6kl_wmi_pstream_timeout_event_rx(struct wmi *wmi, u8 *datap,
1037 int len)
1038{
1039 struct wmi_pstream_timeout_event *ev;
1040
1041 if (len < sizeof(struct wmi_pstream_timeout_event))
1042 return -EINVAL;
1043
1044 ev = (struct wmi_pstream_timeout_event *) datap;
1045
1046 /*
1047 * When the pstream (fat pipe == AC) timesout, it means there were
1048 * no thinStreams within this pstream & it got implicitly created
1049 * due to data flow on this AC. We start the inactivity timer only
1050 * for implicitly created pstream. Just reset the host state.
1051 */
1052 spin_lock_bh(&wmi->lock);
1053 wmi->stream_exist_for_ac[ev->traffic_class] = 0;
1054 wmi->fat_pipe_exist &= ~(1 << ev->traffic_class);
1055 spin_unlock_bh(&wmi->lock);
1056
1057 /* Indicate inactivity to driver layer for this fatpipe (pstream) */
1058 ath6kl_indicate_tx_activity(wmi->parent_dev, ev->traffic_class, false);
1059
1060 return 0;
1061}
1062
1063static int ath6kl_wmi_bitrate_reply_rx(struct wmi *wmi, u8 *datap, int len)
1064{
1065 struct wmi_bit_rate_reply *reply;
1066 s32 rate;
1067 u32 sgi, index;
1068
1069 if (len < sizeof(struct wmi_bit_rate_reply))
1070 return -EINVAL;
1071
1072 reply = (struct wmi_bit_rate_reply *) datap;
1073
1074 ath6kl_dbg(ATH6KL_DBG_WMI, "rateindex %d\n", reply->rate_index);
1075
1076 if (reply->rate_index == (s8) RATE_AUTO) {
1077 rate = RATE_AUTO;
1078 } else {
1079 index = reply->rate_index & 0x7f;
1080 sgi = (reply->rate_index & 0x80) ? 1 : 0;
1081 rate = wmi_rate_tbl[index][sgi];
1082 }
1083
1084 ath6kl_wakeup_event(wmi->parent_dev);
1085
1086 return 0;
1087}
1088
003353b0
KV		 1089static int ath6kl_wmi_tcmd_test_report_rx(struct wmi *wmi, u8 *datap, int len)
1090{
1091 ath6kl_tm_rx_report_event(wmi->parent_dev, datap, len);
1092
1093 return 0;
1094}
1095
bdcd8170
KV		 1096static int ath6kl_wmi_ratemask_reply_rx(struct wmi *wmi, u8 *datap, int len)
1097{
1098 if (len < sizeof(struct wmi_fix_rates_reply))
1099 return -EINVAL;
1100
1101 ath6kl_wakeup_event(wmi->parent_dev);
1102
1103 return 0;
1104}
1105
1106static int ath6kl_wmi_ch_list_reply_rx(struct wmi *wmi, u8 *datap, int len)
1107{
1108 if (len < sizeof(struct wmi_channel_list_reply))
1109 return -EINVAL;
1110
1111 ath6kl_wakeup_event(wmi->parent_dev);
1112
1113 return 0;
1114}
1115
1116static int ath6kl_wmi_tx_pwr_reply_rx(struct wmi *wmi, u8 *datap, int len)
1117{
1118 struct wmi_tx_pwr_reply *reply;
1119
1120 if (len < sizeof(struct wmi_tx_pwr_reply))
1121 return -EINVAL;
1122
1123 reply = (struct wmi_tx_pwr_reply *) datap;
1124 ath6kl_txpwr_rx_evt(wmi->parent_dev, reply->dbM);
1125
1126 return 0;
1127}
1128
1129static int ath6kl_wmi_keepalive_reply_rx(struct wmi *wmi, u8 *datap, int len)
1130{
1131 if (len < sizeof(struct wmi_get_keepalive_cmd))
1132 return -EINVAL;
1133
1134 ath6kl_wakeup_event(wmi->parent_dev);
1135
1136 return 0;
1137}
1138
1139static int ath6kl_wmi_scan_complete_rx(struct wmi *wmi, u8 *datap, int len)
1140{
1141 struct wmi_scan_complete_event *ev;
1142
1143 ev = (struct wmi_scan_complete_event *) datap;
1144
bdcd8170
KV		 1145 ath6kl_scan_complete_evt(wmi->parent_dev, a_sle32_to_cpu(ev->status));
1146 wmi->is_probe_ssid = false;
1147
1148 return 0;
1149}
1150
86512136
JM		 1151static int ath6kl_wmi_neighbor_report_event_rx(struct wmi *wmi, u8 *datap,
1152 int len)
1153{
1154 struct wmi_neighbor_report_event *ev;
1155 u8 i;
1156
1157 if (len < sizeof(*ev))
1158 return -EINVAL;
1159 ev = (struct wmi_neighbor_report_event *) datap;
1160 if (sizeof(*ev) + ev->num_neighbors * sizeof(struct wmi_neighbor_info)
1161 > len) {
1162 ath6kl_dbg(ATH6KL_DBG_WMI, "truncated neighbor event "
1163 "(num=%d len=%d)\n", ev->num_neighbors, len);
1164 return -EINVAL;
1165 }
1166 for (i = 0; i < ev->num_neighbors; i++) {
1167 ath6kl_dbg(ATH6KL_DBG_WMI, "neighbor %d/%d - %pM 0x%x\n",
1168 i + 1, ev->num_neighbors, ev->neighbor[i].bssid,
1169 ev->neighbor[i].bss_flags);
1170 cfg80211_pmksa_candidate_notify(wmi->parent_dev->net_dev, i,
1171 ev->neighbor[i].bssid,
1172 !!(ev->neighbor[i].bss_flags &
1173 WMI_PREAUTH_CAPABLE_BSS),
1174 GFP_ATOMIC);
1175 }
1176
1177 return 0;
1178}
1179
bdcd8170
KV		 1180/*
1181 * Target is reporting a programming error. This is for
1182 * developer aid only. Target only checks a few common violations
1183 * and it is responsibility of host to do all error checking.
1184 * Behavior of target after wmi error event is undefined.
1185 * A reset is recommended.
1186 */
1187static int ath6kl_wmi_error_event_rx(struct wmi *wmi, u8 *datap, int len)
1188{
1189 const char *type = "unknown error";
1190 struct wmi_cmd_error_event *ev;
1191 ev = (struct wmi_cmd_error_event *) datap;
1192
1193 switch (ev->err_code) {
1194 case INVALID_PARAM:
1195 type = "invalid parameter";
1196 break;
1197 case ILLEGAL_STATE:
1198 type = "invalid state";
1199 break;
1200 case INTERNAL_ERROR:
1201 type = "internal error";
1202 break;
1203 }
1204
1205 ath6kl_dbg(ATH6KL_DBG_WMI, "programming error, cmd=%d %s\n",
1206 ev->cmd_id, type);
1207
1208 return 0;
1209}
1210
1211static int ath6kl_wmi_stats_event_rx(struct wmi *wmi, u8 *datap, int len)
1212{
1213 ath6kl_tgt_stats_event(wmi->parent_dev, datap, len);
1214
1215 return 0;
1216}
1217
1218static u8 ath6kl_wmi_get_upper_threshold(s16 rssi,
1219 struct sq_threshold_params *sq_thresh,
1220 u32 size)
1221{
1222 u32 index;
1223 u8 threshold = (u8) sq_thresh->upper_threshold[size - 1];
1224
1225 /* The list is already in sorted order. Get the next lower value */
1226 for (index = 0; index < size; index++) {
1227 if (rssi < sq_thresh->upper_threshold[index]) {
1228 threshold = (u8) sq_thresh->upper_threshold[index];
1229 break;
1230 }
1231 }
1232
1233 return threshold;
1234}
1235
1236static u8 ath6kl_wmi_get_lower_threshold(s16 rssi,
1237 struct sq_threshold_params *sq_thresh,
1238 u32 size)
1239{
1240 u32 index;
1241 u8 threshold = (u8) sq_thresh->lower_threshold[size - 1];
1242
1243 /* The list is already in sorted order. Get the next lower value */
1244 for (index = 0; index < size; index++) {
1245 if (rssi > sq_thresh->lower_threshold[index]) {
1246 threshold = (u8) sq_thresh->lower_threshold[index];
1247 break;
1248 }
1249 }
1250
1251 return threshold;
1252}
1253
1254static int ath6kl_wmi_send_rssi_threshold_params(struct wmi *wmi,
1255 struct wmi_rssi_threshold_params_cmd *rssi_cmd)
1256{
1257 struct sk_buff *skb;
1258 struct wmi_rssi_threshold_params_cmd *cmd;
1259
1260 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
1261 if (!skb)
1262 return -ENOMEM;
1263
1264 cmd = (struct wmi_rssi_threshold_params_cmd *) skb->data;
1265 memcpy(cmd, rssi_cmd, sizeof(struct wmi_rssi_threshold_params_cmd));
1266
1267 return ath6kl_wmi_cmd_send(wmi, skb, WMI_RSSI_THRESHOLD_PARAMS_CMDID,
1268 NO_SYNC_WMIFLAG);
1269}
1270
1271static int ath6kl_wmi_rssi_threshold_event_rx(struct wmi *wmi, u8 *datap,
1272 int len)
1273{
1274 struct wmi_rssi_threshold_event *reply;
1275 struct wmi_rssi_threshold_params_cmd cmd;
1276 struct sq_threshold_params *sq_thresh;
1277 enum wmi_rssi_threshold_val new_threshold;
1278 u8 upper_rssi_threshold, lower_rssi_threshold;
1279 s16 rssi;
1280 int ret;
1281
1282 if (len < sizeof(struct wmi_rssi_threshold_event))
1283 return -EINVAL;
1284
1285 reply = (struct wmi_rssi_threshold_event *) datap;
1286 new_threshold = (enum wmi_rssi_threshold_val) reply->range;
1287 rssi = a_sle16_to_cpu(reply->rssi);
1288
1289 sq_thresh = &wmi->sq_threshld[SIGNAL_QUALITY_METRICS_RSSI];
1290
1291 /*
1292 * Identify the threshold breached and communicate that to the app.
1293 * After that install a new set of thresholds based on the signal
1294 * quality reported by the target
1295 */
1296 if (new_threshold) {
1297 /* Upper threshold breached */
1298 if (rssi < sq_thresh->upper_threshold[0]) {
1299 ath6kl_dbg(ATH6KL_DBG_WMI,
1300 "spurious upper rssi threshold event: %d\n",
1301 rssi);
1302 } else if ((rssi < sq_thresh->upper_threshold[1]) &&
1303 (rssi >= sq_thresh->upper_threshold[0])) {
1304 new_threshold = WMI_RSSI_THRESHOLD1_ABOVE;
1305 } else if ((rssi < sq_thresh->upper_threshold[2]) &&
1306 (rssi >= sq_thresh->upper_threshold[1])) {
1307 new_threshold = WMI_RSSI_THRESHOLD2_ABOVE;
1308 } else if ((rssi < sq_thresh->upper_threshold[3]) &&
1309 (rssi >= sq_thresh->upper_threshold[2])) {
1310 new_threshold = WMI_RSSI_THRESHOLD3_ABOVE;
1311 } else if ((rssi < sq_thresh->upper_threshold[4]) &&
1312 (rssi >= sq_thresh->upper_threshold[3])) {
1313 new_threshold = WMI_RSSI_THRESHOLD4_ABOVE;
1314 } else if ((rssi < sq_thresh->upper_threshold[5]) &&
1315 (rssi >= sq_thresh->upper_threshold[4])) {
1316 new_threshold = WMI_RSSI_THRESHOLD5_ABOVE;
1317 } else if (rssi >= sq_thresh->upper_threshold[5]) {
1318 new_threshold = WMI_RSSI_THRESHOLD6_ABOVE;
1319 }
1320 } else {
1321 /* Lower threshold breached */
1322 if (rssi > sq_thresh->lower_threshold[0]) {
1323 ath6kl_dbg(ATH6KL_DBG_WMI,
1324 "spurious lower rssi threshold event: %d %d\n",
1325 rssi, sq_thresh->lower_threshold[0]);
1326 } else if ((rssi > sq_thresh->lower_threshold[1]) &&
1327 (rssi <= sq_thresh->lower_threshold[0])) {
1328 new_threshold = WMI_RSSI_THRESHOLD6_BELOW;
1329 } else if ((rssi > sq_thresh->lower_threshold[2]) &&
1330 (rssi <= sq_thresh->lower_threshold[1])) {
1331 new_threshold = WMI_RSSI_THRESHOLD5_BELOW;
1332 } else if ((rssi > sq_thresh->lower_threshold[3]) &&
1333 (rssi <= sq_thresh->lower_threshold[2])) {
1334 new_threshold = WMI_RSSI_THRESHOLD4_BELOW;
1335 } else if ((rssi > sq_thresh->lower_threshold[4]) &&
1336 (rssi <= sq_thresh->lower_threshold[3])) {
1337 new_threshold = WMI_RSSI_THRESHOLD3_BELOW;
1338 } else if ((rssi > sq_thresh->lower_threshold[5]) &&
1339 (rssi <= sq_thresh->lower_threshold[4])) {
1340 new_threshold = WMI_RSSI_THRESHOLD2_BELOW;
1341 } else if (rssi <= sq_thresh->lower_threshold[5]) {
1342 new_threshold = WMI_RSSI_THRESHOLD1_BELOW;
1343 }
1344 }
1345
1346 /* Calculate and install the next set of thresholds */
1347 lower_rssi_threshold = ath6kl_wmi_get_lower_threshold(rssi, sq_thresh,
1348 sq_thresh->lower_threshold_valid_count);
1349 upper_rssi_threshold = ath6kl_wmi_get_upper_threshold(rssi, sq_thresh,
1350 sq_thresh->upper_threshold_valid_count);
1351
1352 /* Issue a wmi command to install the thresholds */
1353 cmd.thresh_above1_val = a_cpu_to_sle16(upper_rssi_threshold);
1354 cmd.thresh_below1_val = a_cpu_to_sle16(lower_rssi_threshold);
1355 cmd.weight = sq_thresh->weight;
1356 cmd.poll_time = cpu_to_le32(sq_thresh->polling_interval);
1357
1358 ret = ath6kl_wmi_send_rssi_threshold_params(wmi, &cmd);
1359 if (ret) {
1360 ath6kl_err("unable to configure rssi thresholds\n");
1361 return -EIO;
1362 }
1363
1364 return 0;
1365}
1366
1367static int ath6kl_wmi_cac_event_rx(struct wmi *wmi, u8 *datap, int len)
1368{
1369 struct wmi_cac_event *reply;
1370 struct ieee80211_tspec_ie *ts;
1371 u16 active_tsids, tsinfo;
1372 u8 tsid, index;
1373 u8 ts_id;
1374
1375 if (len < sizeof(struct wmi_cac_event))
1376 return -EINVAL;
1377
1378 reply = (struct wmi_cac_event *) datap;
1379
1380 if ((reply->cac_indication == CAC_INDICATION_ADMISSION_RESP) &&
1381 (reply->status_code != IEEE80211_TSPEC_STATUS_ADMISS_ACCEPTED)) {
1382
1383 ts = (struct ieee80211_tspec_ie *) &(reply->tspec_suggestion);
1384 tsinfo = le16_to_cpu(ts->tsinfo);
1385 tsid = (tsinfo >> IEEE80211_WMM_IE_TSPEC_TID_SHIFT) &
1386 IEEE80211_WMM_IE_TSPEC_TID_MASK;
1387
1388 ath6kl_wmi_delete_pstream_cmd(wmi, reply->ac, tsid);
1389 } else if (reply->cac_indication == CAC_INDICATION_NO_RESP) {
1390 /*
1391 * Following assumes that there is only one outstanding
1392 * ADDTS request when this event is received
1393 */
1394 spin_lock_bh(&wmi->lock);
1395 active_tsids = wmi->stream_exist_for_ac[reply->ac];
1396 spin_unlock_bh(&wmi->lock);
1397
1398 for (index = 0; index < sizeof(active_tsids) * 8; index++) {
1399 if ((active_tsids >> index) & 1)
1400 break;
1401 }
1402 if (index < (sizeof(active_tsids) * 8))
1403 ath6kl_wmi_delete_pstream_cmd(wmi, reply->ac, index);
1404 }
1405
1406 /*
1407 * Clear active tsids and Add missing handling
1408 * for delete qos stream from AP
1409 */
1410 else if (reply->cac_indication == CAC_INDICATION_DELETE) {
1411
1412 ts = (struct ieee80211_tspec_ie *) &(reply->tspec_suggestion);
1413 tsinfo = le16_to_cpu(ts->tsinfo);
1414 ts_id = ((tsinfo >> IEEE80211_WMM_IE_TSPEC_TID_SHIFT) &
1415 IEEE80211_WMM_IE_TSPEC_TID_MASK);
1416
1417 spin_lock_bh(&wmi->lock);
1418 wmi->stream_exist_for_ac[reply->ac] &= ~(1 << ts_id);
1419 active_tsids = wmi->stream_exist_for_ac[reply->ac];
1420 spin_unlock_bh(&wmi->lock);
1421
1422 /* Indicate stream inactivity to driver layer only if all tsids
1423 * within this AC are deleted.
1424 */
1425 if (!active_tsids) {
1426 ath6kl_indicate_tx_activity(wmi->parent_dev, reply->ac,
1427 false);
1428 wmi->fat_pipe_exist &= ~(1 << reply->ac);
1429 }
1430 }
1431
1432 return 0;
1433}
1434
1435static int ath6kl_wmi_send_snr_threshold_params(struct wmi *wmi,
1436 struct wmi_snr_threshold_params_cmd *snr_cmd)
1437{
1438 struct sk_buff *skb;
1439 struct wmi_snr_threshold_params_cmd *cmd;
1440
1441 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
1442 if (!skb)
1443 return -ENOMEM;
1444
1445 cmd = (struct wmi_snr_threshold_params_cmd *) skb->data;
1446 memcpy(cmd, snr_cmd, sizeof(struct wmi_snr_threshold_params_cmd));
1447
1448 return ath6kl_wmi_cmd_send(wmi, skb, WMI_SNR_THRESHOLD_PARAMS_CMDID,
1449 NO_SYNC_WMIFLAG);
1450}
1451
1452static int ath6kl_wmi_snr_threshold_event_rx(struct wmi *wmi, u8 *datap,
1453 int len)
1454{
1455 struct wmi_snr_threshold_event *reply;
1456 struct sq_threshold_params *sq_thresh;
1457 struct wmi_snr_threshold_params_cmd cmd;
1458 enum wmi_snr_threshold_val new_threshold;
1459 u8 upper_snr_threshold, lower_snr_threshold;
1460 s16 snr;
1461 int ret;
1462
1463 if (len < sizeof(struct wmi_snr_threshold_event))
1464 return -EINVAL;
1465
1466 reply = (struct wmi_snr_threshold_event *) datap;
1467
1468 new_threshold = (enum wmi_snr_threshold_val) reply->range;
1469 snr = reply->snr;
1470
1471 sq_thresh = &wmi->sq_threshld[SIGNAL_QUALITY_METRICS_SNR];
1472
1473 /*
1474 * Identify the threshold breached and communicate that to the app.
1475 * After that install a new set of thresholds based on the signal
1476 * quality reported by the target.
1477 */
1478 if (new_threshold) {
1479 /* Upper threshold breached */
1480 if (snr < sq_thresh->upper_threshold[0]) {
1481 ath6kl_dbg(ATH6KL_DBG_WMI,
1482 "spurious upper snr threshold event: %d\n",
1483 snr);
1484 } else if ((snr < sq_thresh->upper_threshold[1]) &&
1485 (snr >= sq_thresh->upper_threshold[0])) {
1486 new_threshold = WMI_SNR_THRESHOLD1_ABOVE;
1487 } else if ((snr < sq_thresh->upper_threshold[2]) &&
1488 (snr >= sq_thresh->upper_threshold[1])) {
1489 new_threshold = WMI_SNR_THRESHOLD2_ABOVE;
1490 } else if ((snr < sq_thresh->upper_threshold[3]) &&
1491 (snr >= sq_thresh->upper_threshold[2])) {
1492 new_threshold = WMI_SNR_THRESHOLD3_ABOVE;
1493 } else if (snr >= sq_thresh->upper_threshold[3]) {
1494 new_threshold = WMI_SNR_THRESHOLD4_ABOVE;
1495 }
1496 } else {
1497 /* Lower threshold breached */
1498 if (snr > sq_thresh->lower_threshold[0]) {
1499 ath6kl_dbg(ATH6KL_DBG_WMI,
1500 "spurious lower snr threshold event: %d\n",
1501 sq_thresh->lower_threshold[0]);
1502 } else if ((snr > sq_thresh->lower_threshold[1]) &&
1503 (snr <= sq_thresh->lower_threshold[0])) {
1504 new_threshold = WMI_SNR_THRESHOLD4_BELOW;
1505 } else if ((snr > sq_thresh->lower_threshold[2]) &&
1506 (snr <= sq_thresh->lower_threshold[1])) {
1507 new_threshold = WMI_SNR_THRESHOLD3_BELOW;
1508 } else if ((snr > sq_thresh->lower_threshold[3]) &&
1509 (snr <= sq_thresh->lower_threshold[2])) {
1510 new_threshold = WMI_SNR_THRESHOLD2_BELOW;
1511 } else if (snr <= sq_thresh->lower_threshold[3]) {
1512 new_threshold = WMI_SNR_THRESHOLD1_BELOW;
1513 }
1514 }
1515
1516 /* Calculate and install the next set of thresholds */
1517 lower_snr_threshold = ath6kl_wmi_get_lower_threshold(snr, sq_thresh,
1518 sq_thresh->lower_threshold_valid_count);
1519 upper_snr_threshold = ath6kl_wmi_get_upper_threshold(snr, sq_thresh,
1520 sq_thresh->upper_threshold_valid_count);
1521
1522 /* Issue a wmi command to install the thresholds */
1523 cmd.thresh_above1_val = upper_snr_threshold;
1524 cmd.thresh_below1_val = lower_snr_threshold;
1525 cmd.weight = sq_thresh->weight;
1526 cmd.poll_time = cpu_to_le32(sq_thresh->polling_interval);
1527
1528 ath6kl_dbg(ATH6KL_DBG_WMI,
1529 "snr: %d, threshold: %d, lower: %d, upper: %d\n",
1530 snr, new_threshold,
1531 lower_snr_threshold, upper_snr_threshold);
1532
1533 ret = ath6kl_wmi_send_snr_threshold_params(wmi, &cmd);
1534 if (ret) {
1535 ath6kl_err("unable to configure snr threshold\n");
1536 return -EIO;
1537 }
1538
1539 return 0;
1540}
1541
1542static int ath6kl_wmi_aplist_event_rx(struct wmi *wmi, u8 *datap, int len)
1543{
1544 u16 ap_info_entry_size;
1545 struct wmi_aplist_event *ev = (struct wmi_aplist_event *) datap;
1546 struct wmi_ap_info_v1 *ap_info_v1;
1547 u8 index;
1548
1549 if (len < sizeof(struct wmi_aplist_event) ||
1550 ev->ap_list_ver != APLIST_VER1)
1551 return -EINVAL;
1552
1553 ap_info_entry_size = sizeof(struct wmi_ap_info_v1);
1554 ap_info_v1 = (struct wmi_ap_info_v1 *) ev->ap_list;
1555
1556 ath6kl_dbg(ATH6KL_DBG_WMI,
1557 "number of APs in aplist event: %d\n", ev->num_ap);
1558
1559 if (len < (int) (sizeof(struct wmi_aplist_event) +
1560 (ev->num_ap - 1) * ap_info_entry_size))
1561 return -EINVAL;
1562
1563 /* AP list version 1 contents */
1564 for (index = 0; index < ev->num_ap; index++) {
1565 ath6kl_dbg(ATH6KL_DBG_WMI, "AP#%d BSSID %pM Channel %d\n",
1566 index, ap_info_v1->bssid, ap_info_v1->channel);
1567 ap_info_v1++;
1568 }
1569
1570 return 0;
1571}
1572
1573int ath6kl_wmi_cmd_send(struct wmi *wmi, struct sk_buff *skb,
1574 enum wmi_cmd_id cmd_id, enum wmi_sync_flag sync_flag)
1575{
1576 struct wmi_cmd_hdr *cmd_hdr;
1577 enum htc_endpoint_id ep_id = wmi->ep_id;
1578 int ret;
1579
1580 if (WARN_ON(skb == NULL))
1581 return -EINVAL;
1582
b9b6ee60
KV		 1583 ath6kl_dbg(ATH6KL_DBG_WMI, "wmi tx id %d len %d flag %d\n",
1584 cmd_id, skb->len, sync_flag);
1585 ath6kl_dbg_dump(ATH6KL_DBG_WMI_DUMP, NULL, "wmi tx ",
1586 skb->data, skb->len);
1587
bdcd8170
KV		 1588 if (sync_flag >= END_WMIFLAG) {
1589 dev_kfree_skb(skb);
1590 return -EINVAL;
1591 }
1592
1593 if ((sync_flag == SYNC_BEFORE_WMIFLAG) ||
1594 (sync_flag == SYNC_BOTH_WMIFLAG)) {
1595 /*
1596 * Make sure all data currently queued is transmitted before
1597 * the cmd execution. Establish a new sync point.
1598 */
1599 ath6kl_wmi_sync_point(wmi);
1600 }
1601
1602 skb_push(skb, sizeof(struct wmi_cmd_hdr));
1603
1604 cmd_hdr = (struct wmi_cmd_hdr *) skb->data;
1605 cmd_hdr->cmd_id = cpu_to_le16(cmd_id);
1606 cmd_hdr->info1 = 0; /* added for virtual interface */
1607
1608 /* Only for OPT_TX_CMD, use BE endpoint. */
1609 if (cmd_id == WMI_OPT_TX_FRAME_CMDID) {
1610 ret = ath6kl_wmi_data_hdr_add(wmi, skb, OPT_MSGTYPE,
1611 false, false, 0, NULL);
1612 if (ret) {
1613 dev_kfree_skb(skb);
1614 return ret;
1615 }
1616 ep_id = ath6kl_ac2_endpoint_id(wmi->parent_dev, WMM_AC_BE);
1617 }
1618
1619 ath6kl_control_tx(wmi->parent_dev, skb, ep_id);
1620
1621 if ((sync_flag == SYNC_AFTER_WMIFLAG) ||
1622 (sync_flag == SYNC_BOTH_WMIFLAG)) {
1623 /*
1624 * Make sure all new data queued waits for the command to
1625 * execute. Establish a new sync point.
1626 */
1627 ath6kl_wmi_sync_point(wmi);
1628 }
1629
1630 return 0;
1631}
1632
1633int ath6kl_wmi_connect_cmd(struct wmi *wmi, enum network_type nw_type,
1634 enum dot11_auth_mode dot11_auth_mode,
1635 enum auth_mode auth_mode,
1636 enum crypto_type pairwise_crypto,
1637 u8 pairwise_crypto_len,
1638 enum crypto_type group_crypto,
1639 u8 group_crypto_len, int ssid_len, u8 *ssid,
1640 u8 *bssid, u16 channel, u32 ctrl_flags)
1641{
1642 struct sk_buff *skb;
1643 struct wmi_connect_cmd *cc;
1644 int ret;
1645
b9b6ee60
KV		 1646 ath6kl_dbg(ATH6KL_DBG_WMI,
1647 "wmi connect bssid %pM freq %d flags 0x%x ssid_len %d "
1648 "type %d dot11_auth %d auth %d pairwise %d group %d\n",
1649 bssid, channel, ctrl_flags, ssid_len, nw_type,
1650 dot11_auth_mode, auth_mode, pairwise_crypto, group_crypto);
1651 ath6kl_dbg_dump(ATH6KL_DBG_WMI, NULL, "ssid ", ssid, ssid_len);
1652
bdcd8170
KV		 1653 wmi->traffic_class = 100;
1654
1655 if ((pairwise_crypto == NONE_CRYPT) && (group_crypto != NONE_CRYPT))
1656 return -EINVAL;
1657
1658 if ((pairwise_crypto != NONE_CRYPT) && (group_crypto == NONE_CRYPT))
1659 return -EINVAL;
1660
1661 skb = ath6kl_wmi_get_new_buf(sizeof(struct wmi_connect_cmd));
1662 if (!skb)
1663 return -ENOMEM;
1664
1665 cc = (struct wmi_connect_cmd *) skb->data;
1666
1667 if (ssid_len)
1668 memcpy(cc->ssid, ssid, ssid_len);
1669
1670 cc->ssid_len = ssid_len;
1671 cc->nw_type = nw_type;
1672 cc->dot11_auth_mode = dot11_auth_mode;
1673 cc->auth_mode = auth_mode;
1674 cc->prwise_crypto_type = pairwise_crypto;
1675 cc->prwise_crypto_len = pairwise_crypto_len;
1676 cc->grp_crypto_type = group_crypto;
1677 cc->grp_crypto_len = group_crypto_len;
1678 cc->ch = cpu_to_le16(channel);
1679 cc->ctrl_flags = cpu_to_le32(ctrl_flags);
1680
1681 if (bssid != NULL)
1682 memcpy(cc->bssid, bssid, ETH_ALEN);
1683
bdcd8170
KV		 1684 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_CONNECT_CMDID, NO_SYNC_WMIFLAG);
1685
1686 return ret;
1687}
1688
1689int ath6kl_wmi_reconnect_cmd(struct wmi *wmi, u8 *bssid, u16 channel)
1690{
1691 struct sk_buff *skb;
1692 struct wmi_reconnect_cmd *cc;
1693 int ret;
1694
b9b6ee60
KV		 1695 ath6kl_dbg(ATH6KL_DBG_WMI, "wmi reconnect bssid %pM freq %d\n",
1696 bssid, channel);
1697
bdcd8170
KV		 1698 wmi->traffic_class = 100;
1699
1700 skb = ath6kl_wmi_get_new_buf(sizeof(struct wmi_reconnect_cmd));
1701 if (!skb)
1702 return -ENOMEM;
1703
1704 cc = (struct wmi_reconnect_cmd *) skb->data;
1705 cc->channel = cpu_to_le16(channel);
1706
1707 if (bssid != NULL)
1708 memcpy(cc->bssid, bssid, ETH_ALEN);
1709
1710 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_RECONNECT_CMDID,
1711 NO_SYNC_WMIFLAG);
1712
1713 return ret;
1714}
1715
1716int ath6kl_wmi_disconnect_cmd(struct wmi *wmi)
1717{
1718 int ret;
1719
b9b6ee60
KV		 1720 ath6kl_dbg(ATH6KL_DBG_WMI, "wmi disconnect\n");
1721
bdcd8170
KV		 1722 wmi->traffic_class = 100;
1723
1724 /* Disconnect command does not need to do a SYNC before. */
1725 ret = ath6kl_wmi_simple_cmd(wmi, WMI_DISCONNECT_CMDID);
1726
1727 return ret;
1728}
1729
1730int ath6kl_wmi_startscan_cmd(struct wmi *wmi, enum wmi_scan_type scan_type,
1731 u32 force_fgscan, u32 is_legacy,
1732 u32 home_dwell_time, u32 force_scan_interval,
1733 s8 num_chan, u16 *ch_list)
1734{
1735 struct sk_buff *skb;
1736 struct wmi_start_scan_cmd *sc;
1737 s8 size;
1276c9ef 1738 int i, ret;
bdcd8170
KV		 1739
1740 size = sizeof(struct wmi_start_scan_cmd);
1741
1742 if ((scan_type != WMI_LONG_SCAN) && (scan_type != WMI_SHORT_SCAN))
1743 return -EINVAL;
1744
1745 if (num_chan > WMI_MAX_CHANNELS)
1746 return -EINVAL;
1747
1748 if (num_chan)
1749 size += sizeof(u16) * (num_chan - 1);
1750
1751 skb = ath6kl_wmi_get_new_buf(size);
1752 if (!skb)
1753 return -ENOMEM;
1754
1755 sc = (struct wmi_start_scan_cmd *) skb->data;
1756 sc->scan_type = scan_type;
1757 sc->force_fg_scan = cpu_to_le32(force_fgscan);
1758 sc->is_legacy = cpu_to_le32(is_legacy);
1759 sc->home_dwell_time = cpu_to_le32(home_dwell_time);
1760 sc->force_scan_intvl = cpu_to_le32(force_scan_interval);
1761 sc->num_ch = num_chan;
1762
1276c9ef
EL		 1763 for (i = 0; i < num_chan; i++)
1764 sc->ch_list[i] = cpu_to_le16(ch_list[i]);
bdcd8170
KV		 1765
1766 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_START_SCAN_CMDID,
1767 NO_SYNC_WMIFLAG);
1768
1769 return ret;
1770}
1771
1772int ath6kl_wmi_scanparams_cmd(struct wmi *wmi, u16 fg_start_sec,
1773 u16 fg_end_sec, u16 bg_sec,
1774 u16 minact_chdw_msec, u16 maxact_chdw_msec,
1775 u16 pas_chdw_msec, u8 short_scan_ratio,
1776 u8 scan_ctrl_flag, u32 max_dfsch_act_time,
1777 u16 maxact_scan_per_ssid)
1778{
1779 struct sk_buff *skb;
1780 struct wmi_scan_params_cmd *sc;
1781 int ret;
1782
1783 skb = ath6kl_wmi_get_new_buf(sizeof(*sc));
1784 if (!skb)
1785 return -ENOMEM;
1786
1787 sc = (struct wmi_scan_params_cmd *) skb->data;
1788 sc->fg_start_period = cpu_to_le16(fg_start_sec);
1789 sc->fg_end_period = cpu_to_le16(fg_end_sec);
1790 sc->bg_period = cpu_to_le16(bg_sec);
1791 sc->minact_chdwell_time = cpu_to_le16(minact_chdw_msec);
1792 sc->maxact_chdwell_time = cpu_to_le16(maxact_chdw_msec);
1793 sc->pas_chdwell_time = cpu_to_le16(pas_chdw_msec);
1794 sc->short_scan_ratio = short_scan_ratio;
1795 sc->scan_ctrl_flags = scan_ctrl_flag;
1796 sc->max_dfsch_act_time = cpu_to_le32(max_dfsch_act_time);
1797 sc->maxact_scan_per_ssid = cpu_to_le16(maxact_scan_per_ssid);
1798
1799 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_SCAN_PARAMS_CMDID,
1800 NO_SYNC_WMIFLAG);
1801 return ret;
1802}
1803
1804int ath6kl_wmi_bssfilter_cmd(struct wmi *wmi, u8 filter, u32 ie_mask)
1805{
1806 struct sk_buff *skb;
1807 struct wmi_bss_filter_cmd *cmd;
1808 int ret;
1809
1810 if (filter >= LAST_BSS_FILTER)
1811 return -EINVAL;
1812
1813 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
1814 if (!skb)
1815 return -ENOMEM;
1816
1817 cmd = (struct wmi_bss_filter_cmd *) skb->data;
1818 cmd->bss_filter = filter;
1819 cmd->ie_mask = cpu_to_le32(ie_mask);
1820
1821 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_BSS_FILTER_CMDID,
1822 NO_SYNC_WMIFLAG);
1823 return ret;
1824}
1825
1826int ath6kl_wmi_probedssid_cmd(struct wmi *wmi, u8 index, u8 flag,
1827 u8 ssid_len, u8 *ssid)
1828{
1829 struct sk_buff *skb;
1830 struct wmi_probed_ssid_cmd *cmd;
1831 int ret;
1832
1833 if (index > MAX_PROBED_SSID_INDEX)
1834 return -EINVAL;
1835
1836 if (ssid_len > sizeof(cmd->ssid))
1837 return -EINVAL;
1838
1839 if ((flag & (DISABLE_SSID_FLAG | ANY_SSID_FLAG)) && (ssid_len > 0))
1840 return -EINVAL;
1841
1842 if ((flag & SPECIFIC_SSID_FLAG) && !ssid_len)
1843 return -EINVAL;
1844
1845 if (flag & SPECIFIC_SSID_FLAG)
1846 wmi->is_probe_ssid = true;
1847
1848 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
1849 if (!skb)
1850 return -ENOMEM;
1851
1852 cmd = (struct wmi_probed_ssid_cmd *) skb->data;
1853 cmd->entry_index = index;
1854 cmd->flag = flag;
1855 cmd->ssid_len = ssid_len;
1856 memcpy(cmd->ssid, ssid, ssid_len);
1857
1858 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_PROBED_SSID_CMDID,
1859 NO_SYNC_WMIFLAG);
1860 return ret;
1861}
1862
1863int ath6kl_wmi_listeninterval_cmd(struct wmi *wmi, u16 listen_interval,
1864 u16 listen_beacons)
1865{
1866 struct sk_buff *skb;
1867 struct wmi_listen_int_cmd *cmd;
1868 int ret;
1869
1870 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
1871 if (!skb)
1872 return -ENOMEM;
1873
1874 cmd = (struct wmi_listen_int_cmd *) skb->data;
1875 cmd->listen_intvl = cpu_to_le16(listen_interval);
1876 cmd->num_beacons = cpu_to_le16(listen_beacons);
1877
1878 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_LISTEN_INT_CMDID,
1879 NO_SYNC_WMIFLAG);
1880 return ret;
1881}
1882
1883int ath6kl_wmi_powermode_cmd(struct wmi *wmi, u8 pwr_mode)
1884{
1885 struct sk_buff *skb;
1886 struct wmi_power_mode_cmd *cmd;
1887 int ret;
1888
1889 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
1890 if (!skb)
1891 return -ENOMEM;
1892
1893 cmd = (struct wmi_power_mode_cmd *) skb->data;
1894 cmd->pwr_mode = pwr_mode;
1895 wmi->pwr_mode = pwr_mode;
1896
1897 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_POWER_MODE_CMDID,
1898 NO_SYNC_WMIFLAG);
1899 return ret;
1900}
1901
1902int ath6kl_wmi_pmparams_cmd(struct wmi *wmi, u16 idle_period,
1903 u16 ps_poll_num, u16 dtim_policy,
1904 u16 tx_wakeup_policy, u16 num_tx_to_wakeup,
1905 u16 ps_fail_event_policy)
1906{
1907 struct sk_buff *skb;
1908 struct wmi_power_params_cmd *pm;
1909 int ret;
1910
1911 skb = ath6kl_wmi_get_new_buf(sizeof(*pm));
1912 if (!skb)
1913 return -ENOMEM;
1914
1915 pm = (struct wmi_power_params_cmd *)skb->data;
1916 pm->idle_period = cpu_to_le16(idle_period);
1917 pm->pspoll_number = cpu_to_le16(ps_poll_num);
1918 pm->dtim_policy = cpu_to_le16(dtim_policy);
1919 pm->tx_wakeup_policy = cpu_to_le16(tx_wakeup_policy);
1920 pm->num_tx_to_wakeup = cpu_to_le16(num_tx_to_wakeup);
1921 pm->ps_fail_event_policy = cpu_to_le16(ps_fail_event_policy);
1922
1923 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_POWER_PARAMS_CMDID,
1924 NO_SYNC_WMIFLAG);
1925 return ret;
1926}
1927
1928int ath6kl_wmi_disctimeout_cmd(struct wmi *wmi, u8 timeout)
1929{
1930 struct sk_buff *skb;
1931 struct wmi_disc_timeout_cmd *cmd;
1932 int ret;
1933
1934 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
1935 if (!skb)
1936 return -ENOMEM;
1937
1938 cmd = (struct wmi_disc_timeout_cmd *) skb->data;
1939 cmd->discon_timeout = timeout;
1940
1941 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_DISC_TIMEOUT_CMDID,
1942 NO_SYNC_WMIFLAG);
ff0b0075
JM		 1943 if (ret == 0)
1944 ath6kl_debug_set_disconnect_timeout(wmi->parent_dev, timeout);
bdcd8170
KV		 1945 return ret;
1946}
1947
1948int ath6kl_wmi_addkey_cmd(struct wmi *wmi, u8 key_index,
1949 enum crypto_type key_type,
1950 u8 key_usage, u8 key_len,
1951 u8 *key_rsc, u8 *key_material,
1952 u8 key_op_ctrl, u8 *mac_addr,
1953 enum wmi_sync_flag sync_flag)
1954{
1955 struct sk_buff *skb;
1956 struct wmi_add_cipher_key_cmd *cmd;
1957 int ret;
1958
9a5b1318
JM		 1959 ath6kl_dbg(ATH6KL_DBG_WMI, "addkey cmd: key_index=%u key_type=%d "
1960 "key_usage=%d key_len=%d key_op_ctrl=%d\n",
1961 key_index, key_type, key_usage, key_len, key_op_ctrl);
1962
bdcd8170
KV		 1963 if ((key_index > WMI_MAX_KEY_INDEX) || (key_len > WMI_MAX_KEY_LEN) ||
1964 (key_material == NULL))
1965 return -EINVAL;
1966
1967 if ((WEP_CRYPT != key_type) && (NULL == key_rsc))
1968 return -EINVAL;
1969
1970 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
1971 if (!skb)
1972 return -ENOMEM;
1973
1974 cmd = (struct wmi_add_cipher_key_cmd *) skb->data;
1975 cmd->key_index = key_index;
1976 cmd->key_type = key_type;
1977 cmd->key_usage = key_usage;
1978 cmd->key_len = key_len;
1979 memcpy(cmd->key, key_material, key_len);
1980
1981 if (key_rsc != NULL)
1982 memcpy(cmd->key_rsc, key_rsc, sizeof(cmd->key_rsc));
1983
1984 cmd->key_op_ctrl = key_op_ctrl;
1985
1986 if (mac_addr)
1987 memcpy(cmd->key_mac_addr, mac_addr, ETH_ALEN);
1988
1989 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_ADD_CIPHER_KEY_CMDID,
1990 sync_flag);
1991
1992 return ret;
1993}
1994
1995int ath6kl_wmi_add_krk_cmd(struct wmi *wmi, u8 *krk)
1996{
1997 struct sk_buff *skb;
1998 struct wmi_add_krk_cmd *cmd;
1999 int ret;
2000
2001 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2002 if (!skb)
2003 return -ENOMEM;
2004
2005 cmd = (struct wmi_add_krk_cmd *) skb->data;
2006 memcpy(cmd->krk, krk, WMI_KRK_LEN);
2007
2008 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_ADD_KRK_CMDID, NO_SYNC_WMIFLAG);
2009
2010 return ret;
2011}
2012
2013int ath6kl_wmi_deletekey_cmd(struct wmi *wmi, u8 key_index)
2014{
2015 struct sk_buff *skb;
2016 struct wmi_delete_cipher_key_cmd *cmd;
2017 int ret;
2018
2019 if (key_index > WMI_MAX_KEY_INDEX)
2020 return -EINVAL;
2021
2022 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2023 if (!skb)
2024 return -ENOMEM;
2025
2026 cmd = (struct wmi_delete_cipher_key_cmd *) skb->data;
2027 cmd->key_index = key_index;
2028
2029 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_DELETE_CIPHER_KEY_CMDID,
2030 NO_SYNC_WMIFLAG);
2031
2032 return ret;
2033}
2034
2035int ath6kl_wmi_setpmkid_cmd(struct wmi *wmi, const u8 *bssid,
2036 const u8 *pmkid, bool set)
2037{
2038 struct sk_buff *skb;
2039 struct wmi_setpmkid_cmd *cmd;
2040 int ret;
2041
2042 if (bssid == NULL)
2043 return -EINVAL;
2044
2045 if (set && pmkid == NULL)
2046 return -EINVAL;
2047
2048 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2049 if (!skb)
2050 return -ENOMEM;
2051
2052 cmd = (struct wmi_setpmkid_cmd *) skb->data;
2053 memcpy(cmd->bssid, bssid, ETH_ALEN);
2054 if (set) {
2055 memcpy(cmd->pmkid, pmkid, sizeof(cmd->pmkid));
2056 cmd->enable = PMKID_ENABLE;
2057 } else {
2058 memset(cmd->pmkid, 0, sizeof(cmd->pmkid));
2059 cmd->enable = PMKID_DISABLE;
2060 }
2061
2062 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_PMKID_CMDID,
2063 NO_SYNC_WMIFLAG);
2064
2065 return ret;
2066}
2067
2068static int ath6kl_wmi_data_sync_send(struct wmi *wmi, struct sk_buff *skb,
2069 enum htc_endpoint_id ep_id)
2070{
2071 struct wmi_data_hdr *data_hdr;
2072 int ret;
2073
2074 if (WARN_ON(skb == NULL || ep_id == wmi->ep_id))
2075 return -EINVAL;
2076
2077 skb_push(skb, sizeof(struct wmi_data_hdr));
2078
2079 data_hdr = (struct wmi_data_hdr *) skb->data;
2080 data_hdr->info = SYNC_MSGTYPE << WMI_DATA_HDR_MSG_TYPE_SHIFT;
2081 data_hdr->info3 = 0;
2082
2083 ret = ath6kl_control_tx(wmi->parent_dev, skb, ep_id);
2084
2085 return ret;
2086}
2087
2088static int ath6kl_wmi_sync_point(struct wmi *wmi)
2089{
2090 struct sk_buff *skb;
2091 struct wmi_sync_cmd *cmd;
2092 struct wmi_data_sync_bufs data_sync_bufs[WMM_NUM_AC];
2093 enum htc_endpoint_id ep_id;
2094 u8 index, num_pri_streams = 0;
2095 int ret = 0;
2096
2097 memset(data_sync_bufs, 0, sizeof(data_sync_bufs));
2098
2099 spin_lock_bh(&wmi->lock);
2100
2101 for (index = 0; index < WMM_NUM_AC; index++) {
2102 if (wmi->fat_pipe_exist & (1 << index)) {
2103 num_pri_streams++;
2104 data_sync_bufs[num_pri_streams - 1].traffic_class =
2105 index;
2106 }
2107 }
2108
2109 spin_unlock_bh(&wmi->lock);
2110
2111 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2112 if (!skb) {
2113 ret = -ENOMEM;
2114 goto free_skb;
2115 }
2116
2117 cmd = (struct wmi_sync_cmd *) skb->data;
2118
2119 /*
2120 * In the SYNC cmd sent on the control Ep, send a bitmap
2121 * of the data eps on which the Data Sync will be sent
2122 */
2123 cmd->data_sync_map = wmi->fat_pipe_exist;
2124
2125 for (index = 0; index < num_pri_streams; index++) {
2126 data_sync_bufs[index].skb = ath6kl_buf_alloc(0);
2127 if (data_sync_bufs[index].skb == NULL) {
2128 ret = -ENOMEM;
2129 break;
2130 }
2131 }
2132
2133 /*
2134 * If buffer allocation for any of the dataSync fails,
2135 * then do not send the Synchronize cmd on the control ep
2136 */
2137 if (ret)
2138 goto free_skb;
2139
2140 /*
2141 * Send sync cmd followed by sync data messages on all
2142 * endpoints being used
2143 */
2144 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SYNCHRONIZE_CMDID,
2145 NO_SYNC_WMIFLAG);
2146
2147 if (ret)
2148 goto free_skb;
2149
2150 /* cmd buffer sent, we no longer own it */
2151 skb = NULL;
2152
2153 for (index = 0; index < num_pri_streams; index++) {
2154
2155 if (WARN_ON(!data_sync_bufs[index].skb))
2156 break;
2157
2158 ep_id = ath6kl_ac2_endpoint_id(wmi->parent_dev,
2159 data_sync_bufs[index].
2160 traffic_class);
2161 ret =
2162 ath6kl_wmi_data_sync_send(wmi, data_sync_bufs[index].skb,
2163 ep_id);
2164
2165 if (ret)
2166 break;
2167
2168 data_sync_bufs[index].skb = NULL;
2169 }
2170
2171free_skb:
2172 /* free up any resources left over (possibly due to an error) */
2173 if (skb)
2174 dev_kfree_skb(skb);
2175
2176 for (index = 0; index < num_pri_streams; index++) {
2177 if (data_sync_bufs[index].skb != NULL) {
2178 dev_kfree_skb((struct sk_buff *)data_sync_bufs[index].
2179 skb);
2180 }
2181 }
2182
2183 return ret;
2184}
2185
2186int ath6kl_wmi_create_pstream_cmd(struct wmi *wmi,
2187 struct wmi_create_pstream_cmd *params)
2188{
2189 struct sk_buff *skb;
2190 struct wmi_create_pstream_cmd *cmd;
2191 u8 fatpipe_exist_for_ac = 0;
2192 s32 min_phy = 0;
2193 s32 nominal_phy = 0;
2194 int ret;
2195
2196 if (!((params->user_pri < 8) &&
2197 (params->user_pri <= 0x7) &&
2198 (up_to_ac[params->user_pri & 0x7] == params->traffic_class) &&
2199 (params->traffic_direc == UPLINK_TRAFFIC ||
2200 params->traffic_direc == DNLINK_TRAFFIC ||
2201 params->traffic_direc == BIDIR_TRAFFIC) &&
2202 (params->traffic_type == TRAFFIC_TYPE_APERIODIC ||
2203 params->traffic_type == TRAFFIC_TYPE_PERIODIC) &&
2204 (params->voice_psc_cap == DISABLE_FOR_THIS_AC ||
2205 params->voice_psc_cap == ENABLE_FOR_THIS_AC ||
2206 params->voice_psc_cap == ENABLE_FOR_ALL_AC) &&
2207 (params->tsid == WMI_IMPLICIT_PSTREAM ||
2208 params->tsid <= WMI_MAX_THINSTREAM))) {
2209 return -EINVAL;
2210 }
2211
2212 /*
2213 * Check nominal PHY rate is >= minimalPHY,
2214 * so that DUT can allow TSRS IE
2215 */
2216
2217 /* Get the physical rate (units of bps) */
2218 min_phy = ((le32_to_cpu(params->min_phy_rate) / 1000) / 1000);
2219
2220 /* Check minimal phy < nominal phy rate */
2221 if (params->nominal_phy >= min_phy) {
2222 /* unit of 500 kbps */
2223 nominal_phy = (params->nominal_phy * 1000) / 500;
2224 ath6kl_dbg(ATH6KL_DBG_WMI,
2225 "TSRS IE enabled::MinPhy %x->NominalPhy ===> %x\n",
2226 min_phy, nominal_phy);
2227
2228 params->nominal_phy = nominal_phy;
2229 } else {
2230 params->nominal_phy = 0;
2231 }
2232
2233 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2234 if (!skb)
2235 return -ENOMEM;
2236
2237 ath6kl_dbg(ATH6KL_DBG_WMI,
2238 "sending create_pstream_cmd: ac=%d tsid:%d\n",
2239 params->traffic_class, params->tsid);
2240
2241 cmd = (struct wmi_create_pstream_cmd *) skb->data;
2242 memcpy(cmd, params, sizeof(*cmd));
2243
2244 /* This is an implicitly created Fat pipe */
2245 if ((u32) params->tsid == (u32) WMI_IMPLICIT_PSTREAM) {
2246 spin_lock_bh(&wmi->lock);
2247 fatpipe_exist_for_ac = (wmi->fat_pipe_exist &
2248 (1 << params->traffic_class));
2249 wmi->fat_pipe_exist |= (1 << params->traffic_class);
2250 spin_unlock_bh(&wmi->lock);
2251 } else {
2252 /* explicitly created thin stream within a fat pipe */
2253 spin_lock_bh(&wmi->lock);
2254 fatpipe_exist_for_ac = (wmi->fat_pipe_exist &
2255 (1 << params->traffic_class));
2256 wmi->stream_exist_for_ac[params->traffic_class] |=
2257 (1 << params->tsid);
2258 /*
2259 * If a thinstream becomes active, the fat pipe automatically
2260 * becomes active
2261 */
2262 wmi->fat_pipe_exist |= (1 << params->traffic_class);
2263 spin_unlock_bh(&wmi->lock);
2264 }
2265
2266 /*
2267 * Indicate activty change to driver layer only if this is the
2268 * first TSID to get created in this AC explicitly or an implicit
2269 * fat pipe is getting created.
2270 */
2271 if (!fatpipe_exist_for_ac)
2272 ath6kl_indicate_tx_activity(wmi->parent_dev,
2273 params->traffic_class, true);
2274
2275 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_CREATE_PSTREAM_CMDID,
2276 NO_SYNC_WMIFLAG);
2277 return ret;
2278}
2279
2280int ath6kl_wmi_delete_pstream_cmd(struct wmi *wmi, u8 traffic_class, u8 tsid)
2281{
2282 struct sk_buff *skb;
2283 struct wmi_delete_pstream_cmd *cmd;
2284 u16 active_tsids = 0;
2285 int ret;
2286
2287 if (traffic_class > 3) {
2288 ath6kl_err("invalid traffic class: %d\n", traffic_class);
2289 return -EINVAL;
2290 }
2291
2292 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2293 if (!skb)
2294 return -ENOMEM;
2295
2296 cmd = (struct wmi_delete_pstream_cmd *) skb->data;
2297 cmd->traffic_class = traffic_class;
2298 cmd->tsid = tsid;
2299
2300 spin_lock_bh(&wmi->lock);
2301 active_tsids = wmi->stream_exist_for_ac[traffic_class];
2302 spin_unlock_bh(&wmi->lock);
2303
2304 if (!(active_tsids & (1 << tsid))) {
2305 dev_kfree_skb(skb);
2306 ath6kl_dbg(ATH6KL_DBG_WMI,
2307 "TSID %d doesn't exist for traffic class: %d\n",
2308 tsid, traffic_class);
2309 return -ENODATA;
2310 }
2311
2312 ath6kl_dbg(ATH6KL_DBG_WMI,
2313 "sending delete_pstream_cmd: traffic class: %d tsid=%d\n",
2314 traffic_class, tsid);
2315
2316 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_DELETE_PSTREAM_CMDID,
2317 SYNC_BEFORE_WMIFLAG);
2318
2319 spin_lock_bh(&wmi->lock);
2320 wmi->stream_exist_for_ac[traffic_class] &= ~(1 << tsid);
2321 active_tsids = wmi->stream_exist_for_ac[traffic_class];
2322 spin_unlock_bh(&wmi->lock);
2323
2324 /*
2325 * Indicate stream inactivity to driver layer only if all tsids
2326 * within this AC are deleted.
2327 */
2328 if (!active_tsids) {
2329 ath6kl_indicate_tx_activity(wmi->parent_dev,
2330 traffic_class, false);
2331 wmi->fat_pipe_exist &= ~(1 << traffic_class);
2332 }
2333
2334 return ret;
2335}
2336
2337int ath6kl_wmi_set_ip_cmd(struct wmi *wmi, struct wmi_set_ip_cmd *ip_cmd)
2338{
2339 struct sk_buff *skb;
2340 struct wmi_set_ip_cmd *cmd;
2341 int ret;
2342
2343 /* Multicast address are not valid */
2344 if ((*((u8 *) &ip_cmd->ips[0]) >= 0xE0) ||
2345 (*((u8 *) &ip_cmd->ips[1]) >= 0xE0))
2346 return -EINVAL;
2347
2348 skb = ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_ip_cmd));
2349 if (!skb)
2350 return -ENOMEM;
2351
2352 cmd = (struct wmi_set_ip_cmd *) skb->data;
2353 memcpy(cmd, ip_cmd, sizeof(struct wmi_set_ip_cmd));
2354
2355 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_IP_CMDID, NO_SYNC_WMIFLAG);
2356 return ret;
2357}
2358
2359static int ath6kl_wmi_get_wow_list_event_rx(struct wmi *wmi, u8 * datap,
2360 int len)
2361{
2362 if (len < sizeof(struct wmi_get_wow_list_reply))
2363 return -EINVAL;
2364
2365 return 0;
2366}
2367
2368static int ath6kl_wmi_cmd_send_xtnd(struct wmi *wmi, struct sk_buff *skb,
2369 enum wmix_command_id cmd_id,
2370 enum wmi_sync_flag sync_flag)
2371{
2372 struct wmix_cmd_hdr *cmd_hdr;
2373 int ret;
2374
2375 skb_push(skb, sizeof(struct wmix_cmd_hdr));
2376
2377 cmd_hdr = (struct wmix_cmd_hdr *) skb->data;
2378 cmd_hdr->cmd_id = cpu_to_le32(cmd_id);
2379
2380 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_EXTENSION_CMDID, sync_flag);
2381
2382 return ret;
2383}
2384
2385int ath6kl_wmi_get_challenge_resp_cmd(struct wmi *wmi, u32 cookie, u32 source)
2386{
2387 struct sk_buff *skb;
2388 struct wmix_hb_challenge_resp_cmd *cmd;
2389 int ret;
2390
2391 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2392 if (!skb)
2393 return -ENOMEM;
2394
2395 cmd = (struct wmix_hb_challenge_resp_cmd *) skb->data;
2396 cmd->cookie = cpu_to_le32(cookie);
2397 cmd->source = cpu_to_le32(source);
2398
2399 ret = ath6kl_wmi_cmd_send_xtnd(wmi, skb, WMIX_HB_CHALLENGE_RESP_CMDID,
2400 NO_SYNC_WMIFLAG);
2401 return ret;
2402}
2403
939f1cce
KV		 2404int ath6kl_wmi_config_debug_module_cmd(struct wmi *wmi, u32 valid, u32 config)
2405{
2406 struct ath6kl_wmix_dbglog_cfg_module_cmd *cmd;
2407 struct sk_buff *skb;
2408 int ret;
2409
2410 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2411 if (!skb)
2412 return -ENOMEM;
2413
2414 cmd = (struct ath6kl_wmix_dbglog_cfg_module_cmd *) skb->data;
2415 cmd->valid = cpu_to_le32(valid);
2416 cmd->config = cpu_to_le32(config);
2417
2418 ret = ath6kl_wmi_cmd_send_xtnd(wmi, skb, WMIX_DBGLOG_CFG_MODULE_CMDID,
2419 NO_SYNC_WMIFLAG);
2420 return ret;
2421}
2422
bdcd8170
KV		 2423int ath6kl_wmi_get_stats_cmd(struct wmi *wmi)
2424{
2425 return ath6kl_wmi_simple_cmd(wmi, WMI_GET_STATISTICS_CMDID);
2426}
2427
2428int ath6kl_wmi_set_tx_pwr_cmd(struct wmi *wmi, u8 dbM)
2429{
2430 struct sk_buff *skb;
2431 struct wmi_set_tx_pwr_cmd *cmd;
2432 int ret;
2433
2434 skb = ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_tx_pwr_cmd));
2435 if (!skb)
2436 return -ENOMEM;
2437
2438 cmd = (struct wmi_set_tx_pwr_cmd *) skb->data;
2439 cmd->dbM = dbM;
2440
2441 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_TX_PWR_CMDID,
2442 NO_SYNC_WMIFLAG);
2443
2444 return ret;
2445}
2446
2447int ath6kl_wmi_get_tx_pwr_cmd(struct wmi *wmi)
2448{
2449 return ath6kl_wmi_simple_cmd(wmi, WMI_GET_TX_PWR_CMDID);
2450}
2451
4b28a80d
JM		 2452int ath6kl_wmi_get_roam_tbl_cmd(struct wmi *wmi)
2453{
2454 return ath6kl_wmi_simple_cmd(wmi, WMI_GET_ROAM_TBL_CMDID);
2455}
2456
bdcd8170
KV		 2457int ath6kl_wmi_set_lpreamble_cmd(struct wmi *wmi, u8 status, u8 preamble_policy)
2458{
2459 struct sk_buff *skb;
2460 struct wmi_set_lpreamble_cmd *cmd;
2461 int ret;
2462
2463 skb = ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_lpreamble_cmd));
2464 if (!skb)
2465 return -ENOMEM;
2466
2467 cmd = (struct wmi_set_lpreamble_cmd *) skb->data;
2468 cmd->status = status;
2469 cmd->preamble_policy = preamble_policy;
2470
2471 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_LPREAMBLE_CMDID,
2472 NO_SYNC_WMIFLAG);
2473 return ret;
2474}
2475
2476int ath6kl_wmi_set_rts_cmd(struct wmi *wmi, u16 threshold)
2477{
2478 struct sk_buff *skb;
2479 struct wmi_set_rts_cmd *cmd;
2480 int ret;
2481
2482 skb = ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_rts_cmd));
2483 if (!skb)
2484 return -ENOMEM;
2485
2486 cmd = (struct wmi_set_rts_cmd *) skb->data;
2487 cmd->threshold = cpu_to_le16(threshold);
2488
2489 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_RTS_CMDID, NO_SYNC_WMIFLAG);
2490 return ret;
2491}
2492
2493int ath6kl_wmi_set_wmm_txop(struct wmi *wmi, enum wmi_txop_cfg cfg)
2494{
2495 struct sk_buff *skb;
2496 struct wmi_set_wmm_txop_cmd *cmd;
2497 int ret;
2498
2499 if (!((cfg == WMI_TXOP_DISABLED) || (cfg == WMI_TXOP_ENABLED)))
2500 return -EINVAL;
2501
2502 skb = ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_wmm_txop_cmd));
2503 if (!skb)
2504 return -ENOMEM;
2505
2506 cmd = (struct wmi_set_wmm_txop_cmd *) skb->data;
2507 cmd->txop_enable = cfg;
2508
2509 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_WMM_TXOP_CMDID,
2510 NO_SYNC_WMIFLAG);
2511 return ret;
2512}
2513
2514int ath6kl_wmi_set_keepalive_cmd(struct wmi *wmi, u8 keep_alive_intvl)
2515{
2516 struct sk_buff *skb;
2517 struct wmi_set_keepalive_cmd *cmd;
2518 int ret;
2519
2520 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2521 if (!skb)
2522 return -ENOMEM;
2523
2524 cmd = (struct wmi_set_keepalive_cmd *) skb->data;
2525 cmd->keep_alive_intvl = keep_alive_intvl;
bdcd8170
KV		 2526
2527 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_KEEPALIVE_CMDID,
2528 NO_SYNC_WMIFLAG);
ff0b0075
JM		 2529 if (ret == 0)
2530 ath6kl_debug_set_keepalive(wmi->parent_dev, keep_alive_intvl);
bdcd8170
KV		 2531 return ret;
2532}
2533
003353b0
KV		 2534int ath6kl_wmi_test_cmd(struct wmi *wmi, void *buf, size_t len)
2535{
2536 struct sk_buff *skb;
2537 int ret;
2538
2539 skb = ath6kl_wmi_get_new_buf(len);
2540 if (!skb)
2541 return -ENOMEM;
2542
2543 memcpy(skb->data, buf, len);
2544
2545 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_TEST_CMDID, NO_SYNC_WMIFLAG);
2546
2547 return ret;
2548}
2549
2550
bdcd8170
KV		 2551s32 ath6kl_wmi_get_rate(s8 rate_index)
2552{
2553 if (rate_index == RATE_AUTO)
2554 return 0;
2555
2556 return wmi_rate_tbl[(u32) rate_index][0];
2557}
2558
bdcd8170
KV		 2559static int ath6kl_wmi_get_pmkid_list_event_rx(struct wmi *wmi, u8 *datap,
2560 u32 len)
2561{
2562 struct wmi_pmkid_list_reply *reply;
2563 u32 expected_len;
2564
2565 if (len < sizeof(struct wmi_pmkid_list_reply))
2566 return -EINVAL;
2567
2568 reply = (struct wmi_pmkid_list_reply *)datap;
2569 expected_len = sizeof(reply->num_pmkid) +
2570 le32_to_cpu(reply->num_pmkid) * WMI_PMKID_LEN;
2571
2572 if (len < expected_len)
2573 return -EINVAL;
2574
2575 return 0;
2576}
2577
2578static int ath6kl_wmi_addba_req_event_rx(struct wmi *wmi, u8 *datap, int len)
2579{
2580 struct wmi_addba_req_event *cmd = (struct wmi_addba_req_event *) datap;
2581
2582 aggr_recv_addba_req_evt(wmi->parent_dev, cmd->tid,
2583 le16_to_cpu(cmd->st_seq_no), cmd->win_sz);
2584
2585 return 0;
2586}
2587
2588static int ath6kl_wmi_delba_req_event_rx(struct wmi *wmi, u8 *datap, int len)
2589{
2590 struct wmi_delba_event *cmd = (struct wmi_delba_event *) datap;
2591
2592 aggr_recv_delba_req_evt(wmi->parent_dev, cmd->tid);
2593
2594 return 0;
2595}
2596
2597/* AP mode functions */
6a7c9bad
JM		 2598
2599int ath6kl_wmi_ap_profile_commit(struct wmi *wmip, struct wmi_connect_cmd *p)
2600{
2601 struct sk_buff *skb;
2602 struct wmi_connect_cmd *cm;
2603 int res;
2604
2605 skb = ath6kl_wmi_get_new_buf(sizeof(*cm));
2606 if (!skb)
2607 return -ENOMEM;
2608
2609 cm = (struct wmi_connect_cmd *) skb->data;
2610 memcpy(cm, p, sizeof(*cm));
2611
2612 res = ath6kl_wmi_cmd_send(wmip, skb, WMI_AP_CONFIG_COMMIT_CMDID,
2613 NO_SYNC_WMIFLAG);
2614 ath6kl_dbg(ATH6KL_DBG_WMI, "%s: nw_type=%u auth_mode=%u ch=%u "
2615 "ctrl_flags=0x%x-> res=%d\n",
2616 __func__, p->nw_type, p->auth_mode, le16_to_cpu(p->ch),
2617 le32_to_cpu(p->ctrl_flags), res);
2618 return res;
2619}
2620
23875136
JM		 2621int ath6kl_wmi_ap_set_mlme(struct wmi *wmip, u8 cmd, const u8 *mac, u16 reason)
2622{
2623 struct sk_buff *skb;
2624 struct wmi_ap_set_mlme_cmd *cm;
2625
2626 skb = ath6kl_wmi_get_new_buf(sizeof(*cm));
2627 if (!skb)
2628 return -ENOMEM;
2629
2630 cm = (struct wmi_ap_set_mlme_cmd *) skb->data;
2631 memcpy(cm->mac, mac, ETH_ALEN);
2632 cm->reason = cpu_to_le16(reason);
2633 cm->cmd = cmd;
2634
2635 return ath6kl_wmi_cmd_send(wmip, skb, WMI_AP_SET_MLME_CMDID,
2636 NO_SYNC_WMIFLAG);
2637}
2638
bdcd8170
KV		 2639static int ath6kl_wmi_pspoll_event_rx(struct wmi *wmi, u8 *datap, int len)
2640{
2641 struct wmi_pspoll_event *ev;
2642
2643 if (len < sizeof(struct wmi_pspoll_event))
2644 return -EINVAL;
2645
2646 ev = (struct wmi_pspoll_event *) datap;
2647
2648 ath6kl_pspoll_event(wmi->parent_dev, le16_to_cpu(ev->aid));
2649
2650 return 0;
2651}
2652
2653static int ath6kl_wmi_dtimexpiry_event_rx(struct wmi *wmi, u8 *datap, int len)
2654{
2655 ath6kl_dtimexpiry_event(wmi->parent_dev);
2656
2657 return 0;
2658}
2659
2660int ath6kl_wmi_set_pvb_cmd(struct wmi *wmi, u16 aid, bool flag)
2661{
2662 struct sk_buff *skb;
2663 struct wmi_ap_set_pvb_cmd *cmd;
2664 int ret;
2665
2666 skb = ath6kl_wmi_get_new_buf(sizeof(struct wmi_ap_set_pvb_cmd));
2667 if (!skb)
2668 return -ENOMEM;
2669
2670 cmd = (struct wmi_ap_set_pvb_cmd *) skb->data;
2671 cmd->aid = cpu_to_le16(aid);
d6e51e6a 2672 cmd->rsvd = cpu_to_le16(0);
bdcd8170
KV		 2673 cmd->flag = cpu_to_le32(flag);
2674
2675 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_AP_SET_PVB_CMDID,
2676 NO_SYNC_WMIFLAG);
2677
2678 return 0;
2679}
2680
2681int ath6kl_wmi_set_rx_frame_format_cmd(struct wmi *wmi, u8 rx_meta_ver,
2682 bool rx_dot11_hdr, bool defrag_on_host)
2683{
2684 struct sk_buff *skb;
2685 struct wmi_rx_frame_format_cmd *cmd;
2686 int ret;
2687
2688 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2689 if (!skb)
2690 return -ENOMEM;
2691
2692 cmd = (struct wmi_rx_frame_format_cmd *) skb->data;
2693 cmd->dot11_hdr = rx_dot11_hdr ? 1 : 0;
2694 cmd->defrag_on_host = defrag_on_host ? 1 : 0;
2695 cmd->meta_ver = rx_meta_ver;
2696
2697 /* Delete the local aggr state, on host */
2698 ret = ath6kl_wmi_cmd_send(wmi, skb, WMI_RX_FRAME_FORMAT_CMDID,
2699 NO_SYNC_WMIFLAG);
2700
2701 return ret;
2702}
2703
6a7c9bad
JM		 2704int ath6kl_wmi_set_appie_cmd(struct wmi *wmi, u8 mgmt_frm_type, const u8 *ie,
2705 u8 ie_len)
2706{
2707 struct sk_buff *skb;
2708 struct wmi_set_appie_cmd *p;
2709
2710 skb = ath6kl_wmi_get_new_buf(sizeof(*p) + ie_len);
2711 if (!skb)
2712 return -ENOMEM;
2713
2714 ath6kl_dbg(ATH6KL_DBG_WMI, "set_appie_cmd: mgmt_frm_type=%u "
2715 "ie_len=%u\n", mgmt_frm_type, ie_len);
2716 p = (struct wmi_set_appie_cmd *) skb->data;
2717 p->mgmt_frm_type = mgmt_frm_type;
2718 p->ie_len = ie_len;
2719 memcpy(p->ie_info, ie, ie_len);
2720 return ath6kl_wmi_cmd_send(wmi, skb, WMI_SET_APPIE_CMDID,
2721 NO_SYNC_WMIFLAG);
2722}
2723
6465ddcf
JM		 2724int ath6kl_wmi_disable_11b_rates_cmd(struct wmi *wmi, bool disable)
2725{
2726 struct sk_buff *skb;
2727 struct wmi_disable_11b_rates_cmd *cmd;
2728
2729 skb = ath6kl_wmi_get_new_buf(sizeof(*cmd));
2730 if (!skb)
2731 return -ENOMEM;
2732
2733 ath6kl_dbg(ATH6KL_DBG_WMI, "disable_11b_rates_cmd: disable=%u\n",
2734 disable);
2735 cmd = (struct wmi_disable_11b_rates_cmd *) skb->data;
2736 cmd->disable = disable ? 1 : 0;
2737
2738 return ath6kl_wmi_cmd_send(wmi, skb, WMI_DISABLE_11B_RATES_CMDID,
2739 NO_SYNC_WMIFLAG);
2740}
2741
2742int ath6kl_wmi_remain_on_chnl_cmd(struct wmi *wmi, u32 freq, u32 dur)
2743{
2744 struct sk_buff *skb;
2745 struct wmi_remain_on_chnl_cmd *p;
2746
2747 skb = ath6kl_wmi_get_new_buf(sizeof(*p));
2748 if (!skb)
2749 return -ENOMEM;
2750
2751 ath6kl_dbg(ATH6KL_DBG_WMI, "remain_on_chnl_cmd: freq=%u dur=%u\n",
2752 freq, dur);
2753 p = (struct wmi_remain_on_chnl_cmd *) skb->data;
2754 p->freq = cpu_to_le32(freq);
2755 p->duration = cpu_to_le32(dur);
2756 return ath6kl_wmi_cmd_send(wmi, skb, WMI_REMAIN_ON_CHNL_CMDID,
2757 NO_SYNC_WMIFLAG);
2758}
2759
2760int ath6kl_wmi_send_action_cmd(struct wmi *wmi, u32 id, u32 freq, u32 wait,
2761 const u8 *data, u16 data_len)
2762{
2763 struct sk_buff *skb;
2764 struct wmi_send_action_cmd *p;
a0df5db1 2765 u8 *buf;
6465ddcf
JM		 2766
2767 if (wait)
2768 return -EINVAL; /* Offload for wait not supported */
2769
a0df5db1
JM		 2770 buf = kmalloc(data_len, GFP_KERNEL);
2771 if (!buf)
2772 return -ENOMEM;
2773
6465ddcf 2774 skb = ath6kl_wmi_get_new_buf(sizeof(*p) + data_len);
a0df5db1
JM		 2775 if (!skb) {
2776 kfree(buf);
6465ddcf 2777 return -ENOMEM;
a0df5db1
JM		 2778 }
2779
2780 kfree(wmi->last_mgmt_tx_frame);
2781 wmi->last_mgmt_tx_frame = buf;
2782 wmi->last_mgmt_tx_frame_len = data_len;
6465ddcf
JM		 2783
2784 ath6kl_dbg(ATH6KL_DBG_WMI, "send_action_cmd: id=%u freq=%u wait=%u "
2785 "len=%u\n", id, freq, wait, data_len);
2786 p = (struct wmi_send_action_cmd *) skb->data;
2787 p->id = cpu_to_le32(id);
2788 p->freq = cpu_to_le32(freq);
2789 p->wait = cpu_to_le32(wait);
2790 p->len = cpu_to_le16(data_len);
2791 memcpy(p->data, data, data_len);
2792 return ath6kl_wmi_cmd_send(wmi, skb, WMI_SEND_ACTION_CMDID,
2793 NO_SYNC_WMIFLAG);
2794}
2795
2796int ath6kl_wmi_send_probe_response_cmd(struct wmi *wmi, u32 freq,
2797 const u8 *dst,
2798 const u8 *data, u16 data_len)
2799{
2800 struct sk_buff *skb;
2801 struct wmi_p2p_probe_response_cmd *p;
2802
2803 skb = ath6kl_wmi_get_new_buf(sizeof(*p) + data_len);
2804 if (!skb)
2805 return -ENOMEM;
2806
2807 ath6kl_dbg(ATH6KL_DBG_WMI, "send_probe_response_cmd: freq=%u dst=%pM "
2808 "len=%u\n", freq, dst, data_len);
2809 p = (struct wmi_p2p_probe_response_cmd *) skb->data;
2810 p->freq = cpu_to_le32(freq);
2811 memcpy(p->destination_addr, dst, ETH_ALEN);
2812 p->len = cpu_to_le16(data_len);
2813 memcpy(p->data, data, data_len);
2814 return ath6kl_wmi_cmd_send(wmi, skb, WMI_SEND_PROBE_RESPONSE_CMDID,
2815 NO_SYNC_WMIFLAG);
2816}
2817
2818int ath6kl_wmi_probe_report_req_cmd(struct wmi *wmi, bool enable)
2819{
2820 struct sk_buff *skb;
2821 struct wmi_probe_req_report_cmd *p;
2822
2823 skb = ath6kl_wmi_get_new_buf(sizeof(*p));
2824 if (!skb)
2825 return -ENOMEM;
2826
2827 ath6kl_dbg(ATH6KL_DBG_WMI, "probe_report_req_cmd: enable=%u\n",
2828 enable);
2829 p = (struct wmi_probe_req_report_cmd *) skb->data;
2830 p->enable = enable ? 1 : 0;
2831 return ath6kl_wmi_cmd_send(wmi, skb, WMI_PROBE_REQ_REPORT_CMDID,
2832 NO_SYNC_WMIFLAG);
2833}
2834
2835int ath6kl_wmi_info_req_cmd(struct wmi *wmi, u32 info_req_flags)
2836{
2837 struct sk_buff *skb;
2838 struct wmi_get_p2p_info *p;
2839
2840 skb = ath6kl_wmi_get_new_buf(sizeof(*p));
2841 if (!skb)
2842 return -ENOMEM;
2843
2844 ath6kl_dbg(ATH6KL_DBG_WMI, "info_req_cmd: flags=%x\n",
2845 info_req_flags);
2846 p = (struct wmi_get_p2p_info *) skb->data;
2847 p->info_req_flags = cpu_to_le32(info_req_flags);
2848 return ath6kl_wmi_cmd_send(wmi, skb, WMI_GET_P2P_INFO_CMDID,
2849 NO_SYNC_WMIFLAG);
2850}
2851
2852int ath6kl_wmi_cancel_remain_on_chnl_cmd(struct wmi *wmi)
2853{
2854 ath6kl_dbg(ATH6KL_DBG_WMI, "cancel_remain_on_chnl_cmd\n");
2855 return ath6kl_wmi_simple_cmd(wmi, WMI_CANCEL_REMAIN_ON_CHNL_CMDID);
2856}
2857
bdcd8170
KV		 2858static int ath6kl_wmi_control_rx_xtnd(struct wmi *wmi, struct sk_buff *skb)
2859{
2860 struct wmix_cmd_hdr *cmd;
2861 u32 len;
2862 u16 id;
2863 u8 *datap;
2864 int ret = 0;
2865
2866 if (skb->len < sizeof(struct wmix_cmd_hdr)) {
2867 ath6kl_err("bad packet 1\n");
bdcd8170
KV		 2868 return -EINVAL;
2869 }
2870
2871 cmd = (struct wmix_cmd_hdr *) skb->data;
2872 id = le32_to_cpu(cmd->cmd_id);
2873
2874 skb_pull(skb, sizeof(struct wmix_cmd_hdr));
2875
2876 datap = skb->data;
2877 len = skb->len;
2878
2879 switch (id) {
2880 case WMIX_HB_CHALLENGE_RESP_EVENTID:
b9b6ee60 2881 ath6kl_dbg(ATH6KL_DBG_WMI, "wmi event hb challenge resp\n");
bdcd8170
KV		 2882 break;
2883 case WMIX_DBGLOG_EVENTID:
b9b6ee60 2884 ath6kl_dbg(ATH6KL_DBG_WMI, "wmi event dbglog len %d\n", len);
bdf5396b 2885 ath6kl_debug_fwlog_event(wmi->parent_dev, datap, len);
bdcd8170
KV		 2886 break;
2887 default:
b9b6ee60 2888 ath6kl_warn("unknown cmd id 0x%x\n", id);
bdcd8170
KV		 2889 ret = -EINVAL;
2890 break;
2891 }
2892
2893 return ret;
2894}
2895
4b28a80d
JM		 2896static int ath6kl_wmi_roam_tbl_event_rx(struct wmi *wmi, u8 *datap, int len)
2897{
2898 return ath6kl_debug_roam_tbl_event(wmi->parent_dev, datap, len);
2899}
2900
bdcd8170
KV		 2901/* Control Path */
2902int ath6kl_wmi_control_rx(struct wmi *wmi, struct sk_buff *skb)
2903{
2904 struct wmi_cmd_hdr *cmd;
2905 u32 len;
2906 u16 id;
2907 u8 *datap;
2908 int ret = 0;
2909
2910 if (WARN_ON(skb == NULL))
2911 return -EINVAL;
2912
2913 if (skb->len < sizeof(struct wmi_cmd_hdr)) {
2914 ath6kl_err("bad packet 1\n");
2915 dev_kfree_skb(skb);
bdcd8170
KV		 2916 return -EINVAL;
2917 }
2918
2919 cmd = (struct wmi_cmd_hdr *) skb->data;
2920 id = le16_to_cpu(cmd->cmd_id);
2921
2922 skb_pull(skb, sizeof(struct wmi_cmd_hdr));
2923
2924 datap = skb->data;
2925 len = skb->len;
2926
b9b6ee60
KV		 2927 ath6kl_dbg(ATH6KL_DBG_WMI, "wmi rx id %d len %d\n", id, len);
2928 ath6kl_dbg_dump(ATH6KL_DBG_WMI_DUMP, NULL, "wmi rx ",
ef094103 2929 datap, len);
bdcd8170
KV		 2930
2931 switch (id) {
2932 case WMI_GET_BITRATE_CMDID:
2933 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_GET_BITRATE_CMDID\n");
2934 ret = ath6kl_wmi_bitrate_reply_rx(wmi, datap, len);
2935 break;
2936 case WMI_GET_CHANNEL_LIST_CMDID:
2937 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_GET_CHANNEL_LIST_CMDID\n");
2938 ret = ath6kl_wmi_ch_list_reply_rx(wmi, datap, len);
2939 break;
2940 case WMI_GET_TX_PWR_CMDID:
2941 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_GET_TX_PWR_CMDID\n");
2942 ret = ath6kl_wmi_tx_pwr_reply_rx(wmi, datap, len);
2943 break;
2944 case WMI_READY_EVENTID:
2945 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_READY_EVENTID\n");
2946 ret = ath6kl_wmi_ready_event_rx(wmi, datap, len);
2947 break;
2948 case WMI_CONNECT_EVENTID:
2949 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_CONNECT_EVENTID\n");
2950 ret = ath6kl_wmi_connect_event_rx(wmi, datap, len);
2951 break;
2952 case WMI_DISCONNECT_EVENTID:
2953 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_DISCONNECT_EVENTID\n");
2954 ret = ath6kl_wmi_disconnect_event_rx(wmi, datap, len);
2955 break;
2956 case WMI_PEER_NODE_EVENTID:
2957 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_PEER_NODE_EVENTID\n");
2958 ret = ath6kl_wmi_peer_node_event_rx(wmi, datap, len);
2959 break;
2960 case WMI_TKIP_MICERR_EVENTID:
2961 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_TKIP_MICERR_EVENTID\n");
2962 ret = ath6kl_wmi_tkip_micerr_event_rx(wmi, datap, len);
2963 break;
2964 case WMI_BSSINFO_EVENTID:
2965 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_BSSINFO_EVENTID\n");
82e14f56 2966 ret = ath6kl_wmi_bssinfo_event_rx(wmi, datap, len);
bdcd8170
KV		 2967 break;
2968 case WMI_REGDOMAIN_EVENTID:
2969 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_REGDOMAIN_EVENTID\n");
06033760 2970 ath6kl_wmi_regdomain_event(wmi, datap, len);
bdcd8170
KV		 2971 break;
2972 case WMI_PSTREAM_TIMEOUT_EVENTID:
2973 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_PSTREAM_TIMEOUT_EVENTID\n");
2974 ret = ath6kl_wmi_pstream_timeout_event_rx(wmi, datap, len);
2975 break;
2976 case WMI_NEIGHBOR_REPORT_EVENTID:
2977 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_NEIGHBOR_REPORT_EVENTID\n");
86512136 2978 ret = ath6kl_wmi_neighbor_report_event_rx(wmi, datap, len);
bdcd8170
KV		 2979 break;
2980 case WMI_SCAN_COMPLETE_EVENTID:
2981 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_SCAN_COMPLETE_EVENTID\n");
2982 ret = ath6kl_wmi_scan_complete_rx(wmi, datap, len);
2983 break;
2984 case WMI_CMDERROR_EVENTID:
2985 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_CMDERROR_EVENTID\n");
2986 ret = ath6kl_wmi_error_event_rx(wmi, datap, len);
2987 break;
2988 case WMI_REPORT_STATISTICS_EVENTID:
2989 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_REPORT_STATISTICS_EVENTID\n");
2990 ret = ath6kl_wmi_stats_event_rx(wmi, datap, len);
2991 break;
2992 case WMI_RSSI_THRESHOLD_EVENTID:
2993 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_RSSI_THRESHOLD_EVENTID\n");
2994 ret = ath6kl_wmi_rssi_threshold_event_rx(wmi, datap, len);
2995 break;
2996 case WMI_ERROR_REPORT_EVENTID:
2997 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_ERROR_REPORT_EVENTID\n");
2998 break;
2999 case WMI_OPT_RX_FRAME_EVENTID:
3000 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_OPT_RX_FRAME_EVENTID\n");
f195d507 3001 /* this event has been deprecated */
bdcd8170
KV		 3002 break;
3003 case WMI_REPORT_ROAM_TBL_EVENTID:
3004 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_REPORT_ROAM_TBL_EVENTID\n");
4b28a80d 3005 ret = ath6kl_wmi_roam_tbl_event_rx(wmi, datap, len);
bdcd8170
KV		 3006 break;
3007 case WMI_EXTENSION_EVENTID:
3008 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_EXTENSION_EVENTID\n");
3009 ret = ath6kl_wmi_control_rx_xtnd(wmi, skb);
3010 break;
3011 case WMI_CAC_EVENTID:
3012 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_CAC_EVENTID\n");
3013 ret = ath6kl_wmi_cac_event_rx(wmi, datap, len);
3014 break;
3015 case WMI_CHANNEL_CHANGE_EVENTID:
3016 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_CHANNEL_CHANGE_EVENTID\n");
3017 break;
3018 case WMI_REPORT_ROAM_DATA_EVENTID:
3019 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_REPORT_ROAM_DATA_EVENTID\n");
3020 break;
003353b0
KV		 3021 case WMI_TEST_EVENTID:
3022 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_TEST_EVENTID\n");
3023 ret = ath6kl_wmi_tcmd_test_report_rx(wmi, datap, len);
3024 break;
bdcd8170
KV		 3025 case WMI_GET_FIXRATES_CMDID:
3026 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_GET_FIXRATES_CMDID\n");
3027 ret = ath6kl_wmi_ratemask_reply_rx(wmi, datap, len);
3028 break;
3029 case WMI_TX_RETRY_ERR_EVENTID:
3030 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_TX_RETRY_ERR_EVENTID\n");
3031 break;
3032 case WMI_SNR_THRESHOLD_EVENTID:
3033 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_SNR_THRESHOLD_EVENTID\n");
3034 ret = ath6kl_wmi_snr_threshold_event_rx(wmi, datap, len);
3035 break;
3036 case WMI_LQ_THRESHOLD_EVENTID:
3037 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_LQ_THRESHOLD_EVENTID\n");
3038 break;
3039 case WMI_APLIST_EVENTID:
3040 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_APLIST_EVENTID\n");
3041 ret = ath6kl_wmi_aplist_event_rx(wmi, datap, len);
3042 break;
3043 case WMI_GET_KEEPALIVE_CMDID:
3044 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_GET_KEEPALIVE_CMDID\n");
3045 ret = ath6kl_wmi_keepalive_reply_rx(wmi, datap, len);
3046 break;
3047 case WMI_GET_WOW_LIST_EVENTID:
3048 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_GET_WOW_LIST_EVENTID\n");
3049 ret = ath6kl_wmi_get_wow_list_event_rx(wmi, datap, len);
3050 break;
3051 case WMI_GET_PMKID_LIST_EVENTID:
3052 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_GET_PMKID_LIST_EVENTID\n");
3053 ret = ath6kl_wmi_get_pmkid_list_event_rx(wmi, datap, len);
3054 break;
3055 case WMI_PSPOLL_EVENTID:
3056 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_PSPOLL_EVENTID\n");
3057 ret = ath6kl_wmi_pspoll_event_rx(wmi, datap, len);
3058 break;
3059 case WMI_DTIMEXPIRY_EVENTID:
3060 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_DTIMEXPIRY_EVENTID\n");
3061 ret = ath6kl_wmi_dtimexpiry_event_rx(wmi, datap, len);
3062 break;
3063 case WMI_SET_PARAMS_REPLY_EVENTID:
3064 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_SET_PARAMS_REPLY_EVENTID\n");
3065 break;
3066 case WMI_ADDBA_REQ_EVENTID:
3067 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_ADDBA_REQ_EVENTID\n");
3068 ret = ath6kl_wmi_addba_req_event_rx(wmi, datap, len);
3069 break;
3070 case WMI_ADDBA_RESP_EVENTID:
3071 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_ADDBA_RESP_EVENTID\n");
3072 break;
3073 case WMI_DELBA_REQ_EVENTID:
3074 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_DELBA_REQ_EVENTID\n");
3075 ret = ath6kl_wmi_delba_req_event_rx(wmi, datap, len);
3076 break;
3077 case WMI_REPORT_BTCOEX_CONFIG_EVENTID:
3078 ath6kl_dbg(ATH6KL_DBG_WMI,
3079 "WMI_REPORT_BTCOEX_CONFIG_EVENTID\n");
3080 break;
3081 case WMI_REPORT_BTCOEX_STATS_EVENTID:
3082 ath6kl_dbg(ATH6KL_DBG_WMI,
3083 "WMI_REPORT_BTCOEX_STATS_EVENTID\n");
3084 break;
3085 case WMI_TX_COMPLETE_EVENTID:
3086 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_TX_COMPLETE_EVENTID\n");
3087 ret = ath6kl_wmi_tx_complete_event_rx(datap, len);
3088 break;
6465ddcf
JM		 3089 case WMI_REMAIN_ON_CHNL_EVENTID:
3090 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_REMAIN_ON_CHNL_EVENTID\n");
f9e5f05c 3091 ret = ath6kl_wmi_remain_on_chnl_event_rx(wmi, datap, len);
6465ddcf
JM		 3092 break;
3093 case WMI_CANCEL_REMAIN_ON_CHNL_EVENTID:
3094 ath6kl_dbg(ATH6KL_DBG_WMI,
3095 "WMI_CANCEL_REMAIN_ON_CHNL_EVENTID\n");
f9e5f05c
JM		 3096 ret = ath6kl_wmi_cancel_remain_on_chnl_event_rx(wmi, datap,
3097 len);
6465ddcf
JM		 3098 break;
3099 case WMI_TX_STATUS_EVENTID:
3100 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_TX_STATUS_EVENTID\n");
a0df5db1 3101 ret = ath6kl_wmi_tx_status_event_rx(wmi, datap, len);
6465ddcf
JM		 3102 break;
3103 case WMI_RX_PROBE_REQ_EVENTID:
3104 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_RX_PROBE_REQ_EVENTID\n");
ae32c30a 3105 ret = ath6kl_wmi_rx_probe_req_event_rx(wmi, datap, len);
6465ddcf
JM		 3106 break;
3107 case WMI_P2P_CAPABILITIES_EVENTID:
3108 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_P2P_CAPABILITIES_EVENTID\n");
3109 ret = ath6kl_wmi_p2p_capabilities_event_rx(datap, len);
3110 break;
3111 case WMI_RX_ACTION_EVENTID:
3112 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_RX_ACTION_EVENTID\n");
9809d8ef 3113 ret = ath6kl_wmi_rx_action_event_rx(wmi, datap, len);
6465ddcf
JM		 3114 break;
3115 case WMI_P2P_INFO_EVENTID:
3116 ath6kl_dbg(ATH6KL_DBG_WMI, "WMI_P2P_INFO_EVENTID\n");
3117 ret = ath6kl_wmi_p2p_info_event_rx(datap, len);
3118 break;
bdcd8170
KV		 3119 default:
3120 ath6kl_dbg(ATH6KL_DBG_WMI, "unknown cmd id 0x%x\n", id);
bdcd8170
KV		 3121 ret = -EINVAL;
3122 break;
3123 }
3124
3125 dev_kfree_skb(skb);
3126
3127 return ret;
3128}
3129
3130static void ath6kl_wmi_qos_state_init(struct wmi *wmi)
3131{
3132 if (!wmi)
3133 return;
3134
3135 spin_lock_bh(&wmi->lock);
3136
3137 wmi->fat_pipe_exist = 0;
3138 memset(wmi->stream_exist_for_ac, 0, sizeof(wmi->stream_exist_for_ac));
3139
3140 spin_unlock_bh(&wmi->lock);
3141}
3142
2865785e 3143void *ath6kl_wmi_init(struct ath6kl *dev)
bdcd8170
KV		 3144{
3145 struct wmi *wmi;
3146
3147 wmi = kzalloc(sizeof(struct wmi), GFP_KERNEL);
3148 if (!wmi)
3149 return NULL;
3150
3151 spin_lock_init(&wmi->lock);
3152
3153 wmi->parent_dev = dev;
3154
bdcd8170 3155 wmi->pwr_mode = REC_POWER;
bdcd8170 3156
a7f0c58b 3157 ath6kl_wmi_qos_state_init(wmi);
bdcd8170
KV		 3158
3159 return wmi;
3160}
3161
3162void ath6kl_wmi_shutdown(struct wmi *wmi)
3163{
3164 if (!wmi)
3165 return;
3166
a0df5db1 3167 kfree(wmi->last_mgmt_tx_frame);
bdcd8170
KV		 3168 kfree(wmi);
3169}
Linux kernel - Deliverables
This page took 0.225302 seconds and 5 git commands to generate.