2 * Copyright (c) 2004-2011 Atheros Communications Inc.
3 * Copyright (c) 2011-2012 Qualcomm Atheros, Inc.
5 * Permission to use, copy, modify, and/or distribute this software for any
6 * purpose with or without fee is hereby granted, provided that the above
7 * copyright notice and this permission notice appear in all copies.
9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
23 #include "../regd_common.h"
25 static int ath6kl_wmi_sync_point(struct wmi
*wmi
, u8 if_idx
);
27 static const s32 wmi_rate_tbl
[][2] = {
28 /* {W/O SGI, with SGI} */
60 /* 802.1d to AC mapping. Refer pg 57 of WMM-test-plan-v1.2 */
61 static const u8 up_to_ac
[] = {
72 void ath6kl_wmi_set_control_ep(struct wmi
*wmi
, enum htc_endpoint_id ep_id
)
74 if (WARN_ON(ep_id
== ENDPOINT_UNUSED
|| ep_id
>= ENDPOINT_MAX
))
80 enum htc_endpoint_id
ath6kl_wmi_get_control_ep(struct wmi
*wmi
)
85 struct ath6kl_vif
*ath6kl_get_vif_by_index(struct ath6kl
*ar
, u8 if_idx
)
87 struct ath6kl_vif
*vif
, *found
= NULL
;
89 if (WARN_ON(if_idx
> (ar
->vif_max
- 1)))
93 spin_lock_bh(&ar
->list_lock
);
94 list_for_each_entry(vif
, &ar
->vif_list
, list
) {
95 if (vif
->fw_vif_idx
== if_idx
) {
100 spin_unlock_bh(&ar
->list_lock
);
105 /* Performs DIX to 802.3 encapsulation for transmit packets.
106 * Assumes the entire DIX header is contigous and that there is
107 * enough room in the buffer for a 802.3 mac header and LLC+SNAP headers.
109 int ath6kl_wmi_dix_2_dot3(struct wmi
*wmi
, struct sk_buff
*skb
)
111 struct ath6kl_llc_snap_hdr
*llc_hdr
;
112 struct ethhdr
*eth_hdr
;
118 if (WARN_ON(skb
== NULL
))
121 size
= sizeof(struct ath6kl_llc_snap_hdr
) + sizeof(struct wmi_data_hdr
);
122 if (skb_headroom(skb
) < size
)
125 eth_hdr
= (struct ethhdr
*) skb
->data
;
126 type
= eth_hdr
->h_proto
;
128 if (!is_ethertype(be16_to_cpu(type
))) {
129 ath6kl_dbg(ATH6KL_DBG_WMI
,
130 "%s: pkt is already in 802.3 format\n", __func__
);
134 new_len
= skb
->len
- sizeof(*eth_hdr
) + sizeof(*llc_hdr
);
136 skb_push(skb
, sizeof(struct ath6kl_llc_snap_hdr
));
139 eth_hdr
->h_proto
= cpu_to_be16(new_len
);
141 memcpy(datap
, eth_hdr
, sizeof(*eth_hdr
));
143 llc_hdr
= (struct ath6kl_llc_snap_hdr
*)(datap
+ sizeof(*eth_hdr
));
144 llc_hdr
->dsap
= 0xAA;
145 llc_hdr
->ssap
= 0xAA;
146 llc_hdr
->cntl
= 0x03;
147 llc_hdr
->org_code
[0] = 0x0;
148 llc_hdr
->org_code
[1] = 0x0;
149 llc_hdr
->org_code
[2] = 0x0;
150 llc_hdr
->eth_type
= type
;
155 static int ath6kl_wmi_meta_add(struct wmi
*wmi
, struct sk_buff
*skb
,
156 u8
*version
, void *tx_meta_info
)
158 struct wmi_tx_meta_v1
*v1
;
159 struct wmi_tx_meta_v2
*v2
;
161 if (WARN_ON(skb
== NULL
|| version
== NULL
))
165 case WMI_META_VERSION_1
:
166 skb_push(skb
, WMI_MAX_TX_META_SZ
);
167 v1
= (struct wmi_tx_meta_v1
*) skb
->data
;
169 v1
->rate_plcy_id
= 0;
170 *version
= WMI_META_VERSION_1
;
172 case WMI_META_VERSION_2
:
173 skb_push(skb
, WMI_MAX_TX_META_SZ
);
174 v2
= (struct wmi_tx_meta_v2
*) skb
->data
;
175 memcpy(v2
, (struct wmi_tx_meta_v2
*) tx_meta_info
,
176 sizeof(struct wmi_tx_meta_v2
));
183 int ath6kl_wmi_data_hdr_add(struct wmi
*wmi
, struct sk_buff
*skb
,
184 u8 msg_type
, u32 flags
,
185 enum wmi_data_hdr_data_type data_type
,
186 u8 meta_ver
, void *tx_meta_info
, u8 if_idx
)
188 struct wmi_data_hdr
*data_hdr
;
191 if (WARN_ON(skb
== NULL
|| (if_idx
> wmi
->parent_dev
->vif_max
- 1)))
195 ret
= ath6kl_wmi_meta_add(wmi
, skb
, &meta_ver
, tx_meta_info
);
200 skb_push(skb
, sizeof(struct wmi_data_hdr
));
202 data_hdr
= (struct wmi_data_hdr
*)skb
->data
;
203 memset(data_hdr
, 0, sizeof(struct wmi_data_hdr
));
205 data_hdr
->info
= msg_type
<< WMI_DATA_HDR_MSG_TYPE_SHIFT
;
206 data_hdr
->info
|= data_type
<< WMI_DATA_HDR_DATA_TYPE_SHIFT
;
208 if (flags
& WMI_DATA_HDR_FLAGS_MORE
)
209 data_hdr
->info
|= WMI_DATA_HDR_MORE
;
211 if (flags
& WMI_DATA_HDR_FLAGS_EOSP
)
212 data_hdr
->info3
|= cpu_to_le16(WMI_DATA_HDR_EOSP
);
214 data_hdr
->info2
|= cpu_to_le16(meta_ver
<< WMI_DATA_HDR_META_SHIFT
);
215 data_hdr
->info3
|= cpu_to_le16(if_idx
& WMI_DATA_HDR_IF_IDX_MASK
);
220 u8
ath6kl_wmi_determine_user_priority(u8
*pkt
, u32 layer2_pri
)
222 struct iphdr
*ip_hdr
= (struct iphdr
*) pkt
;
226 * Determine IPTOS priority
229 * : DSCP(6-bits) ECN(2-bits)
230 * : DSCP - P2 P1 P0 X X X
231 * where (P2 P1 P0) form 802.1D
233 ip_pri
= ip_hdr
->tos
>> 5;
236 if ((layer2_pri
& 0x7) > ip_pri
)
237 return (u8
) layer2_pri
& 0x7;
242 u8
ath6kl_wmi_get_traffic_class(u8 user_priority
)
244 return up_to_ac
[user_priority
& 0x7];
247 int ath6kl_wmi_implicit_create_pstream(struct wmi
*wmi
, u8 if_idx
,
249 u32 layer2_priority
, bool wmm_enabled
,
252 struct wmi_data_hdr
*data_hdr
;
253 struct ath6kl_llc_snap_hdr
*llc_hdr
;
254 struct wmi_create_pstream_cmd cmd
;
255 u32 meta_size
, hdr_size
;
256 u16 ip_type
= IP_ETHERTYPE
;
257 u8 stream_exist
, usr_pri
;
258 u8 traffic_class
= WMM_AC_BE
;
261 if (WARN_ON(skb
== NULL
))
265 data_hdr
= (struct wmi_data_hdr
*) datap
;
267 meta_size
= ((le16_to_cpu(data_hdr
->info2
) >> WMI_DATA_HDR_META_SHIFT
) &
268 WMI_DATA_HDR_META_MASK
) ? WMI_MAX_TX_META_SZ
: 0;
271 /* If WMM is disabled all traffic goes as BE traffic */
274 hdr_size
= sizeof(struct ethhdr
);
276 llc_hdr
= (struct ath6kl_llc_snap_hdr
*)(datap
+
279 meta_size
+ hdr_size
);
281 if (llc_hdr
->eth_type
== htons(ip_type
)) {
283 * Extract the endpoint info from the TOS field
287 ath6kl_wmi_determine_user_priority(((u8
*) llc_hdr
) +
288 sizeof(struct ath6kl_llc_snap_hdr
),
291 usr_pri
= layer2_priority
& 0x7;
295 * workaround for WMM S5
297 * FIXME: wmi->traffic_class is always 100 so this test doesn't
300 if ((wmi
->traffic_class
== WMM_AC_VI
) &&
301 ((usr_pri
== 5) || (usr_pri
== 4)))
304 /* Convert user priority to traffic class */
305 traffic_class
= up_to_ac
[usr_pri
& 0x7];
307 wmi_data_hdr_set_up(data_hdr
, usr_pri
);
309 spin_lock_bh(&wmi
->lock
);
310 stream_exist
= wmi
->fat_pipe_exist
;
311 spin_unlock_bh(&wmi
->lock
);
313 if (!(stream_exist
& (1 << traffic_class
))) {
314 memset(&cmd
, 0, sizeof(cmd
));
315 cmd
.traffic_class
= traffic_class
;
316 cmd
.user_pri
= usr_pri
;
318 cpu_to_le32(WMI_IMPLICIT_PSTREAM_INACTIVITY_INT
);
319 /* Implicit streams are created with TSID 0xFF */
320 cmd
.tsid
= WMI_IMPLICIT_PSTREAM
;
321 ath6kl_wmi_create_pstream_cmd(wmi
, if_idx
, &cmd
);
329 int ath6kl_wmi_dot11_hdr_remove(struct wmi
*wmi
, struct sk_buff
*skb
)
331 struct ieee80211_hdr_3addr
*pwh
, wh
;
332 struct ath6kl_llc_snap_hdr
*llc_hdr
;
333 struct ethhdr eth_hdr
;
338 if (WARN_ON(skb
== NULL
))
342 pwh
= (struct ieee80211_hdr_3addr
*) datap
;
344 sub_type
= pwh
->frame_control
& cpu_to_le16(IEEE80211_FCTL_STYPE
);
346 memcpy((u8
*) &wh
, datap
, sizeof(struct ieee80211_hdr_3addr
));
348 /* Strip off the 802.11 header */
349 if (sub_type
== cpu_to_le16(IEEE80211_STYPE_QOS_DATA
)) {
350 hdr_size
= roundup(sizeof(struct ieee80211_qos_hdr
),
352 skb_pull(skb
, hdr_size
);
353 } else if (sub_type
== cpu_to_le16(IEEE80211_STYPE_DATA
))
354 skb_pull(skb
, sizeof(struct ieee80211_hdr_3addr
));
357 llc_hdr
= (struct ath6kl_llc_snap_hdr
*)(datap
);
359 memset(ð_hdr
, 0, sizeof(eth_hdr
));
360 eth_hdr
.h_proto
= llc_hdr
->eth_type
;
362 switch ((le16_to_cpu(wh
.frame_control
)) &
363 (IEEE80211_FCTL_FROMDS
| IEEE80211_FCTL_TODS
)) {
365 memcpy(eth_hdr
.h_dest
, wh
.addr1
, ETH_ALEN
);
366 memcpy(eth_hdr
.h_source
, wh
.addr2
, ETH_ALEN
);
368 case IEEE80211_FCTL_TODS
:
369 memcpy(eth_hdr
.h_dest
, wh
.addr3
, ETH_ALEN
);
370 memcpy(eth_hdr
.h_source
, wh
.addr2
, ETH_ALEN
);
372 case IEEE80211_FCTL_FROMDS
:
373 memcpy(eth_hdr
.h_dest
, wh
.addr1
, ETH_ALEN
);
374 memcpy(eth_hdr
.h_source
, wh
.addr3
, ETH_ALEN
);
376 case IEEE80211_FCTL_FROMDS
| IEEE80211_FCTL_TODS
:
380 skb_pull(skb
, sizeof(struct ath6kl_llc_snap_hdr
));
381 skb_push(skb
, sizeof(eth_hdr
));
385 memcpy(datap
, ð_hdr
, sizeof(eth_hdr
));
391 * Performs 802.3 to DIX encapsulation for received packets.
392 * Assumes the entire 802.3 header is contigous.
394 int ath6kl_wmi_dot3_2_dix(struct sk_buff
*skb
)
396 struct ath6kl_llc_snap_hdr
*llc_hdr
;
397 struct ethhdr eth_hdr
;
400 if (WARN_ON(skb
== NULL
))
405 memcpy(ð_hdr
, datap
, sizeof(eth_hdr
));
407 llc_hdr
= (struct ath6kl_llc_snap_hdr
*) (datap
+ sizeof(eth_hdr
));
408 eth_hdr
.h_proto
= llc_hdr
->eth_type
;
410 skb_pull(skb
, sizeof(struct ath6kl_llc_snap_hdr
));
413 memcpy(datap
, ð_hdr
, sizeof(eth_hdr
));
418 static int ath6kl_wmi_tx_complete_event_rx(u8
*datap
, int len
)
420 struct tx_complete_msg_v1
*msg_v1
;
421 struct wmi_tx_complete_event
*evt
;
425 evt
= (struct wmi_tx_complete_event
*) datap
;
427 ath6kl_dbg(ATH6KL_DBG_WMI
, "comp: %d %d %d\n",
428 evt
->num_msg
, evt
->msg_len
, evt
->msg_type
);
430 for (index
= 0; index
< evt
->num_msg
; index
++) {
431 size
= sizeof(struct wmi_tx_complete_event
) +
432 (index
* sizeof(struct tx_complete_msg_v1
));
433 msg_v1
= (struct tx_complete_msg_v1
*)(datap
+ size
);
435 ath6kl_dbg(ATH6KL_DBG_WMI
, "msg: %d %d %d %d\n",
436 msg_v1
->status
, msg_v1
->pkt_id
,
437 msg_v1
->rate_idx
, msg_v1
->ack_failures
);
443 static int ath6kl_wmi_remain_on_chnl_event_rx(struct wmi
*wmi
, u8
*datap
,
444 int len
, struct ath6kl_vif
*vif
)
446 struct wmi_remain_on_chnl_event
*ev
;
449 struct ieee80211_channel
*chan
;
450 struct ath6kl
*ar
= wmi
->parent_dev
;
453 if (len
< sizeof(*ev
))
456 ev
= (struct wmi_remain_on_chnl_event
*) datap
;
457 freq
= le32_to_cpu(ev
->freq
);
458 dur
= le32_to_cpu(ev
->duration
);
459 ath6kl_dbg(ATH6KL_DBG_WMI
, "remain_on_chnl: freq=%u dur=%u\n",
461 chan
= ieee80211_get_channel(ar
->wiphy
, freq
);
463 ath6kl_dbg(ATH6KL_DBG_WMI
, "remain_on_chnl: Unknown channel "
464 "(freq=%u)\n", freq
);
467 id
= vif
->last_roc_id
;
468 cfg80211_ready_on_channel(vif
->ndev
, id
, chan
, NL80211_CHAN_NO_HT
,
474 static int ath6kl_wmi_cancel_remain_on_chnl_event_rx(struct wmi
*wmi
,
476 struct ath6kl_vif
*vif
)
478 struct wmi_cancel_remain_on_chnl_event
*ev
;
481 struct ieee80211_channel
*chan
;
482 struct ath6kl
*ar
= wmi
->parent_dev
;
485 if (len
< sizeof(*ev
))
488 ev
= (struct wmi_cancel_remain_on_chnl_event
*) datap
;
489 freq
= le32_to_cpu(ev
->freq
);
490 dur
= le32_to_cpu(ev
->duration
);
491 ath6kl_dbg(ATH6KL_DBG_WMI
, "cancel_remain_on_chnl: freq=%u dur=%u "
492 "status=%u\n", freq
, dur
, ev
->status
);
493 chan
= ieee80211_get_channel(ar
->wiphy
, freq
);
495 ath6kl_dbg(ATH6KL_DBG_WMI
, "cancel_remain_on_chnl: Unknown "
496 "channel (freq=%u)\n", freq
);
499 if (vif
->last_cancel_roc_id
&&
500 vif
->last_cancel_roc_id
+ 1 == vif
->last_roc_id
)
501 id
= vif
->last_cancel_roc_id
; /* event for cancel command */
503 id
= vif
->last_roc_id
; /* timeout on uncanceled r-o-c */
504 vif
->last_cancel_roc_id
= 0;
505 cfg80211_remain_on_channel_expired(vif
->ndev
, id
, chan
,
506 NL80211_CHAN_NO_HT
, GFP_ATOMIC
);
511 static int ath6kl_wmi_tx_status_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
512 struct ath6kl_vif
*vif
)
514 struct wmi_tx_status_event
*ev
;
517 if (len
< sizeof(*ev
))
520 ev
= (struct wmi_tx_status_event
*) datap
;
521 id
= le32_to_cpu(ev
->id
);
522 ath6kl_dbg(ATH6KL_DBG_WMI
, "tx_status: id=%x ack_status=%u\n",
524 if (wmi
->last_mgmt_tx_frame
) {
525 cfg80211_mgmt_tx_status(vif
->ndev
, id
,
526 wmi
->last_mgmt_tx_frame
,
527 wmi
->last_mgmt_tx_frame_len
,
528 !!ev
->ack_status
, GFP_ATOMIC
);
529 kfree(wmi
->last_mgmt_tx_frame
);
530 wmi
->last_mgmt_tx_frame
= NULL
;
531 wmi
->last_mgmt_tx_frame_len
= 0;
537 static int ath6kl_wmi_rx_probe_req_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
538 struct ath6kl_vif
*vif
)
540 struct wmi_p2p_rx_probe_req_event
*ev
;
544 if (len
< sizeof(*ev
))
547 ev
= (struct wmi_p2p_rx_probe_req_event
*) datap
;
548 freq
= le32_to_cpu(ev
->freq
);
549 dlen
= le16_to_cpu(ev
->len
);
550 if (datap
+ len
< ev
->data
+ dlen
) {
551 ath6kl_err("invalid wmi_p2p_rx_probe_req_event: "
552 "len=%d dlen=%u\n", len
, dlen
);
555 ath6kl_dbg(ATH6KL_DBG_WMI
, "rx_probe_req: len=%u freq=%u "
556 "probe_req_report=%d\n",
557 dlen
, freq
, vif
->probe_req_report
);
559 if (vif
->probe_req_report
|| vif
->nw_type
== AP_NETWORK
)
560 cfg80211_rx_mgmt(vif
->ndev
, freq
, ev
->data
, dlen
, GFP_ATOMIC
);
565 static int ath6kl_wmi_p2p_capabilities_event_rx(u8
*datap
, int len
)
567 struct wmi_p2p_capabilities_event
*ev
;
570 if (len
< sizeof(*ev
))
573 ev
= (struct wmi_p2p_capabilities_event
*) datap
;
574 dlen
= le16_to_cpu(ev
->len
);
575 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_capab: len=%u\n", dlen
);
580 static int ath6kl_wmi_rx_action_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
581 struct ath6kl_vif
*vif
)
583 struct wmi_rx_action_event
*ev
;
587 if (len
< sizeof(*ev
))
590 ev
= (struct wmi_rx_action_event
*) datap
;
591 freq
= le32_to_cpu(ev
->freq
);
592 dlen
= le16_to_cpu(ev
->len
);
593 if (datap
+ len
< ev
->data
+ dlen
) {
594 ath6kl_err("invalid wmi_rx_action_event: "
595 "len=%d dlen=%u\n", len
, dlen
);
598 ath6kl_dbg(ATH6KL_DBG_WMI
, "rx_action: len=%u freq=%u\n", dlen
, freq
);
599 cfg80211_rx_mgmt(vif
->ndev
, freq
, ev
->data
, dlen
, GFP_ATOMIC
);
604 static int ath6kl_wmi_p2p_info_event_rx(u8
*datap
, int len
)
606 struct wmi_p2p_info_event
*ev
;
610 if (len
< sizeof(*ev
))
613 ev
= (struct wmi_p2p_info_event
*) datap
;
614 flags
= le32_to_cpu(ev
->info_req_flags
);
615 dlen
= le16_to_cpu(ev
->len
);
616 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_info: flags=%x len=%d\n", flags
, dlen
);
618 if (flags
& P2P_FLAG_CAPABILITIES_REQ
) {
619 struct wmi_p2p_capabilities
*cap
;
620 if (dlen
< sizeof(*cap
))
622 cap
= (struct wmi_p2p_capabilities
*) ev
->data
;
623 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_info: GO Power Save = %d\n",
627 if (flags
& P2P_FLAG_MACADDR_REQ
) {
628 struct wmi_p2p_macaddr
*mac
;
629 if (dlen
< sizeof(*mac
))
631 mac
= (struct wmi_p2p_macaddr
*) ev
->data
;
632 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_info: MAC Address = %pM\n",
636 if (flags
& P2P_FLAG_HMODEL_REQ
) {
637 struct wmi_p2p_hmodel
*mod
;
638 if (dlen
< sizeof(*mod
))
640 mod
= (struct wmi_p2p_hmodel
*) ev
->data
;
641 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_info: P2P Model = %d (%s)\n",
643 mod
->p2p_model
? "host" : "firmware");
648 static inline struct sk_buff
*ath6kl_wmi_get_new_buf(u32 size
)
652 skb
= ath6kl_buf_alloc(size
);
658 memset(skb
->data
, 0, size
);
663 /* Send a "simple" wmi command -- one with no arguments */
664 static int ath6kl_wmi_simple_cmd(struct wmi
*wmi
, u8 if_idx
,
665 enum wmi_cmd_id cmd_id
)
670 skb
= ath6kl_wmi_get_new_buf(0);
674 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, cmd_id
, NO_SYNC_WMIFLAG
);
679 static int ath6kl_wmi_ready_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
681 struct wmi_ready_event_2
*ev
= (struct wmi_ready_event_2
*) datap
;
683 if (len
< sizeof(struct wmi_ready_event_2
))
686 ath6kl_ready_event(wmi
->parent_dev
, ev
->mac_addr
,
687 le32_to_cpu(ev
->sw_version
),
688 le32_to_cpu(ev
->abi_version
));
694 * Mechanism to modify the roaming behavior in the firmware. The lower rssi
695 * at which the station has to roam can be passed with
696 * WMI_SET_LRSSI_SCAN_PARAMS. Subtract 96 from RSSI to get the signal level
699 int ath6kl_wmi_set_roam_lrssi_cmd(struct wmi
*wmi
, u8 lrssi
)
702 struct roam_ctrl_cmd
*cmd
;
704 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
708 cmd
= (struct roam_ctrl_cmd
*) skb
->data
;
710 cmd
->info
.params
.lrssi_scan_period
= cpu_to_le16(DEF_LRSSI_SCAN_PERIOD
);
711 cmd
->info
.params
.lrssi_scan_threshold
= a_cpu_to_sle16(lrssi
+
712 DEF_SCAN_FOR_ROAM_INTVL
);
713 cmd
->info
.params
.lrssi_roam_threshold
= a_cpu_to_sle16(lrssi
);
714 cmd
->info
.params
.roam_rssi_floor
= DEF_LRSSI_ROAM_FLOOR
;
715 cmd
->roam_ctrl
= WMI_SET_LRSSI_SCAN_PARAMS
;
717 ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_ROAM_CTRL_CMDID
,
723 int ath6kl_wmi_force_roam_cmd(struct wmi
*wmi
, const u8
*bssid
)
726 struct roam_ctrl_cmd
*cmd
;
728 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
732 cmd
= (struct roam_ctrl_cmd
*) skb
->data
;
733 memset(cmd
, 0, sizeof(*cmd
));
735 memcpy(cmd
->info
.bssid
, bssid
, ETH_ALEN
);
736 cmd
->roam_ctrl
= WMI_FORCE_ROAM
;
738 ath6kl_dbg(ATH6KL_DBG_WMI
, "force roam to %pM\n", bssid
);
739 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_ROAM_CTRL_CMDID
,
743 int ath6kl_wmi_set_roam_mode_cmd(struct wmi
*wmi
, enum wmi_roam_mode mode
)
746 struct roam_ctrl_cmd
*cmd
;
748 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
752 cmd
= (struct roam_ctrl_cmd
*) skb
->data
;
753 memset(cmd
, 0, sizeof(*cmd
));
755 cmd
->info
.roam_mode
= mode
;
756 cmd
->roam_ctrl
= WMI_SET_ROAM_MODE
;
758 ath6kl_dbg(ATH6KL_DBG_WMI
, "set roam mode %d\n", mode
);
759 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_ROAM_CTRL_CMDID
,
763 static int ath6kl_wmi_connect_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
764 struct ath6kl_vif
*vif
)
766 struct wmi_connect_event
*ev
;
769 if (len
< sizeof(struct wmi_connect_event
))
772 ev
= (struct wmi_connect_event
*) datap
;
774 if (vif
->nw_type
== AP_NETWORK
) {
775 /* AP mode start/STA connected event */
776 struct net_device
*dev
= vif
->ndev
;
777 if (memcmp(dev
->dev_addr
, ev
->u
.ap_bss
.bssid
, ETH_ALEN
) == 0) {
778 ath6kl_dbg(ATH6KL_DBG_WMI
, "%s: freq %d bssid %pM "
780 __func__
, le16_to_cpu(ev
->u
.ap_bss
.ch
),
782 ath6kl_connect_ap_mode_bss(
783 vif
, le16_to_cpu(ev
->u
.ap_bss
.ch
));
785 ath6kl_dbg(ATH6KL_DBG_WMI
, "%s: aid %u mac_addr %pM "
786 "auth=%u keymgmt=%u cipher=%u apsd_info=%u "
788 __func__
, ev
->u
.ap_sta
.aid
,
789 ev
->u
.ap_sta
.mac_addr
,
791 ev
->u
.ap_sta
.keymgmt
,
792 le16_to_cpu(ev
->u
.ap_sta
.cipher
),
793 ev
->u
.ap_sta
.apsd_info
);
795 ath6kl_connect_ap_mode_sta(
796 vif
, ev
->u
.ap_sta
.aid
, ev
->u
.ap_sta
.mac_addr
,
797 ev
->u
.ap_sta
.keymgmt
,
798 le16_to_cpu(ev
->u
.ap_sta
.cipher
),
799 ev
->u
.ap_sta
.auth
, ev
->assoc_req_len
,
800 ev
->assoc_info
+ ev
->beacon_ie_len
,
801 ev
->u
.ap_sta
.apsd_info
);
806 /* STA/IBSS mode connection event */
808 ath6kl_dbg(ATH6KL_DBG_WMI
,
809 "wmi event connect freq %d bssid %pM listen_intvl %d beacon_intvl %d type %d\n",
810 le16_to_cpu(ev
->u
.sta
.ch
), ev
->u
.sta
.bssid
,
811 le16_to_cpu(ev
->u
.sta
.listen_intvl
),
812 le16_to_cpu(ev
->u
.sta
.beacon_intvl
),
813 le32_to_cpu(ev
->u
.sta
.nw_type
));
815 /* Start of assoc rsp IEs */
816 pie
= ev
->assoc_info
+ ev
->beacon_ie_len
+
817 ev
->assoc_req_len
+ (sizeof(u16
) * 3); /* capinfo, status, aid */
819 /* End of assoc rsp IEs */
820 peie
= ev
->assoc_info
+ ev
->beacon_ie_len
+ ev
->assoc_req_len
+
825 case WLAN_EID_VENDOR_SPECIFIC
:
826 if (pie
[1] > 3 && pie
[2] == 0x00 && pie
[3] == 0x50 &&
827 pie
[4] == 0xf2 && pie
[5] == WMM_OUI_TYPE
) {
828 /* WMM OUT (00:50:F2) */
830 && pie
[6] == WMM_PARAM_OUI_SUBTYPE
)
831 wmi
->is_wmm_enabled
= true;
836 if (wmi
->is_wmm_enabled
)
842 ath6kl_connect_event(vif
, le16_to_cpu(ev
->u
.sta
.ch
),
844 le16_to_cpu(ev
->u
.sta
.listen_intvl
),
845 le16_to_cpu(ev
->u
.sta
.beacon_intvl
),
846 le32_to_cpu(ev
->u
.sta
.nw_type
),
847 ev
->beacon_ie_len
, ev
->assoc_req_len
,
848 ev
->assoc_resp_len
, ev
->assoc_info
);
853 static struct country_code_to_enum_rd
*
854 ath6kl_regd_find_country(u16 countryCode
)
858 for (i
= 0; i
< ARRAY_SIZE(allCountries
); i
++) {
859 if (allCountries
[i
].countryCode
== countryCode
)
860 return &allCountries
[i
];
866 static struct reg_dmn_pair_mapping
*
867 ath6kl_get_regpair(u16 regdmn
)
871 if (regdmn
== NO_ENUMRD
)
874 for (i
= 0; i
< ARRAY_SIZE(regDomainPairs
); i
++) {
875 if (regDomainPairs
[i
].regDmnEnum
== regdmn
)
876 return ®DomainPairs
[i
];
882 static struct country_code_to_enum_rd
*
883 ath6kl_regd_find_country_by_rd(u16 regdmn
)
887 for (i
= 0; i
< ARRAY_SIZE(allCountries
); i
++) {
888 if (allCountries
[i
].regDmnEnum
== regdmn
)
889 return &allCountries
[i
];
895 static void ath6kl_wmi_regdomain_event(struct wmi
*wmi
, u8
*datap
, int len
)
898 struct ath6kl_wmi_regdomain
*ev
;
899 struct country_code_to_enum_rd
*country
= NULL
;
900 struct reg_dmn_pair_mapping
*regpair
= NULL
;
904 ev
= (struct ath6kl_wmi_regdomain
*) datap
;
905 reg_code
= le32_to_cpu(ev
->reg_code
);
907 if ((reg_code
>> ATH6KL_COUNTRY_RD_SHIFT
) & COUNTRY_ERD_FLAG
)
908 country
= ath6kl_regd_find_country((u16
) reg_code
);
909 else if (!(((u16
) reg_code
& WORLD_SKU_MASK
) == WORLD_SKU_PREFIX
)) {
911 regpair
= ath6kl_get_regpair((u16
) reg_code
);
912 country
= ath6kl_regd_find_country_by_rd((u16
) reg_code
);
913 ath6kl_dbg(ATH6KL_DBG_WMI
, "Regpair used: 0x%0x\n",
914 regpair
->regDmnEnum
);
917 if (country
&& wmi
->parent_dev
->wiphy_registered
) {
918 alpha2
[0] = country
->isoName
[0];
919 alpha2
[1] = country
->isoName
[1];
921 regulatory_hint(wmi
->parent_dev
->wiphy
, alpha2
);
923 ath6kl_dbg(ATH6KL_DBG_WMI
, "Country alpha2 being used: %c%c\n",
924 alpha2
[0], alpha2
[1]);
928 static int ath6kl_wmi_disconnect_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
929 struct ath6kl_vif
*vif
)
931 struct wmi_disconnect_event
*ev
;
932 wmi
->traffic_class
= 100;
934 if (len
< sizeof(struct wmi_disconnect_event
))
937 ev
= (struct wmi_disconnect_event
*) datap
;
939 ath6kl_dbg(ATH6KL_DBG_WMI
,
940 "wmi event disconnect proto_reason %d bssid %pM wmi_reason %d assoc_resp_len %d\n",
941 le16_to_cpu(ev
->proto_reason_status
), ev
->bssid
,
942 ev
->disconn_reason
, ev
->assoc_resp_len
);
944 wmi
->is_wmm_enabled
= false;
946 ath6kl_disconnect_event(vif
, ev
->disconn_reason
,
947 ev
->bssid
, ev
->assoc_resp_len
, ev
->assoc_info
,
948 le16_to_cpu(ev
->proto_reason_status
));
953 static int ath6kl_wmi_peer_node_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
955 struct wmi_peer_node_event
*ev
;
957 if (len
< sizeof(struct wmi_peer_node_event
))
960 ev
= (struct wmi_peer_node_event
*) datap
;
962 if (ev
->event_code
== PEER_NODE_JOIN_EVENT
)
963 ath6kl_dbg(ATH6KL_DBG_WMI
, "joined node with mac addr: %pM\n",
965 else if (ev
->event_code
== PEER_NODE_LEAVE_EVENT
)
966 ath6kl_dbg(ATH6KL_DBG_WMI
, "left node with mac addr: %pM\n",
972 static int ath6kl_wmi_tkip_micerr_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
973 struct ath6kl_vif
*vif
)
975 struct wmi_tkip_micerr_event
*ev
;
977 if (len
< sizeof(struct wmi_tkip_micerr_event
))
980 ev
= (struct wmi_tkip_micerr_event
*) datap
;
982 ath6kl_tkip_micerr_event(vif
, ev
->key_id
, ev
->is_mcast
);
987 void ath6kl_wmi_sscan_timer(unsigned long ptr
)
989 struct ath6kl_vif
*vif
= (struct ath6kl_vif
*) ptr
;
991 cfg80211_sched_scan_results(vif
->ar
->wiphy
);
994 static int ath6kl_wmi_bssinfo_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
995 struct ath6kl_vif
*vif
)
997 struct wmi_bss_info_hdr2
*bih
;
999 struct ieee80211_channel
*channel
;
1000 struct ath6kl
*ar
= wmi
->parent_dev
;
1001 struct ieee80211_mgmt
*mgmt
;
1002 struct cfg80211_bss
*bss
;
1004 if (len
<= sizeof(struct wmi_bss_info_hdr2
))
1007 bih
= (struct wmi_bss_info_hdr2
*) datap
;
1008 buf
= datap
+ sizeof(struct wmi_bss_info_hdr2
);
1009 len
-= sizeof(struct wmi_bss_info_hdr2
);
1011 ath6kl_dbg(ATH6KL_DBG_WMI
,
1012 "bss info evt - ch %u, snr %d, rssi %d, bssid \"%pM\" "
1014 bih
->ch
, bih
->snr
, bih
->snr
- 95, bih
->bssid
,
1017 if (bih
->frame_type
!= BEACON_FTYPE
&&
1018 bih
->frame_type
!= PROBERESP_FTYPE
)
1019 return 0; /* Only update BSS table for now */
1021 if (bih
->frame_type
== BEACON_FTYPE
&&
1022 test_bit(CLEAR_BSSFILTER_ON_BEACON
, &vif
->flags
)) {
1023 clear_bit(CLEAR_BSSFILTER_ON_BEACON
, &vif
->flags
);
1024 ath6kl_wmi_bssfilter_cmd(ar
->wmi
, vif
->fw_vif_idx
,
1025 NONE_BSS_FILTER
, 0);
1028 channel
= ieee80211_get_channel(ar
->wiphy
, le16_to_cpu(bih
->ch
));
1029 if (channel
== NULL
)
1032 if (len
< 8 + 2 + 2)
1035 if (bih
->frame_type
== BEACON_FTYPE
&& test_bit(CONNECTED
, &vif
->flags
)
1036 && memcmp(bih
->bssid
, vif
->bssid
, ETH_ALEN
) == 0) {
1038 tim
= cfg80211_find_ie(WLAN_EID_TIM
, buf
+ 8 + 2 + 2,
1040 if (tim
&& tim
[1] >= 2) {
1041 vif
->assoc_bss_dtim_period
= tim
[3];
1042 set_bit(DTIM_PERIOD_AVAIL
, &vif
->flags
);
1047 * In theory, use of cfg80211_inform_bss() would be more natural here
1048 * since we do not have the full frame. However, at least for now,
1049 * cfg80211 can only distinguish Beacon and Probe Response frames from
1050 * each other when using cfg80211_inform_bss_frame(), so let's build a
1051 * fake IEEE 802.11 header to be able to take benefit of this.
1053 mgmt
= kmalloc(24 + len
, GFP_ATOMIC
);
1057 if (bih
->frame_type
== BEACON_FTYPE
) {
1058 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
1059 IEEE80211_STYPE_BEACON
);
1060 memset(mgmt
->da
, 0xff, ETH_ALEN
);
1062 struct net_device
*dev
= vif
->ndev
;
1064 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
1065 IEEE80211_STYPE_PROBE_RESP
);
1066 memcpy(mgmt
->da
, dev
->dev_addr
, ETH_ALEN
);
1068 mgmt
->duration
= cpu_to_le16(0);
1069 memcpy(mgmt
->sa
, bih
->bssid
, ETH_ALEN
);
1070 memcpy(mgmt
->bssid
, bih
->bssid
, ETH_ALEN
);
1071 mgmt
->seq_ctrl
= cpu_to_le16(0);
1073 memcpy(&mgmt
->u
.beacon
, buf
, len
);
1075 bss
= cfg80211_inform_bss_frame(ar
->wiphy
, channel
, mgmt
,
1076 24 + len
, (bih
->snr
- 95) * 100,
1081 cfg80211_put_bss(bss
);
1084 * Firmware doesn't return any event when scheduled scan has
1085 * finished, so we need to use a timer to find out when there are
1088 * The timer is started from the first bss info received, otherwise
1089 * the timer would not ever fire if the scan interval is short
1092 if (ar
->state
== ATH6KL_STATE_SCHED_SCAN
&&
1093 !timer_pending(&vif
->sched_scan_timer
)) {
1094 mod_timer(&vif
->sched_scan_timer
, jiffies
+
1095 msecs_to_jiffies(ATH6KL_SCHED_SCAN_RESULT_DELAY
));
1101 /* Inactivity timeout of a fatpipe(pstream) at the target */
1102 static int ath6kl_wmi_pstream_timeout_event_rx(struct wmi
*wmi
, u8
*datap
,
1105 struct wmi_pstream_timeout_event
*ev
;
1107 if (len
< sizeof(struct wmi_pstream_timeout_event
))
1110 ev
= (struct wmi_pstream_timeout_event
*) datap
;
1113 * When the pstream (fat pipe == AC) timesout, it means there were
1114 * no thinStreams within this pstream & it got implicitly created
1115 * due to data flow on this AC. We start the inactivity timer only
1116 * for implicitly created pstream. Just reset the host state.
1118 spin_lock_bh(&wmi
->lock
);
1119 wmi
->stream_exist_for_ac
[ev
->traffic_class
] = 0;
1120 wmi
->fat_pipe_exist
&= ~(1 << ev
->traffic_class
);
1121 spin_unlock_bh(&wmi
->lock
);
1123 /* Indicate inactivity to driver layer for this fatpipe (pstream) */
1124 ath6kl_indicate_tx_activity(wmi
->parent_dev
, ev
->traffic_class
, false);
1129 static int ath6kl_wmi_bitrate_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1131 struct wmi_bit_rate_reply
*reply
;
1135 if (len
< sizeof(struct wmi_bit_rate_reply
))
1138 reply
= (struct wmi_bit_rate_reply
*) datap
;
1140 ath6kl_dbg(ATH6KL_DBG_WMI
, "rateindex %d\n", reply
->rate_index
);
1142 if (reply
->rate_index
== (s8
) RATE_AUTO
) {
1145 index
= reply
->rate_index
& 0x7f;
1146 sgi
= (reply
->rate_index
& 0x80) ? 1 : 0;
1147 rate
= wmi_rate_tbl
[index
][sgi
];
1150 ath6kl_wakeup_event(wmi
->parent_dev
);
1155 static int ath6kl_wmi_test_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1157 ath6kl_tm_rx_event(wmi
->parent_dev
, datap
, len
);
1162 static int ath6kl_wmi_ratemask_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1164 if (len
< sizeof(struct wmi_fix_rates_reply
))
1167 ath6kl_wakeup_event(wmi
->parent_dev
);
1172 static int ath6kl_wmi_ch_list_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1174 if (len
< sizeof(struct wmi_channel_list_reply
))
1177 ath6kl_wakeup_event(wmi
->parent_dev
);
1182 static int ath6kl_wmi_tx_pwr_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1184 struct wmi_tx_pwr_reply
*reply
;
1186 if (len
< sizeof(struct wmi_tx_pwr_reply
))
1189 reply
= (struct wmi_tx_pwr_reply
*) datap
;
1190 ath6kl_txpwr_rx_evt(wmi
->parent_dev
, reply
->dbM
);
1195 static int ath6kl_wmi_keepalive_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1197 if (len
< sizeof(struct wmi_get_keepalive_cmd
))
1200 ath6kl_wakeup_event(wmi
->parent_dev
);
1205 static int ath6kl_wmi_scan_complete_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1206 struct ath6kl_vif
*vif
)
1208 struct wmi_scan_complete_event
*ev
;
1210 ev
= (struct wmi_scan_complete_event
*) datap
;
1212 ath6kl_scan_complete_evt(vif
, a_sle32_to_cpu(ev
->status
));
1213 wmi
->is_probe_ssid
= false;
1218 static int ath6kl_wmi_neighbor_report_event_rx(struct wmi
*wmi
, u8
*datap
,
1219 int len
, struct ath6kl_vif
*vif
)
1221 struct wmi_neighbor_report_event
*ev
;
1224 if (len
< sizeof(*ev
))
1226 ev
= (struct wmi_neighbor_report_event
*) datap
;
1227 if (sizeof(*ev
) + ev
->num_neighbors
* sizeof(struct wmi_neighbor_info
)
1229 ath6kl_dbg(ATH6KL_DBG_WMI
, "truncated neighbor event "
1230 "(num=%d len=%d)\n", ev
->num_neighbors
, len
);
1233 for (i
= 0; i
< ev
->num_neighbors
; i
++) {
1234 ath6kl_dbg(ATH6KL_DBG_WMI
, "neighbor %d/%d - %pM 0x%x\n",
1235 i
+ 1, ev
->num_neighbors
, ev
->neighbor
[i
].bssid
,
1236 ev
->neighbor
[i
].bss_flags
);
1237 cfg80211_pmksa_candidate_notify(vif
->ndev
, i
,
1238 ev
->neighbor
[i
].bssid
,
1239 !!(ev
->neighbor
[i
].bss_flags
&
1240 WMI_PREAUTH_CAPABLE_BSS
),
1248 * Target is reporting a programming error. This is for
1249 * developer aid only. Target only checks a few common violations
1250 * and it is responsibility of host to do all error checking.
1251 * Behavior of target after wmi error event is undefined.
1252 * A reset is recommended.
1254 static int ath6kl_wmi_error_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1256 const char *type
= "unknown error";
1257 struct wmi_cmd_error_event
*ev
;
1258 ev
= (struct wmi_cmd_error_event
*) datap
;
1260 switch (ev
->err_code
) {
1262 type
= "invalid parameter";
1265 type
= "invalid state";
1267 case INTERNAL_ERROR
:
1268 type
= "internal error";
1272 ath6kl_dbg(ATH6KL_DBG_WMI
, "programming error, cmd=%d %s\n",
1278 static int ath6kl_wmi_stats_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1279 struct ath6kl_vif
*vif
)
1281 ath6kl_tgt_stats_event(vif
, datap
, len
);
1286 static u8
ath6kl_wmi_get_upper_threshold(s16 rssi
,
1287 struct sq_threshold_params
*sq_thresh
,
1291 u8 threshold
= (u8
) sq_thresh
->upper_threshold
[size
- 1];
1293 /* The list is already in sorted order. Get the next lower value */
1294 for (index
= 0; index
< size
; index
++) {
1295 if (rssi
< sq_thresh
->upper_threshold
[index
]) {
1296 threshold
= (u8
) sq_thresh
->upper_threshold
[index
];
1304 static u8
ath6kl_wmi_get_lower_threshold(s16 rssi
,
1305 struct sq_threshold_params
*sq_thresh
,
1309 u8 threshold
= (u8
) sq_thresh
->lower_threshold
[size
- 1];
1311 /* The list is already in sorted order. Get the next lower value */
1312 for (index
= 0; index
< size
; index
++) {
1313 if (rssi
> sq_thresh
->lower_threshold
[index
]) {
1314 threshold
= (u8
) sq_thresh
->lower_threshold
[index
];
1322 static int ath6kl_wmi_send_rssi_threshold_params(struct wmi
*wmi
,
1323 struct wmi_rssi_threshold_params_cmd
*rssi_cmd
)
1325 struct sk_buff
*skb
;
1326 struct wmi_rssi_threshold_params_cmd
*cmd
;
1328 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
1332 cmd
= (struct wmi_rssi_threshold_params_cmd
*) skb
->data
;
1333 memcpy(cmd
, rssi_cmd
, sizeof(struct wmi_rssi_threshold_params_cmd
));
1335 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_RSSI_THRESHOLD_PARAMS_CMDID
,
1339 static int ath6kl_wmi_rssi_threshold_event_rx(struct wmi
*wmi
, u8
*datap
,
1342 struct wmi_rssi_threshold_event
*reply
;
1343 struct wmi_rssi_threshold_params_cmd cmd
;
1344 struct sq_threshold_params
*sq_thresh
;
1345 enum wmi_rssi_threshold_val new_threshold
;
1346 u8 upper_rssi_threshold
, lower_rssi_threshold
;
1350 if (len
< sizeof(struct wmi_rssi_threshold_event
))
1353 reply
= (struct wmi_rssi_threshold_event
*) datap
;
1354 new_threshold
= (enum wmi_rssi_threshold_val
) reply
->range
;
1355 rssi
= a_sle16_to_cpu(reply
->rssi
);
1357 sq_thresh
= &wmi
->sq_threshld
[SIGNAL_QUALITY_METRICS_RSSI
];
1360 * Identify the threshold breached and communicate that to the app.
1361 * After that install a new set of thresholds based on the signal
1362 * quality reported by the target
1364 if (new_threshold
) {
1365 /* Upper threshold breached */
1366 if (rssi
< sq_thresh
->upper_threshold
[0]) {
1367 ath6kl_dbg(ATH6KL_DBG_WMI
,
1368 "spurious upper rssi threshold event: %d\n",
1370 } else if ((rssi
< sq_thresh
->upper_threshold
[1]) &&
1371 (rssi
>= sq_thresh
->upper_threshold
[0])) {
1372 new_threshold
= WMI_RSSI_THRESHOLD1_ABOVE
;
1373 } else if ((rssi
< sq_thresh
->upper_threshold
[2]) &&
1374 (rssi
>= sq_thresh
->upper_threshold
[1])) {
1375 new_threshold
= WMI_RSSI_THRESHOLD2_ABOVE
;
1376 } else if ((rssi
< sq_thresh
->upper_threshold
[3]) &&
1377 (rssi
>= sq_thresh
->upper_threshold
[2])) {
1378 new_threshold
= WMI_RSSI_THRESHOLD3_ABOVE
;
1379 } else if ((rssi
< sq_thresh
->upper_threshold
[4]) &&
1380 (rssi
>= sq_thresh
->upper_threshold
[3])) {
1381 new_threshold
= WMI_RSSI_THRESHOLD4_ABOVE
;
1382 } else if ((rssi
< sq_thresh
->upper_threshold
[5]) &&
1383 (rssi
>= sq_thresh
->upper_threshold
[4])) {
1384 new_threshold
= WMI_RSSI_THRESHOLD5_ABOVE
;
1385 } else if (rssi
>= sq_thresh
->upper_threshold
[5]) {
1386 new_threshold
= WMI_RSSI_THRESHOLD6_ABOVE
;
1389 /* Lower threshold breached */
1390 if (rssi
> sq_thresh
->lower_threshold
[0]) {
1391 ath6kl_dbg(ATH6KL_DBG_WMI
,
1392 "spurious lower rssi threshold event: %d %d\n",
1393 rssi
, sq_thresh
->lower_threshold
[0]);
1394 } else if ((rssi
> sq_thresh
->lower_threshold
[1]) &&
1395 (rssi
<= sq_thresh
->lower_threshold
[0])) {
1396 new_threshold
= WMI_RSSI_THRESHOLD6_BELOW
;
1397 } else if ((rssi
> sq_thresh
->lower_threshold
[2]) &&
1398 (rssi
<= sq_thresh
->lower_threshold
[1])) {
1399 new_threshold
= WMI_RSSI_THRESHOLD5_BELOW
;
1400 } else if ((rssi
> sq_thresh
->lower_threshold
[3]) &&
1401 (rssi
<= sq_thresh
->lower_threshold
[2])) {
1402 new_threshold
= WMI_RSSI_THRESHOLD4_BELOW
;
1403 } else if ((rssi
> sq_thresh
->lower_threshold
[4]) &&
1404 (rssi
<= sq_thresh
->lower_threshold
[3])) {
1405 new_threshold
= WMI_RSSI_THRESHOLD3_BELOW
;
1406 } else if ((rssi
> sq_thresh
->lower_threshold
[5]) &&
1407 (rssi
<= sq_thresh
->lower_threshold
[4])) {
1408 new_threshold
= WMI_RSSI_THRESHOLD2_BELOW
;
1409 } else if (rssi
<= sq_thresh
->lower_threshold
[5]) {
1410 new_threshold
= WMI_RSSI_THRESHOLD1_BELOW
;
1414 /* Calculate and install the next set of thresholds */
1415 lower_rssi_threshold
= ath6kl_wmi_get_lower_threshold(rssi
, sq_thresh
,
1416 sq_thresh
->lower_threshold_valid_count
);
1417 upper_rssi_threshold
= ath6kl_wmi_get_upper_threshold(rssi
, sq_thresh
,
1418 sq_thresh
->upper_threshold_valid_count
);
1420 /* Issue a wmi command to install the thresholds */
1421 cmd
.thresh_above1_val
= a_cpu_to_sle16(upper_rssi_threshold
);
1422 cmd
.thresh_below1_val
= a_cpu_to_sle16(lower_rssi_threshold
);
1423 cmd
.weight
= sq_thresh
->weight
;
1424 cmd
.poll_time
= cpu_to_le32(sq_thresh
->polling_interval
);
1426 ret
= ath6kl_wmi_send_rssi_threshold_params(wmi
, &cmd
);
1428 ath6kl_err("unable to configure rssi thresholds\n");
1435 static int ath6kl_wmi_cac_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1436 struct ath6kl_vif
*vif
)
1438 struct wmi_cac_event
*reply
;
1439 struct ieee80211_tspec_ie
*ts
;
1440 u16 active_tsids
, tsinfo
;
1444 if (len
< sizeof(struct wmi_cac_event
))
1447 reply
= (struct wmi_cac_event
*) datap
;
1449 if ((reply
->cac_indication
== CAC_INDICATION_ADMISSION_RESP
) &&
1450 (reply
->status_code
!= IEEE80211_TSPEC_STATUS_ADMISS_ACCEPTED
)) {
1452 ts
= (struct ieee80211_tspec_ie
*) &(reply
->tspec_suggestion
);
1453 tsinfo
= le16_to_cpu(ts
->tsinfo
);
1454 tsid
= (tsinfo
>> IEEE80211_WMM_IE_TSPEC_TID_SHIFT
) &
1455 IEEE80211_WMM_IE_TSPEC_TID_MASK
;
1457 ath6kl_wmi_delete_pstream_cmd(wmi
, vif
->fw_vif_idx
,
1459 } else if (reply
->cac_indication
== CAC_INDICATION_NO_RESP
) {
1461 * Following assumes that there is only one outstanding
1462 * ADDTS request when this event is received
1464 spin_lock_bh(&wmi
->lock
);
1465 active_tsids
= wmi
->stream_exist_for_ac
[reply
->ac
];
1466 spin_unlock_bh(&wmi
->lock
);
1468 for (index
= 0; index
< sizeof(active_tsids
) * 8; index
++) {
1469 if ((active_tsids
>> index
) & 1)
1472 if (index
< (sizeof(active_tsids
) * 8))
1473 ath6kl_wmi_delete_pstream_cmd(wmi
, vif
->fw_vif_idx
,
1478 * Clear active tsids and Add missing handling
1479 * for delete qos stream from AP
1481 else if (reply
->cac_indication
== CAC_INDICATION_DELETE
) {
1483 ts
= (struct ieee80211_tspec_ie
*) &(reply
->tspec_suggestion
);
1484 tsinfo
= le16_to_cpu(ts
->tsinfo
);
1485 ts_id
= ((tsinfo
>> IEEE80211_WMM_IE_TSPEC_TID_SHIFT
) &
1486 IEEE80211_WMM_IE_TSPEC_TID_MASK
);
1488 spin_lock_bh(&wmi
->lock
);
1489 wmi
->stream_exist_for_ac
[reply
->ac
] &= ~(1 << ts_id
);
1490 active_tsids
= wmi
->stream_exist_for_ac
[reply
->ac
];
1491 spin_unlock_bh(&wmi
->lock
);
1493 /* Indicate stream inactivity to driver layer only if all tsids
1494 * within this AC are deleted.
1496 if (!active_tsids
) {
1497 ath6kl_indicate_tx_activity(wmi
->parent_dev
, reply
->ac
,
1499 wmi
->fat_pipe_exist
&= ~(1 << reply
->ac
);
1506 static int ath6kl_wmi_send_snr_threshold_params(struct wmi
*wmi
,
1507 struct wmi_snr_threshold_params_cmd
*snr_cmd
)
1509 struct sk_buff
*skb
;
1510 struct wmi_snr_threshold_params_cmd
*cmd
;
1512 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
1516 cmd
= (struct wmi_snr_threshold_params_cmd
*) skb
->data
;
1517 memcpy(cmd
, snr_cmd
, sizeof(struct wmi_snr_threshold_params_cmd
));
1519 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SNR_THRESHOLD_PARAMS_CMDID
,
1523 static int ath6kl_wmi_snr_threshold_event_rx(struct wmi
*wmi
, u8
*datap
,
1526 struct wmi_snr_threshold_event
*reply
;
1527 struct sq_threshold_params
*sq_thresh
;
1528 struct wmi_snr_threshold_params_cmd cmd
;
1529 enum wmi_snr_threshold_val new_threshold
;
1530 u8 upper_snr_threshold
, lower_snr_threshold
;
1534 if (len
< sizeof(struct wmi_snr_threshold_event
))
1537 reply
= (struct wmi_snr_threshold_event
*) datap
;
1539 new_threshold
= (enum wmi_snr_threshold_val
) reply
->range
;
1542 sq_thresh
= &wmi
->sq_threshld
[SIGNAL_QUALITY_METRICS_SNR
];
1545 * Identify the threshold breached and communicate that to the app.
1546 * After that install a new set of thresholds based on the signal
1547 * quality reported by the target.
1549 if (new_threshold
) {
1550 /* Upper threshold breached */
1551 if (snr
< sq_thresh
->upper_threshold
[0]) {
1552 ath6kl_dbg(ATH6KL_DBG_WMI
,
1553 "spurious upper snr threshold event: %d\n",
1555 } else if ((snr
< sq_thresh
->upper_threshold
[1]) &&
1556 (snr
>= sq_thresh
->upper_threshold
[0])) {
1557 new_threshold
= WMI_SNR_THRESHOLD1_ABOVE
;
1558 } else if ((snr
< sq_thresh
->upper_threshold
[2]) &&
1559 (snr
>= sq_thresh
->upper_threshold
[1])) {
1560 new_threshold
= WMI_SNR_THRESHOLD2_ABOVE
;
1561 } else if ((snr
< sq_thresh
->upper_threshold
[3]) &&
1562 (snr
>= sq_thresh
->upper_threshold
[2])) {
1563 new_threshold
= WMI_SNR_THRESHOLD3_ABOVE
;
1564 } else if (snr
>= sq_thresh
->upper_threshold
[3]) {
1565 new_threshold
= WMI_SNR_THRESHOLD4_ABOVE
;
1568 /* Lower threshold breached */
1569 if (snr
> sq_thresh
->lower_threshold
[0]) {
1570 ath6kl_dbg(ATH6KL_DBG_WMI
,
1571 "spurious lower snr threshold event: %d\n",
1572 sq_thresh
->lower_threshold
[0]);
1573 } else if ((snr
> sq_thresh
->lower_threshold
[1]) &&
1574 (snr
<= sq_thresh
->lower_threshold
[0])) {
1575 new_threshold
= WMI_SNR_THRESHOLD4_BELOW
;
1576 } else if ((snr
> sq_thresh
->lower_threshold
[2]) &&
1577 (snr
<= sq_thresh
->lower_threshold
[1])) {
1578 new_threshold
= WMI_SNR_THRESHOLD3_BELOW
;
1579 } else if ((snr
> sq_thresh
->lower_threshold
[3]) &&
1580 (snr
<= sq_thresh
->lower_threshold
[2])) {
1581 new_threshold
= WMI_SNR_THRESHOLD2_BELOW
;
1582 } else if (snr
<= sq_thresh
->lower_threshold
[3]) {
1583 new_threshold
= WMI_SNR_THRESHOLD1_BELOW
;
1587 /* Calculate and install the next set of thresholds */
1588 lower_snr_threshold
= ath6kl_wmi_get_lower_threshold(snr
, sq_thresh
,
1589 sq_thresh
->lower_threshold_valid_count
);
1590 upper_snr_threshold
= ath6kl_wmi_get_upper_threshold(snr
, sq_thresh
,
1591 sq_thresh
->upper_threshold_valid_count
);
1593 /* Issue a wmi command to install the thresholds */
1594 cmd
.thresh_above1_val
= upper_snr_threshold
;
1595 cmd
.thresh_below1_val
= lower_snr_threshold
;
1596 cmd
.weight
= sq_thresh
->weight
;
1597 cmd
.poll_time
= cpu_to_le32(sq_thresh
->polling_interval
);
1599 ath6kl_dbg(ATH6KL_DBG_WMI
,
1600 "snr: %d, threshold: %d, lower: %d, upper: %d\n",
1602 lower_snr_threshold
, upper_snr_threshold
);
1604 ret
= ath6kl_wmi_send_snr_threshold_params(wmi
, &cmd
);
1606 ath6kl_err("unable to configure snr threshold\n");
1613 static int ath6kl_wmi_aplist_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1615 u16 ap_info_entry_size
;
1616 struct wmi_aplist_event
*ev
= (struct wmi_aplist_event
*) datap
;
1617 struct wmi_ap_info_v1
*ap_info_v1
;
1620 if (len
< sizeof(struct wmi_aplist_event
) ||
1621 ev
->ap_list_ver
!= APLIST_VER1
)
1624 ap_info_entry_size
= sizeof(struct wmi_ap_info_v1
);
1625 ap_info_v1
= (struct wmi_ap_info_v1
*) ev
->ap_list
;
1627 ath6kl_dbg(ATH6KL_DBG_WMI
,
1628 "number of APs in aplist event: %d\n", ev
->num_ap
);
1630 if (len
< (int) (sizeof(struct wmi_aplist_event
) +
1631 (ev
->num_ap
- 1) * ap_info_entry_size
))
1634 /* AP list version 1 contents */
1635 for (index
= 0; index
< ev
->num_ap
; index
++) {
1636 ath6kl_dbg(ATH6KL_DBG_WMI
, "AP#%d BSSID %pM Channel %d\n",
1637 index
, ap_info_v1
->bssid
, ap_info_v1
->channel
);
1644 int ath6kl_wmi_cmd_send(struct wmi
*wmi
, u8 if_idx
, struct sk_buff
*skb
,
1645 enum wmi_cmd_id cmd_id
, enum wmi_sync_flag sync_flag
)
1647 struct wmi_cmd_hdr
*cmd_hdr
;
1648 enum htc_endpoint_id ep_id
= wmi
->ep_id
;
1652 if (WARN_ON(skb
== NULL
|| (if_idx
> (wmi
->parent_dev
->vif_max
- 1))))
1655 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi tx id %d len %d flag %d\n",
1656 cmd_id
, skb
->len
, sync_flag
);
1657 ath6kl_dbg_dump(ATH6KL_DBG_WMI_DUMP
, NULL
, "wmi tx ",
1658 skb
->data
, skb
->len
);
1660 if (sync_flag
>= END_WMIFLAG
) {
1665 if ((sync_flag
== SYNC_BEFORE_WMIFLAG
) ||
1666 (sync_flag
== SYNC_BOTH_WMIFLAG
)) {
1668 * Make sure all data currently queued is transmitted before
1669 * the cmd execution. Establish a new sync point.
1671 ath6kl_wmi_sync_point(wmi
, if_idx
);
1674 skb_push(skb
, sizeof(struct wmi_cmd_hdr
));
1676 cmd_hdr
= (struct wmi_cmd_hdr
*) skb
->data
;
1677 cmd_hdr
->cmd_id
= cpu_to_le16(cmd_id
);
1678 info1
= if_idx
& WMI_CMD_HDR_IF_ID_MASK
;
1679 cmd_hdr
->info1
= cpu_to_le16(info1
);
1681 /* Only for OPT_TX_CMD, use BE endpoint. */
1682 if (cmd_id
== WMI_OPT_TX_FRAME_CMDID
) {
1683 ret
= ath6kl_wmi_data_hdr_add(wmi
, skb
, OPT_MSGTYPE
,
1684 false, false, 0, NULL
, if_idx
);
1689 ep_id
= ath6kl_ac2_endpoint_id(wmi
->parent_dev
, WMM_AC_BE
);
1692 ath6kl_control_tx(wmi
->parent_dev
, skb
, ep_id
);
1694 if ((sync_flag
== SYNC_AFTER_WMIFLAG
) ||
1695 (sync_flag
== SYNC_BOTH_WMIFLAG
)) {
1697 * Make sure all new data queued waits for the command to
1698 * execute. Establish a new sync point.
1700 ath6kl_wmi_sync_point(wmi
, if_idx
);
1706 int ath6kl_wmi_connect_cmd(struct wmi
*wmi
, u8 if_idx
,
1707 enum network_type nw_type
,
1708 enum dot11_auth_mode dot11_auth_mode
,
1709 enum auth_mode auth_mode
,
1710 enum crypto_type pairwise_crypto
,
1711 u8 pairwise_crypto_len
,
1712 enum crypto_type group_crypto
,
1713 u8 group_crypto_len
, int ssid_len
, u8
*ssid
,
1714 u8
*bssid
, u16 channel
, u32 ctrl_flags
,
1717 struct sk_buff
*skb
;
1718 struct wmi_connect_cmd
*cc
;
1721 ath6kl_dbg(ATH6KL_DBG_WMI
,
1722 "wmi connect bssid %pM freq %d flags 0x%x ssid_len %d "
1723 "type %d dot11_auth %d auth %d pairwise %d group %d\n",
1724 bssid
, channel
, ctrl_flags
, ssid_len
, nw_type
,
1725 dot11_auth_mode
, auth_mode
, pairwise_crypto
, group_crypto
);
1726 ath6kl_dbg_dump(ATH6KL_DBG_WMI
, NULL
, "ssid ", ssid
, ssid_len
);
1728 wmi
->traffic_class
= 100;
1730 if ((pairwise_crypto
== NONE_CRYPT
) && (group_crypto
!= NONE_CRYPT
))
1733 if ((pairwise_crypto
!= NONE_CRYPT
) && (group_crypto
== NONE_CRYPT
))
1736 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_connect_cmd
));
1740 cc
= (struct wmi_connect_cmd
*) skb
->data
;
1743 memcpy(cc
->ssid
, ssid
, ssid_len
);
1745 cc
->ssid_len
= ssid_len
;
1746 cc
->nw_type
= nw_type
;
1747 cc
->dot11_auth_mode
= dot11_auth_mode
;
1748 cc
->auth_mode
= auth_mode
;
1749 cc
->prwise_crypto_type
= pairwise_crypto
;
1750 cc
->prwise_crypto_len
= pairwise_crypto_len
;
1751 cc
->grp_crypto_type
= group_crypto
;
1752 cc
->grp_crypto_len
= group_crypto_len
;
1753 cc
->ch
= cpu_to_le16(channel
);
1754 cc
->ctrl_flags
= cpu_to_le32(ctrl_flags
);
1755 cc
->nw_subtype
= nw_subtype
;
1758 memcpy(cc
->bssid
, bssid
, ETH_ALEN
);
1760 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_CONNECT_CMDID
,
1766 int ath6kl_wmi_reconnect_cmd(struct wmi
*wmi
, u8 if_idx
, u8
*bssid
,
1769 struct sk_buff
*skb
;
1770 struct wmi_reconnect_cmd
*cc
;
1773 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi reconnect bssid %pM freq %d\n",
1776 wmi
->traffic_class
= 100;
1778 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_reconnect_cmd
));
1782 cc
= (struct wmi_reconnect_cmd
*) skb
->data
;
1783 cc
->channel
= cpu_to_le16(channel
);
1786 memcpy(cc
->bssid
, bssid
, ETH_ALEN
);
1788 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_RECONNECT_CMDID
,
1794 int ath6kl_wmi_disconnect_cmd(struct wmi
*wmi
, u8 if_idx
)
1798 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi disconnect\n");
1800 wmi
->traffic_class
= 100;
1802 /* Disconnect command does not need to do a SYNC before. */
1803 ret
= ath6kl_wmi_simple_cmd(wmi
, if_idx
, WMI_DISCONNECT_CMDID
);
1808 int ath6kl_wmi_beginscan_cmd(struct wmi
*wmi
, u8 if_idx
,
1809 enum wmi_scan_type scan_type
,
1810 u32 force_fgscan
, u32 is_legacy
,
1811 u32 home_dwell_time
, u32 force_scan_interval
,
1812 s8 num_chan
, u16
*ch_list
, u32 no_cck
, u32
*rates
)
1814 struct sk_buff
*skb
;
1815 struct wmi_begin_scan_cmd
*sc
;
1818 struct ath6kl
*ar
= wmi
->parent_dev
;
1821 size
= sizeof(struct wmi_begin_scan_cmd
);
1823 if ((scan_type
!= WMI_LONG_SCAN
) && (scan_type
!= WMI_SHORT_SCAN
))
1826 if (num_chan
> WMI_MAX_CHANNELS
)
1830 size
+= sizeof(u16
) * (num_chan
- 1);
1832 skb
= ath6kl_wmi_get_new_buf(size
);
1836 sc
= (struct wmi_begin_scan_cmd
*) skb
->data
;
1837 sc
->scan_type
= scan_type
;
1838 sc
->force_fg_scan
= cpu_to_le32(force_fgscan
);
1839 sc
->is_legacy
= cpu_to_le32(is_legacy
);
1840 sc
->home_dwell_time
= cpu_to_le32(home_dwell_time
);
1841 sc
->force_scan_intvl
= cpu_to_le32(force_scan_interval
);
1842 sc
->no_cck
= cpu_to_le32(no_cck
);
1843 sc
->num_ch
= num_chan
;
1845 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++) {
1846 struct ieee80211_supported_band
*sband
=
1847 ar
->wiphy
->bands
[band
];
1848 u32 ratemask
= rates
[band
];
1849 u8
*supp_rates
= sc
->supp_rates
[band
].rates
;
1852 for (i
= 0; i
< sband
->n_bitrates
; i
++) {
1853 if ((BIT(i
) & ratemask
) == 0)
1854 continue; /* skip rate */
1855 supp_rates
[num_rates
++] =
1856 (u8
) (sband
->bitrates
[i
].bitrate
/ 5);
1858 sc
->supp_rates
[band
].nrates
= num_rates
;
1861 for (i
= 0; i
< num_chan
; i
++)
1862 sc
->ch_list
[i
] = cpu_to_le16(ch_list
[i
]);
1864 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_BEGIN_SCAN_CMDID
,
1870 /* ath6kl_wmi_start_scan_cmd is to be deprecated. Use
1871 * ath6kl_wmi_begin_scan_cmd instead. The new function supports P2P
1872 * mgmt operations using station interface.
1874 int ath6kl_wmi_startscan_cmd(struct wmi
*wmi
, u8 if_idx
,
1875 enum wmi_scan_type scan_type
,
1876 u32 force_fgscan
, u32 is_legacy
,
1877 u32 home_dwell_time
, u32 force_scan_interval
,
1878 s8 num_chan
, u16
*ch_list
)
1880 struct sk_buff
*skb
;
1881 struct wmi_start_scan_cmd
*sc
;
1885 size
= sizeof(struct wmi_start_scan_cmd
);
1887 if ((scan_type
!= WMI_LONG_SCAN
) && (scan_type
!= WMI_SHORT_SCAN
))
1890 if (num_chan
> WMI_MAX_CHANNELS
)
1894 size
+= sizeof(u16
) * (num_chan
- 1);
1896 skb
= ath6kl_wmi_get_new_buf(size
);
1900 sc
= (struct wmi_start_scan_cmd
*) skb
->data
;
1901 sc
->scan_type
= scan_type
;
1902 sc
->force_fg_scan
= cpu_to_le32(force_fgscan
);
1903 sc
->is_legacy
= cpu_to_le32(is_legacy
);
1904 sc
->home_dwell_time
= cpu_to_le32(home_dwell_time
);
1905 sc
->force_scan_intvl
= cpu_to_le32(force_scan_interval
);
1906 sc
->num_ch
= num_chan
;
1908 for (i
= 0; i
< num_chan
; i
++)
1909 sc
->ch_list
[i
] = cpu_to_le16(ch_list
[i
]);
1911 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_START_SCAN_CMDID
,
1917 int ath6kl_wmi_scanparams_cmd(struct wmi
*wmi
, u8 if_idx
,
1919 u16 fg_end_sec
, u16 bg_sec
,
1920 u16 minact_chdw_msec
, u16 maxact_chdw_msec
,
1921 u16 pas_chdw_msec
, u8 short_scan_ratio
,
1922 u8 scan_ctrl_flag
, u32 max_dfsch_act_time
,
1923 u16 maxact_scan_per_ssid
)
1925 struct sk_buff
*skb
;
1926 struct wmi_scan_params_cmd
*sc
;
1929 skb
= ath6kl_wmi_get_new_buf(sizeof(*sc
));
1933 sc
= (struct wmi_scan_params_cmd
*) skb
->data
;
1934 sc
->fg_start_period
= cpu_to_le16(fg_start_sec
);
1935 sc
->fg_end_period
= cpu_to_le16(fg_end_sec
);
1936 sc
->bg_period
= cpu_to_le16(bg_sec
);
1937 sc
->minact_chdwell_time
= cpu_to_le16(minact_chdw_msec
);
1938 sc
->maxact_chdwell_time
= cpu_to_le16(maxact_chdw_msec
);
1939 sc
->pas_chdwell_time
= cpu_to_le16(pas_chdw_msec
);
1940 sc
->short_scan_ratio
= short_scan_ratio
;
1941 sc
->scan_ctrl_flags
= scan_ctrl_flag
;
1942 sc
->max_dfsch_act_time
= cpu_to_le32(max_dfsch_act_time
);
1943 sc
->maxact_scan_per_ssid
= cpu_to_le16(maxact_scan_per_ssid
);
1945 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_SCAN_PARAMS_CMDID
,
1950 int ath6kl_wmi_bssfilter_cmd(struct wmi
*wmi
, u8 if_idx
, u8 filter
, u32 ie_mask
)
1952 struct sk_buff
*skb
;
1953 struct wmi_bss_filter_cmd
*cmd
;
1956 if (filter
>= LAST_BSS_FILTER
)
1959 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
1963 cmd
= (struct wmi_bss_filter_cmd
*) skb
->data
;
1964 cmd
->bss_filter
= filter
;
1965 cmd
->ie_mask
= cpu_to_le32(ie_mask
);
1967 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_BSS_FILTER_CMDID
,
1972 int ath6kl_wmi_probedssid_cmd(struct wmi
*wmi
, u8 if_idx
, u8 index
, u8 flag
,
1973 u8 ssid_len
, u8
*ssid
)
1975 struct sk_buff
*skb
;
1976 struct wmi_probed_ssid_cmd
*cmd
;
1979 if (index
> MAX_PROBED_SSID_INDEX
)
1982 if (ssid_len
> sizeof(cmd
->ssid
))
1985 if ((flag
& (DISABLE_SSID_FLAG
| ANY_SSID_FLAG
)) && (ssid_len
> 0))
1988 if ((flag
& SPECIFIC_SSID_FLAG
) && !ssid_len
)
1991 if (flag
& SPECIFIC_SSID_FLAG
)
1992 wmi
->is_probe_ssid
= true;
1994 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
1998 cmd
= (struct wmi_probed_ssid_cmd
*) skb
->data
;
1999 cmd
->entry_index
= index
;
2001 cmd
->ssid_len
= ssid_len
;
2002 memcpy(cmd
->ssid
, ssid
, ssid_len
);
2004 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_PROBED_SSID_CMDID
,
2009 int ath6kl_wmi_listeninterval_cmd(struct wmi
*wmi
, u8 if_idx
,
2010 u16 listen_interval
,
2013 struct sk_buff
*skb
;
2014 struct wmi_listen_int_cmd
*cmd
;
2017 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2021 cmd
= (struct wmi_listen_int_cmd
*) skb
->data
;
2022 cmd
->listen_intvl
= cpu_to_le16(listen_interval
);
2023 cmd
->num_beacons
= cpu_to_le16(listen_beacons
);
2025 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_LISTEN_INT_CMDID
,
2030 int ath6kl_wmi_powermode_cmd(struct wmi
*wmi
, u8 if_idx
, u8 pwr_mode
)
2032 struct sk_buff
*skb
;
2033 struct wmi_power_mode_cmd
*cmd
;
2036 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2040 cmd
= (struct wmi_power_mode_cmd
*) skb
->data
;
2041 cmd
->pwr_mode
= pwr_mode
;
2042 wmi
->pwr_mode
= pwr_mode
;
2044 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_POWER_MODE_CMDID
,
2049 int ath6kl_wmi_pmparams_cmd(struct wmi
*wmi
, u8 if_idx
, u16 idle_period
,
2050 u16 ps_poll_num
, u16 dtim_policy
,
2051 u16 tx_wakeup_policy
, u16 num_tx_to_wakeup
,
2052 u16 ps_fail_event_policy
)
2054 struct sk_buff
*skb
;
2055 struct wmi_power_params_cmd
*pm
;
2058 skb
= ath6kl_wmi_get_new_buf(sizeof(*pm
));
2062 pm
= (struct wmi_power_params_cmd
*)skb
->data
;
2063 pm
->idle_period
= cpu_to_le16(idle_period
);
2064 pm
->pspoll_number
= cpu_to_le16(ps_poll_num
);
2065 pm
->dtim_policy
= cpu_to_le16(dtim_policy
);
2066 pm
->tx_wakeup_policy
= cpu_to_le16(tx_wakeup_policy
);
2067 pm
->num_tx_to_wakeup
= cpu_to_le16(num_tx_to_wakeup
);
2068 pm
->ps_fail_event_policy
= cpu_to_le16(ps_fail_event_policy
);
2070 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_POWER_PARAMS_CMDID
,
2075 int ath6kl_wmi_disctimeout_cmd(struct wmi
*wmi
, u8 if_idx
, u8 timeout
)
2077 struct sk_buff
*skb
;
2078 struct wmi_disc_timeout_cmd
*cmd
;
2081 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2085 cmd
= (struct wmi_disc_timeout_cmd
*) skb
->data
;
2086 cmd
->discon_timeout
= timeout
;
2088 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_DISC_TIMEOUT_CMDID
,
2092 ath6kl_debug_set_disconnect_timeout(wmi
->parent_dev
, timeout
);
2097 int ath6kl_wmi_addkey_cmd(struct wmi
*wmi
, u8 if_idx
, u8 key_index
,
2098 enum crypto_type key_type
,
2099 u8 key_usage
, u8 key_len
,
2100 u8
*key_rsc
, unsigned int key_rsc_len
,
2102 u8 key_op_ctrl
, u8
*mac_addr
,
2103 enum wmi_sync_flag sync_flag
)
2105 struct sk_buff
*skb
;
2106 struct wmi_add_cipher_key_cmd
*cmd
;
2109 ath6kl_dbg(ATH6KL_DBG_WMI
, "addkey cmd: key_index=%u key_type=%d "
2110 "key_usage=%d key_len=%d key_op_ctrl=%d\n",
2111 key_index
, key_type
, key_usage
, key_len
, key_op_ctrl
);
2113 if ((key_index
> WMI_MAX_KEY_INDEX
) || (key_len
> WMI_MAX_KEY_LEN
) ||
2114 (key_material
== NULL
) || key_rsc_len
> 8)
2117 if ((WEP_CRYPT
!= key_type
) && (NULL
== key_rsc
))
2120 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2124 cmd
= (struct wmi_add_cipher_key_cmd
*) skb
->data
;
2125 cmd
->key_index
= key_index
;
2126 cmd
->key_type
= key_type
;
2127 cmd
->key_usage
= key_usage
;
2128 cmd
->key_len
= key_len
;
2129 memcpy(cmd
->key
, key_material
, key_len
);
2131 if (key_rsc
!= NULL
)
2132 memcpy(cmd
->key_rsc
, key_rsc
, key_rsc_len
);
2134 cmd
->key_op_ctrl
= key_op_ctrl
;
2137 memcpy(cmd
->key_mac_addr
, mac_addr
, ETH_ALEN
);
2139 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_CIPHER_KEY_CMDID
,
2145 int ath6kl_wmi_add_krk_cmd(struct wmi
*wmi
, u8 if_idx
, u8
*krk
)
2147 struct sk_buff
*skb
;
2148 struct wmi_add_krk_cmd
*cmd
;
2151 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2155 cmd
= (struct wmi_add_krk_cmd
*) skb
->data
;
2156 memcpy(cmd
->krk
, krk
, WMI_KRK_LEN
);
2158 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_KRK_CMDID
,
2164 int ath6kl_wmi_deletekey_cmd(struct wmi
*wmi
, u8 if_idx
, u8 key_index
)
2166 struct sk_buff
*skb
;
2167 struct wmi_delete_cipher_key_cmd
*cmd
;
2170 if (key_index
> WMI_MAX_KEY_INDEX
)
2173 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2177 cmd
= (struct wmi_delete_cipher_key_cmd
*) skb
->data
;
2178 cmd
->key_index
= key_index
;
2180 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DELETE_CIPHER_KEY_CMDID
,
2186 int ath6kl_wmi_setpmkid_cmd(struct wmi
*wmi
, u8 if_idx
, const u8
*bssid
,
2187 const u8
*pmkid
, bool set
)
2189 struct sk_buff
*skb
;
2190 struct wmi_setpmkid_cmd
*cmd
;
2196 if (set
&& pmkid
== NULL
)
2199 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2203 cmd
= (struct wmi_setpmkid_cmd
*) skb
->data
;
2204 memcpy(cmd
->bssid
, bssid
, ETH_ALEN
);
2206 memcpy(cmd
->pmkid
, pmkid
, sizeof(cmd
->pmkid
));
2207 cmd
->enable
= PMKID_ENABLE
;
2209 memset(cmd
->pmkid
, 0, sizeof(cmd
->pmkid
));
2210 cmd
->enable
= PMKID_DISABLE
;
2213 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_PMKID_CMDID
,
2219 static int ath6kl_wmi_data_sync_send(struct wmi
*wmi
, struct sk_buff
*skb
,
2220 enum htc_endpoint_id ep_id
, u8 if_idx
)
2222 struct wmi_data_hdr
*data_hdr
;
2225 if (WARN_ON(skb
== NULL
|| ep_id
== wmi
->ep_id
))
2228 skb_push(skb
, sizeof(struct wmi_data_hdr
));
2230 data_hdr
= (struct wmi_data_hdr
*) skb
->data
;
2231 data_hdr
->info
= SYNC_MSGTYPE
<< WMI_DATA_HDR_MSG_TYPE_SHIFT
;
2232 data_hdr
->info3
= cpu_to_le16(if_idx
& WMI_DATA_HDR_IF_IDX_MASK
);
2234 ret
= ath6kl_control_tx(wmi
->parent_dev
, skb
, ep_id
);
2239 static int ath6kl_wmi_sync_point(struct wmi
*wmi
, u8 if_idx
)
2241 struct sk_buff
*skb
;
2242 struct wmi_sync_cmd
*cmd
;
2243 struct wmi_data_sync_bufs data_sync_bufs
[WMM_NUM_AC
];
2244 enum htc_endpoint_id ep_id
;
2245 u8 index
, num_pri_streams
= 0;
2248 memset(data_sync_bufs
, 0, sizeof(data_sync_bufs
));
2250 spin_lock_bh(&wmi
->lock
);
2252 for (index
= 0; index
< WMM_NUM_AC
; index
++) {
2253 if (wmi
->fat_pipe_exist
& (1 << index
)) {
2255 data_sync_bufs
[num_pri_streams
- 1].traffic_class
=
2260 spin_unlock_bh(&wmi
->lock
);
2262 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2268 cmd
= (struct wmi_sync_cmd
*) skb
->data
;
2271 * In the SYNC cmd sent on the control Ep, send a bitmap
2272 * of the data eps on which the Data Sync will be sent
2274 cmd
->data_sync_map
= wmi
->fat_pipe_exist
;
2276 for (index
= 0; index
< num_pri_streams
; index
++) {
2277 data_sync_bufs
[index
].skb
= ath6kl_buf_alloc(0);
2278 if (data_sync_bufs
[index
].skb
== NULL
) {
2285 * If buffer allocation for any of the dataSync fails,
2286 * then do not send the Synchronize cmd on the control ep
2292 * Send sync cmd followed by sync data messages on all
2293 * endpoints being used
2295 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SYNCHRONIZE_CMDID
,
2301 /* cmd buffer sent, we no longer own it */
2304 for (index
= 0; index
< num_pri_streams
; index
++) {
2306 if (WARN_ON(!data_sync_bufs
[index
].skb
))
2309 ep_id
= ath6kl_ac2_endpoint_id(wmi
->parent_dev
,
2310 data_sync_bufs
[index
].
2313 ath6kl_wmi_data_sync_send(wmi
, data_sync_bufs
[index
].skb
,
2319 data_sync_bufs
[index
].skb
= NULL
;
2323 /* free up any resources left over (possibly due to an error) */
2327 for (index
= 0; index
< num_pri_streams
; index
++) {
2328 if (data_sync_bufs
[index
].skb
!= NULL
) {
2329 dev_kfree_skb((struct sk_buff
*)data_sync_bufs
[index
].
2337 int ath6kl_wmi_create_pstream_cmd(struct wmi
*wmi
, u8 if_idx
,
2338 struct wmi_create_pstream_cmd
*params
)
2340 struct sk_buff
*skb
;
2341 struct wmi_create_pstream_cmd
*cmd
;
2342 u8 fatpipe_exist_for_ac
= 0;
2344 s32 nominal_phy
= 0;
2347 if (!((params
->user_pri
< 8) &&
2348 (params
->user_pri
<= 0x7) &&
2349 (up_to_ac
[params
->user_pri
& 0x7] == params
->traffic_class
) &&
2350 (params
->traffic_direc
== UPLINK_TRAFFIC
||
2351 params
->traffic_direc
== DNLINK_TRAFFIC
||
2352 params
->traffic_direc
== BIDIR_TRAFFIC
) &&
2353 (params
->traffic_type
== TRAFFIC_TYPE_APERIODIC
||
2354 params
->traffic_type
== TRAFFIC_TYPE_PERIODIC
) &&
2355 (params
->voice_psc_cap
== DISABLE_FOR_THIS_AC
||
2356 params
->voice_psc_cap
== ENABLE_FOR_THIS_AC
||
2357 params
->voice_psc_cap
== ENABLE_FOR_ALL_AC
) &&
2358 (params
->tsid
== WMI_IMPLICIT_PSTREAM
||
2359 params
->tsid
<= WMI_MAX_THINSTREAM
))) {
2364 * Check nominal PHY rate is >= minimalPHY,
2365 * so that DUT can allow TSRS IE
2368 /* Get the physical rate (units of bps) */
2369 min_phy
= ((le32_to_cpu(params
->min_phy_rate
) / 1000) / 1000);
2371 /* Check minimal phy < nominal phy rate */
2372 if (params
->nominal_phy
>= min_phy
) {
2373 /* unit of 500 kbps */
2374 nominal_phy
= (params
->nominal_phy
* 1000) / 500;
2375 ath6kl_dbg(ATH6KL_DBG_WMI
,
2376 "TSRS IE enabled::MinPhy %x->NominalPhy ===> %x\n",
2377 min_phy
, nominal_phy
);
2379 params
->nominal_phy
= nominal_phy
;
2381 params
->nominal_phy
= 0;
2384 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2388 ath6kl_dbg(ATH6KL_DBG_WMI
,
2389 "sending create_pstream_cmd: ac=%d tsid:%d\n",
2390 params
->traffic_class
, params
->tsid
);
2392 cmd
= (struct wmi_create_pstream_cmd
*) skb
->data
;
2393 memcpy(cmd
, params
, sizeof(*cmd
));
2395 /* This is an implicitly created Fat pipe */
2396 if ((u32
) params
->tsid
== (u32
) WMI_IMPLICIT_PSTREAM
) {
2397 spin_lock_bh(&wmi
->lock
);
2398 fatpipe_exist_for_ac
= (wmi
->fat_pipe_exist
&
2399 (1 << params
->traffic_class
));
2400 wmi
->fat_pipe_exist
|= (1 << params
->traffic_class
);
2401 spin_unlock_bh(&wmi
->lock
);
2403 /* explicitly created thin stream within a fat pipe */
2404 spin_lock_bh(&wmi
->lock
);
2405 fatpipe_exist_for_ac
= (wmi
->fat_pipe_exist
&
2406 (1 << params
->traffic_class
));
2407 wmi
->stream_exist_for_ac
[params
->traffic_class
] |=
2408 (1 << params
->tsid
);
2410 * If a thinstream becomes active, the fat pipe automatically
2413 wmi
->fat_pipe_exist
|= (1 << params
->traffic_class
);
2414 spin_unlock_bh(&wmi
->lock
);
2418 * Indicate activty change to driver layer only if this is the
2419 * first TSID to get created in this AC explicitly or an implicit
2420 * fat pipe is getting created.
2422 if (!fatpipe_exist_for_ac
)
2423 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2424 params
->traffic_class
, true);
2426 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_CREATE_PSTREAM_CMDID
,
2431 int ath6kl_wmi_delete_pstream_cmd(struct wmi
*wmi
, u8 if_idx
, u8 traffic_class
,
2434 struct sk_buff
*skb
;
2435 struct wmi_delete_pstream_cmd
*cmd
;
2436 u16 active_tsids
= 0;
2439 if (traffic_class
> 3) {
2440 ath6kl_err("invalid traffic class: %d\n", traffic_class
);
2444 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2448 cmd
= (struct wmi_delete_pstream_cmd
*) skb
->data
;
2449 cmd
->traffic_class
= traffic_class
;
2452 spin_lock_bh(&wmi
->lock
);
2453 active_tsids
= wmi
->stream_exist_for_ac
[traffic_class
];
2454 spin_unlock_bh(&wmi
->lock
);
2456 if (!(active_tsids
& (1 << tsid
))) {
2458 ath6kl_dbg(ATH6KL_DBG_WMI
,
2459 "TSID %d doesn't exist for traffic class: %d\n",
2460 tsid
, traffic_class
);
2464 ath6kl_dbg(ATH6KL_DBG_WMI
,
2465 "sending delete_pstream_cmd: traffic class: %d tsid=%d\n",
2466 traffic_class
, tsid
);
2468 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DELETE_PSTREAM_CMDID
,
2469 SYNC_BEFORE_WMIFLAG
);
2471 spin_lock_bh(&wmi
->lock
);
2472 wmi
->stream_exist_for_ac
[traffic_class
] &= ~(1 << tsid
);
2473 active_tsids
= wmi
->stream_exist_for_ac
[traffic_class
];
2474 spin_unlock_bh(&wmi
->lock
);
2477 * Indicate stream inactivity to driver layer only if all tsids
2478 * within this AC are deleted.
2480 if (!active_tsids
) {
2481 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2482 traffic_class
, false);
2483 wmi
->fat_pipe_exist
&= ~(1 << traffic_class
);
2489 int ath6kl_wmi_set_ip_cmd(struct wmi
*wmi
, u8 if_idx
,
2490 __be32 ips0
, __be32 ips1
)
2492 struct sk_buff
*skb
;
2493 struct wmi_set_ip_cmd
*cmd
;
2496 /* Multicast address are not valid */
2497 if (ipv4_is_multicast(ips0
) ||
2498 ipv4_is_multicast(ips1
))
2501 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_ip_cmd
));
2505 cmd
= (struct wmi_set_ip_cmd
*) skb
->data
;
2509 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_IP_CMDID
,
2514 static void ath6kl_wmi_relinquish_implicit_pstream_credits(struct wmi
*wmi
)
2521 * Relinquish credits from all implicitly created pstreams
2522 * since when we go to sleep. If user created explicit
2523 * thinstreams exists with in a fatpipe leave them intact
2524 * for the user to delete.
2526 spin_lock_bh(&wmi
->lock
);
2527 stream_exist
= wmi
->fat_pipe_exist
;
2528 spin_unlock_bh(&wmi
->lock
);
2530 for (i
= 0; i
< WMM_NUM_AC
; i
++) {
2531 if (stream_exist
& (1 << i
)) {
2534 * FIXME: Is this lock & unlock inside
2535 * for loop correct? may need rework.
2537 spin_lock_bh(&wmi
->lock
);
2538 active_tsids
= wmi
->stream_exist_for_ac
[i
];
2539 spin_unlock_bh(&wmi
->lock
);
2542 * If there are no user created thin streams
2543 * delete the fatpipe
2545 if (!active_tsids
) {
2546 stream_exist
&= ~(1 << i
);
2548 * Indicate inactivity to driver layer for
2549 * this fatpipe (pstream)
2551 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2557 /* FIXME: Can we do this assignment without locking ? */
2558 spin_lock_bh(&wmi
->lock
);
2559 wmi
->fat_pipe_exist
= stream_exist
;
2560 spin_unlock_bh(&wmi
->lock
);
2563 int ath6kl_wmi_set_host_sleep_mode_cmd(struct wmi
*wmi
, u8 if_idx
,
2564 enum ath6kl_host_mode host_mode
)
2566 struct sk_buff
*skb
;
2567 struct wmi_set_host_sleep_mode_cmd
*cmd
;
2570 if ((host_mode
!= ATH6KL_HOST_MODE_ASLEEP
) &&
2571 (host_mode
!= ATH6KL_HOST_MODE_AWAKE
)) {
2572 ath6kl_err("invalid host sleep mode: %d\n", host_mode
);
2576 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2580 cmd
= (struct wmi_set_host_sleep_mode_cmd
*) skb
->data
;
2582 if (host_mode
== ATH6KL_HOST_MODE_ASLEEP
) {
2583 ath6kl_wmi_relinquish_implicit_pstream_credits(wmi
);
2584 cmd
->asleep
= cpu_to_le32(1);
2586 cmd
->awake
= cpu_to_le32(1);
2588 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
2589 WMI_SET_HOST_SLEEP_MODE_CMDID
,
2594 /* This command has zero length payload */
2595 static int ath6kl_wmi_host_sleep_mode_cmd_prcd_evt_rx(struct wmi
*wmi
,
2596 struct ath6kl_vif
*vif
)
2598 struct ath6kl
*ar
= wmi
->parent_dev
;
2600 set_bit(HOST_SLEEP_MODE_CMD_PROCESSED
, &vif
->flags
);
2601 wake_up(&ar
->event_wq
);
2606 int ath6kl_wmi_set_wow_mode_cmd(struct wmi
*wmi
, u8 if_idx
,
2607 enum ath6kl_wow_mode wow_mode
,
2608 u32 filter
, u16 host_req_delay
)
2610 struct sk_buff
*skb
;
2611 struct wmi_set_wow_mode_cmd
*cmd
;
2614 if ((wow_mode
!= ATH6KL_WOW_MODE_ENABLE
) &&
2615 wow_mode
!= ATH6KL_WOW_MODE_DISABLE
) {
2616 ath6kl_err("invalid wow mode: %d\n", wow_mode
);
2620 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2624 cmd
= (struct wmi_set_wow_mode_cmd
*) skb
->data
;
2625 cmd
->enable_wow
= cpu_to_le32(wow_mode
);
2626 cmd
->filter
= cpu_to_le32(filter
);
2627 cmd
->host_req_delay
= cpu_to_le16(host_req_delay
);
2629 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_WOW_MODE_CMDID
,
2634 int ath6kl_wmi_add_wow_pattern_cmd(struct wmi
*wmi
, u8 if_idx
,
2635 u8 list_id
, u8 filter_size
,
2636 u8 filter_offset
, const u8
*filter
,
2639 struct sk_buff
*skb
;
2640 struct wmi_add_wow_pattern_cmd
*cmd
;
2646 * Allocate additional memory in the buffer to hold
2647 * filter and mask value, which is twice of filter_size.
2649 size
= sizeof(*cmd
) + (2 * filter_size
);
2651 skb
= ath6kl_wmi_get_new_buf(size
);
2655 cmd
= (struct wmi_add_wow_pattern_cmd
*) skb
->data
;
2656 cmd
->filter_list_id
= list_id
;
2657 cmd
->filter_size
= filter_size
;
2658 cmd
->filter_offset
= filter_offset
;
2660 memcpy(cmd
->filter
, filter
, filter_size
);
2662 filter_mask
= (u8
*) (cmd
->filter
+ filter_size
);
2663 memcpy(filter_mask
, mask
, filter_size
);
2665 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_WOW_PATTERN_CMDID
,
2671 int ath6kl_wmi_del_wow_pattern_cmd(struct wmi
*wmi
, u8 if_idx
,
2672 u16 list_id
, u16 filter_id
)
2674 struct sk_buff
*skb
;
2675 struct wmi_del_wow_pattern_cmd
*cmd
;
2678 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2682 cmd
= (struct wmi_del_wow_pattern_cmd
*) skb
->data
;
2683 cmd
->filter_list_id
= cpu_to_le16(list_id
);
2684 cmd
->filter_id
= cpu_to_le16(filter_id
);
2686 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DEL_WOW_PATTERN_CMDID
,
2691 static int ath6kl_wmi_cmd_send_xtnd(struct wmi
*wmi
, struct sk_buff
*skb
,
2692 enum wmix_command_id cmd_id
,
2693 enum wmi_sync_flag sync_flag
)
2695 struct wmix_cmd_hdr
*cmd_hdr
;
2698 skb_push(skb
, sizeof(struct wmix_cmd_hdr
));
2700 cmd_hdr
= (struct wmix_cmd_hdr
*) skb
->data
;
2701 cmd_hdr
->cmd_id
= cpu_to_le32(cmd_id
);
2703 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_EXTENSION_CMDID
, sync_flag
);
2708 int ath6kl_wmi_get_challenge_resp_cmd(struct wmi
*wmi
, u32 cookie
, u32 source
)
2710 struct sk_buff
*skb
;
2711 struct wmix_hb_challenge_resp_cmd
*cmd
;
2714 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2718 cmd
= (struct wmix_hb_challenge_resp_cmd
*) skb
->data
;
2719 cmd
->cookie
= cpu_to_le32(cookie
);
2720 cmd
->source
= cpu_to_le32(source
);
2722 ret
= ath6kl_wmi_cmd_send_xtnd(wmi
, skb
, WMIX_HB_CHALLENGE_RESP_CMDID
,
2727 int ath6kl_wmi_config_debug_module_cmd(struct wmi
*wmi
, u32 valid
, u32 config
)
2729 struct ath6kl_wmix_dbglog_cfg_module_cmd
*cmd
;
2730 struct sk_buff
*skb
;
2733 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2737 cmd
= (struct ath6kl_wmix_dbglog_cfg_module_cmd
*) skb
->data
;
2738 cmd
->valid
= cpu_to_le32(valid
);
2739 cmd
->config
= cpu_to_le32(config
);
2741 ret
= ath6kl_wmi_cmd_send_xtnd(wmi
, skb
, WMIX_DBGLOG_CFG_MODULE_CMDID
,
2746 int ath6kl_wmi_get_stats_cmd(struct wmi
*wmi
, u8 if_idx
)
2748 return ath6kl_wmi_simple_cmd(wmi
, if_idx
, WMI_GET_STATISTICS_CMDID
);
2751 int ath6kl_wmi_set_tx_pwr_cmd(struct wmi
*wmi
, u8 if_idx
, u8 dbM
)
2753 struct sk_buff
*skb
;
2754 struct wmi_set_tx_pwr_cmd
*cmd
;
2757 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_tx_pwr_cmd
));
2761 cmd
= (struct wmi_set_tx_pwr_cmd
*) skb
->data
;
2764 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_TX_PWR_CMDID
,
2770 int ath6kl_wmi_get_tx_pwr_cmd(struct wmi
*wmi
, u8 if_idx
)
2772 return ath6kl_wmi_simple_cmd(wmi
, if_idx
, WMI_GET_TX_PWR_CMDID
);
2775 int ath6kl_wmi_get_roam_tbl_cmd(struct wmi
*wmi
)
2777 return ath6kl_wmi_simple_cmd(wmi
, 0, WMI_GET_ROAM_TBL_CMDID
);
2780 int ath6kl_wmi_set_lpreamble_cmd(struct wmi
*wmi
, u8 if_idx
, u8 status
,
2783 struct sk_buff
*skb
;
2784 struct wmi_set_lpreamble_cmd
*cmd
;
2787 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_lpreamble_cmd
));
2791 cmd
= (struct wmi_set_lpreamble_cmd
*) skb
->data
;
2792 cmd
->status
= status
;
2793 cmd
->preamble_policy
= preamble_policy
;
2795 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_LPREAMBLE_CMDID
,
2800 int ath6kl_wmi_set_rts_cmd(struct wmi
*wmi
, u16 threshold
)
2802 struct sk_buff
*skb
;
2803 struct wmi_set_rts_cmd
*cmd
;
2806 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_rts_cmd
));
2810 cmd
= (struct wmi_set_rts_cmd
*) skb
->data
;
2811 cmd
->threshold
= cpu_to_le16(threshold
);
2813 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_RTS_CMDID
,
2818 int ath6kl_wmi_set_wmm_txop(struct wmi
*wmi
, u8 if_idx
, enum wmi_txop_cfg cfg
)
2820 struct sk_buff
*skb
;
2821 struct wmi_set_wmm_txop_cmd
*cmd
;
2824 if (!((cfg
== WMI_TXOP_DISABLED
) || (cfg
== WMI_TXOP_ENABLED
)))
2827 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_wmm_txop_cmd
));
2831 cmd
= (struct wmi_set_wmm_txop_cmd
*) skb
->data
;
2832 cmd
->txop_enable
= cfg
;
2834 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_WMM_TXOP_CMDID
,
2839 int ath6kl_wmi_set_keepalive_cmd(struct wmi
*wmi
, u8 if_idx
,
2840 u8 keep_alive_intvl
)
2842 struct sk_buff
*skb
;
2843 struct wmi_set_keepalive_cmd
*cmd
;
2846 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2850 cmd
= (struct wmi_set_keepalive_cmd
*) skb
->data
;
2851 cmd
->keep_alive_intvl
= keep_alive_intvl
;
2853 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_KEEPALIVE_CMDID
,
2857 ath6kl_debug_set_keepalive(wmi
->parent_dev
, keep_alive_intvl
);
2862 int ath6kl_wmi_test_cmd(struct wmi
*wmi
, void *buf
, size_t len
)
2864 struct sk_buff
*skb
;
2867 skb
= ath6kl_wmi_get_new_buf(len
);
2871 memcpy(skb
->data
, buf
, len
);
2873 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_TEST_CMDID
, NO_SYNC_WMIFLAG
);
2878 int ath6kl_wmi_mcast_filter_cmd(struct wmi
*wmi
, u8 if_idx
, bool mc_all_on
)
2880 struct sk_buff
*skb
;
2881 struct wmi_mcast_filter_cmd
*cmd
;
2884 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2888 cmd
= (struct wmi_mcast_filter_cmd
*) skb
->data
;
2889 cmd
->mcast_all_enable
= mc_all_on
;
2891 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_MCAST_FILTER_CMDID
,
2896 int ath6kl_wmi_add_del_mcast_filter_cmd(struct wmi
*wmi
, u8 if_idx
,
2897 u8
*filter
, bool add_filter
)
2899 struct sk_buff
*skb
;
2900 struct wmi_mcast_filter_add_del_cmd
*cmd
;
2903 if ((filter
[0] != 0x33 || filter
[1] != 0x33) &&
2904 (filter
[0] != 0x01 || filter
[1] != 0x00 ||
2905 filter
[2] != 0x5e || filter
[3] > 0x7f)) {
2906 ath6kl_warn("invalid multicast filter address\n");
2910 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2914 cmd
= (struct wmi_mcast_filter_add_del_cmd
*) skb
->data
;
2915 memcpy(cmd
->mcast_mac
, filter
, ATH6KL_MCAST_FILTER_MAC_ADDR_SIZE
);
2916 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
2917 add_filter
? WMI_SET_MCAST_FILTER_CMDID
:
2918 WMI_DEL_MCAST_FILTER_CMDID
,
2924 s32
ath6kl_wmi_get_rate(s8 rate_index
)
2926 if (rate_index
== RATE_AUTO
)
2929 return wmi_rate_tbl
[(u32
) rate_index
][0];
2932 static int ath6kl_wmi_get_pmkid_list_event_rx(struct wmi
*wmi
, u8
*datap
,
2935 struct wmi_pmkid_list_reply
*reply
;
2938 if (len
< sizeof(struct wmi_pmkid_list_reply
))
2941 reply
= (struct wmi_pmkid_list_reply
*)datap
;
2942 expected_len
= sizeof(reply
->num_pmkid
) +
2943 le32_to_cpu(reply
->num_pmkid
) * WMI_PMKID_LEN
;
2945 if (len
< expected_len
)
2951 static int ath6kl_wmi_addba_req_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
2952 struct ath6kl_vif
*vif
)
2954 struct wmi_addba_req_event
*cmd
= (struct wmi_addba_req_event
*) datap
;
2956 aggr_recv_addba_req_evt(vif
, cmd
->tid
,
2957 le16_to_cpu(cmd
->st_seq_no
), cmd
->win_sz
);
2962 static int ath6kl_wmi_delba_req_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
2963 struct ath6kl_vif
*vif
)
2965 struct wmi_delba_event
*cmd
= (struct wmi_delba_event
*) datap
;
2967 aggr_recv_delba_req_evt(vif
, cmd
->tid
);
2972 /* AP mode functions */
2974 int ath6kl_wmi_ap_profile_commit(struct wmi
*wmip
, u8 if_idx
,
2975 struct wmi_connect_cmd
*p
)
2977 struct sk_buff
*skb
;
2978 struct wmi_connect_cmd
*cm
;
2981 skb
= ath6kl_wmi_get_new_buf(sizeof(*cm
));
2985 cm
= (struct wmi_connect_cmd
*) skb
->data
;
2986 memcpy(cm
, p
, sizeof(*cm
));
2988 res
= ath6kl_wmi_cmd_send(wmip
, if_idx
, skb
, WMI_AP_CONFIG_COMMIT_CMDID
,
2990 ath6kl_dbg(ATH6KL_DBG_WMI
, "%s: nw_type=%u auth_mode=%u ch=%u "
2991 "ctrl_flags=0x%x-> res=%d\n",
2992 __func__
, p
->nw_type
, p
->auth_mode
, le16_to_cpu(p
->ch
),
2993 le32_to_cpu(p
->ctrl_flags
), res
);
2997 int ath6kl_wmi_ap_set_mlme(struct wmi
*wmip
, u8 if_idx
, u8 cmd
, const u8
*mac
,
3000 struct sk_buff
*skb
;
3001 struct wmi_ap_set_mlme_cmd
*cm
;
3003 skb
= ath6kl_wmi_get_new_buf(sizeof(*cm
));
3007 cm
= (struct wmi_ap_set_mlme_cmd
*) skb
->data
;
3008 memcpy(cm
->mac
, mac
, ETH_ALEN
);
3009 cm
->reason
= cpu_to_le16(reason
);
3012 return ath6kl_wmi_cmd_send(wmip
, if_idx
, skb
, WMI_AP_SET_MLME_CMDID
,
3016 int ath6kl_wmi_ap_hidden_ssid(struct wmi
*wmi
, u8 if_idx
, bool enable
)
3018 struct sk_buff
*skb
;
3019 struct wmi_ap_hidden_ssid_cmd
*cmd
;
3021 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3025 cmd
= (struct wmi_ap_hidden_ssid_cmd
*) skb
->data
;
3026 cmd
->hidden_ssid
= enable
? 1 : 0;
3028 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_HIDDEN_SSID_CMDID
,
3032 /* This command will be used to enable/disable AP uAPSD feature */
3033 int ath6kl_wmi_ap_set_apsd(struct wmi
*wmi
, u8 if_idx
, u8 enable
)
3035 struct wmi_ap_set_apsd_cmd
*cmd
;
3036 struct sk_buff
*skb
;
3038 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3042 cmd
= (struct wmi_ap_set_apsd_cmd
*)skb
->data
;
3043 cmd
->enable
= enable
;
3045 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_SET_APSD_CMDID
,
3049 int ath6kl_wmi_set_apsd_bfrd_traf(struct wmi
*wmi
, u8 if_idx
,
3050 u16 aid
, u16 bitmap
, u32 flags
)
3052 struct wmi_ap_apsd_buffered_traffic_cmd
*cmd
;
3053 struct sk_buff
*skb
;
3055 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3059 cmd
= (struct wmi_ap_apsd_buffered_traffic_cmd
*)skb
->data
;
3060 cmd
->aid
= cpu_to_le16(aid
);
3061 cmd
->bitmap
= cpu_to_le16(bitmap
);
3062 cmd
->flags
= cpu_to_le32(flags
);
3064 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
3065 WMI_AP_APSD_BUFFERED_TRAFFIC_CMDID
,
3069 static int ath6kl_wmi_pspoll_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
3070 struct ath6kl_vif
*vif
)
3072 struct wmi_pspoll_event
*ev
;
3074 if (len
< sizeof(struct wmi_pspoll_event
))
3077 ev
= (struct wmi_pspoll_event
*) datap
;
3079 ath6kl_pspoll_event(vif
, le16_to_cpu(ev
->aid
));
3084 static int ath6kl_wmi_dtimexpiry_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
3085 struct ath6kl_vif
*vif
)
3087 ath6kl_dtimexpiry_event(vif
);
3092 int ath6kl_wmi_set_pvb_cmd(struct wmi
*wmi
, u8 if_idx
, u16 aid
,
3095 struct sk_buff
*skb
;
3096 struct wmi_ap_set_pvb_cmd
*cmd
;
3099 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_ap_set_pvb_cmd
));
3103 cmd
= (struct wmi_ap_set_pvb_cmd
*) skb
->data
;
3104 cmd
->aid
= cpu_to_le16(aid
);
3105 cmd
->rsvd
= cpu_to_le16(0);
3106 cmd
->flag
= cpu_to_le32(flag
);
3108 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_SET_PVB_CMDID
,
3114 int ath6kl_wmi_set_rx_frame_format_cmd(struct wmi
*wmi
, u8 if_idx
,
3116 bool rx_dot11_hdr
, bool defrag_on_host
)
3118 struct sk_buff
*skb
;
3119 struct wmi_rx_frame_format_cmd
*cmd
;
3122 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3126 cmd
= (struct wmi_rx_frame_format_cmd
*) skb
->data
;
3127 cmd
->dot11_hdr
= rx_dot11_hdr
? 1 : 0;
3128 cmd
->defrag_on_host
= defrag_on_host
? 1 : 0;
3129 cmd
->meta_ver
= rx_meta_ver
;
3131 /* Delete the local aggr state, on host */
3132 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_RX_FRAME_FORMAT_CMDID
,
3138 int ath6kl_wmi_set_appie_cmd(struct wmi
*wmi
, u8 if_idx
, u8 mgmt_frm_type
,
3139 const u8
*ie
, u8 ie_len
)
3141 struct sk_buff
*skb
;
3142 struct wmi_set_appie_cmd
*p
;
3144 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + ie_len
);
3148 ath6kl_dbg(ATH6KL_DBG_WMI
, "set_appie_cmd: mgmt_frm_type=%u "
3149 "ie_len=%u\n", mgmt_frm_type
, ie_len
);
3150 p
= (struct wmi_set_appie_cmd
*) skb
->data
;
3151 p
->mgmt_frm_type
= mgmt_frm_type
;
3154 if (ie
!= NULL
&& ie_len
> 0)
3155 memcpy(p
->ie_info
, ie
, ie_len
);
3157 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_APPIE_CMDID
,
3161 int ath6kl_wmi_disable_11b_rates_cmd(struct wmi
*wmi
, bool disable
)
3163 struct sk_buff
*skb
;
3164 struct wmi_disable_11b_rates_cmd
*cmd
;
3166 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3170 ath6kl_dbg(ATH6KL_DBG_WMI
, "disable_11b_rates_cmd: disable=%u\n",
3172 cmd
= (struct wmi_disable_11b_rates_cmd
*) skb
->data
;
3173 cmd
->disable
= disable
? 1 : 0;
3175 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_DISABLE_11B_RATES_CMDID
,
3179 int ath6kl_wmi_remain_on_chnl_cmd(struct wmi
*wmi
, u8 if_idx
, u32 freq
, u32 dur
)
3181 struct sk_buff
*skb
;
3182 struct wmi_remain_on_chnl_cmd
*p
;
3184 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3188 ath6kl_dbg(ATH6KL_DBG_WMI
, "remain_on_chnl_cmd: freq=%u dur=%u\n",
3190 p
= (struct wmi_remain_on_chnl_cmd
*) skb
->data
;
3191 p
->freq
= cpu_to_le32(freq
);
3192 p
->duration
= cpu_to_le32(dur
);
3193 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_REMAIN_ON_CHNL_CMDID
,
3197 /* ath6kl_wmi_send_action_cmd is to be deprecated. Use
3198 * ath6kl_wmi_send_mgmt_cmd instead. The new function supports P2P
3199 * mgmt operations using station interface.
3201 static int ath6kl_wmi_send_action_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
,
3202 u32 freq
, u32 wait
, const u8
*data
,
3205 struct sk_buff
*skb
;
3206 struct wmi_send_action_cmd
*p
;
3210 return -EINVAL
; /* Offload for wait not supported */
3212 buf
= kmalloc(data_len
, GFP_KERNEL
);
3216 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + data_len
);
3222 kfree(wmi
->last_mgmt_tx_frame
);
3223 memcpy(buf
, data
, data_len
);
3224 wmi
->last_mgmt_tx_frame
= buf
;
3225 wmi
->last_mgmt_tx_frame_len
= data_len
;
3227 ath6kl_dbg(ATH6KL_DBG_WMI
, "send_action_cmd: id=%u freq=%u wait=%u "
3228 "len=%u\n", id
, freq
, wait
, data_len
);
3229 p
= (struct wmi_send_action_cmd
*) skb
->data
;
3230 p
->id
= cpu_to_le32(id
);
3231 p
->freq
= cpu_to_le32(freq
);
3232 p
->wait
= cpu_to_le32(wait
);
3233 p
->len
= cpu_to_le16(data_len
);
3234 memcpy(p
->data
, data
, data_len
);
3235 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SEND_ACTION_CMDID
,
3239 static int __ath6kl_wmi_send_mgmt_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
,
3240 u32 freq
, u32 wait
, const u8
*data
,
3241 u16 data_len
, u32 no_cck
)
3243 struct sk_buff
*skb
;
3244 struct wmi_send_mgmt_cmd
*p
;
3248 return -EINVAL
; /* Offload for wait not supported */
3250 buf
= kmalloc(data_len
, GFP_KERNEL
);
3254 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + data_len
);
3260 kfree(wmi
->last_mgmt_tx_frame
);
3261 memcpy(buf
, data
, data_len
);
3262 wmi
->last_mgmt_tx_frame
= buf
;
3263 wmi
->last_mgmt_tx_frame_len
= data_len
;
3265 ath6kl_dbg(ATH6KL_DBG_WMI
, "send_action_cmd: id=%u freq=%u wait=%u "
3266 "len=%u\n", id
, freq
, wait
, data_len
);
3267 p
= (struct wmi_send_mgmt_cmd
*) skb
->data
;
3268 p
->id
= cpu_to_le32(id
);
3269 p
->freq
= cpu_to_le32(freq
);
3270 p
->wait
= cpu_to_le32(wait
);
3271 p
->no_cck
= cpu_to_le32(no_cck
);
3272 p
->len
= cpu_to_le16(data_len
);
3273 memcpy(p
->data
, data
, data_len
);
3274 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SEND_MGMT_CMDID
,
3278 int ath6kl_wmi_send_mgmt_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
, u32 freq
,
3279 u32 wait
, const u8
*data
, u16 data_len
,
3283 struct ath6kl
*ar
= wmi
->parent_dev
;
3285 if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX
,
3286 ar
->fw_capabilities
)) {
3288 * If capable of doing P2P mgmt operations using
3289 * station interface, send additional information like
3290 * supported rates to advertise and xmit rates for
3293 status
= __ath6kl_wmi_send_mgmt_cmd(ar
->wmi
, if_idx
, id
, freq
,
3294 wait
, data
, data_len
,
3297 status
= ath6kl_wmi_send_action_cmd(ar
->wmi
, if_idx
, id
, freq
,
3298 wait
, data
, data_len
);
3304 int ath6kl_wmi_send_probe_response_cmd(struct wmi
*wmi
, u8 if_idx
, u32 freq
,
3305 const u8
*dst
, const u8
*data
,
3308 struct sk_buff
*skb
;
3309 struct wmi_p2p_probe_response_cmd
*p
;
3310 size_t cmd_len
= sizeof(*p
) + data_len
;
3313 cmd_len
++; /* work around target minimum length requirement */
3315 skb
= ath6kl_wmi_get_new_buf(cmd_len
);
3319 ath6kl_dbg(ATH6KL_DBG_WMI
, "send_probe_response_cmd: freq=%u dst=%pM "
3320 "len=%u\n", freq
, dst
, data_len
);
3321 p
= (struct wmi_p2p_probe_response_cmd
*) skb
->data
;
3322 p
->freq
= cpu_to_le32(freq
);
3323 memcpy(p
->destination_addr
, dst
, ETH_ALEN
);
3324 p
->len
= cpu_to_le16(data_len
);
3325 memcpy(p
->data
, data
, data_len
);
3326 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
3327 WMI_SEND_PROBE_RESPONSE_CMDID
,
3331 int ath6kl_wmi_probe_report_req_cmd(struct wmi
*wmi
, u8 if_idx
, bool enable
)
3333 struct sk_buff
*skb
;
3334 struct wmi_probe_req_report_cmd
*p
;
3336 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3340 ath6kl_dbg(ATH6KL_DBG_WMI
, "probe_report_req_cmd: enable=%u\n",
3342 p
= (struct wmi_probe_req_report_cmd
*) skb
->data
;
3343 p
->enable
= enable
? 1 : 0;
3344 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_PROBE_REQ_REPORT_CMDID
,
3348 int ath6kl_wmi_info_req_cmd(struct wmi
*wmi
, u8 if_idx
, u32 info_req_flags
)
3350 struct sk_buff
*skb
;
3351 struct wmi_get_p2p_info
*p
;
3353 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3357 ath6kl_dbg(ATH6KL_DBG_WMI
, "info_req_cmd: flags=%x\n",
3359 p
= (struct wmi_get_p2p_info
*) skb
->data
;
3360 p
->info_req_flags
= cpu_to_le32(info_req_flags
);
3361 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_GET_P2P_INFO_CMDID
,
3365 int ath6kl_wmi_cancel_remain_on_chnl_cmd(struct wmi
*wmi
, u8 if_idx
)
3367 ath6kl_dbg(ATH6KL_DBG_WMI
, "cancel_remain_on_chnl_cmd\n");
3368 return ath6kl_wmi_simple_cmd(wmi
, if_idx
,
3369 WMI_CANCEL_REMAIN_ON_CHNL_CMDID
);
3372 static int ath6kl_wmi_control_rx_xtnd(struct wmi
*wmi
, struct sk_buff
*skb
)
3374 struct wmix_cmd_hdr
*cmd
;
3380 if (skb
->len
< sizeof(struct wmix_cmd_hdr
)) {
3381 ath6kl_err("bad packet 1\n");
3385 cmd
= (struct wmix_cmd_hdr
*) skb
->data
;
3386 id
= le32_to_cpu(cmd
->cmd_id
);
3388 skb_pull(skb
, sizeof(struct wmix_cmd_hdr
));
3394 case WMIX_HB_CHALLENGE_RESP_EVENTID
:
3395 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi event hb challenge resp\n");
3397 case WMIX_DBGLOG_EVENTID
:
3398 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi event dbglog len %d\n", len
);
3399 ath6kl_debug_fwlog_event(wmi
->parent_dev
, datap
, len
);
3402 ath6kl_warn("unknown cmd id 0x%x\n", id
);
3410 static int ath6kl_wmi_roam_tbl_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
3412 return ath6kl_debug_roam_tbl_event(wmi
->parent_dev
, datap
, len
);
3415 /* Process interface specific wmi events, caller would free the datap */
3416 static int ath6kl_wmi_proc_events_vif(struct wmi
*wmi
, u16 if_idx
, u16 cmd_id
,
3419 struct ath6kl_vif
*vif
;
3421 vif
= ath6kl_get_vif_by_index(wmi
->parent_dev
, if_idx
);
3423 ath6kl_dbg(ATH6KL_DBG_WMI
,
3424 "Wmi event for unavailable vif, vif_index:%d\n",
3430 case WMI_CONNECT_EVENTID
:
3431 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CONNECT_EVENTID\n");
3432 return ath6kl_wmi_connect_event_rx(wmi
, datap
, len
, vif
);
3433 case WMI_DISCONNECT_EVENTID
:
3434 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DISCONNECT_EVENTID\n");
3435 return ath6kl_wmi_disconnect_event_rx(wmi
, datap
, len
, vif
);
3436 case WMI_TKIP_MICERR_EVENTID
:
3437 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TKIP_MICERR_EVENTID\n");
3438 return ath6kl_wmi_tkip_micerr_event_rx(wmi
, datap
, len
, vif
);
3439 case WMI_BSSINFO_EVENTID
:
3440 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_BSSINFO_EVENTID\n");
3441 return ath6kl_wmi_bssinfo_event_rx(wmi
, datap
, len
, vif
);
3442 case WMI_NEIGHBOR_REPORT_EVENTID
:
3443 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_NEIGHBOR_REPORT_EVENTID\n");
3444 return ath6kl_wmi_neighbor_report_event_rx(wmi
, datap
, len
,
3446 case WMI_SCAN_COMPLETE_EVENTID
:
3447 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SCAN_COMPLETE_EVENTID\n");
3448 return ath6kl_wmi_scan_complete_rx(wmi
, datap
, len
, vif
);
3449 case WMI_REPORT_STATISTICS_EVENTID
:
3450 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_STATISTICS_EVENTID\n");
3451 return ath6kl_wmi_stats_event_rx(wmi
, datap
, len
, vif
);
3452 case WMI_CAC_EVENTID
:
3453 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CAC_EVENTID\n");
3454 return ath6kl_wmi_cac_event_rx(wmi
, datap
, len
, vif
);
3455 case WMI_PSPOLL_EVENTID
:
3456 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PSPOLL_EVENTID\n");
3457 return ath6kl_wmi_pspoll_event_rx(wmi
, datap
, len
, vif
);
3458 case WMI_DTIMEXPIRY_EVENTID
:
3459 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DTIMEXPIRY_EVENTID\n");
3460 return ath6kl_wmi_dtimexpiry_event_rx(wmi
, datap
, len
, vif
);
3461 case WMI_ADDBA_REQ_EVENTID
:
3462 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ADDBA_REQ_EVENTID\n");
3463 return ath6kl_wmi_addba_req_event_rx(wmi
, datap
, len
, vif
);
3464 case WMI_DELBA_REQ_EVENTID
:
3465 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DELBA_REQ_EVENTID\n");
3466 return ath6kl_wmi_delba_req_event_rx(wmi
, datap
, len
, vif
);
3467 case WMI_SET_HOST_SLEEP_MODE_CMD_PROCESSED_EVENTID
:
3468 ath6kl_dbg(ATH6KL_DBG_WMI
,
3469 "WMI_SET_HOST_SLEEP_MODE_CMD_PROCESSED_EVENTID");
3470 return ath6kl_wmi_host_sleep_mode_cmd_prcd_evt_rx(wmi
, vif
);
3471 case WMI_REMAIN_ON_CHNL_EVENTID
:
3472 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REMAIN_ON_CHNL_EVENTID\n");
3473 return ath6kl_wmi_remain_on_chnl_event_rx(wmi
, datap
, len
, vif
);
3474 case WMI_CANCEL_REMAIN_ON_CHNL_EVENTID
:
3475 ath6kl_dbg(ATH6KL_DBG_WMI
,
3476 "WMI_CANCEL_REMAIN_ON_CHNL_EVENTID\n");
3477 return ath6kl_wmi_cancel_remain_on_chnl_event_rx(wmi
, datap
,
3479 case WMI_TX_STATUS_EVENTID
:
3480 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_STATUS_EVENTID\n");
3481 return ath6kl_wmi_tx_status_event_rx(wmi
, datap
, len
, vif
);
3482 case WMI_RX_PROBE_REQ_EVENTID
:
3483 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RX_PROBE_REQ_EVENTID\n");
3484 return ath6kl_wmi_rx_probe_req_event_rx(wmi
, datap
, len
, vif
);
3485 case WMI_RX_ACTION_EVENTID
:
3486 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RX_ACTION_EVENTID\n");
3487 return ath6kl_wmi_rx_action_event_rx(wmi
, datap
, len
, vif
);
3489 ath6kl_dbg(ATH6KL_DBG_WMI
, "unknown cmd id 0x%x\n", cmd_id
);
3496 static int ath6kl_wmi_proc_events(struct wmi
*wmi
, struct sk_buff
*skb
)
3498 struct wmi_cmd_hdr
*cmd
;
3505 cmd
= (struct wmi_cmd_hdr
*) skb
->data
;
3506 id
= le16_to_cpu(cmd
->cmd_id
);
3507 if_idx
= le16_to_cpu(cmd
->info1
) & WMI_CMD_HDR_IF_ID_MASK
;
3509 skb_pull(skb
, sizeof(struct wmi_cmd_hdr
));
3513 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi rx id %d len %d\n", id
, len
);
3514 ath6kl_dbg_dump(ATH6KL_DBG_WMI_DUMP
, NULL
, "wmi rx ",
3518 case WMI_GET_BITRATE_CMDID
:
3519 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_BITRATE_CMDID\n");
3520 ret
= ath6kl_wmi_bitrate_reply_rx(wmi
, datap
, len
);
3522 case WMI_GET_CHANNEL_LIST_CMDID
:
3523 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_CHANNEL_LIST_CMDID\n");
3524 ret
= ath6kl_wmi_ch_list_reply_rx(wmi
, datap
, len
);
3526 case WMI_GET_TX_PWR_CMDID
:
3527 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_TX_PWR_CMDID\n");
3528 ret
= ath6kl_wmi_tx_pwr_reply_rx(wmi
, datap
, len
);
3530 case WMI_READY_EVENTID
:
3531 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_READY_EVENTID\n");
3532 ret
= ath6kl_wmi_ready_event_rx(wmi
, datap
, len
);
3534 case WMI_PEER_NODE_EVENTID
:
3535 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PEER_NODE_EVENTID\n");
3536 ret
= ath6kl_wmi_peer_node_event_rx(wmi
, datap
, len
);
3538 case WMI_REGDOMAIN_EVENTID
:
3539 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REGDOMAIN_EVENTID\n");
3540 ath6kl_wmi_regdomain_event(wmi
, datap
, len
);
3542 case WMI_PSTREAM_TIMEOUT_EVENTID
:
3543 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PSTREAM_TIMEOUT_EVENTID\n");
3544 ret
= ath6kl_wmi_pstream_timeout_event_rx(wmi
, datap
, len
);
3546 case WMI_CMDERROR_EVENTID
:
3547 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CMDERROR_EVENTID\n");
3548 ret
= ath6kl_wmi_error_event_rx(wmi
, datap
, len
);
3550 case WMI_RSSI_THRESHOLD_EVENTID
:
3551 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RSSI_THRESHOLD_EVENTID\n");
3552 ret
= ath6kl_wmi_rssi_threshold_event_rx(wmi
, datap
, len
);
3554 case WMI_ERROR_REPORT_EVENTID
:
3555 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ERROR_REPORT_EVENTID\n");
3557 case WMI_OPT_RX_FRAME_EVENTID
:
3558 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_OPT_RX_FRAME_EVENTID\n");
3559 /* this event has been deprecated */
3561 case WMI_REPORT_ROAM_TBL_EVENTID
:
3562 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_ROAM_TBL_EVENTID\n");
3563 ret
= ath6kl_wmi_roam_tbl_event_rx(wmi
, datap
, len
);
3565 case WMI_EXTENSION_EVENTID
:
3566 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_EXTENSION_EVENTID\n");
3567 ret
= ath6kl_wmi_control_rx_xtnd(wmi
, skb
);
3569 case WMI_CHANNEL_CHANGE_EVENTID
:
3570 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CHANNEL_CHANGE_EVENTID\n");
3572 case WMI_REPORT_ROAM_DATA_EVENTID
:
3573 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_ROAM_DATA_EVENTID\n");
3575 case WMI_TEST_EVENTID
:
3576 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TEST_EVENTID\n");
3577 ret
= ath6kl_wmi_test_rx(wmi
, datap
, len
);
3579 case WMI_GET_FIXRATES_CMDID
:
3580 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_FIXRATES_CMDID\n");
3581 ret
= ath6kl_wmi_ratemask_reply_rx(wmi
, datap
, len
);
3583 case WMI_TX_RETRY_ERR_EVENTID
:
3584 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_RETRY_ERR_EVENTID\n");
3586 case WMI_SNR_THRESHOLD_EVENTID
:
3587 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SNR_THRESHOLD_EVENTID\n");
3588 ret
= ath6kl_wmi_snr_threshold_event_rx(wmi
, datap
, len
);
3590 case WMI_LQ_THRESHOLD_EVENTID
:
3591 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_LQ_THRESHOLD_EVENTID\n");
3593 case WMI_APLIST_EVENTID
:
3594 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_APLIST_EVENTID\n");
3595 ret
= ath6kl_wmi_aplist_event_rx(wmi
, datap
, len
);
3597 case WMI_GET_KEEPALIVE_CMDID
:
3598 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_KEEPALIVE_CMDID\n");
3599 ret
= ath6kl_wmi_keepalive_reply_rx(wmi
, datap
, len
);
3601 case WMI_GET_WOW_LIST_EVENTID
:
3602 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_WOW_LIST_EVENTID\n");
3604 case WMI_GET_PMKID_LIST_EVENTID
:
3605 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_PMKID_LIST_EVENTID\n");
3606 ret
= ath6kl_wmi_get_pmkid_list_event_rx(wmi
, datap
, len
);
3608 case WMI_SET_PARAMS_REPLY_EVENTID
:
3609 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SET_PARAMS_REPLY_EVENTID\n");
3611 case WMI_ADDBA_RESP_EVENTID
:
3612 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ADDBA_RESP_EVENTID\n");
3614 case WMI_REPORT_BTCOEX_CONFIG_EVENTID
:
3615 ath6kl_dbg(ATH6KL_DBG_WMI
,
3616 "WMI_REPORT_BTCOEX_CONFIG_EVENTID\n");
3618 case WMI_REPORT_BTCOEX_STATS_EVENTID
:
3619 ath6kl_dbg(ATH6KL_DBG_WMI
,
3620 "WMI_REPORT_BTCOEX_STATS_EVENTID\n");
3622 case WMI_TX_COMPLETE_EVENTID
:
3623 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_COMPLETE_EVENTID\n");
3624 ret
= ath6kl_wmi_tx_complete_event_rx(datap
, len
);
3626 case WMI_P2P_CAPABILITIES_EVENTID
:
3627 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_P2P_CAPABILITIES_EVENTID\n");
3628 ret
= ath6kl_wmi_p2p_capabilities_event_rx(datap
, len
);
3630 case WMI_P2P_INFO_EVENTID
:
3631 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_P2P_INFO_EVENTID\n");
3632 ret
= ath6kl_wmi_p2p_info_event_rx(datap
, len
);
3635 /* may be the event is interface specific */
3636 ret
= ath6kl_wmi_proc_events_vif(wmi
, if_idx
, id
, datap
, len
);
3645 int ath6kl_wmi_control_rx(struct wmi
*wmi
, struct sk_buff
*skb
)
3647 if (WARN_ON(skb
== NULL
))
3650 if (skb
->len
< sizeof(struct wmi_cmd_hdr
)) {
3651 ath6kl_err("bad packet 1\n");
3656 return ath6kl_wmi_proc_events(wmi
, skb
);
3659 void ath6kl_wmi_reset(struct wmi
*wmi
)
3661 spin_lock_bh(&wmi
->lock
);
3663 wmi
->fat_pipe_exist
= 0;
3664 memset(wmi
->stream_exist_for_ac
, 0, sizeof(wmi
->stream_exist_for_ac
));
3666 spin_unlock_bh(&wmi
->lock
);
3669 void *ath6kl_wmi_init(struct ath6kl
*dev
)
3673 wmi
= kzalloc(sizeof(struct wmi
), GFP_KERNEL
);
3677 spin_lock_init(&wmi
->lock
);
3679 wmi
->parent_dev
= dev
;
3681 wmi
->pwr_mode
= REC_POWER
;
3683 ath6kl_wmi_reset(wmi
);
3688 void ath6kl_wmi_shutdown(struct wmi
*wmi
)
3693 kfree(wmi
->last_mgmt_tx_frame
);