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_bmisstime_cmd(struct wmi
*wmi
, u8 if_idx
,
2031 u16 bmiss_time
, u16 num_beacons
)
2033 struct sk_buff
*skb
;
2034 struct wmi_bmiss_time_cmd
*cmd
;
2037 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2041 cmd
= (struct wmi_bmiss_time_cmd
*) skb
->data
;
2042 cmd
->bmiss_time
= cpu_to_le16(bmiss_time
);
2043 cmd
->num_beacons
= cpu_to_le16(num_beacons
);
2045 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_BMISS_TIME_CMDID
,
2050 int ath6kl_wmi_powermode_cmd(struct wmi
*wmi
, u8 if_idx
, u8 pwr_mode
)
2052 struct sk_buff
*skb
;
2053 struct wmi_power_mode_cmd
*cmd
;
2056 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2060 cmd
= (struct wmi_power_mode_cmd
*) skb
->data
;
2061 cmd
->pwr_mode
= pwr_mode
;
2062 wmi
->pwr_mode
= pwr_mode
;
2064 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_POWER_MODE_CMDID
,
2069 int ath6kl_wmi_pmparams_cmd(struct wmi
*wmi
, u8 if_idx
, u16 idle_period
,
2070 u16 ps_poll_num
, u16 dtim_policy
,
2071 u16 tx_wakeup_policy
, u16 num_tx_to_wakeup
,
2072 u16 ps_fail_event_policy
)
2074 struct sk_buff
*skb
;
2075 struct wmi_power_params_cmd
*pm
;
2078 skb
= ath6kl_wmi_get_new_buf(sizeof(*pm
));
2082 pm
= (struct wmi_power_params_cmd
*)skb
->data
;
2083 pm
->idle_period
= cpu_to_le16(idle_period
);
2084 pm
->pspoll_number
= cpu_to_le16(ps_poll_num
);
2085 pm
->dtim_policy
= cpu_to_le16(dtim_policy
);
2086 pm
->tx_wakeup_policy
= cpu_to_le16(tx_wakeup_policy
);
2087 pm
->num_tx_to_wakeup
= cpu_to_le16(num_tx_to_wakeup
);
2088 pm
->ps_fail_event_policy
= cpu_to_le16(ps_fail_event_policy
);
2090 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_POWER_PARAMS_CMDID
,
2095 int ath6kl_wmi_disctimeout_cmd(struct wmi
*wmi
, u8 if_idx
, u8 timeout
)
2097 struct sk_buff
*skb
;
2098 struct wmi_disc_timeout_cmd
*cmd
;
2101 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2105 cmd
= (struct wmi_disc_timeout_cmd
*) skb
->data
;
2106 cmd
->discon_timeout
= timeout
;
2108 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_DISC_TIMEOUT_CMDID
,
2112 ath6kl_debug_set_disconnect_timeout(wmi
->parent_dev
, timeout
);
2117 int ath6kl_wmi_addkey_cmd(struct wmi
*wmi
, u8 if_idx
, u8 key_index
,
2118 enum crypto_type key_type
,
2119 u8 key_usage
, u8 key_len
,
2120 u8
*key_rsc
, unsigned int key_rsc_len
,
2122 u8 key_op_ctrl
, u8
*mac_addr
,
2123 enum wmi_sync_flag sync_flag
)
2125 struct sk_buff
*skb
;
2126 struct wmi_add_cipher_key_cmd
*cmd
;
2129 ath6kl_dbg(ATH6KL_DBG_WMI
, "addkey cmd: key_index=%u key_type=%d "
2130 "key_usage=%d key_len=%d key_op_ctrl=%d\n",
2131 key_index
, key_type
, key_usage
, key_len
, key_op_ctrl
);
2133 if ((key_index
> WMI_MAX_KEY_INDEX
) || (key_len
> WMI_MAX_KEY_LEN
) ||
2134 (key_material
== NULL
) || key_rsc_len
> 8)
2137 if ((WEP_CRYPT
!= key_type
) && (NULL
== key_rsc
))
2140 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2144 cmd
= (struct wmi_add_cipher_key_cmd
*) skb
->data
;
2145 cmd
->key_index
= key_index
;
2146 cmd
->key_type
= key_type
;
2147 cmd
->key_usage
= key_usage
;
2148 cmd
->key_len
= key_len
;
2149 memcpy(cmd
->key
, key_material
, key_len
);
2151 if (key_rsc
!= NULL
)
2152 memcpy(cmd
->key_rsc
, key_rsc
, key_rsc_len
);
2154 cmd
->key_op_ctrl
= key_op_ctrl
;
2157 memcpy(cmd
->key_mac_addr
, mac_addr
, ETH_ALEN
);
2159 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_CIPHER_KEY_CMDID
,
2165 int ath6kl_wmi_add_krk_cmd(struct wmi
*wmi
, u8 if_idx
, u8
*krk
)
2167 struct sk_buff
*skb
;
2168 struct wmi_add_krk_cmd
*cmd
;
2171 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2175 cmd
= (struct wmi_add_krk_cmd
*) skb
->data
;
2176 memcpy(cmd
->krk
, krk
, WMI_KRK_LEN
);
2178 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_KRK_CMDID
,
2184 int ath6kl_wmi_deletekey_cmd(struct wmi
*wmi
, u8 if_idx
, u8 key_index
)
2186 struct sk_buff
*skb
;
2187 struct wmi_delete_cipher_key_cmd
*cmd
;
2190 if (key_index
> WMI_MAX_KEY_INDEX
)
2193 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2197 cmd
= (struct wmi_delete_cipher_key_cmd
*) skb
->data
;
2198 cmd
->key_index
= key_index
;
2200 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DELETE_CIPHER_KEY_CMDID
,
2206 int ath6kl_wmi_setpmkid_cmd(struct wmi
*wmi
, u8 if_idx
, const u8
*bssid
,
2207 const u8
*pmkid
, bool set
)
2209 struct sk_buff
*skb
;
2210 struct wmi_setpmkid_cmd
*cmd
;
2216 if (set
&& pmkid
== NULL
)
2219 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2223 cmd
= (struct wmi_setpmkid_cmd
*) skb
->data
;
2224 memcpy(cmd
->bssid
, bssid
, ETH_ALEN
);
2226 memcpy(cmd
->pmkid
, pmkid
, sizeof(cmd
->pmkid
));
2227 cmd
->enable
= PMKID_ENABLE
;
2229 memset(cmd
->pmkid
, 0, sizeof(cmd
->pmkid
));
2230 cmd
->enable
= PMKID_DISABLE
;
2233 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_PMKID_CMDID
,
2239 static int ath6kl_wmi_data_sync_send(struct wmi
*wmi
, struct sk_buff
*skb
,
2240 enum htc_endpoint_id ep_id
, u8 if_idx
)
2242 struct wmi_data_hdr
*data_hdr
;
2245 if (WARN_ON(skb
== NULL
|| ep_id
== wmi
->ep_id
))
2248 skb_push(skb
, sizeof(struct wmi_data_hdr
));
2250 data_hdr
= (struct wmi_data_hdr
*) skb
->data
;
2251 data_hdr
->info
= SYNC_MSGTYPE
<< WMI_DATA_HDR_MSG_TYPE_SHIFT
;
2252 data_hdr
->info3
= cpu_to_le16(if_idx
& WMI_DATA_HDR_IF_IDX_MASK
);
2254 ret
= ath6kl_control_tx(wmi
->parent_dev
, skb
, ep_id
);
2259 static int ath6kl_wmi_sync_point(struct wmi
*wmi
, u8 if_idx
)
2261 struct sk_buff
*skb
;
2262 struct wmi_sync_cmd
*cmd
;
2263 struct wmi_data_sync_bufs data_sync_bufs
[WMM_NUM_AC
];
2264 enum htc_endpoint_id ep_id
;
2265 u8 index
, num_pri_streams
= 0;
2268 memset(data_sync_bufs
, 0, sizeof(data_sync_bufs
));
2270 spin_lock_bh(&wmi
->lock
);
2272 for (index
= 0; index
< WMM_NUM_AC
; index
++) {
2273 if (wmi
->fat_pipe_exist
& (1 << index
)) {
2275 data_sync_bufs
[num_pri_streams
- 1].traffic_class
=
2280 spin_unlock_bh(&wmi
->lock
);
2282 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2288 cmd
= (struct wmi_sync_cmd
*) skb
->data
;
2291 * In the SYNC cmd sent on the control Ep, send a bitmap
2292 * of the data eps on which the Data Sync will be sent
2294 cmd
->data_sync_map
= wmi
->fat_pipe_exist
;
2296 for (index
= 0; index
< num_pri_streams
; index
++) {
2297 data_sync_bufs
[index
].skb
= ath6kl_buf_alloc(0);
2298 if (data_sync_bufs
[index
].skb
== NULL
) {
2305 * If buffer allocation for any of the dataSync fails,
2306 * then do not send the Synchronize cmd on the control ep
2312 * Send sync cmd followed by sync data messages on all
2313 * endpoints being used
2315 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SYNCHRONIZE_CMDID
,
2321 /* cmd buffer sent, we no longer own it */
2324 for (index
= 0; index
< num_pri_streams
; index
++) {
2326 if (WARN_ON(!data_sync_bufs
[index
].skb
))
2329 ep_id
= ath6kl_ac2_endpoint_id(wmi
->parent_dev
,
2330 data_sync_bufs
[index
].
2333 ath6kl_wmi_data_sync_send(wmi
, data_sync_bufs
[index
].skb
,
2339 data_sync_bufs
[index
].skb
= NULL
;
2343 /* free up any resources left over (possibly due to an error) */
2347 for (index
= 0; index
< num_pri_streams
; index
++) {
2348 if (data_sync_bufs
[index
].skb
!= NULL
) {
2349 dev_kfree_skb((struct sk_buff
*)data_sync_bufs
[index
].
2357 int ath6kl_wmi_create_pstream_cmd(struct wmi
*wmi
, u8 if_idx
,
2358 struct wmi_create_pstream_cmd
*params
)
2360 struct sk_buff
*skb
;
2361 struct wmi_create_pstream_cmd
*cmd
;
2362 u8 fatpipe_exist_for_ac
= 0;
2364 s32 nominal_phy
= 0;
2367 if (!((params
->user_pri
< 8) &&
2368 (params
->user_pri
<= 0x7) &&
2369 (up_to_ac
[params
->user_pri
& 0x7] == params
->traffic_class
) &&
2370 (params
->traffic_direc
== UPLINK_TRAFFIC
||
2371 params
->traffic_direc
== DNLINK_TRAFFIC
||
2372 params
->traffic_direc
== BIDIR_TRAFFIC
) &&
2373 (params
->traffic_type
== TRAFFIC_TYPE_APERIODIC
||
2374 params
->traffic_type
== TRAFFIC_TYPE_PERIODIC
) &&
2375 (params
->voice_psc_cap
== DISABLE_FOR_THIS_AC
||
2376 params
->voice_psc_cap
== ENABLE_FOR_THIS_AC
||
2377 params
->voice_psc_cap
== ENABLE_FOR_ALL_AC
) &&
2378 (params
->tsid
== WMI_IMPLICIT_PSTREAM
||
2379 params
->tsid
<= WMI_MAX_THINSTREAM
))) {
2384 * Check nominal PHY rate is >= minimalPHY,
2385 * so that DUT can allow TSRS IE
2388 /* Get the physical rate (units of bps) */
2389 min_phy
= ((le32_to_cpu(params
->min_phy_rate
) / 1000) / 1000);
2391 /* Check minimal phy < nominal phy rate */
2392 if (params
->nominal_phy
>= min_phy
) {
2393 /* unit of 500 kbps */
2394 nominal_phy
= (params
->nominal_phy
* 1000) / 500;
2395 ath6kl_dbg(ATH6KL_DBG_WMI
,
2396 "TSRS IE enabled::MinPhy %x->NominalPhy ===> %x\n",
2397 min_phy
, nominal_phy
);
2399 params
->nominal_phy
= nominal_phy
;
2401 params
->nominal_phy
= 0;
2404 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2408 ath6kl_dbg(ATH6KL_DBG_WMI
,
2409 "sending create_pstream_cmd: ac=%d tsid:%d\n",
2410 params
->traffic_class
, params
->tsid
);
2412 cmd
= (struct wmi_create_pstream_cmd
*) skb
->data
;
2413 memcpy(cmd
, params
, sizeof(*cmd
));
2415 /* This is an implicitly created Fat pipe */
2416 if ((u32
) params
->tsid
== (u32
) WMI_IMPLICIT_PSTREAM
) {
2417 spin_lock_bh(&wmi
->lock
);
2418 fatpipe_exist_for_ac
= (wmi
->fat_pipe_exist
&
2419 (1 << params
->traffic_class
));
2420 wmi
->fat_pipe_exist
|= (1 << params
->traffic_class
);
2421 spin_unlock_bh(&wmi
->lock
);
2423 /* explicitly created thin stream within a fat pipe */
2424 spin_lock_bh(&wmi
->lock
);
2425 fatpipe_exist_for_ac
= (wmi
->fat_pipe_exist
&
2426 (1 << params
->traffic_class
));
2427 wmi
->stream_exist_for_ac
[params
->traffic_class
] |=
2428 (1 << params
->tsid
);
2430 * If a thinstream becomes active, the fat pipe automatically
2433 wmi
->fat_pipe_exist
|= (1 << params
->traffic_class
);
2434 spin_unlock_bh(&wmi
->lock
);
2438 * Indicate activty change to driver layer only if this is the
2439 * first TSID to get created in this AC explicitly or an implicit
2440 * fat pipe is getting created.
2442 if (!fatpipe_exist_for_ac
)
2443 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2444 params
->traffic_class
, true);
2446 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_CREATE_PSTREAM_CMDID
,
2451 int ath6kl_wmi_delete_pstream_cmd(struct wmi
*wmi
, u8 if_idx
, u8 traffic_class
,
2454 struct sk_buff
*skb
;
2455 struct wmi_delete_pstream_cmd
*cmd
;
2456 u16 active_tsids
= 0;
2459 if (traffic_class
> 3) {
2460 ath6kl_err("invalid traffic class: %d\n", traffic_class
);
2464 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2468 cmd
= (struct wmi_delete_pstream_cmd
*) skb
->data
;
2469 cmd
->traffic_class
= traffic_class
;
2472 spin_lock_bh(&wmi
->lock
);
2473 active_tsids
= wmi
->stream_exist_for_ac
[traffic_class
];
2474 spin_unlock_bh(&wmi
->lock
);
2476 if (!(active_tsids
& (1 << tsid
))) {
2478 ath6kl_dbg(ATH6KL_DBG_WMI
,
2479 "TSID %d doesn't exist for traffic class: %d\n",
2480 tsid
, traffic_class
);
2484 ath6kl_dbg(ATH6KL_DBG_WMI
,
2485 "sending delete_pstream_cmd: traffic class: %d tsid=%d\n",
2486 traffic_class
, tsid
);
2488 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DELETE_PSTREAM_CMDID
,
2489 SYNC_BEFORE_WMIFLAG
);
2491 spin_lock_bh(&wmi
->lock
);
2492 wmi
->stream_exist_for_ac
[traffic_class
] &= ~(1 << tsid
);
2493 active_tsids
= wmi
->stream_exist_for_ac
[traffic_class
];
2494 spin_unlock_bh(&wmi
->lock
);
2497 * Indicate stream inactivity to driver layer only if all tsids
2498 * within this AC are deleted.
2500 if (!active_tsids
) {
2501 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2502 traffic_class
, false);
2503 wmi
->fat_pipe_exist
&= ~(1 << traffic_class
);
2509 int ath6kl_wmi_set_ip_cmd(struct wmi
*wmi
, u8 if_idx
,
2510 __be32 ips0
, __be32 ips1
)
2512 struct sk_buff
*skb
;
2513 struct wmi_set_ip_cmd
*cmd
;
2516 /* Multicast address are not valid */
2517 if (ipv4_is_multicast(ips0
) ||
2518 ipv4_is_multicast(ips1
))
2521 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_ip_cmd
));
2525 cmd
= (struct wmi_set_ip_cmd
*) skb
->data
;
2529 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_IP_CMDID
,
2534 static void ath6kl_wmi_relinquish_implicit_pstream_credits(struct wmi
*wmi
)
2541 * Relinquish credits from all implicitly created pstreams
2542 * since when we go to sleep. If user created explicit
2543 * thinstreams exists with in a fatpipe leave them intact
2544 * for the user to delete.
2546 spin_lock_bh(&wmi
->lock
);
2547 stream_exist
= wmi
->fat_pipe_exist
;
2548 spin_unlock_bh(&wmi
->lock
);
2550 for (i
= 0; i
< WMM_NUM_AC
; i
++) {
2551 if (stream_exist
& (1 << i
)) {
2554 * FIXME: Is this lock & unlock inside
2555 * for loop correct? may need rework.
2557 spin_lock_bh(&wmi
->lock
);
2558 active_tsids
= wmi
->stream_exist_for_ac
[i
];
2559 spin_unlock_bh(&wmi
->lock
);
2562 * If there are no user created thin streams
2563 * delete the fatpipe
2565 if (!active_tsids
) {
2566 stream_exist
&= ~(1 << i
);
2568 * Indicate inactivity to driver layer for
2569 * this fatpipe (pstream)
2571 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2577 /* FIXME: Can we do this assignment without locking ? */
2578 spin_lock_bh(&wmi
->lock
);
2579 wmi
->fat_pipe_exist
= stream_exist
;
2580 spin_unlock_bh(&wmi
->lock
);
2583 int ath6kl_wmi_set_host_sleep_mode_cmd(struct wmi
*wmi
, u8 if_idx
,
2584 enum ath6kl_host_mode host_mode
)
2586 struct sk_buff
*skb
;
2587 struct wmi_set_host_sleep_mode_cmd
*cmd
;
2590 if ((host_mode
!= ATH6KL_HOST_MODE_ASLEEP
) &&
2591 (host_mode
!= ATH6KL_HOST_MODE_AWAKE
)) {
2592 ath6kl_err("invalid host sleep mode: %d\n", host_mode
);
2596 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2600 cmd
= (struct wmi_set_host_sleep_mode_cmd
*) skb
->data
;
2602 if (host_mode
== ATH6KL_HOST_MODE_ASLEEP
) {
2603 ath6kl_wmi_relinquish_implicit_pstream_credits(wmi
);
2604 cmd
->asleep
= cpu_to_le32(1);
2606 cmd
->awake
= cpu_to_le32(1);
2608 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
2609 WMI_SET_HOST_SLEEP_MODE_CMDID
,
2614 /* This command has zero length payload */
2615 static int ath6kl_wmi_host_sleep_mode_cmd_prcd_evt_rx(struct wmi
*wmi
,
2616 struct ath6kl_vif
*vif
)
2618 struct ath6kl
*ar
= wmi
->parent_dev
;
2620 set_bit(HOST_SLEEP_MODE_CMD_PROCESSED
, &vif
->flags
);
2621 wake_up(&ar
->event_wq
);
2626 int ath6kl_wmi_set_wow_mode_cmd(struct wmi
*wmi
, u8 if_idx
,
2627 enum ath6kl_wow_mode wow_mode
,
2628 u32 filter
, u16 host_req_delay
)
2630 struct sk_buff
*skb
;
2631 struct wmi_set_wow_mode_cmd
*cmd
;
2634 if ((wow_mode
!= ATH6KL_WOW_MODE_ENABLE
) &&
2635 wow_mode
!= ATH6KL_WOW_MODE_DISABLE
) {
2636 ath6kl_err("invalid wow mode: %d\n", wow_mode
);
2640 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2644 cmd
= (struct wmi_set_wow_mode_cmd
*) skb
->data
;
2645 cmd
->enable_wow
= cpu_to_le32(wow_mode
);
2646 cmd
->filter
= cpu_to_le32(filter
);
2647 cmd
->host_req_delay
= cpu_to_le16(host_req_delay
);
2649 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_WOW_MODE_CMDID
,
2654 int ath6kl_wmi_add_wow_pattern_cmd(struct wmi
*wmi
, u8 if_idx
,
2655 u8 list_id
, u8 filter_size
,
2656 u8 filter_offset
, const u8
*filter
,
2659 struct sk_buff
*skb
;
2660 struct wmi_add_wow_pattern_cmd
*cmd
;
2666 * Allocate additional memory in the buffer to hold
2667 * filter and mask value, which is twice of filter_size.
2669 size
= sizeof(*cmd
) + (2 * filter_size
);
2671 skb
= ath6kl_wmi_get_new_buf(size
);
2675 cmd
= (struct wmi_add_wow_pattern_cmd
*) skb
->data
;
2676 cmd
->filter_list_id
= list_id
;
2677 cmd
->filter_size
= filter_size
;
2678 cmd
->filter_offset
= filter_offset
;
2680 memcpy(cmd
->filter
, filter
, filter_size
);
2682 filter_mask
= (u8
*) (cmd
->filter
+ filter_size
);
2683 memcpy(filter_mask
, mask
, filter_size
);
2685 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_WOW_PATTERN_CMDID
,
2691 int ath6kl_wmi_del_wow_pattern_cmd(struct wmi
*wmi
, u8 if_idx
,
2692 u16 list_id
, u16 filter_id
)
2694 struct sk_buff
*skb
;
2695 struct wmi_del_wow_pattern_cmd
*cmd
;
2698 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2702 cmd
= (struct wmi_del_wow_pattern_cmd
*) skb
->data
;
2703 cmd
->filter_list_id
= cpu_to_le16(list_id
);
2704 cmd
->filter_id
= cpu_to_le16(filter_id
);
2706 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DEL_WOW_PATTERN_CMDID
,
2711 static int ath6kl_wmi_cmd_send_xtnd(struct wmi
*wmi
, struct sk_buff
*skb
,
2712 enum wmix_command_id cmd_id
,
2713 enum wmi_sync_flag sync_flag
)
2715 struct wmix_cmd_hdr
*cmd_hdr
;
2718 skb_push(skb
, sizeof(struct wmix_cmd_hdr
));
2720 cmd_hdr
= (struct wmix_cmd_hdr
*) skb
->data
;
2721 cmd_hdr
->cmd_id
= cpu_to_le32(cmd_id
);
2723 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_EXTENSION_CMDID
, sync_flag
);
2728 int ath6kl_wmi_get_challenge_resp_cmd(struct wmi
*wmi
, u32 cookie
, u32 source
)
2730 struct sk_buff
*skb
;
2731 struct wmix_hb_challenge_resp_cmd
*cmd
;
2734 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2738 cmd
= (struct wmix_hb_challenge_resp_cmd
*) skb
->data
;
2739 cmd
->cookie
= cpu_to_le32(cookie
);
2740 cmd
->source
= cpu_to_le32(source
);
2742 ret
= ath6kl_wmi_cmd_send_xtnd(wmi
, skb
, WMIX_HB_CHALLENGE_RESP_CMDID
,
2747 int ath6kl_wmi_config_debug_module_cmd(struct wmi
*wmi
, u32 valid
, u32 config
)
2749 struct ath6kl_wmix_dbglog_cfg_module_cmd
*cmd
;
2750 struct sk_buff
*skb
;
2753 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2757 cmd
= (struct ath6kl_wmix_dbglog_cfg_module_cmd
*) skb
->data
;
2758 cmd
->valid
= cpu_to_le32(valid
);
2759 cmd
->config
= cpu_to_le32(config
);
2761 ret
= ath6kl_wmi_cmd_send_xtnd(wmi
, skb
, WMIX_DBGLOG_CFG_MODULE_CMDID
,
2766 int ath6kl_wmi_get_stats_cmd(struct wmi
*wmi
, u8 if_idx
)
2768 return ath6kl_wmi_simple_cmd(wmi
, if_idx
, WMI_GET_STATISTICS_CMDID
);
2771 int ath6kl_wmi_set_tx_pwr_cmd(struct wmi
*wmi
, u8 if_idx
, u8 dbM
)
2773 struct sk_buff
*skb
;
2774 struct wmi_set_tx_pwr_cmd
*cmd
;
2777 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_tx_pwr_cmd
));
2781 cmd
= (struct wmi_set_tx_pwr_cmd
*) skb
->data
;
2784 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_TX_PWR_CMDID
,
2790 int ath6kl_wmi_get_tx_pwr_cmd(struct wmi
*wmi
, u8 if_idx
)
2792 return ath6kl_wmi_simple_cmd(wmi
, if_idx
, WMI_GET_TX_PWR_CMDID
);
2795 int ath6kl_wmi_get_roam_tbl_cmd(struct wmi
*wmi
)
2797 return ath6kl_wmi_simple_cmd(wmi
, 0, WMI_GET_ROAM_TBL_CMDID
);
2800 int ath6kl_wmi_set_lpreamble_cmd(struct wmi
*wmi
, u8 if_idx
, u8 status
,
2803 struct sk_buff
*skb
;
2804 struct wmi_set_lpreamble_cmd
*cmd
;
2807 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_lpreamble_cmd
));
2811 cmd
= (struct wmi_set_lpreamble_cmd
*) skb
->data
;
2812 cmd
->status
= status
;
2813 cmd
->preamble_policy
= preamble_policy
;
2815 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_LPREAMBLE_CMDID
,
2820 int ath6kl_wmi_set_rts_cmd(struct wmi
*wmi
, u16 threshold
)
2822 struct sk_buff
*skb
;
2823 struct wmi_set_rts_cmd
*cmd
;
2826 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_rts_cmd
));
2830 cmd
= (struct wmi_set_rts_cmd
*) skb
->data
;
2831 cmd
->threshold
= cpu_to_le16(threshold
);
2833 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_RTS_CMDID
,
2838 int ath6kl_wmi_set_wmm_txop(struct wmi
*wmi
, u8 if_idx
, enum wmi_txop_cfg cfg
)
2840 struct sk_buff
*skb
;
2841 struct wmi_set_wmm_txop_cmd
*cmd
;
2844 if (!((cfg
== WMI_TXOP_DISABLED
) || (cfg
== WMI_TXOP_ENABLED
)))
2847 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_wmm_txop_cmd
));
2851 cmd
= (struct wmi_set_wmm_txop_cmd
*) skb
->data
;
2852 cmd
->txop_enable
= cfg
;
2854 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_WMM_TXOP_CMDID
,
2859 int ath6kl_wmi_set_keepalive_cmd(struct wmi
*wmi
, u8 if_idx
,
2860 u8 keep_alive_intvl
)
2862 struct sk_buff
*skb
;
2863 struct wmi_set_keepalive_cmd
*cmd
;
2866 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2870 cmd
= (struct wmi_set_keepalive_cmd
*) skb
->data
;
2871 cmd
->keep_alive_intvl
= keep_alive_intvl
;
2873 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_KEEPALIVE_CMDID
,
2877 ath6kl_debug_set_keepalive(wmi
->parent_dev
, keep_alive_intvl
);
2882 int ath6kl_wmi_test_cmd(struct wmi
*wmi
, void *buf
, size_t len
)
2884 struct sk_buff
*skb
;
2887 skb
= ath6kl_wmi_get_new_buf(len
);
2891 memcpy(skb
->data
, buf
, len
);
2893 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_TEST_CMDID
, NO_SYNC_WMIFLAG
);
2898 int ath6kl_wmi_mcast_filter_cmd(struct wmi
*wmi
, u8 if_idx
, bool mc_all_on
)
2900 struct sk_buff
*skb
;
2901 struct wmi_mcast_filter_cmd
*cmd
;
2904 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2908 cmd
= (struct wmi_mcast_filter_cmd
*) skb
->data
;
2909 cmd
->mcast_all_enable
= mc_all_on
;
2911 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_MCAST_FILTER_CMDID
,
2916 int ath6kl_wmi_add_del_mcast_filter_cmd(struct wmi
*wmi
, u8 if_idx
,
2917 u8
*filter
, bool add_filter
)
2919 struct sk_buff
*skb
;
2920 struct wmi_mcast_filter_add_del_cmd
*cmd
;
2923 if ((filter
[0] != 0x33 || filter
[1] != 0x33) &&
2924 (filter
[0] != 0x01 || filter
[1] != 0x00 ||
2925 filter
[2] != 0x5e || filter
[3] > 0x7f)) {
2926 ath6kl_warn("invalid multicast filter address\n");
2930 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2934 cmd
= (struct wmi_mcast_filter_add_del_cmd
*) skb
->data
;
2935 memcpy(cmd
->mcast_mac
, filter
, ATH6KL_MCAST_FILTER_MAC_ADDR_SIZE
);
2936 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
2937 add_filter
? WMI_SET_MCAST_FILTER_CMDID
:
2938 WMI_DEL_MCAST_FILTER_CMDID
,
2944 s32
ath6kl_wmi_get_rate(s8 rate_index
)
2946 if (rate_index
== RATE_AUTO
)
2949 return wmi_rate_tbl
[(u32
) rate_index
][0];
2952 static int ath6kl_wmi_get_pmkid_list_event_rx(struct wmi
*wmi
, u8
*datap
,
2955 struct wmi_pmkid_list_reply
*reply
;
2958 if (len
< sizeof(struct wmi_pmkid_list_reply
))
2961 reply
= (struct wmi_pmkid_list_reply
*)datap
;
2962 expected_len
= sizeof(reply
->num_pmkid
) +
2963 le32_to_cpu(reply
->num_pmkid
) * WMI_PMKID_LEN
;
2965 if (len
< expected_len
)
2971 static int ath6kl_wmi_addba_req_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
2972 struct ath6kl_vif
*vif
)
2974 struct wmi_addba_req_event
*cmd
= (struct wmi_addba_req_event
*) datap
;
2976 aggr_recv_addba_req_evt(vif
, cmd
->tid
,
2977 le16_to_cpu(cmd
->st_seq_no
), cmd
->win_sz
);
2982 static int ath6kl_wmi_delba_req_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
2983 struct ath6kl_vif
*vif
)
2985 struct wmi_delba_event
*cmd
= (struct wmi_delba_event
*) datap
;
2987 aggr_recv_delba_req_evt(vif
, cmd
->tid
);
2992 /* AP mode functions */
2994 int ath6kl_wmi_ap_profile_commit(struct wmi
*wmip
, u8 if_idx
,
2995 struct wmi_connect_cmd
*p
)
2997 struct sk_buff
*skb
;
2998 struct wmi_connect_cmd
*cm
;
3001 skb
= ath6kl_wmi_get_new_buf(sizeof(*cm
));
3005 cm
= (struct wmi_connect_cmd
*) skb
->data
;
3006 memcpy(cm
, p
, sizeof(*cm
));
3008 res
= ath6kl_wmi_cmd_send(wmip
, if_idx
, skb
, WMI_AP_CONFIG_COMMIT_CMDID
,
3010 ath6kl_dbg(ATH6KL_DBG_WMI
, "%s: nw_type=%u auth_mode=%u ch=%u "
3011 "ctrl_flags=0x%x-> res=%d\n",
3012 __func__
, p
->nw_type
, p
->auth_mode
, le16_to_cpu(p
->ch
),
3013 le32_to_cpu(p
->ctrl_flags
), res
);
3017 int ath6kl_wmi_ap_set_mlme(struct wmi
*wmip
, u8 if_idx
, u8 cmd
, const u8
*mac
,
3020 struct sk_buff
*skb
;
3021 struct wmi_ap_set_mlme_cmd
*cm
;
3023 skb
= ath6kl_wmi_get_new_buf(sizeof(*cm
));
3027 cm
= (struct wmi_ap_set_mlme_cmd
*) skb
->data
;
3028 memcpy(cm
->mac
, mac
, ETH_ALEN
);
3029 cm
->reason
= cpu_to_le16(reason
);
3032 return ath6kl_wmi_cmd_send(wmip
, if_idx
, skb
, WMI_AP_SET_MLME_CMDID
,
3036 int ath6kl_wmi_ap_hidden_ssid(struct wmi
*wmi
, u8 if_idx
, bool enable
)
3038 struct sk_buff
*skb
;
3039 struct wmi_ap_hidden_ssid_cmd
*cmd
;
3041 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3045 cmd
= (struct wmi_ap_hidden_ssid_cmd
*) skb
->data
;
3046 cmd
->hidden_ssid
= enable
? 1 : 0;
3048 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_HIDDEN_SSID_CMDID
,
3052 /* This command will be used to enable/disable AP uAPSD feature */
3053 int ath6kl_wmi_ap_set_apsd(struct wmi
*wmi
, u8 if_idx
, u8 enable
)
3055 struct wmi_ap_set_apsd_cmd
*cmd
;
3056 struct sk_buff
*skb
;
3058 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3062 cmd
= (struct wmi_ap_set_apsd_cmd
*)skb
->data
;
3063 cmd
->enable
= enable
;
3065 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_SET_APSD_CMDID
,
3069 int ath6kl_wmi_set_apsd_bfrd_traf(struct wmi
*wmi
, u8 if_idx
,
3070 u16 aid
, u16 bitmap
, u32 flags
)
3072 struct wmi_ap_apsd_buffered_traffic_cmd
*cmd
;
3073 struct sk_buff
*skb
;
3075 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3079 cmd
= (struct wmi_ap_apsd_buffered_traffic_cmd
*)skb
->data
;
3080 cmd
->aid
= cpu_to_le16(aid
);
3081 cmd
->bitmap
= cpu_to_le16(bitmap
);
3082 cmd
->flags
= cpu_to_le32(flags
);
3084 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
3085 WMI_AP_APSD_BUFFERED_TRAFFIC_CMDID
,
3089 static int ath6kl_wmi_pspoll_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
3090 struct ath6kl_vif
*vif
)
3092 struct wmi_pspoll_event
*ev
;
3094 if (len
< sizeof(struct wmi_pspoll_event
))
3097 ev
= (struct wmi_pspoll_event
*) datap
;
3099 ath6kl_pspoll_event(vif
, le16_to_cpu(ev
->aid
));
3104 static int ath6kl_wmi_dtimexpiry_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
3105 struct ath6kl_vif
*vif
)
3107 ath6kl_dtimexpiry_event(vif
);
3112 int ath6kl_wmi_set_pvb_cmd(struct wmi
*wmi
, u8 if_idx
, u16 aid
,
3115 struct sk_buff
*skb
;
3116 struct wmi_ap_set_pvb_cmd
*cmd
;
3119 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_ap_set_pvb_cmd
));
3123 cmd
= (struct wmi_ap_set_pvb_cmd
*) skb
->data
;
3124 cmd
->aid
= cpu_to_le16(aid
);
3125 cmd
->rsvd
= cpu_to_le16(0);
3126 cmd
->flag
= cpu_to_le32(flag
);
3128 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_SET_PVB_CMDID
,
3134 int ath6kl_wmi_set_rx_frame_format_cmd(struct wmi
*wmi
, u8 if_idx
,
3136 bool rx_dot11_hdr
, bool defrag_on_host
)
3138 struct sk_buff
*skb
;
3139 struct wmi_rx_frame_format_cmd
*cmd
;
3142 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3146 cmd
= (struct wmi_rx_frame_format_cmd
*) skb
->data
;
3147 cmd
->dot11_hdr
= rx_dot11_hdr
? 1 : 0;
3148 cmd
->defrag_on_host
= defrag_on_host
? 1 : 0;
3149 cmd
->meta_ver
= rx_meta_ver
;
3151 /* Delete the local aggr state, on host */
3152 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_RX_FRAME_FORMAT_CMDID
,
3158 int ath6kl_wmi_set_appie_cmd(struct wmi
*wmi
, u8 if_idx
, u8 mgmt_frm_type
,
3159 const u8
*ie
, u8 ie_len
)
3161 struct sk_buff
*skb
;
3162 struct wmi_set_appie_cmd
*p
;
3164 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + ie_len
);
3168 ath6kl_dbg(ATH6KL_DBG_WMI
, "set_appie_cmd: mgmt_frm_type=%u "
3169 "ie_len=%u\n", mgmt_frm_type
, ie_len
);
3170 p
= (struct wmi_set_appie_cmd
*) skb
->data
;
3171 p
->mgmt_frm_type
= mgmt_frm_type
;
3174 if (ie
!= NULL
&& ie_len
> 0)
3175 memcpy(p
->ie_info
, ie
, ie_len
);
3177 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_APPIE_CMDID
,
3181 int ath6kl_wmi_disable_11b_rates_cmd(struct wmi
*wmi
, bool disable
)
3183 struct sk_buff
*skb
;
3184 struct wmi_disable_11b_rates_cmd
*cmd
;
3186 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3190 ath6kl_dbg(ATH6KL_DBG_WMI
, "disable_11b_rates_cmd: disable=%u\n",
3192 cmd
= (struct wmi_disable_11b_rates_cmd
*) skb
->data
;
3193 cmd
->disable
= disable
? 1 : 0;
3195 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_DISABLE_11B_RATES_CMDID
,
3199 int ath6kl_wmi_remain_on_chnl_cmd(struct wmi
*wmi
, u8 if_idx
, u32 freq
, u32 dur
)
3201 struct sk_buff
*skb
;
3202 struct wmi_remain_on_chnl_cmd
*p
;
3204 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3208 ath6kl_dbg(ATH6KL_DBG_WMI
, "remain_on_chnl_cmd: freq=%u dur=%u\n",
3210 p
= (struct wmi_remain_on_chnl_cmd
*) skb
->data
;
3211 p
->freq
= cpu_to_le32(freq
);
3212 p
->duration
= cpu_to_le32(dur
);
3213 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_REMAIN_ON_CHNL_CMDID
,
3217 /* ath6kl_wmi_send_action_cmd is to be deprecated. Use
3218 * ath6kl_wmi_send_mgmt_cmd instead. The new function supports P2P
3219 * mgmt operations using station interface.
3221 static int ath6kl_wmi_send_action_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
,
3222 u32 freq
, u32 wait
, const u8
*data
,
3225 struct sk_buff
*skb
;
3226 struct wmi_send_action_cmd
*p
;
3230 return -EINVAL
; /* Offload for wait not supported */
3232 buf
= kmalloc(data_len
, GFP_KERNEL
);
3236 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + data_len
);
3242 kfree(wmi
->last_mgmt_tx_frame
);
3243 memcpy(buf
, data
, data_len
);
3244 wmi
->last_mgmt_tx_frame
= buf
;
3245 wmi
->last_mgmt_tx_frame_len
= data_len
;
3247 ath6kl_dbg(ATH6KL_DBG_WMI
, "send_action_cmd: id=%u freq=%u wait=%u "
3248 "len=%u\n", id
, freq
, wait
, data_len
);
3249 p
= (struct wmi_send_action_cmd
*) skb
->data
;
3250 p
->id
= cpu_to_le32(id
);
3251 p
->freq
= cpu_to_le32(freq
);
3252 p
->wait
= cpu_to_le32(wait
);
3253 p
->len
= cpu_to_le16(data_len
);
3254 memcpy(p
->data
, data
, data_len
);
3255 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SEND_ACTION_CMDID
,
3259 static int __ath6kl_wmi_send_mgmt_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
,
3260 u32 freq
, u32 wait
, const u8
*data
,
3261 u16 data_len
, u32 no_cck
)
3263 struct sk_buff
*skb
;
3264 struct wmi_send_mgmt_cmd
*p
;
3268 return -EINVAL
; /* Offload for wait not supported */
3270 buf
= kmalloc(data_len
, GFP_KERNEL
);
3274 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + data_len
);
3280 kfree(wmi
->last_mgmt_tx_frame
);
3281 memcpy(buf
, data
, data_len
);
3282 wmi
->last_mgmt_tx_frame
= buf
;
3283 wmi
->last_mgmt_tx_frame_len
= data_len
;
3285 ath6kl_dbg(ATH6KL_DBG_WMI
, "send_action_cmd: id=%u freq=%u wait=%u "
3286 "len=%u\n", id
, freq
, wait
, data_len
);
3287 p
= (struct wmi_send_mgmt_cmd
*) skb
->data
;
3288 p
->id
= cpu_to_le32(id
);
3289 p
->freq
= cpu_to_le32(freq
);
3290 p
->wait
= cpu_to_le32(wait
);
3291 p
->no_cck
= cpu_to_le32(no_cck
);
3292 p
->len
= cpu_to_le16(data_len
);
3293 memcpy(p
->data
, data
, data_len
);
3294 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SEND_MGMT_CMDID
,
3298 int ath6kl_wmi_send_mgmt_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
, u32 freq
,
3299 u32 wait
, const u8
*data
, u16 data_len
,
3303 struct ath6kl
*ar
= wmi
->parent_dev
;
3305 if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX
,
3306 ar
->fw_capabilities
)) {
3308 * If capable of doing P2P mgmt operations using
3309 * station interface, send additional information like
3310 * supported rates to advertise and xmit rates for
3313 status
= __ath6kl_wmi_send_mgmt_cmd(ar
->wmi
, if_idx
, id
, freq
,
3314 wait
, data
, data_len
,
3317 status
= ath6kl_wmi_send_action_cmd(ar
->wmi
, if_idx
, id
, freq
,
3318 wait
, data
, data_len
);
3324 int ath6kl_wmi_send_probe_response_cmd(struct wmi
*wmi
, u8 if_idx
, u32 freq
,
3325 const u8
*dst
, const u8
*data
,
3328 struct sk_buff
*skb
;
3329 struct wmi_p2p_probe_response_cmd
*p
;
3330 size_t cmd_len
= sizeof(*p
) + data_len
;
3333 cmd_len
++; /* work around target minimum length requirement */
3335 skb
= ath6kl_wmi_get_new_buf(cmd_len
);
3339 ath6kl_dbg(ATH6KL_DBG_WMI
, "send_probe_response_cmd: freq=%u dst=%pM "
3340 "len=%u\n", freq
, dst
, data_len
);
3341 p
= (struct wmi_p2p_probe_response_cmd
*) skb
->data
;
3342 p
->freq
= cpu_to_le32(freq
);
3343 memcpy(p
->destination_addr
, dst
, ETH_ALEN
);
3344 p
->len
= cpu_to_le16(data_len
);
3345 memcpy(p
->data
, data
, data_len
);
3346 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
3347 WMI_SEND_PROBE_RESPONSE_CMDID
,
3351 int ath6kl_wmi_probe_report_req_cmd(struct wmi
*wmi
, u8 if_idx
, bool enable
)
3353 struct sk_buff
*skb
;
3354 struct wmi_probe_req_report_cmd
*p
;
3356 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3360 ath6kl_dbg(ATH6KL_DBG_WMI
, "probe_report_req_cmd: enable=%u\n",
3362 p
= (struct wmi_probe_req_report_cmd
*) skb
->data
;
3363 p
->enable
= enable
? 1 : 0;
3364 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_PROBE_REQ_REPORT_CMDID
,
3368 int ath6kl_wmi_info_req_cmd(struct wmi
*wmi
, u8 if_idx
, u32 info_req_flags
)
3370 struct sk_buff
*skb
;
3371 struct wmi_get_p2p_info
*p
;
3373 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3377 ath6kl_dbg(ATH6KL_DBG_WMI
, "info_req_cmd: flags=%x\n",
3379 p
= (struct wmi_get_p2p_info
*) skb
->data
;
3380 p
->info_req_flags
= cpu_to_le32(info_req_flags
);
3381 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_GET_P2P_INFO_CMDID
,
3385 int ath6kl_wmi_cancel_remain_on_chnl_cmd(struct wmi
*wmi
, u8 if_idx
)
3387 ath6kl_dbg(ATH6KL_DBG_WMI
, "cancel_remain_on_chnl_cmd\n");
3388 return ath6kl_wmi_simple_cmd(wmi
, if_idx
,
3389 WMI_CANCEL_REMAIN_ON_CHNL_CMDID
);
3392 static int ath6kl_wmi_control_rx_xtnd(struct wmi
*wmi
, struct sk_buff
*skb
)
3394 struct wmix_cmd_hdr
*cmd
;
3400 if (skb
->len
< sizeof(struct wmix_cmd_hdr
)) {
3401 ath6kl_err("bad packet 1\n");
3405 cmd
= (struct wmix_cmd_hdr
*) skb
->data
;
3406 id
= le32_to_cpu(cmd
->cmd_id
);
3408 skb_pull(skb
, sizeof(struct wmix_cmd_hdr
));
3414 case WMIX_HB_CHALLENGE_RESP_EVENTID
:
3415 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi event hb challenge resp\n");
3417 case WMIX_DBGLOG_EVENTID
:
3418 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi event dbglog len %d\n", len
);
3419 ath6kl_debug_fwlog_event(wmi
->parent_dev
, datap
, len
);
3422 ath6kl_warn("unknown cmd id 0x%x\n", id
);
3430 static int ath6kl_wmi_roam_tbl_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
3432 return ath6kl_debug_roam_tbl_event(wmi
->parent_dev
, datap
, len
);
3435 /* Process interface specific wmi events, caller would free the datap */
3436 static int ath6kl_wmi_proc_events_vif(struct wmi
*wmi
, u16 if_idx
, u16 cmd_id
,
3439 struct ath6kl_vif
*vif
;
3441 vif
= ath6kl_get_vif_by_index(wmi
->parent_dev
, if_idx
);
3443 ath6kl_dbg(ATH6KL_DBG_WMI
,
3444 "Wmi event for unavailable vif, vif_index:%d\n",
3450 case WMI_CONNECT_EVENTID
:
3451 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CONNECT_EVENTID\n");
3452 return ath6kl_wmi_connect_event_rx(wmi
, datap
, len
, vif
);
3453 case WMI_DISCONNECT_EVENTID
:
3454 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DISCONNECT_EVENTID\n");
3455 return ath6kl_wmi_disconnect_event_rx(wmi
, datap
, len
, vif
);
3456 case WMI_TKIP_MICERR_EVENTID
:
3457 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TKIP_MICERR_EVENTID\n");
3458 return ath6kl_wmi_tkip_micerr_event_rx(wmi
, datap
, len
, vif
);
3459 case WMI_BSSINFO_EVENTID
:
3460 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_BSSINFO_EVENTID\n");
3461 return ath6kl_wmi_bssinfo_event_rx(wmi
, datap
, len
, vif
);
3462 case WMI_NEIGHBOR_REPORT_EVENTID
:
3463 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_NEIGHBOR_REPORT_EVENTID\n");
3464 return ath6kl_wmi_neighbor_report_event_rx(wmi
, datap
, len
,
3466 case WMI_SCAN_COMPLETE_EVENTID
:
3467 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SCAN_COMPLETE_EVENTID\n");
3468 return ath6kl_wmi_scan_complete_rx(wmi
, datap
, len
, vif
);
3469 case WMI_REPORT_STATISTICS_EVENTID
:
3470 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_STATISTICS_EVENTID\n");
3471 return ath6kl_wmi_stats_event_rx(wmi
, datap
, len
, vif
);
3472 case WMI_CAC_EVENTID
:
3473 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CAC_EVENTID\n");
3474 return ath6kl_wmi_cac_event_rx(wmi
, datap
, len
, vif
);
3475 case WMI_PSPOLL_EVENTID
:
3476 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PSPOLL_EVENTID\n");
3477 return ath6kl_wmi_pspoll_event_rx(wmi
, datap
, len
, vif
);
3478 case WMI_DTIMEXPIRY_EVENTID
:
3479 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DTIMEXPIRY_EVENTID\n");
3480 return ath6kl_wmi_dtimexpiry_event_rx(wmi
, datap
, len
, vif
);
3481 case WMI_ADDBA_REQ_EVENTID
:
3482 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ADDBA_REQ_EVENTID\n");
3483 return ath6kl_wmi_addba_req_event_rx(wmi
, datap
, len
, vif
);
3484 case WMI_DELBA_REQ_EVENTID
:
3485 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DELBA_REQ_EVENTID\n");
3486 return ath6kl_wmi_delba_req_event_rx(wmi
, datap
, len
, vif
);
3487 case WMI_SET_HOST_SLEEP_MODE_CMD_PROCESSED_EVENTID
:
3488 ath6kl_dbg(ATH6KL_DBG_WMI
,
3489 "WMI_SET_HOST_SLEEP_MODE_CMD_PROCESSED_EVENTID");
3490 return ath6kl_wmi_host_sleep_mode_cmd_prcd_evt_rx(wmi
, vif
);
3491 case WMI_REMAIN_ON_CHNL_EVENTID
:
3492 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REMAIN_ON_CHNL_EVENTID\n");
3493 return ath6kl_wmi_remain_on_chnl_event_rx(wmi
, datap
, len
, vif
);
3494 case WMI_CANCEL_REMAIN_ON_CHNL_EVENTID
:
3495 ath6kl_dbg(ATH6KL_DBG_WMI
,
3496 "WMI_CANCEL_REMAIN_ON_CHNL_EVENTID\n");
3497 return ath6kl_wmi_cancel_remain_on_chnl_event_rx(wmi
, datap
,
3499 case WMI_TX_STATUS_EVENTID
:
3500 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_STATUS_EVENTID\n");
3501 return ath6kl_wmi_tx_status_event_rx(wmi
, datap
, len
, vif
);
3502 case WMI_RX_PROBE_REQ_EVENTID
:
3503 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RX_PROBE_REQ_EVENTID\n");
3504 return ath6kl_wmi_rx_probe_req_event_rx(wmi
, datap
, len
, vif
);
3505 case WMI_RX_ACTION_EVENTID
:
3506 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RX_ACTION_EVENTID\n");
3507 return ath6kl_wmi_rx_action_event_rx(wmi
, datap
, len
, vif
);
3509 ath6kl_dbg(ATH6KL_DBG_WMI
, "unknown cmd id 0x%x\n", cmd_id
);
3516 static int ath6kl_wmi_proc_events(struct wmi
*wmi
, struct sk_buff
*skb
)
3518 struct wmi_cmd_hdr
*cmd
;
3525 cmd
= (struct wmi_cmd_hdr
*) skb
->data
;
3526 id
= le16_to_cpu(cmd
->cmd_id
);
3527 if_idx
= le16_to_cpu(cmd
->info1
) & WMI_CMD_HDR_IF_ID_MASK
;
3529 skb_pull(skb
, sizeof(struct wmi_cmd_hdr
));
3533 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi rx id %d len %d\n", id
, len
);
3534 ath6kl_dbg_dump(ATH6KL_DBG_WMI_DUMP
, NULL
, "wmi rx ",
3538 case WMI_GET_BITRATE_CMDID
:
3539 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_BITRATE_CMDID\n");
3540 ret
= ath6kl_wmi_bitrate_reply_rx(wmi
, datap
, len
);
3542 case WMI_GET_CHANNEL_LIST_CMDID
:
3543 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_CHANNEL_LIST_CMDID\n");
3544 ret
= ath6kl_wmi_ch_list_reply_rx(wmi
, datap
, len
);
3546 case WMI_GET_TX_PWR_CMDID
:
3547 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_TX_PWR_CMDID\n");
3548 ret
= ath6kl_wmi_tx_pwr_reply_rx(wmi
, datap
, len
);
3550 case WMI_READY_EVENTID
:
3551 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_READY_EVENTID\n");
3552 ret
= ath6kl_wmi_ready_event_rx(wmi
, datap
, len
);
3554 case WMI_PEER_NODE_EVENTID
:
3555 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PEER_NODE_EVENTID\n");
3556 ret
= ath6kl_wmi_peer_node_event_rx(wmi
, datap
, len
);
3558 case WMI_REGDOMAIN_EVENTID
:
3559 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REGDOMAIN_EVENTID\n");
3560 ath6kl_wmi_regdomain_event(wmi
, datap
, len
);
3562 case WMI_PSTREAM_TIMEOUT_EVENTID
:
3563 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PSTREAM_TIMEOUT_EVENTID\n");
3564 ret
= ath6kl_wmi_pstream_timeout_event_rx(wmi
, datap
, len
);
3566 case WMI_CMDERROR_EVENTID
:
3567 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CMDERROR_EVENTID\n");
3568 ret
= ath6kl_wmi_error_event_rx(wmi
, datap
, len
);
3570 case WMI_RSSI_THRESHOLD_EVENTID
:
3571 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RSSI_THRESHOLD_EVENTID\n");
3572 ret
= ath6kl_wmi_rssi_threshold_event_rx(wmi
, datap
, len
);
3574 case WMI_ERROR_REPORT_EVENTID
:
3575 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ERROR_REPORT_EVENTID\n");
3577 case WMI_OPT_RX_FRAME_EVENTID
:
3578 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_OPT_RX_FRAME_EVENTID\n");
3579 /* this event has been deprecated */
3581 case WMI_REPORT_ROAM_TBL_EVENTID
:
3582 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_ROAM_TBL_EVENTID\n");
3583 ret
= ath6kl_wmi_roam_tbl_event_rx(wmi
, datap
, len
);
3585 case WMI_EXTENSION_EVENTID
:
3586 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_EXTENSION_EVENTID\n");
3587 ret
= ath6kl_wmi_control_rx_xtnd(wmi
, skb
);
3589 case WMI_CHANNEL_CHANGE_EVENTID
:
3590 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CHANNEL_CHANGE_EVENTID\n");
3592 case WMI_REPORT_ROAM_DATA_EVENTID
:
3593 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_ROAM_DATA_EVENTID\n");
3595 case WMI_TEST_EVENTID
:
3596 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TEST_EVENTID\n");
3597 ret
= ath6kl_wmi_test_rx(wmi
, datap
, len
);
3599 case WMI_GET_FIXRATES_CMDID
:
3600 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_FIXRATES_CMDID\n");
3601 ret
= ath6kl_wmi_ratemask_reply_rx(wmi
, datap
, len
);
3603 case WMI_TX_RETRY_ERR_EVENTID
:
3604 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_RETRY_ERR_EVENTID\n");
3606 case WMI_SNR_THRESHOLD_EVENTID
:
3607 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SNR_THRESHOLD_EVENTID\n");
3608 ret
= ath6kl_wmi_snr_threshold_event_rx(wmi
, datap
, len
);
3610 case WMI_LQ_THRESHOLD_EVENTID
:
3611 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_LQ_THRESHOLD_EVENTID\n");
3613 case WMI_APLIST_EVENTID
:
3614 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_APLIST_EVENTID\n");
3615 ret
= ath6kl_wmi_aplist_event_rx(wmi
, datap
, len
);
3617 case WMI_GET_KEEPALIVE_CMDID
:
3618 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_KEEPALIVE_CMDID\n");
3619 ret
= ath6kl_wmi_keepalive_reply_rx(wmi
, datap
, len
);
3621 case WMI_GET_WOW_LIST_EVENTID
:
3622 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_WOW_LIST_EVENTID\n");
3624 case WMI_GET_PMKID_LIST_EVENTID
:
3625 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_PMKID_LIST_EVENTID\n");
3626 ret
= ath6kl_wmi_get_pmkid_list_event_rx(wmi
, datap
, len
);
3628 case WMI_SET_PARAMS_REPLY_EVENTID
:
3629 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SET_PARAMS_REPLY_EVENTID\n");
3631 case WMI_ADDBA_RESP_EVENTID
:
3632 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ADDBA_RESP_EVENTID\n");
3634 case WMI_REPORT_BTCOEX_CONFIG_EVENTID
:
3635 ath6kl_dbg(ATH6KL_DBG_WMI
,
3636 "WMI_REPORT_BTCOEX_CONFIG_EVENTID\n");
3638 case WMI_REPORT_BTCOEX_STATS_EVENTID
:
3639 ath6kl_dbg(ATH6KL_DBG_WMI
,
3640 "WMI_REPORT_BTCOEX_STATS_EVENTID\n");
3642 case WMI_TX_COMPLETE_EVENTID
:
3643 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_COMPLETE_EVENTID\n");
3644 ret
= ath6kl_wmi_tx_complete_event_rx(datap
, len
);
3646 case WMI_P2P_CAPABILITIES_EVENTID
:
3647 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_P2P_CAPABILITIES_EVENTID\n");
3648 ret
= ath6kl_wmi_p2p_capabilities_event_rx(datap
, len
);
3650 case WMI_P2P_INFO_EVENTID
:
3651 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_P2P_INFO_EVENTID\n");
3652 ret
= ath6kl_wmi_p2p_info_event_rx(datap
, len
);
3655 /* may be the event is interface specific */
3656 ret
= ath6kl_wmi_proc_events_vif(wmi
, if_idx
, id
, datap
, len
);
3665 int ath6kl_wmi_control_rx(struct wmi
*wmi
, struct sk_buff
*skb
)
3667 if (WARN_ON(skb
== NULL
))
3670 if (skb
->len
< sizeof(struct wmi_cmd_hdr
)) {
3671 ath6kl_err("bad packet 1\n");
3676 return ath6kl_wmi_proc_events(wmi
, skb
);
3679 void ath6kl_wmi_reset(struct wmi
*wmi
)
3681 spin_lock_bh(&wmi
->lock
);
3683 wmi
->fat_pipe_exist
= 0;
3684 memset(wmi
->stream_exist_for_ac
, 0, sizeof(wmi
->stream_exist_for_ac
));
3686 spin_unlock_bh(&wmi
->lock
);
3689 void *ath6kl_wmi_init(struct ath6kl
*dev
)
3693 wmi
= kzalloc(sizeof(struct wmi
), GFP_KERNEL
);
3697 spin_lock_init(&wmi
->lock
);
3699 wmi
->parent_dev
= dev
;
3701 wmi
->pwr_mode
= REC_POWER
;
3703 ath6kl_wmi_reset(wmi
);
3708 void ath6kl_wmi_shutdown(struct wmi
*wmi
)
3713 kfree(wmi
->last_mgmt_tx_frame
);