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.
25 #include "../regd_common.h"
27 static int ath6kl_wmi_sync_point(struct wmi
*wmi
, u8 if_idx
);
29 static const s32 wmi_rate_tbl
[][2] = {
30 /* {W/O SGI, with SGI} */
62 /* 802.1d to AC mapping. Refer pg 57 of WMM-test-plan-v1.2 */
63 static const u8 up_to_ac
[] = {
74 void ath6kl_wmi_set_control_ep(struct wmi
*wmi
, enum htc_endpoint_id ep_id
)
76 if (WARN_ON(ep_id
== ENDPOINT_UNUSED
|| ep_id
>= ENDPOINT_MAX
))
82 enum htc_endpoint_id
ath6kl_wmi_get_control_ep(struct wmi
*wmi
)
87 struct ath6kl_vif
*ath6kl_get_vif_by_index(struct ath6kl
*ar
, u8 if_idx
)
89 struct ath6kl_vif
*vif
, *found
= NULL
;
91 if (WARN_ON(if_idx
> (ar
->vif_max
- 1)))
95 spin_lock_bh(&ar
->list_lock
);
96 list_for_each_entry(vif
, &ar
->vif_list
, list
) {
97 if (vif
->fw_vif_idx
== if_idx
) {
102 spin_unlock_bh(&ar
->list_lock
);
107 /* Performs DIX to 802.3 encapsulation for transmit packets.
108 * Assumes the entire DIX header is contigous and that there is
109 * enough room in the buffer for a 802.3 mac header and LLC+SNAP headers.
111 int ath6kl_wmi_dix_2_dot3(struct wmi
*wmi
, struct sk_buff
*skb
)
113 struct ath6kl_llc_snap_hdr
*llc_hdr
;
114 struct ethhdr
*eth_hdr
;
120 if (WARN_ON(skb
== NULL
))
123 size
= sizeof(struct ath6kl_llc_snap_hdr
) + sizeof(struct wmi_data_hdr
);
124 if (skb_headroom(skb
) < size
)
127 eth_hdr
= (struct ethhdr
*) skb
->data
;
128 type
= eth_hdr
->h_proto
;
130 if (!is_ethertype(be16_to_cpu(type
))) {
131 ath6kl_dbg(ATH6KL_DBG_WMI
,
132 "%s: pkt is already in 802.3 format\n", __func__
);
136 new_len
= skb
->len
- sizeof(*eth_hdr
) + sizeof(*llc_hdr
);
138 skb_push(skb
, sizeof(struct ath6kl_llc_snap_hdr
));
141 eth_hdr
->h_proto
= cpu_to_be16(new_len
);
143 memcpy(datap
, eth_hdr
, sizeof(*eth_hdr
));
145 llc_hdr
= (struct ath6kl_llc_snap_hdr
*)(datap
+ sizeof(*eth_hdr
));
146 llc_hdr
->dsap
= 0xAA;
147 llc_hdr
->ssap
= 0xAA;
148 llc_hdr
->cntl
= 0x03;
149 llc_hdr
->org_code
[0] = 0x0;
150 llc_hdr
->org_code
[1] = 0x0;
151 llc_hdr
->org_code
[2] = 0x0;
152 llc_hdr
->eth_type
= type
;
157 static int ath6kl_wmi_meta_add(struct wmi
*wmi
, struct sk_buff
*skb
,
158 u8
*version
, void *tx_meta_info
)
160 struct wmi_tx_meta_v1
*v1
;
161 struct wmi_tx_meta_v2
*v2
;
163 if (WARN_ON(skb
== NULL
|| version
== NULL
))
167 case WMI_META_VERSION_1
:
168 skb_push(skb
, WMI_MAX_TX_META_SZ
);
169 v1
= (struct wmi_tx_meta_v1
*) skb
->data
;
171 v1
->rate_plcy_id
= 0;
172 *version
= WMI_META_VERSION_1
;
174 case WMI_META_VERSION_2
:
175 skb_push(skb
, WMI_MAX_TX_META_SZ
);
176 v2
= (struct wmi_tx_meta_v2
*) skb
->data
;
177 memcpy(v2
, (struct wmi_tx_meta_v2
*) tx_meta_info
,
178 sizeof(struct wmi_tx_meta_v2
));
185 int ath6kl_wmi_data_hdr_add(struct wmi
*wmi
, struct sk_buff
*skb
,
186 u8 msg_type
, u32 flags
,
187 enum wmi_data_hdr_data_type data_type
,
188 u8 meta_ver
, void *tx_meta_info
, u8 if_idx
)
190 struct wmi_data_hdr
*data_hdr
;
193 if (WARN_ON(skb
== NULL
|| (if_idx
> wmi
->parent_dev
->vif_max
- 1)))
197 ret
= ath6kl_wmi_meta_add(wmi
, skb
, &meta_ver
, tx_meta_info
);
202 skb_push(skb
, sizeof(struct wmi_data_hdr
));
204 data_hdr
= (struct wmi_data_hdr
*)skb
->data
;
205 memset(data_hdr
, 0, sizeof(struct wmi_data_hdr
));
207 data_hdr
->info
= msg_type
<< WMI_DATA_HDR_MSG_TYPE_SHIFT
;
208 data_hdr
->info
|= data_type
<< WMI_DATA_HDR_DATA_TYPE_SHIFT
;
210 if (flags
& WMI_DATA_HDR_FLAGS_MORE
)
211 data_hdr
->info
|= WMI_DATA_HDR_MORE
;
213 if (flags
& WMI_DATA_HDR_FLAGS_EOSP
)
214 data_hdr
->info3
|= cpu_to_le16(WMI_DATA_HDR_EOSP
);
216 data_hdr
->info2
|= cpu_to_le16(meta_ver
<< WMI_DATA_HDR_META_SHIFT
);
217 data_hdr
->info3
|= cpu_to_le16(if_idx
& WMI_DATA_HDR_IF_IDX_MASK
);
222 u8
ath6kl_wmi_determine_user_priority(u8
*pkt
, u32 layer2_pri
)
224 struct iphdr
*ip_hdr
= (struct iphdr
*) pkt
;
228 * Determine IPTOS priority
231 * : DSCP(6-bits) ECN(2-bits)
232 * : DSCP - P2 P1 P0 X X X
233 * where (P2 P1 P0) form 802.1D
235 ip_pri
= ip_hdr
->tos
>> 5;
238 if ((layer2_pri
& 0x7) > ip_pri
)
239 return (u8
) layer2_pri
& 0x7;
244 u8
ath6kl_wmi_get_traffic_class(u8 user_priority
)
246 return up_to_ac
[user_priority
& 0x7];
249 int ath6kl_wmi_implicit_create_pstream(struct wmi
*wmi
, u8 if_idx
,
251 u32 layer2_priority
, bool wmm_enabled
,
254 struct wmi_data_hdr
*data_hdr
;
255 struct ath6kl_llc_snap_hdr
*llc_hdr
;
256 struct wmi_create_pstream_cmd cmd
;
257 u32 meta_size
, hdr_size
;
258 u16 ip_type
= IP_ETHERTYPE
;
259 u8 stream_exist
, usr_pri
;
260 u8 traffic_class
= WMM_AC_BE
;
263 if (WARN_ON(skb
== NULL
))
267 data_hdr
= (struct wmi_data_hdr
*) datap
;
269 meta_size
= ((le16_to_cpu(data_hdr
->info2
) >> WMI_DATA_HDR_META_SHIFT
) &
270 WMI_DATA_HDR_META_MASK
) ? WMI_MAX_TX_META_SZ
: 0;
273 /* If WMM is disabled all traffic goes as BE traffic */
276 hdr_size
= sizeof(struct ethhdr
);
278 llc_hdr
= (struct ath6kl_llc_snap_hdr
*)(datap
+
281 meta_size
+ hdr_size
);
283 if (llc_hdr
->eth_type
== htons(ip_type
)) {
285 * Extract the endpoint info from the TOS field
289 ath6kl_wmi_determine_user_priority(((u8
*) llc_hdr
) +
290 sizeof(struct ath6kl_llc_snap_hdr
),
293 usr_pri
= layer2_priority
& 0x7;
296 * Queue the EAPOL frames in the same WMM_AC_VO queue
297 * as that of management frames.
299 if (skb
->protocol
== cpu_to_be16(ETH_P_PAE
))
300 usr_pri
= WMI_VOICE_USER_PRIORITY
;
304 * workaround for WMM S5
306 * FIXME: wmi->traffic_class is always 100 so this test doesn't
309 if ((wmi
->traffic_class
== WMM_AC_VI
) &&
310 ((usr_pri
== 5) || (usr_pri
== 4)))
313 /* Convert user priority to traffic class */
314 traffic_class
= up_to_ac
[usr_pri
& 0x7];
316 wmi_data_hdr_set_up(data_hdr
, usr_pri
);
318 spin_lock_bh(&wmi
->lock
);
319 stream_exist
= wmi
->fat_pipe_exist
;
320 spin_unlock_bh(&wmi
->lock
);
322 if (!(stream_exist
& (1 << traffic_class
))) {
323 memset(&cmd
, 0, sizeof(cmd
));
324 cmd
.traffic_class
= traffic_class
;
325 cmd
.user_pri
= usr_pri
;
327 cpu_to_le32(WMI_IMPLICIT_PSTREAM_INACTIVITY_INT
);
328 /* Implicit streams are created with TSID 0xFF */
329 cmd
.tsid
= WMI_IMPLICIT_PSTREAM
;
330 ath6kl_wmi_create_pstream_cmd(wmi
, if_idx
, &cmd
);
338 int ath6kl_wmi_dot11_hdr_remove(struct wmi
*wmi
, struct sk_buff
*skb
)
340 struct ieee80211_hdr_3addr
*pwh
, wh
;
341 struct ath6kl_llc_snap_hdr
*llc_hdr
;
342 struct ethhdr eth_hdr
;
347 if (WARN_ON(skb
== NULL
))
351 pwh
= (struct ieee80211_hdr_3addr
*) datap
;
353 sub_type
= pwh
->frame_control
& cpu_to_le16(IEEE80211_FCTL_STYPE
);
355 memcpy((u8
*) &wh
, datap
, sizeof(struct ieee80211_hdr_3addr
));
357 /* Strip off the 802.11 header */
358 if (sub_type
== cpu_to_le16(IEEE80211_STYPE_QOS_DATA
)) {
359 hdr_size
= roundup(sizeof(struct ieee80211_qos_hdr
),
361 skb_pull(skb
, hdr_size
);
362 } else if (sub_type
== cpu_to_le16(IEEE80211_STYPE_DATA
))
363 skb_pull(skb
, sizeof(struct ieee80211_hdr_3addr
));
366 llc_hdr
= (struct ath6kl_llc_snap_hdr
*)(datap
);
368 memset(ð_hdr
, 0, sizeof(eth_hdr
));
369 eth_hdr
.h_proto
= llc_hdr
->eth_type
;
371 switch ((le16_to_cpu(wh
.frame_control
)) &
372 (IEEE80211_FCTL_FROMDS
| IEEE80211_FCTL_TODS
)) {
374 memcpy(eth_hdr
.h_dest
, wh
.addr1
, ETH_ALEN
);
375 memcpy(eth_hdr
.h_source
, wh
.addr2
, ETH_ALEN
);
377 case IEEE80211_FCTL_TODS
:
378 memcpy(eth_hdr
.h_dest
, wh
.addr3
, ETH_ALEN
);
379 memcpy(eth_hdr
.h_source
, wh
.addr2
, ETH_ALEN
);
381 case IEEE80211_FCTL_FROMDS
:
382 memcpy(eth_hdr
.h_dest
, wh
.addr1
, ETH_ALEN
);
383 memcpy(eth_hdr
.h_source
, wh
.addr3
, ETH_ALEN
);
385 case IEEE80211_FCTL_FROMDS
| IEEE80211_FCTL_TODS
:
389 skb_pull(skb
, sizeof(struct ath6kl_llc_snap_hdr
));
390 skb_push(skb
, sizeof(eth_hdr
));
394 memcpy(datap
, ð_hdr
, sizeof(eth_hdr
));
400 * Performs 802.3 to DIX encapsulation for received packets.
401 * Assumes the entire 802.3 header is contigous.
403 int ath6kl_wmi_dot3_2_dix(struct sk_buff
*skb
)
405 struct ath6kl_llc_snap_hdr
*llc_hdr
;
406 struct ethhdr eth_hdr
;
409 if (WARN_ON(skb
== NULL
))
414 memcpy(ð_hdr
, datap
, sizeof(eth_hdr
));
416 llc_hdr
= (struct ath6kl_llc_snap_hdr
*) (datap
+ sizeof(eth_hdr
));
417 eth_hdr
.h_proto
= llc_hdr
->eth_type
;
419 skb_pull(skb
, sizeof(struct ath6kl_llc_snap_hdr
));
422 memcpy(datap
, ð_hdr
, sizeof(eth_hdr
));
427 static int ath6kl_wmi_tx_complete_event_rx(u8
*datap
, int len
)
429 struct tx_complete_msg_v1
*msg_v1
;
430 struct wmi_tx_complete_event
*evt
;
434 evt
= (struct wmi_tx_complete_event
*) datap
;
436 ath6kl_dbg(ATH6KL_DBG_WMI
, "comp: %d %d %d\n",
437 evt
->num_msg
, evt
->msg_len
, evt
->msg_type
);
439 for (index
= 0; index
< evt
->num_msg
; index
++) {
440 size
= sizeof(struct wmi_tx_complete_event
) +
441 (index
* sizeof(struct tx_complete_msg_v1
));
442 msg_v1
= (struct tx_complete_msg_v1
*)(datap
+ size
);
444 ath6kl_dbg(ATH6KL_DBG_WMI
, "msg: %d %d %d %d\n",
445 msg_v1
->status
, msg_v1
->pkt_id
,
446 msg_v1
->rate_idx
, msg_v1
->ack_failures
);
452 static int ath6kl_wmi_remain_on_chnl_event_rx(struct wmi
*wmi
, u8
*datap
,
453 int len
, struct ath6kl_vif
*vif
)
455 struct wmi_remain_on_chnl_event
*ev
;
458 struct ieee80211_channel
*chan
;
459 struct ath6kl
*ar
= wmi
->parent_dev
;
462 if (len
< sizeof(*ev
))
465 ev
= (struct wmi_remain_on_chnl_event
*) datap
;
466 freq
= le32_to_cpu(ev
->freq
);
467 dur
= le32_to_cpu(ev
->duration
);
468 ath6kl_dbg(ATH6KL_DBG_WMI
, "remain_on_chnl: freq=%u dur=%u\n",
470 chan
= ieee80211_get_channel(ar
->wiphy
, freq
);
472 ath6kl_dbg(ATH6KL_DBG_WMI
,
473 "remain_on_chnl: Unknown channel (freq=%u)\n",
477 id
= vif
->last_roc_id
;
478 cfg80211_ready_on_channel(&vif
->wdev
, id
, chan
,
484 static int ath6kl_wmi_cancel_remain_on_chnl_event_rx(struct wmi
*wmi
,
486 struct ath6kl_vif
*vif
)
488 struct wmi_cancel_remain_on_chnl_event
*ev
;
491 struct ieee80211_channel
*chan
;
492 struct ath6kl
*ar
= wmi
->parent_dev
;
495 if (len
< sizeof(*ev
))
498 ev
= (struct wmi_cancel_remain_on_chnl_event
*) datap
;
499 freq
= le32_to_cpu(ev
->freq
);
500 dur
= le32_to_cpu(ev
->duration
);
501 ath6kl_dbg(ATH6KL_DBG_WMI
,
502 "cancel_remain_on_chnl: freq=%u dur=%u status=%u\n",
503 freq
, dur
, ev
->status
);
504 chan
= ieee80211_get_channel(ar
->wiphy
, freq
);
506 ath6kl_dbg(ATH6KL_DBG_WMI
,
507 "cancel_remain_on_chnl: Unknown channel (freq=%u)\n",
511 if (vif
->last_cancel_roc_id
&&
512 vif
->last_cancel_roc_id
+ 1 == vif
->last_roc_id
)
513 id
= vif
->last_cancel_roc_id
; /* event for cancel command */
515 id
= vif
->last_roc_id
; /* timeout on uncanceled r-o-c */
516 vif
->last_cancel_roc_id
= 0;
517 cfg80211_remain_on_channel_expired(&vif
->wdev
, id
, chan
, GFP_ATOMIC
);
522 static int ath6kl_wmi_tx_status_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
523 struct ath6kl_vif
*vif
)
525 struct wmi_tx_status_event
*ev
;
528 if (len
< sizeof(*ev
))
531 ev
= (struct wmi_tx_status_event
*) datap
;
532 id
= le32_to_cpu(ev
->id
);
533 ath6kl_dbg(ATH6KL_DBG_WMI
, "tx_status: id=%x ack_status=%u\n",
535 if (wmi
->last_mgmt_tx_frame
) {
536 cfg80211_mgmt_tx_status(&vif
->wdev
, id
,
537 wmi
->last_mgmt_tx_frame
,
538 wmi
->last_mgmt_tx_frame_len
,
539 !!ev
->ack_status
, GFP_ATOMIC
);
540 kfree(wmi
->last_mgmt_tx_frame
);
541 wmi
->last_mgmt_tx_frame
= NULL
;
542 wmi
->last_mgmt_tx_frame_len
= 0;
548 static int ath6kl_wmi_rx_probe_req_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
549 struct ath6kl_vif
*vif
)
551 struct wmi_p2p_rx_probe_req_event
*ev
;
555 if (len
< sizeof(*ev
))
558 ev
= (struct wmi_p2p_rx_probe_req_event
*) datap
;
559 freq
= le32_to_cpu(ev
->freq
);
560 dlen
= le16_to_cpu(ev
->len
);
561 if (datap
+ len
< ev
->data
+ dlen
) {
562 ath6kl_err("invalid wmi_p2p_rx_probe_req_event: len=%d dlen=%u\n",
566 ath6kl_dbg(ATH6KL_DBG_WMI
,
567 "rx_probe_req: len=%u freq=%u probe_req_report=%d\n",
568 dlen
, freq
, vif
->probe_req_report
);
570 if (vif
->probe_req_report
|| vif
->nw_type
== AP_NETWORK
)
571 cfg80211_rx_mgmt(&vif
->wdev
, freq
, 0, ev
->data
, dlen
, 0,
577 static int ath6kl_wmi_p2p_capabilities_event_rx(u8
*datap
, int len
)
579 struct wmi_p2p_capabilities_event
*ev
;
582 if (len
< sizeof(*ev
))
585 ev
= (struct wmi_p2p_capabilities_event
*) datap
;
586 dlen
= le16_to_cpu(ev
->len
);
587 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_capab: len=%u\n", dlen
);
592 static int ath6kl_wmi_rx_action_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
593 struct ath6kl_vif
*vif
)
595 struct wmi_rx_action_event
*ev
;
599 if (len
< sizeof(*ev
))
602 ev
= (struct wmi_rx_action_event
*) datap
;
603 freq
= le32_to_cpu(ev
->freq
);
604 dlen
= le16_to_cpu(ev
->len
);
605 if (datap
+ len
< ev
->data
+ dlen
) {
606 ath6kl_err("invalid wmi_rx_action_event: len=%d dlen=%u\n",
610 ath6kl_dbg(ATH6KL_DBG_WMI
, "rx_action: len=%u freq=%u\n", dlen
, freq
);
611 cfg80211_rx_mgmt(&vif
->wdev
, freq
, 0, ev
->data
, dlen
, 0, GFP_ATOMIC
);
616 static int ath6kl_wmi_p2p_info_event_rx(u8
*datap
, int len
)
618 struct wmi_p2p_info_event
*ev
;
622 if (len
< sizeof(*ev
))
625 ev
= (struct wmi_p2p_info_event
*) datap
;
626 flags
= le32_to_cpu(ev
->info_req_flags
);
627 dlen
= le16_to_cpu(ev
->len
);
628 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_info: flags=%x len=%d\n", flags
, dlen
);
630 if (flags
& P2P_FLAG_CAPABILITIES_REQ
) {
631 struct wmi_p2p_capabilities
*cap
;
632 if (dlen
< sizeof(*cap
))
634 cap
= (struct wmi_p2p_capabilities
*) ev
->data
;
635 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_info: GO Power Save = %d\n",
639 if (flags
& P2P_FLAG_MACADDR_REQ
) {
640 struct wmi_p2p_macaddr
*mac
;
641 if (dlen
< sizeof(*mac
))
643 mac
= (struct wmi_p2p_macaddr
*) ev
->data
;
644 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_info: MAC Address = %pM\n",
648 if (flags
& P2P_FLAG_HMODEL_REQ
) {
649 struct wmi_p2p_hmodel
*mod
;
650 if (dlen
< sizeof(*mod
))
652 mod
= (struct wmi_p2p_hmodel
*) ev
->data
;
653 ath6kl_dbg(ATH6KL_DBG_WMI
, "p2p_info: P2P Model = %d (%s)\n",
655 mod
->p2p_model
? "host" : "firmware");
660 static inline struct sk_buff
*ath6kl_wmi_get_new_buf(u32 size
)
664 skb
= ath6kl_buf_alloc(size
);
670 memset(skb
->data
, 0, size
);
675 /* Send a "simple" wmi command -- one with no arguments */
676 static int ath6kl_wmi_simple_cmd(struct wmi
*wmi
, u8 if_idx
,
677 enum wmi_cmd_id cmd_id
)
682 skb
= ath6kl_wmi_get_new_buf(0);
686 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, cmd_id
, NO_SYNC_WMIFLAG
);
691 static int ath6kl_wmi_ready_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
693 struct wmi_ready_event_2
*ev
= (struct wmi_ready_event_2
*) datap
;
695 if (len
< sizeof(struct wmi_ready_event_2
))
698 ath6kl_ready_event(wmi
->parent_dev
, ev
->mac_addr
,
699 le32_to_cpu(ev
->sw_version
),
700 le32_to_cpu(ev
->abi_version
), ev
->phy_cap
);
706 * Mechanism to modify the roaming behavior in the firmware. The lower rssi
707 * at which the station has to roam can be passed with
708 * WMI_SET_LRSSI_SCAN_PARAMS. Subtract 96 from RSSI to get the signal level
711 int ath6kl_wmi_set_roam_lrssi_cmd(struct wmi
*wmi
, u8 lrssi
)
714 struct roam_ctrl_cmd
*cmd
;
716 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
720 cmd
= (struct roam_ctrl_cmd
*) skb
->data
;
722 cmd
->info
.params
.lrssi_scan_period
= cpu_to_le16(DEF_LRSSI_SCAN_PERIOD
);
723 cmd
->info
.params
.lrssi_scan_threshold
= a_cpu_to_sle16(lrssi
+
724 DEF_SCAN_FOR_ROAM_INTVL
);
725 cmd
->info
.params
.lrssi_roam_threshold
= a_cpu_to_sle16(lrssi
);
726 cmd
->info
.params
.roam_rssi_floor
= DEF_LRSSI_ROAM_FLOOR
;
727 cmd
->roam_ctrl
= WMI_SET_LRSSI_SCAN_PARAMS
;
729 ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_ROAM_CTRL_CMDID
,
735 int ath6kl_wmi_force_roam_cmd(struct wmi
*wmi
, const u8
*bssid
)
738 struct roam_ctrl_cmd
*cmd
;
740 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
744 cmd
= (struct roam_ctrl_cmd
*) skb
->data
;
746 memcpy(cmd
->info
.bssid
, bssid
, ETH_ALEN
);
747 cmd
->roam_ctrl
= WMI_FORCE_ROAM
;
749 ath6kl_dbg(ATH6KL_DBG_WMI
, "force roam to %pM\n", bssid
);
750 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_ROAM_CTRL_CMDID
,
754 int ath6kl_wmi_ap_set_beacon_intvl_cmd(struct wmi
*wmi
, u8 if_idx
,
758 struct set_beacon_int_cmd
*cmd
;
760 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
764 cmd
= (struct set_beacon_int_cmd
*) skb
->data
;
766 cmd
->beacon_intvl
= cpu_to_le32(beacon_intvl
);
767 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
768 WMI_SET_BEACON_INT_CMDID
, NO_SYNC_WMIFLAG
);
771 int ath6kl_wmi_ap_set_dtim_cmd(struct wmi
*wmi
, u8 if_idx
, u32 dtim_period
)
774 struct set_dtim_cmd
*cmd
;
776 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
780 cmd
= (struct set_dtim_cmd
*) skb
->data
;
782 cmd
->dtim_period
= cpu_to_le32(dtim_period
);
783 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
784 WMI_AP_SET_DTIM_CMDID
, NO_SYNC_WMIFLAG
);
787 int ath6kl_wmi_set_roam_mode_cmd(struct wmi
*wmi
, enum wmi_roam_mode mode
)
790 struct roam_ctrl_cmd
*cmd
;
792 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
796 cmd
= (struct roam_ctrl_cmd
*) skb
->data
;
798 cmd
->info
.roam_mode
= mode
;
799 cmd
->roam_ctrl
= WMI_SET_ROAM_MODE
;
801 ath6kl_dbg(ATH6KL_DBG_WMI
, "set roam mode %d\n", mode
);
802 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_ROAM_CTRL_CMDID
,
806 static int ath6kl_wmi_connect_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
807 struct ath6kl_vif
*vif
)
809 struct wmi_connect_event
*ev
;
812 if (len
< sizeof(struct wmi_connect_event
))
815 ev
= (struct wmi_connect_event
*) datap
;
817 if (vif
->nw_type
== AP_NETWORK
) {
818 /* AP mode start/STA connected event */
819 struct net_device
*dev
= vif
->ndev
;
820 if (memcmp(dev
->dev_addr
, ev
->u
.ap_bss
.bssid
, ETH_ALEN
) == 0) {
821 ath6kl_dbg(ATH6KL_DBG_WMI
,
822 "%s: freq %d bssid %pM (AP started)\n",
823 __func__
, le16_to_cpu(ev
->u
.ap_bss
.ch
),
825 ath6kl_connect_ap_mode_bss(
826 vif
, le16_to_cpu(ev
->u
.ap_bss
.ch
));
828 ath6kl_dbg(ATH6KL_DBG_WMI
,
829 "%s: aid %u mac_addr %pM auth=%u keymgmt=%u cipher=%u apsd_info=%u (STA connected)\n",
830 __func__
, ev
->u
.ap_sta
.aid
,
831 ev
->u
.ap_sta
.mac_addr
,
833 ev
->u
.ap_sta
.keymgmt
,
834 le16_to_cpu(ev
->u
.ap_sta
.cipher
),
835 ev
->u
.ap_sta
.apsd_info
);
837 ath6kl_connect_ap_mode_sta(
838 vif
, ev
->u
.ap_sta
.aid
, ev
->u
.ap_sta
.mac_addr
,
839 ev
->u
.ap_sta
.keymgmt
,
840 le16_to_cpu(ev
->u
.ap_sta
.cipher
),
841 ev
->u
.ap_sta
.auth
, ev
->assoc_req_len
,
842 ev
->assoc_info
+ ev
->beacon_ie_len
,
843 ev
->u
.ap_sta
.apsd_info
);
848 /* STA/IBSS mode connection event */
850 ath6kl_dbg(ATH6KL_DBG_WMI
,
851 "wmi event connect freq %d bssid %pM listen_intvl %d beacon_intvl %d type %d\n",
852 le16_to_cpu(ev
->u
.sta
.ch
), ev
->u
.sta
.bssid
,
853 le16_to_cpu(ev
->u
.sta
.listen_intvl
),
854 le16_to_cpu(ev
->u
.sta
.beacon_intvl
),
855 le32_to_cpu(ev
->u
.sta
.nw_type
));
857 /* Start of assoc rsp IEs */
858 pie
= ev
->assoc_info
+ ev
->beacon_ie_len
+
859 ev
->assoc_req_len
+ (sizeof(u16
) * 3); /* capinfo, status, aid */
861 /* End of assoc rsp IEs */
862 peie
= ev
->assoc_info
+ ev
->beacon_ie_len
+ ev
->assoc_req_len
+
867 case WLAN_EID_VENDOR_SPECIFIC
:
868 if (pie
[1] > 3 && pie
[2] == 0x00 && pie
[3] == 0x50 &&
869 pie
[4] == 0xf2 && pie
[5] == WMM_OUI_TYPE
) {
870 /* WMM OUT (00:50:F2) */
872 pie
[6] == WMM_PARAM_OUI_SUBTYPE
)
873 wmi
->is_wmm_enabled
= true;
878 if (wmi
->is_wmm_enabled
)
884 ath6kl_connect_event(vif
, le16_to_cpu(ev
->u
.sta
.ch
),
886 le16_to_cpu(ev
->u
.sta
.listen_intvl
),
887 le16_to_cpu(ev
->u
.sta
.beacon_intvl
),
888 le32_to_cpu(ev
->u
.sta
.nw_type
),
889 ev
->beacon_ie_len
, ev
->assoc_req_len
,
890 ev
->assoc_resp_len
, ev
->assoc_info
);
895 static struct country_code_to_enum_rd
*
896 ath6kl_regd_find_country(u16 countryCode
)
900 for (i
= 0; i
< ARRAY_SIZE(allCountries
); i
++) {
901 if (allCountries
[i
].countryCode
== countryCode
)
902 return &allCountries
[i
];
908 static struct reg_dmn_pair_mapping
*
909 ath6kl_get_regpair(u16 regdmn
)
913 if (regdmn
== NO_ENUMRD
)
916 for (i
= 0; i
< ARRAY_SIZE(regDomainPairs
); i
++) {
917 if (regDomainPairs
[i
].regDmnEnum
== regdmn
)
918 return ®DomainPairs
[i
];
924 static struct country_code_to_enum_rd
*
925 ath6kl_regd_find_country_by_rd(u16 regdmn
)
929 for (i
= 0; i
< ARRAY_SIZE(allCountries
); i
++) {
930 if (allCountries
[i
].regDmnEnum
== regdmn
)
931 return &allCountries
[i
];
937 static void ath6kl_wmi_regdomain_event(struct wmi
*wmi
, u8
*datap
, int len
)
940 struct ath6kl_wmi_regdomain
*ev
;
941 struct country_code_to_enum_rd
*country
= NULL
;
942 struct reg_dmn_pair_mapping
*regpair
= NULL
;
946 ev
= (struct ath6kl_wmi_regdomain
*) datap
;
947 reg_code
= le32_to_cpu(ev
->reg_code
);
949 if ((reg_code
>> ATH6KL_COUNTRY_RD_SHIFT
) & COUNTRY_ERD_FLAG
)
950 country
= ath6kl_regd_find_country((u16
) reg_code
);
951 else if (!(((u16
) reg_code
& WORLD_SKU_MASK
) == WORLD_SKU_PREFIX
)) {
953 regpair
= ath6kl_get_regpair((u16
) reg_code
);
954 country
= ath6kl_regd_find_country_by_rd((u16
) reg_code
);
956 ath6kl_dbg(ATH6KL_DBG_WMI
, "Regpair used: 0x%0x\n",
957 regpair
->regDmnEnum
);
959 ath6kl_warn("Regpair not found reg_code 0x%0x\n",
963 if (country
&& wmi
->parent_dev
->wiphy_registered
) {
964 alpha2
[0] = country
->isoName
[0];
965 alpha2
[1] = country
->isoName
[1];
967 regulatory_hint(wmi
->parent_dev
->wiphy
, alpha2
);
969 ath6kl_dbg(ATH6KL_DBG_WMI
, "Country alpha2 being used: %c%c\n",
970 alpha2
[0], alpha2
[1]);
974 static int ath6kl_wmi_disconnect_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
975 struct ath6kl_vif
*vif
)
977 struct wmi_disconnect_event
*ev
;
978 wmi
->traffic_class
= 100;
980 if (len
< sizeof(struct wmi_disconnect_event
))
983 ev
= (struct wmi_disconnect_event
*) datap
;
985 ath6kl_dbg(ATH6KL_DBG_WMI
,
986 "wmi event disconnect proto_reason %d bssid %pM wmi_reason %d assoc_resp_len %d\n",
987 le16_to_cpu(ev
->proto_reason_status
), ev
->bssid
,
988 ev
->disconn_reason
, ev
->assoc_resp_len
);
990 wmi
->is_wmm_enabled
= false;
992 ath6kl_disconnect_event(vif
, ev
->disconn_reason
,
993 ev
->bssid
, ev
->assoc_resp_len
, ev
->assoc_info
,
994 le16_to_cpu(ev
->proto_reason_status
));
999 static int ath6kl_wmi_peer_node_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1001 struct wmi_peer_node_event
*ev
;
1003 if (len
< sizeof(struct wmi_peer_node_event
))
1006 ev
= (struct wmi_peer_node_event
*) datap
;
1008 if (ev
->event_code
== PEER_NODE_JOIN_EVENT
)
1009 ath6kl_dbg(ATH6KL_DBG_WMI
, "joined node with mac addr: %pM\n",
1011 else if (ev
->event_code
== PEER_NODE_LEAVE_EVENT
)
1012 ath6kl_dbg(ATH6KL_DBG_WMI
, "left node with mac addr: %pM\n",
1018 static int ath6kl_wmi_tkip_micerr_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1019 struct ath6kl_vif
*vif
)
1021 struct wmi_tkip_micerr_event
*ev
;
1023 if (len
< sizeof(struct wmi_tkip_micerr_event
))
1026 ev
= (struct wmi_tkip_micerr_event
*) datap
;
1028 ath6kl_tkip_micerr_event(vif
, ev
->key_id
, ev
->is_mcast
);
1033 void ath6kl_wmi_sscan_timer(unsigned long ptr
)
1035 struct ath6kl_vif
*vif
= (struct ath6kl_vif
*) ptr
;
1037 cfg80211_sched_scan_results(vif
->ar
->wiphy
);
1040 static int ath6kl_wmi_bssinfo_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1041 struct ath6kl_vif
*vif
)
1043 struct wmi_bss_info_hdr2
*bih
;
1045 struct ieee80211_channel
*channel
;
1046 struct ath6kl
*ar
= wmi
->parent_dev
;
1047 struct ieee80211_mgmt
*mgmt
;
1048 struct cfg80211_bss
*bss
;
1050 if (len
<= sizeof(struct wmi_bss_info_hdr2
))
1053 bih
= (struct wmi_bss_info_hdr2
*) datap
;
1054 buf
= datap
+ sizeof(struct wmi_bss_info_hdr2
);
1055 len
-= sizeof(struct wmi_bss_info_hdr2
);
1057 ath6kl_dbg(ATH6KL_DBG_WMI
,
1058 "bss info evt - ch %u, snr %d, rssi %d, bssid \"%pM\" "
1060 bih
->ch
, bih
->snr
, bih
->snr
- 95, bih
->bssid
,
1063 if (bih
->frame_type
!= BEACON_FTYPE
&&
1064 bih
->frame_type
!= PROBERESP_FTYPE
)
1065 return 0; /* Only update BSS table for now */
1067 if (bih
->frame_type
== BEACON_FTYPE
&&
1068 test_bit(CLEAR_BSSFILTER_ON_BEACON
, &vif
->flags
)) {
1069 clear_bit(CLEAR_BSSFILTER_ON_BEACON
, &vif
->flags
);
1070 ath6kl_wmi_bssfilter_cmd(ar
->wmi
, vif
->fw_vif_idx
,
1071 NONE_BSS_FILTER
, 0);
1074 channel
= ieee80211_get_channel(ar
->wiphy
, le16_to_cpu(bih
->ch
));
1075 if (channel
== NULL
)
1078 if (len
< 8 + 2 + 2)
1081 if (bih
->frame_type
== BEACON_FTYPE
&&
1082 test_bit(CONNECTED
, &vif
->flags
) &&
1083 memcmp(bih
->bssid
, vif
->bssid
, ETH_ALEN
) == 0) {
1085 tim
= cfg80211_find_ie(WLAN_EID_TIM
, buf
+ 8 + 2 + 2,
1087 if (tim
&& tim
[1] >= 2) {
1088 vif
->assoc_bss_dtim_period
= tim
[3];
1089 set_bit(DTIM_PERIOD_AVAIL
, &vif
->flags
);
1094 * In theory, use of cfg80211_inform_bss() would be more natural here
1095 * since we do not have the full frame. However, at least for now,
1096 * cfg80211 can only distinguish Beacon and Probe Response frames from
1097 * each other when using cfg80211_inform_bss_frame(), so let's build a
1098 * fake IEEE 802.11 header to be able to take benefit of this.
1100 mgmt
= kmalloc(24 + len
, GFP_ATOMIC
);
1104 if (bih
->frame_type
== BEACON_FTYPE
) {
1105 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
1106 IEEE80211_STYPE_BEACON
);
1107 memset(mgmt
->da
, 0xff, ETH_ALEN
);
1109 struct net_device
*dev
= vif
->ndev
;
1111 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
1112 IEEE80211_STYPE_PROBE_RESP
);
1113 memcpy(mgmt
->da
, dev
->dev_addr
, ETH_ALEN
);
1115 mgmt
->duration
= cpu_to_le16(0);
1116 memcpy(mgmt
->sa
, bih
->bssid
, ETH_ALEN
);
1117 memcpy(mgmt
->bssid
, bih
->bssid
, ETH_ALEN
);
1118 mgmt
->seq_ctrl
= cpu_to_le16(0);
1120 memcpy(&mgmt
->u
.beacon
, buf
, len
);
1122 bss
= cfg80211_inform_bss_frame(ar
->wiphy
, channel
, mgmt
,
1123 24 + len
, (bih
->snr
- 95) * 100,
1128 cfg80211_put_bss(ar
->wiphy
, bss
);
1131 * Firmware doesn't return any event when scheduled scan has
1132 * finished, so we need to use a timer to find out when there are
1135 * The timer is started from the first bss info received, otherwise
1136 * the timer would not ever fire if the scan interval is short
1139 if (test_bit(SCHED_SCANNING
, &vif
->flags
) &&
1140 !timer_pending(&vif
->sched_scan_timer
)) {
1141 mod_timer(&vif
->sched_scan_timer
, jiffies
+
1142 msecs_to_jiffies(ATH6KL_SCHED_SCAN_RESULT_DELAY
));
1148 /* Inactivity timeout of a fatpipe(pstream) at the target */
1149 static int ath6kl_wmi_pstream_timeout_event_rx(struct wmi
*wmi
, u8
*datap
,
1152 struct wmi_pstream_timeout_event
*ev
;
1154 if (len
< sizeof(struct wmi_pstream_timeout_event
))
1157 ev
= (struct wmi_pstream_timeout_event
*) datap
;
1160 * When the pstream (fat pipe == AC) timesout, it means there were
1161 * no thinStreams within this pstream & it got implicitly created
1162 * due to data flow on this AC. We start the inactivity timer only
1163 * for implicitly created pstream. Just reset the host state.
1165 spin_lock_bh(&wmi
->lock
);
1166 wmi
->stream_exist_for_ac
[ev
->traffic_class
] = 0;
1167 wmi
->fat_pipe_exist
&= ~(1 << ev
->traffic_class
);
1168 spin_unlock_bh(&wmi
->lock
);
1170 /* Indicate inactivity to driver layer for this fatpipe (pstream) */
1171 ath6kl_indicate_tx_activity(wmi
->parent_dev
, ev
->traffic_class
, false);
1176 static int ath6kl_wmi_bitrate_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1178 struct wmi_bit_rate_reply
*reply
;
1182 if (len
< sizeof(struct wmi_bit_rate_reply
))
1185 reply
= (struct wmi_bit_rate_reply
*) datap
;
1187 ath6kl_dbg(ATH6KL_DBG_WMI
, "rateindex %d\n", reply
->rate_index
);
1189 if (reply
->rate_index
== (s8
) RATE_AUTO
) {
1192 index
= reply
->rate_index
& 0x7f;
1193 if (WARN_ON_ONCE(index
> (RATE_MCS_7_40
+ 1)))
1196 sgi
= (reply
->rate_index
& 0x80) ? 1 : 0;
1197 rate
= wmi_rate_tbl
[index
][sgi
];
1200 ath6kl_wakeup_event(wmi
->parent_dev
);
1205 static int ath6kl_wmi_test_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1207 ath6kl_tm_rx_event(wmi
->parent_dev
, datap
, len
);
1212 static int ath6kl_wmi_ratemask_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1214 if (len
< sizeof(struct wmi_fix_rates_reply
))
1217 ath6kl_wakeup_event(wmi
->parent_dev
);
1222 static int ath6kl_wmi_ch_list_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1224 if (len
< sizeof(struct wmi_channel_list_reply
))
1227 ath6kl_wakeup_event(wmi
->parent_dev
);
1232 static int ath6kl_wmi_tx_pwr_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1234 struct wmi_tx_pwr_reply
*reply
;
1236 if (len
< sizeof(struct wmi_tx_pwr_reply
))
1239 reply
= (struct wmi_tx_pwr_reply
*) datap
;
1240 ath6kl_txpwr_rx_evt(wmi
->parent_dev
, reply
->dbM
);
1245 static int ath6kl_wmi_keepalive_reply_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1247 if (len
< sizeof(struct wmi_get_keepalive_cmd
))
1250 ath6kl_wakeup_event(wmi
->parent_dev
);
1255 static int ath6kl_wmi_scan_complete_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1256 struct ath6kl_vif
*vif
)
1258 struct wmi_scan_complete_event
*ev
;
1260 ev
= (struct wmi_scan_complete_event
*) datap
;
1262 ath6kl_scan_complete_evt(vif
, a_sle32_to_cpu(ev
->status
));
1263 wmi
->is_probe_ssid
= false;
1268 static int ath6kl_wmi_neighbor_report_event_rx(struct wmi
*wmi
, u8
*datap
,
1269 int len
, struct ath6kl_vif
*vif
)
1271 struct wmi_neighbor_report_event
*ev
;
1274 if (len
< sizeof(*ev
))
1276 ev
= (struct wmi_neighbor_report_event
*) datap
;
1277 if (sizeof(*ev
) + ev
->num_neighbors
* sizeof(struct wmi_neighbor_info
)
1279 ath6kl_dbg(ATH6KL_DBG_WMI
,
1280 "truncated neighbor event (num=%d len=%d)\n",
1281 ev
->num_neighbors
, len
);
1284 for (i
= 0; i
< ev
->num_neighbors
; i
++) {
1285 ath6kl_dbg(ATH6KL_DBG_WMI
, "neighbor %d/%d - %pM 0x%x\n",
1286 i
+ 1, ev
->num_neighbors
, ev
->neighbor
[i
].bssid
,
1287 ev
->neighbor
[i
].bss_flags
);
1288 cfg80211_pmksa_candidate_notify(vif
->ndev
, i
,
1289 ev
->neighbor
[i
].bssid
,
1290 !!(ev
->neighbor
[i
].bss_flags
&
1291 WMI_PREAUTH_CAPABLE_BSS
),
1299 * Target is reporting a programming error. This is for
1300 * developer aid only. Target only checks a few common violations
1301 * and it is responsibility of host to do all error checking.
1302 * Behavior of target after wmi error event is undefined.
1303 * A reset is recommended.
1305 static int ath6kl_wmi_error_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1307 const char *type
= "unknown error";
1308 struct wmi_cmd_error_event
*ev
;
1309 ev
= (struct wmi_cmd_error_event
*) datap
;
1311 switch (ev
->err_code
) {
1313 type
= "invalid parameter";
1316 type
= "invalid state";
1318 case INTERNAL_ERROR
:
1319 type
= "internal error";
1323 ath6kl_dbg(ATH6KL_DBG_WMI
, "programming error, cmd=%d %s\n",
1329 static int ath6kl_wmi_stats_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1330 struct ath6kl_vif
*vif
)
1332 ath6kl_tgt_stats_event(vif
, datap
, len
);
1337 static u8
ath6kl_wmi_get_upper_threshold(s16 rssi
,
1338 struct sq_threshold_params
*sq_thresh
,
1342 u8 threshold
= (u8
) sq_thresh
->upper_threshold
[size
- 1];
1344 /* The list is already in sorted order. Get the next lower value */
1345 for (index
= 0; index
< size
; index
++) {
1346 if (rssi
< sq_thresh
->upper_threshold
[index
]) {
1347 threshold
= (u8
) sq_thresh
->upper_threshold
[index
];
1355 static u8
ath6kl_wmi_get_lower_threshold(s16 rssi
,
1356 struct sq_threshold_params
*sq_thresh
,
1360 u8 threshold
= (u8
) sq_thresh
->lower_threshold
[size
- 1];
1362 /* The list is already in sorted order. Get the next lower value */
1363 for (index
= 0; index
< size
; index
++) {
1364 if (rssi
> sq_thresh
->lower_threshold
[index
]) {
1365 threshold
= (u8
) sq_thresh
->lower_threshold
[index
];
1373 static int ath6kl_wmi_send_rssi_threshold_params(struct wmi
*wmi
,
1374 struct wmi_rssi_threshold_params_cmd
*rssi_cmd
)
1376 struct sk_buff
*skb
;
1377 struct wmi_rssi_threshold_params_cmd
*cmd
;
1379 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
1383 cmd
= (struct wmi_rssi_threshold_params_cmd
*) skb
->data
;
1384 memcpy(cmd
, rssi_cmd
, sizeof(struct wmi_rssi_threshold_params_cmd
));
1386 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_RSSI_THRESHOLD_PARAMS_CMDID
,
1390 static int ath6kl_wmi_rssi_threshold_event_rx(struct wmi
*wmi
, u8
*datap
,
1393 struct wmi_rssi_threshold_event
*reply
;
1394 struct wmi_rssi_threshold_params_cmd cmd
;
1395 struct sq_threshold_params
*sq_thresh
;
1396 enum wmi_rssi_threshold_val new_threshold
;
1397 u8 upper_rssi_threshold
, lower_rssi_threshold
;
1401 if (len
< sizeof(struct wmi_rssi_threshold_event
))
1404 reply
= (struct wmi_rssi_threshold_event
*) datap
;
1405 new_threshold
= (enum wmi_rssi_threshold_val
) reply
->range
;
1406 rssi
= a_sle16_to_cpu(reply
->rssi
);
1408 sq_thresh
= &wmi
->sq_threshld
[SIGNAL_QUALITY_METRICS_RSSI
];
1411 * Identify the threshold breached and communicate that to the app.
1412 * After that install a new set of thresholds based on the signal
1413 * quality reported by the target
1415 if (new_threshold
) {
1416 /* Upper threshold breached */
1417 if (rssi
< sq_thresh
->upper_threshold
[0]) {
1418 ath6kl_dbg(ATH6KL_DBG_WMI
,
1419 "spurious upper rssi threshold event: %d\n",
1421 } else if ((rssi
< sq_thresh
->upper_threshold
[1]) &&
1422 (rssi
>= sq_thresh
->upper_threshold
[0])) {
1423 new_threshold
= WMI_RSSI_THRESHOLD1_ABOVE
;
1424 } else if ((rssi
< sq_thresh
->upper_threshold
[2]) &&
1425 (rssi
>= sq_thresh
->upper_threshold
[1])) {
1426 new_threshold
= WMI_RSSI_THRESHOLD2_ABOVE
;
1427 } else if ((rssi
< sq_thresh
->upper_threshold
[3]) &&
1428 (rssi
>= sq_thresh
->upper_threshold
[2])) {
1429 new_threshold
= WMI_RSSI_THRESHOLD3_ABOVE
;
1430 } else if ((rssi
< sq_thresh
->upper_threshold
[4]) &&
1431 (rssi
>= sq_thresh
->upper_threshold
[3])) {
1432 new_threshold
= WMI_RSSI_THRESHOLD4_ABOVE
;
1433 } else if ((rssi
< sq_thresh
->upper_threshold
[5]) &&
1434 (rssi
>= sq_thresh
->upper_threshold
[4])) {
1435 new_threshold
= WMI_RSSI_THRESHOLD5_ABOVE
;
1436 } else if (rssi
>= sq_thresh
->upper_threshold
[5]) {
1437 new_threshold
= WMI_RSSI_THRESHOLD6_ABOVE
;
1440 /* Lower threshold breached */
1441 if (rssi
> sq_thresh
->lower_threshold
[0]) {
1442 ath6kl_dbg(ATH6KL_DBG_WMI
,
1443 "spurious lower rssi threshold event: %d %d\n",
1444 rssi
, sq_thresh
->lower_threshold
[0]);
1445 } else if ((rssi
> sq_thresh
->lower_threshold
[1]) &&
1446 (rssi
<= sq_thresh
->lower_threshold
[0])) {
1447 new_threshold
= WMI_RSSI_THRESHOLD6_BELOW
;
1448 } else if ((rssi
> sq_thresh
->lower_threshold
[2]) &&
1449 (rssi
<= sq_thresh
->lower_threshold
[1])) {
1450 new_threshold
= WMI_RSSI_THRESHOLD5_BELOW
;
1451 } else if ((rssi
> sq_thresh
->lower_threshold
[3]) &&
1452 (rssi
<= sq_thresh
->lower_threshold
[2])) {
1453 new_threshold
= WMI_RSSI_THRESHOLD4_BELOW
;
1454 } else if ((rssi
> sq_thresh
->lower_threshold
[4]) &&
1455 (rssi
<= sq_thresh
->lower_threshold
[3])) {
1456 new_threshold
= WMI_RSSI_THRESHOLD3_BELOW
;
1457 } else if ((rssi
> sq_thresh
->lower_threshold
[5]) &&
1458 (rssi
<= sq_thresh
->lower_threshold
[4])) {
1459 new_threshold
= WMI_RSSI_THRESHOLD2_BELOW
;
1460 } else if (rssi
<= sq_thresh
->lower_threshold
[5]) {
1461 new_threshold
= WMI_RSSI_THRESHOLD1_BELOW
;
1465 /* Calculate and install the next set of thresholds */
1466 lower_rssi_threshold
= ath6kl_wmi_get_lower_threshold(rssi
, sq_thresh
,
1467 sq_thresh
->lower_threshold_valid_count
);
1468 upper_rssi_threshold
= ath6kl_wmi_get_upper_threshold(rssi
, sq_thresh
,
1469 sq_thresh
->upper_threshold_valid_count
);
1471 /* Issue a wmi command to install the thresholds */
1472 cmd
.thresh_above1_val
= a_cpu_to_sle16(upper_rssi_threshold
);
1473 cmd
.thresh_below1_val
= a_cpu_to_sle16(lower_rssi_threshold
);
1474 cmd
.weight
= sq_thresh
->weight
;
1475 cmd
.poll_time
= cpu_to_le32(sq_thresh
->polling_interval
);
1477 ret
= ath6kl_wmi_send_rssi_threshold_params(wmi
, &cmd
);
1479 ath6kl_err("unable to configure rssi thresholds\n");
1486 static int ath6kl_wmi_cac_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1487 struct ath6kl_vif
*vif
)
1489 struct wmi_cac_event
*reply
;
1490 struct ieee80211_tspec_ie
*ts
;
1491 u16 active_tsids
, tsinfo
;
1495 if (len
< sizeof(struct wmi_cac_event
))
1498 reply
= (struct wmi_cac_event
*) datap
;
1500 if ((reply
->cac_indication
== CAC_INDICATION_ADMISSION_RESP
) &&
1501 (reply
->status_code
!= IEEE80211_TSPEC_STATUS_ADMISS_ACCEPTED
)) {
1503 ts
= (struct ieee80211_tspec_ie
*) &(reply
->tspec_suggestion
);
1504 tsinfo
= le16_to_cpu(ts
->tsinfo
);
1505 tsid
= (tsinfo
>> IEEE80211_WMM_IE_TSPEC_TID_SHIFT
) &
1506 IEEE80211_WMM_IE_TSPEC_TID_MASK
;
1508 ath6kl_wmi_delete_pstream_cmd(wmi
, vif
->fw_vif_idx
,
1510 } else if (reply
->cac_indication
== CAC_INDICATION_NO_RESP
) {
1512 * Following assumes that there is only one outstanding
1513 * ADDTS request when this event is received
1515 spin_lock_bh(&wmi
->lock
);
1516 active_tsids
= wmi
->stream_exist_for_ac
[reply
->ac
];
1517 spin_unlock_bh(&wmi
->lock
);
1519 for (index
= 0; index
< sizeof(active_tsids
) * 8; index
++) {
1520 if ((active_tsids
>> index
) & 1)
1523 if (index
< (sizeof(active_tsids
) * 8))
1524 ath6kl_wmi_delete_pstream_cmd(wmi
, vif
->fw_vif_idx
,
1529 * Clear active tsids and Add missing handling
1530 * for delete qos stream from AP
1532 else if (reply
->cac_indication
== CAC_INDICATION_DELETE
) {
1534 ts
= (struct ieee80211_tspec_ie
*) &(reply
->tspec_suggestion
);
1535 tsinfo
= le16_to_cpu(ts
->tsinfo
);
1536 ts_id
= ((tsinfo
>> IEEE80211_WMM_IE_TSPEC_TID_SHIFT
) &
1537 IEEE80211_WMM_IE_TSPEC_TID_MASK
);
1539 spin_lock_bh(&wmi
->lock
);
1540 wmi
->stream_exist_for_ac
[reply
->ac
] &= ~(1 << ts_id
);
1541 active_tsids
= wmi
->stream_exist_for_ac
[reply
->ac
];
1542 spin_unlock_bh(&wmi
->lock
);
1544 /* Indicate stream inactivity to driver layer only if all tsids
1545 * within this AC are deleted.
1547 if (!active_tsids
) {
1548 ath6kl_indicate_tx_activity(wmi
->parent_dev
, reply
->ac
,
1550 wmi
->fat_pipe_exist
&= ~(1 << reply
->ac
);
1557 static int ath6kl_wmi_txe_notify_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
1558 struct ath6kl_vif
*vif
)
1560 struct wmi_txe_notify_event
*ev
;
1563 if (len
< sizeof(*ev
))
1566 if (vif
->sme_state
!= SME_CONNECTED
)
1569 ev
= (struct wmi_txe_notify_event
*) datap
;
1570 rate
= le32_to_cpu(ev
->rate
);
1571 pkts
= le32_to_cpu(ev
->pkts
);
1573 ath6kl_dbg(ATH6KL_DBG_WMI
, "TXE notify event: peer %pM rate %d% pkts %d intvl %ds\n",
1574 vif
->bssid
, rate
, pkts
, vif
->txe_intvl
);
1576 cfg80211_cqm_txe_notify(vif
->ndev
, vif
->bssid
, pkts
,
1577 rate
, vif
->txe_intvl
, GFP_KERNEL
);
1582 int ath6kl_wmi_set_txe_notify(struct wmi
*wmi
, u8 idx
,
1583 u32 rate
, u32 pkts
, u32 intvl
)
1585 struct sk_buff
*skb
;
1586 struct wmi_txe_notify_cmd
*cmd
;
1588 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
1592 cmd
= (struct wmi_txe_notify_cmd
*) skb
->data
;
1593 cmd
->rate
= cpu_to_le32(rate
);
1594 cmd
->pkts
= cpu_to_le32(pkts
);
1595 cmd
->intvl
= cpu_to_le32(intvl
);
1597 return ath6kl_wmi_cmd_send(wmi
, idx
, skb
, WMI_SET_TXE_NOTIFY_CMDID
,
1601 int ath6kl_wmi_set_rssi_filter_cmd(struct wmi
*wmi
, u8 if_idx
, s8 rssi
)
1603 struct sk_buff
*skb
;
1604 struct wmi_set_rssi_filter_cmd
*cmd
;
1607 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
1611 cmd
= (struct wmi_set_rssi_filter_cmd
*) skb
->data
;
1614 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_RSSI_FILTER_CMDID
,
1619 static int ath6kl_wmi_send_snr_threshold_params(struct wmi
*wmi
,
1620 struct wmi_snr_threshold_params_cmd
*snr_cmd
)
1622 struct sk_buff
*skb
;
1623 struct wmi_snr_threshold_params_cmd
*cmd
;
1625 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
1629 cmd
= (struct wmi_snr_threshold_params_cmd
*) skb
->data
;
1630 memcpy(cmd
, snr_cmd
, sizeof(struct wmi_snr_threshold_params_cmd
));
1632 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SNR_THRESHOLD_PARAMS_CMDID
,
1636 static int ath6kl_wmi_snr_threshold_event_rx(struct wmi
*wmi
, u8
*datap
,
1639 struct wmi_snr_threshold_event
*reply
;
1640 struct sq_threshold_params
*sq_thresh
;
1641 struct wmi_snr_threshold_params_cmd cmd
;
1642 enum wmi_snr_threshold_val new_threshold
;
1643 u8 upper_snr_threshold
, lower_snr_threshold
;
1647 if (len
< sizeof(struct wmi_snr_threshold_event
))
1650 reply
= (struct wmi_snr_threshold_event
*) datap
;
1652 new_threshold
= (enum wmi_snr_threshold_val
) reply
->range
;
1655 sq_thresh
= &wmi
->sq_threshld
[SIGNAL_QUALITY_METRICS_SNR
];
1658 * Identify the threshold breached and communicate that to the app.
1659 * After that install a new set of thresholds based on the signal
1660 * quality reported by the target.
1662 if (new_threshold
) {
1663 /* Upper threshold breached */
1664 if (snr
< sq_thresh
->upper_threshold
[0]) {
1665 ath6kl_dbg(ATH6KL_DBG_WMI
,
1666 "spurious upper snr threshold event: %d\n",
1668 } else if ((snr
< sq_thresh
->upper_threshold
[1]) &&
1669 (snr
>= sq_thresh
->upper_threshold
[0])) {
1670 new_threshold
= WMI_SNR_THRESHOLD1_ABOVE
;
1671 } else if ((snr
< sq_thresh
->upper_threshold
[2]) &&
1672 (snr
>= sq_thresh
->upper_threshold
[1])) {
1673 new_threshold
= WMI_SNR_THRESHOLD2_ABOVE
;
1674 } else if ((snr
< sq_thresh
->upper_threshold
[3]) &&
1675 (snr
>= sq_thresh
->upper_threshold
[2])) {
1676 new_threshold
= WMI_SNR_THRESHOLD3_ABOVE
;
1677 } else if (snr
>= sq_thresh
->upper_threshold
[3]) {
1678 new_threshold
= WMI_SNR_THRESHOLD4_ABOVE
;
1681 /* Lower threshold breached */
1682 if (snr
> sq_thresh
->lower_threshold
[0]) {
1683 ath6kl_dbg(ATH6KL_DBG_WMI
,
1684 "spurious lower snr threshold event: %d\n",
1685 sq_thresh
->lower_threshold
[0]);
1686 } else if ((snr
> sq_thresh
->lower_threshold
[1]) &&
1687 (snr
<= sq_thresh
->lower_threshold
[0])) {
1688 new_threshold
= WMI_SNR_THRESHOLD4_BELOW
;
1689 } else if ((snr
> sq_thresh
->lower_threshold
[2]) &&
1690 (snr
<= sq_thresh
->lower_threshold
[1])) {
1691 new_threshold
= WMI_SNR_THRESHOLD3_BELOW
;
1692 } else if ((snr
> sq_thresh
->lower_threshold
[3]) &&
1693 (snr
<= sq_thresh
->lower_threshold
[2])) {
1694 new_threshold
= WMI_SNR_THRESHOLD2_BELOW
;
1695 } else if (snr
<= sq_thresh
->lower_threshold
[3]) {
1696 new_threshold
= WMI_SNR_THRESHOLD1_BELOW
;
1700 /* Calculate and install the next set of thresholds */
1701 lower_snr_threshold
= ath6kl_wmi_get_lower_threshold(snr
, sq_thresh
,
1702 sq_thresh
->lower_threshold_valid_count
);
1703 upper_snr_threshold
= ath6kl_wmi_get_upper_threshold(snr
, sq_thresh
,
1704 sq_thresh
->upper_threshold_valid_count
);
1706 /* Issue a wmi command to install the thresholds */
1707 cmd
.thresh_above1_val
= upper_snr_threshold
;
1708 cmd
.thresh_below1_val
= lower_snr_threshold
;
1709 cmd
.weight
= sq_thresh
->weight
;
1710 cmd
.poll_time
= cpu_to_le32(sq_thresh
->polling_interval
);
1712 ath6kl_dbg(ATH6KL_DBG_WMI
,
1713 "snr: %d, threshold: %d, lower: %d, upper: %d\n",
1715 lower_snr_threshold
, upper_snr_threshold
);
1717 ret
= ath6kl_wmi_send_snr_threshold_params(wmi
, &cmd
);
1719 ath6kl_err("unable to configure snr threshold\n");
1726 static int ath6kl_wmi_aplist_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
1728 u16 ap_info_entry_size
;
1729 struct wmi_aplist_event
*ev
= (struct wmi_aplist_event
*) datap
;
1730 struct wmi_ap_info_v1
*ap_info_v1
;
1733 if (len
< sizeof(struct wmi_aplist_event
) ||
1734 ev
->ap_list_ver
!= APLIST_VER1
)
1737 ap_info_entry_size
= sizeof(struct wmi_ap_info_v1
);
1738 ap_info_v1
= (struct wmi_ap_info_v1
*) ev
->ap_list
;
1740 ath6kl_dbg(ATH6KL_DBG_WMI
,
1741 "number of APs in aplist event: %d\n", ev
->num_ap
);
1743 if (len
< (int) (sizeof(struct wmi_aplist_event
) +
1744 (ev
->num_ap
- 1) * ap_info_entry_size
))
1747 /* AP list version 1 contents */
1748 for (index
= 0; index
< ev
->num_ap
; index
++) {
1749 ath6kl_dbg(ATH6KL_DBG_WMI
, "AP#%d BSSID %pM Channel %d\n",
1750 index
, ap_info_v1
->bssid
, ap_info_v1
->channel
);
1757 int ath6kl_wmi_cmd_send(struct wmi
*wmi
, u8 if_idx
, struct sk_buff
*skb
,
1758 enum wmi_cmd_id cmd_id
, enum wmi_sync_flag sync_flag
)
1760 struct wmi_cmd_hdr
*cmd_hdr
;
1761 enum htc_endpoint_id ep_id
= wmi
->ep_id
;
1765 if (WARN_ON(skb
== NULL
||
1766 (if_idx
> (wmi
->parent_dev
->vif_max
- 1)))) {
1771 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi tx id %d len %d flag %d\n",
1772 cmd_id
, skb
->len
, sync_flag
);
1773 ath6kl_dbg_dump(ATH6KL_DBG_WMI_DUMP
, NULL
, "wmi tx ",
1774 skb
->data
, skb
->len
);
1776 if (sync_flag
>= END_WMIFLAG
) {
1781 if ((sync_flag
== SYNC_BEFORE_WMIFLAG
) ||
1782 (sync_flag
== SYNC_BOTH_WMIFLAG
)) {
1784 * Make sure all data currently queued is transmitted before
1785 * the cmd execution. Establish a new sync point.
1787 ath6kl_wmi_sync_point(wmi
, if_idx
);
1790 skb_push(skb
, sizeof(struct wmi_cmd_hdr
));
1792 cmd_hdr
= (struct wmi_cmd_hdr
*) skb
->data
;
1793 cmd_hdr
->cmd_id
= cpu_to_le16(cmd_id
);
1794 info1
= if_idx
& WMI_CMD_HDR_IF_ID_MASK
;
1795 cmd_hdr
->info1
= cpu_to_le16(info1
);
1797 /* Only for OPT_TX_CMD, use BE endpoint. */
1798 if (cmd_id
== WMI_OPT_TX_FRAME_CMDID
) {
1799 ret
= ath6kl_wmi_data_hdr_add(wmi
, skb
, OPT_MSGTYPE
,
1800 false, false, 0, NULL
, if_idx
);
1805 ep_id
= ath6kl_ac2_endpoint_id(wmi
->parent_dev
, WMM_AC_BE
);
1808 ath6kl_control_tx(wmi
->parent_dev
, skb
, ep_id
);
1810 if ((sync_flag
== SYNC_AFTER_WMIFLAG
) ||
1811 (sync_flag
== SYNC_BOTH_WMIFLAG
)) {
1813 * Make sure all new data queued waits for the command to
1814 * execute. Establish a new sync point.
1816 ath6kl_wmi_sync_point(wmi
, if_idx
);
1822 int ath6kl_wmi_connect_cmd(struct wmi
*wmi
, u8 if_idx
,
1823 enum network_type nw_type
,
1824 enum dot11_auth_mode dot11_auth_mode
,
1825 enum auth_mode auth_mode
,
1826 enum crypto_type pairwise_crypto
,
1827 u8 pairwise_crypto_len
,
1828 enum crypto_type group_crypto
,
1829 u8 group_crypto_len
, int ssid_len
, u8
*ssid
,
1830 u8
*bssid
, u16 channel
, u32 ctrl_flags
,
1833 struct sk_buff
*skb
;
1834 struct wmi_connect_cmd
*cc
;
1837 ath6kl_dbg(ATH6KL_DBG_WMI
,
1838 "wmi connect bssid %pM freq %d flags 0x%x ssid_len %d "
1839 "type %d dot11_auth %d auth %d pairwise %d group %d\n",
1840 bssid
, channel
, ctrl_flags
, ssid_len
, nw_type
,
1841 dot11_auth_mode
, auth_mode
, pairwise_crypto
, group_crypto
);
1842 ath6kl_dbg_dump(ATH6KL_DBG_WMI
, NULL
, "ssid ", ssid
, ssid_len
);
1844 wmi
->traffic_class
= 100;
1846 if ((pairwise_crypto
== NONE_CRYPT
) && (group_crypto
!= NONE_CRYPT
))
1849 if ((pairwise_crypto
!= NONE_CRYPT
) && (group_crypto
== NONE_CRYPT
))
1852 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_connect_cmd
));
1856 cc
= (struct wmi_connect_cmd
*) skb
->data
;
1859 memcpy(cc
->ssid
, ssid
, ssid_len
);
1861 cc
->ssid_len
= ssid_len
;
1862 cc
->nw_type
= nw_type
;
1863 cc
->dot11_auth_mode
= dot11_auth_mode
;
1864 cc
->auth_mode
= auth_mode
;
1865 cc
->prwise_crypto_type
= pairwise_crypto
;
1866 cc
->prwise_crypto_len
= pairwise_crypto_len
;
1867 cc
->grp_crypto_type
= group_crypto
;
1868 cc
->grp_crypto_len
= group_crypto_len
;
1869 cc
->ch
= cpu_to_le16(channel
);
1870 cc
->ctrl_flags
= cpu_to_le32(ctrl_flags
);
1871 cc
->nw_subtype
= nw_subtype
;
1874 memcpy(cc
->bssid
, bssid
, ETH_ALEN
);
1876 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_CONNECT_CMDID
,
1882 int ath6kl_wmi_reconnect_cmd(struct wmi
*wmi
, u8 if_idx
, u8
*bssid
,
1885 struct sk_buff
*skb
;
1886 struct wmi_reconnect_cmd
*cc
;
1889 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi reconnect bssid %pM freq %d\n",
1892 wmi
->traffic_class
= 100;
1894 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_reconnect_cmd
));
1898 cc
= (struct wmi_reconnect_cmd
*) skb
->data
;
1899 cc
->channel
= cpu_to_le16(channel
);
1902 memcpy(cc
->bssid
, bssid
, ETH_ALEN
);
1904 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_RECONNECT_CMDID
,
1910 int ath6kl_wmi_disconnect_cmd(struct wmi
*wmi
, u8 if_idx
)
1914 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi disconnect\n");
1916 wmi
->traffic_class
= 100;
1918 /* Disconnect command does not need to do a SYNC before. */
1919 ret
= ath6kl_wmi_simple_cmd(wmi
, if_idx
, WMI_DISCONNECT_CMDID
);
1924 /* ath6kl_wmi_start_scan_cmd is to be deprecated. Use
1925 * ath6kl_wmi_begin_scan_cmd instead. The new function supports P2P
1926 * mgmt operations using station interface.
1928 static int ath6kl_wmi_startscan_cmd(struct wmi
*wmi
, u8 if_idx
,
1929 enum wmi_scan_type scan_type
,
1930 u32 force_fgscan
, u32 is_legacy
,
1931 u32 home_dwell_time
,
1932 u32 force_scan_interval
,
1933 s8 num_chan
, u16
*ch_list
)
1935 struct sk_buff
*skb
;
1936 struct wmi_start_scan_cmd
*sc
;
1940 size
= sizeof(struct wmi_start_scan_cmd
);
1942 if ((scan_type
!= WMI_LONG_SCAN
) && (scan_type
!= WMI_SHORT_SCAN
))
1945 if (num_chan
> WMI_MAX_CHANNELS
)
1949 size
+= sizeof(u16
) * (num_chan
- 1);
1951 skb
= ath6kl_wmi_get_new_buf(size
);
1955 sc
= (struct wmi_start_scan_cmd
*) skb
->data
;
1956 sc
->scan_type
= scan_type
;
1957 sc
->force_fg_scan
= cpu_to_le32(force_fgscan
);
1958 sc
->is_legacy
= cpu_to_le32(is_legacy
);
1959 sc
->home_dwell_time
= cpu_to_le32(home_dwell_time
);
1960 sc
->force_scan_intvl
= cpu_to_le32(force_scan_interval
);
1961 sc
->num_ch
= num_chan
;
1963 for (i
= 0; i
< num_chan
; i
++)
1964 sc
->ch_list
[i
] = cpu_to_le16(ch_list
[i
]);
1966 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_START_SCAN_CMDID
,
1973 * beginscan supports (compared to old startscan) P2P mgmt operations using
1974 * station interface, send additional information like supported rates to
1975 * advertise and xmit rates for probe requests
1977 int ath6kl_wmi_beginscan_cmd(struct wmi
*wmi
, u8 if_idx
,
1978 enum wmi_scan_type scan_type
,
1979 u32 force_fgscan
, u32 is_legacy
,
1980 u32 home_dwell_time
, u32 force_scan_interval
,
1981 s8 num_chan
, u16
*ch_list
, u32 no_cck
, u32
*rates
)
1983 struct ieee80211_supported_band
*sband
;
1984 struct sk_buff
*skb
;
1985 struct wmi_begin_scan_cmd
*sc
;
1986 s8 size
, *supp_rates
;
1988 struct ath6kl
*ar
= wmi
->parent_dev
;
1992 if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX
,
1993 ar
->fw_capabilities
)) {
1994 return ath6kl_wmi_startscan_cmd(wmi
, if_idx
,
1995 scan_type
, force_fgscan
,
1996 is_legacy
, home_dwell_time
,
1997 force_scan_interval
,
2001 size
= sizeof(struct wmi_begin_scan_cmd
);
2003 if ((scan_type
!= WMI_LONG_SCAN
) && (scan_type
!= WMI_SHORT_SCAN
))
2006 if (num_chan
> WMI_MAX_CHANNELS
)
2010 size
+= sizeof(u16
) * (num_chan
- 1);
2012 skb
= ath6kl_wmi_get_new_buf(size
);
2016 sc
= (struct wmi_begin_scan_cmd
*) skb
->data
;
2017 sc
->scan_type
= scan_type
;
2018 sc
->force_fg_scan
= cpu_to_le32(force_fgscan
);
2019 sc
->is_legacy
= cpu_to_le32(is_legacy
);
2020 sc
->home_dwell_time
= cpu_to_le32(home_dwell_time
);
2021 sc
->force_scan_intvl
= cpu_to_le32(force_scan_interval
);
2022 sc
->no_cck
= cpu_to_le32(no_cck
);
2023 sc
->num_ch
= num_chan
;
2025 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++) {
2026 sband
= ar
->wiphy
->bands
[band
];
2031 if (WARN_ON(band
>= ATH6KL_NUM_BANDS
))
2034 ratemask
= rates
[band
];
2035 supp_rates
= sc
->supp_rates
[band
].rates
;
2038 for (i
= 0; i
< sband
->n_bitrates
; i
++) {
2039 if ((BIT(i
) & ratemask
) == 0)
2040 continue; /* skip rate */
2041 supp_rates
[num_rates
++] =
2042 (u8
) (sband
->bitrates
[i
].bitrate
/ 5);
2044 sc
->supp_rates
[band
].nrates
= num_rates
;
2047 for (i
= 0; i
< num_chan
; i
++)
2048 sc
->ch_list
[i
] = cpu_to_le16(ch_list
[i
]);
2050 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_BEGIN_SCAN_CMDID
,
2056 int ath6kl_wmi_enable_sched_scan_cmd(struct wmi
*wmi
, u8 if_idx
, bool enable
)
2058 struct sk_buff
*skb
;
2059 struct wmi_enable_sched_scan_cmd
*sc
;
2062 skb
= ath6kl_wmi_get_new_buf(sizeof(*sc
));
2066 ath6kl_dbg(ATH6KL_DBG_WMI
, "%s scheduled scan on vif %d\n",
2067 enable
? "enabling" : "disabling", if_idx
);
2068 sc
= (struct wmi_enable_sched_scan_cmd
*) skb
->data
;
2069 sc
->enable
= enable
? 1 : 0;
2071 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
2072 WMI_ENABLE_SCHED_SCAN_CMDID
,
2077 int ath6kl_wmi_scanparams_cmd(struct wmi
*wmi
, u8 if_idx
,
2079 u16 fg_end_sec
, u16 bg_sec
,
2080 u16 minact_chdw_msec
, u16 maxact_chdw_msec
,
2081 u16 pas_chdw_msec
, u8 short_scan_ratio
,
2082 u8 scan_ctrl_flag
, u32 max_dfsch_act_time
,
2083 u16 maxact_scan_per_ssid
)
2085 struct sk_buff
*skb
;
2086 struct wmi_scan_params_cmd
*sc
;
2089 skb
= ath6kl_wmi_get_new_buf(sizeof(*sc
));
2093 sc
= (struct wmi_scan_params_cmd
*) skb
->data
;
2094 sc
->fg_start_period
= cpu_to_le16(fg_start_sec
);
2095 sc
->fg_end_period
= cpu_to_le16(fg_end_sec
);
2096 sc
->bg_period
= cpu_to_le16(bg_sec
);
2097 sc
->minact_chdwell_time
= cpu_to_le16(minact_chdw_msec
);
2098 sc
->maxact_chdwell_time
= cpu_to_le16(maxact_chdw_msec
);
2099 sc
->pas_chdwell_time
= cpu_to_le16(pas_chdw_msec
);
2100 sc
->short_scan_ratio
= short_scan_ratio
;
2101 sc
->scan_ctrl_flags
= scan_ctrl_flag
;
2102 sc
->max_dfsch_act_time
= cpu_to_le32(max_dfsch_act_time
);
2103 sc
->maxact_scan_per_ssid
= cpu_to_le16(maxact_scan_per_ssid
);
2105 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_SCAN_PARAMS_CMDID
,
2110 int ath6kl_wmi_bssfilter_cmd(struct wmi
*wmi
, u8 if_idx
, u8 filter
, u32 ie_mask
)
2112 struct sk_buff
*skb
;
2113 struct wmi_bss_filter_cmd
*cmd
;
2116 if (filter
>= LAST_BSS_FILTER
)
2119 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2123 cmd
= (struct wmi_bss_filter_cmd
*) skb
->data
;
2124 cmd
->bss_filter
= filter
;
2125 cmd
->ie_mask
= cpu_to_le32(ie_mask
);
2127 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_BSS_FILTER_CMDID
,
2132 int ath6kl_wmi_probedssid_cmd(struct wmi
*wmi
, u8 if_idx
, u8 index
, u8 flag
,
2133 u8 ssid_len
, u8
*ssid
)
2135 struct sk_buff
*skb
;
2136 struct wmi_probed_ssid_cmd
*cmd
;
2139 if (index
>= MAX_PROBED_SSIDS
)
2142 if (ssid_len
> sizeof(cmd
->ssid
))
2145 if ((flag
& (DISABLE_SSID_FLAG
| ANY_SSID_FLAG
)) && (ssid_len
> 0))
2148 if ((flag
& SPECIFIC_SSID_FLAG
) && !ssid_len
)
2151 if (flag
& SPECIFIC_SSID_FLAG
)
2152 wmi
->is_probe_ssid
= true;
2154 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2158 cmd
= (struct wmi_probed_ssid_cmd
*) skb
->data
;
2159 cmd
->entry_index
= index
;
2161 cmd
->ssid_len
= ssid_len
;
2162 memcpy(cmd
->ssid
, ssid
, ssid_len
);
2164 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_PROBED_SSID_CMDID
,
2169 int ath6kl_wmi_listeninterval_cmd(struct wmi
*wmi
, u8 if_idx
,
2170 u16 listen_interval
,
2173 struct sk_buff
*skb
;
2174 struct wmi_listen_int_cmd
*cmd
;
2177 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2181 cmd
= (struct wmi_listen_int_cmd
*) skb
->data
;
2182 cmd
->listen_intvl
= cpu_to_le16(listen_interval
);
2183 cmd
->num_beacons
= cpu_to_le16(listen_beacons
);
2185 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_LISTEN_INT_CMDID
,
2190 int ath6kl_wmi_bmisstime_cmd(struct wmi
*wmi
, u8 if_idx
,
2191 u16 bmiss_time
, u16 num_beacons
)
2193 struct sk_buff
*skb
;
2194 struct wmi_bmiss_time_cmd
*cmd
;
2197 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2201 cmd
= (struct wmi_bmiss_time_cmd
*) skb
->data
;
2202 cmd
->bmiss_time
= cpu_to_le16(bmiss_time
);
2203 cmd
->num_beacons
= cpu_to_le16(num_beacons
);
2205 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_BMISS_TIME_CMDID
,
2210 int ath6kl_wmi_powermode_cmd(struct wmi
*wmi
, u8 if_idx
, u8 pwr_mode
)
2212 struct sk_buff
*skb
;
2213 struct wmi_power_mode_cmd
*cmd
;
2216 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2220 cmd
= (struct wmi_power_mode_cmd
*) skb
->data
;
2221 cmd
->pwr_mode
= pwr_mode
;
2222 wmi
->pwr_mode
= pwr_mode
;
2224 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_POWER_MODE_CMDID
,
2229 int ath6kl_wmi_pmparams_cmd(struct wmi
*wmi
, u8 if_idx
, u16 idle_period
,
2230 u16 ps_poll_num
, u16 dtim_policy
,
2231 u16 tx_wakeup_policy
, u16 num_tx_to_wakeup
,
2232 u16 ps_fail_event_policy
)
2234 struct sk_buff
*skb
;
2235 struct wmi_power_params_cmd
*pm
;
2238 skb
= ath6kl_wmi_get_new_buf(sizeof(*pm
));
2242 pm
= (struct wmi_power_params_cmd
*)skb
->data
;
2243 pm
->idle_period
= cpu_to_le16(idle_period
);
2244 pm
->pspoll_number
= cpu_to_le16(ps_poll_num
);
2245 pm
->dtim_policy
= cpu_to_le16(dtim_policy
);
2246 pm
->tx_wakeup_policy
= cpu_to_le16(tx_wakeup_policy
);
2247 pm
->num_tx_to_wakeup
= cpu_to_le16(num_tx_to_wakeup
);
2248 pm
->ps_fail_event_policy
= cpu_to_le16(ps_fail_event_policy
);
2250 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_POWER_PARAMS_CMDID
,
2255 int ath6kl_wmi_disctimeout_cmd(struct wmi
*wmi
, u8 if_idx
, u8 timeout
)
2257 struct sk_buff
*skb
;
2258 struct wmi_disc_timeout_cmd
*cmd
;
2261 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2265 cmd
= (struct wmi_disc_timeout_cmd
*) skb
->data
;
2266 cmd
->discon_timeout
= timeout
;
2268 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_DISC_TIMEOUT_CMDID
,
2272 ath6kl_debug_set_disconnect_timeout(wmi
->parent_dev
, timeout
);
2277 int ath6kl_wmi_addkey_cmd(struct wmi
*wmi
, u8 if_idx
, u8 key_index
,
2278 enum crypto_type key_type
,
2279 u8 key_usage
, u8 key_len
,
2280 u8
*key_rsc
, unsigned int key_rsc_len
,
2282 u8 key_op_ctrl
, u8
*mac_addr
,
2283 enum wmi_sync_flag sync_flag
)
2285 struct sk_buff
*skb
;
2286 struct wmi_add_cipher_key_cmd
*cmd
;
2289 ath6kl_dbg(ATH6KL_DBG_WMI
,
2290 "addkey cmd: key_index=%u key_type=%d key_usage=%d key_len=%d key_op_ctrl=%d\n",
2291 key_index
, key_type
, key_usage
, key_len
, key_op_ctrl
);
2293 if ((key_index
> WMI_MAX_KEY_INDEX
) || (key_len
> WMI_MAX_KEY_LEN
) ||
2294 (key_material
== NULL
) || key_rsc_len
> 8)
2297 if ((WEP_CRYPT
!= key_type
) && (NULL
== key_rsc
))
2300 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2304 cmd
= (struct wmi_add_cipher_key_cmd
*) skb
->data
;
2305 cmd
->key_index
= key_index
;
2306 cmd
->key_type
= key_type
;
2307 cmd
->key_usage
= key_usage
;
2308 cmd
->key_len
= key_len
;
2309 memcpy(cmd
->key
, key_material
, key_len
);
2311 if (key_rsc
!= NULL
)
2312 memcpy(cmd
->key_rsc
, key_rsc
, key_rsc_len
);
2314 cmd
->key_op_ctrl
= key_op_ctrl
;
2317 memcpy(cmd
->key_mac_addr
, mac_addr
, ETH_ALEN
);
2319 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_CIPHER_KEY_CMDID
,
2325 int ath6kl_wmi_add_krk_cmd(struct wmi
*wmi
, u8 if_idx
, u8
*krk
)
2327 struct sk_buff
*skb
;
2328 struct wmi_add_krk_cmd
*cmd
;
2331 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2335 cmd
= (struct wmi_add_krk_cmd
*) skb
->data
;
2336 memcpy(cmd
->krk
, krk
, WMI_KRK_LEN
);
2338 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_KRK_CMDID
,
2344 int ath6kl_wmi_deletekey_cmd(struct wmi
*wmi
, u8 if_idx
, u8 key_index
)
2346 struct sk_buff
*skb
;
2347 struct wmi_delete_cipher_key_cmd
*cmd
;
2350 if (key_index
> WMI_MAX_KEY_INDEX
)
2353 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2357 cmd
= (struct wmi_delete_cipher_key_cmd
*) skb
->data
;
2358 cmd
->key_index
= key_index
;
2360 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DELETE_CIPHER_KEY_CMDID
,
2366 int ath6kl_wmi_setpmkid_cmd(struct wmi
*wmi
, u8 if_idx
, const u8
*bssid
,
2367 const u8
*pmkid
, bool set
)
2369 struct sk_buff
*skb
;
2370 struct wmi_setpmkid_cmd
*cmd
;
2376 if (set
&& pmkid
== NULL
)
2379 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2383 cmd
= (struct wmi_setpmkid_cmd
*) skb
->data
;
2384 memcpy(cmd
->bssid
, bssid
, ETH_ALEN
);
2386 memcpy(cmd
->pmkid
, pmkid
, sizeof(cmd
->pmkid
));
2387 cmd
->enable
= PMKID_ENABLE
;
2389 memset(cmd
->pmkid
, 0, sizeof(cmd
->pmkid
));
2390 cmd
->enable
= PMKID_DISABLE
;
2393 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_PMKID_CMDID
,
2399 static int ath6kl_wmi_data_sync_send(struct wmi
*wmi
, struct sk_buff
*skb
,
2400 enum htc_endpoint_id ep_id
, u8 if_idx
)
2402 struct wmi_data_hdr
*data_hdr
;
2405 if (WARN_ON(skb
== NULL
|| ep_id
== wmi
->ep_id
)) {
2410 skb_push(skb
, sizeof(struct wmi_data_hdr
));
2412 data_hdr
= (struct wmi_data_hdr
*) skb
->data
;
2413 data_hdr
->info
= SYNC_MSGTYPE
<< WMI_DATA_HDR_MSG_TYPE_SHIFT
;
2414 data_hdr
->info3
= cpu_to_le16(if_idx
& WMI_DATA_HDR_IF_IDX_MASK
);
2416 ret
= ath6kl_control_tx(wmi
->parent_dev
, skb
, ep_id
);
2421 static int ath6kl_wmi_sync_point(struct wmi
*wmi
, u8 if_idx
)
2423 struct sk_buff
*skb
;
2424 struct wmi_sync_cmd
*cmd
;
2425 struct wmi_data_sync_bufs data_sync_bufs
[WMM_NUM_AC
];
2426 enum htc_endpoint_id ep_id
;
2427 u8 index
, num_pri_streams
= 0;
2430 memset(data_sync_bufs
, 0, sizeof(data_sync_bufs
));
2432 spin_lock_bh(&wmi
->lock
);
2434 for (index
= 0; index
< WMM_NUM_AC
; index
++) {
2435 if (wmi
->fat_pipe_exist
& (1 << index
)) {
2437 data_sync_bufs
[num_pri_streams
- 1].traffic_class
=
2442 spin_unlock_bh(&wmi
->lock
);
2444 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2448 cmd
= (struct wmi_sync_cmd
*) skb
->data
;
2451 * In the SYNC cmd sent on the control Ep, send a bitmap
2452 * of the data eps on which the Data Sync will be sent
2454 cmd
->data_sync_map
= wmi
->fat_pipe_exist
;
2456 for (index
= 0; index
< num_pri_streams
; index
++) {
2457 data_sync_bufs
[index
].skb
= ath6kl_buf_alloc(0);
2458 if (data_sync_bufs
[index
].skb
== NULL
) {
2465 * If buffer allocation for any of the dataSync fails,
2466 * then do not send the Synchronize cmd on the control ep
2472 * Send sync cmd followed by sync data messages on all
2473 * endpoints being used
2475 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SYNCHRONIZE_CMDID
,
2481 for (index
= 0; index
< num_pri_streams
; index
++) {
2483 if (WARN_ON(!data_sync_bufs
[index
].skb
))
2486 ep_id
= ath6kl_ac2_endpoint_id(wmi
->parent_dev
,
2487 data_sync_bufs
[index
].
2490 ath6kl_wmi_data_sync_send(wmi
, data_sync_bufs
[index
].skb
,
2493 data_sync_bufs
[index
].skb
= NULL
;
2502 /* free up any resources left over (possibly due to an error) */
2506 for (index
= 0; index
< num_pri_streams
; index
++)
2507 dev_kfree_skb((struct sk_buff
*)data_sync_bufs
[index
].skb
);
2512 int ath6kl_wmi_create_pstream_cmd(struct wmi
*wmi
, u8 if_idx
,
2513 struct wmi_create_pstream_cmd
*params
)
2515 struct sk_buff
*skb
;
2516 struct wmi_create_pstream_cmd
*cmd
;
2517 u8 fatpipe_exist_for_ac
= 0;
2519 s32 nominal_phy
= 0;
2522 if (!((params
->user_pri
< 8) &&
2523 (params
->user_pri
<= 0x7) &&
2524 (up_to_ac
[params
->user_pri
& 0x7] == params
->traffic_class
) &&
2525 (params
->traffic_direc
== UPLINK_TRAFFIC
||
2526 params
->traffic_direc
== DNLINK_TRAFFIC
||
2527 params
->traffic_direc
== BIDIR_TRAFFIC
) &&
2528 (params
->traffic_type
== TRAFFIC_TYPE_APERIODIC
||
2529 params
->traffic_type
== TRAFFIC_TYPE_PERIODIC
) &&
2530 (params
->voice_psc_cap
== DISABLE_FOR_THIS_AC
||
2531 params
->voice_psc_cap
== ENABLE_FOR_THIS_AC
||
2532 params
->voice_psc_cap
== ENABLE_FOR_ALL_AC
) &&
2533 (params
->tsid
== WMI_IMPLICIT_PSTREAM
||
2534 params
->tsid
<= WMI_MAX_THINSTREAM
))) {
2539 * Check nominal PHY rate is >= minimalPHY,
2540 * so that DUT can allow TSRS IE
2543 /* Get the physical rate (units of bps) */
2544 min_phy
= ((le32_to_cpu(params
->min_phy_rate
) / 1000) / 1000);
2546 /* Check minimal phy < nominal phy rate */
2547 if (params
->nominal_phy
>= min_phy
) {
2548 /* unit of 500 kbps */
2549 nominal_phy
= (params
->nominal_phy
* 1000) / 500;
2550 ath6kl_dbg(ATH6KL_DBG_WMI
,
2551 "TSRS IE enabled::MinPhy %x->NominalPhy ===> %x\n",
2552 min_phy
, nominal_phy
);
2554 params
->nominal_phy
= nominal_phy
;
2556 params
->nominal_phy
= 0;
2559 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2563 ath6kl_dbg(ATH6KL_DBG_WMI
,
2564 "sending create_pstream_cmd: ac=%d tsid:%d\n",
2565 params
->traffic_class
, params
->tsid
);
2567 cmd
= (struct wmi_create_pstream_cmd
*) skb
->data
;
2568 memcpy(cmd
, params
, sizeof(*cmd
));
2570 /* This is an implicitly created Fat pipe */
2571 if ((u32
) params
->tsid
== (u32
) WMI_IMPLICIT_PSTREAM
) {
2572 spin_lock_bh(&wmi
->lock
);
2573 fatpipe_exist_for_ac
= (wmi
->fat_pipe_exist
&
2574 (1 << params
->traffic_class
));
2575 wmi
->fat_pipe_exist
|= (1 << params
->traffic_class
);
2576 spin_unlock_bh(&wmi
->lock
);
2578 /* explicitly created thin stream within a fat pipe */
2579 spin_lock_bh(&wmi
->lock
);
2580 fatpipe_exist_for_ac
= (wmi
->fat_pipe_exist
&
2581 (1 << params
->traffic_class
));
2582 wmi
->stream_exist_for_ac
[params
->traffic_class
] |=
2583 (1 << params
->tsid
);
2585 * If a thinstream becomes active, the fat pipe automatically
2588 wmi
->fat_pipe_exist
|= (1 << params
->traffic_class
);
2589 spin_unlock_bh(&wmi
->lock
);
2593 * Indicate activty change to driver layer only if this is the
2594 * first TSID to get created in this AC explicitly or an implicit
2595 * fat pipe is getting created.
2597 if (!fatpipe_exist_for_ac
)
2598 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2599 params
->traffic_class
, true);
2601 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_CREATE_PSTREAM_CMDID
,
2606 int ath6kl_wmi_delete_pstream_cmd(struct wmi
*wmi
, u8 if_idx
, u8 traffic_class
,
2609 struct sk_buff
*skb
;
2610 struct wmi_delete_pstream_cmd
*cmd
;
2611 u16 active_tsids
= 0;
2614 if (traffic_class
> 3) {
2615 ath6kl_err("invalid traffic class: %d\n", traffic_class
);
2619 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2623 cmd
= (struct wmi_delete_pstream_cmd
*) skb
->data
;
2624 cmd
->traffic_class
= traffic_class
;
2627 spin_lock_bh(&wmi
->lock
);
2628 active_tsids
= wmi
->stream_exist_for_ac
[traffic_class
];
2629 spin_unlock_bh(&wmi
->lock
);
2631 if (!(active_tsids
& (1 << tsid
))) {
2633 ath6kl_dbg(ATH6KL_DBG_WMI
,
2634 "TSID %d doesn't exist for traffic class: %d\n",
2635 tsid
, traffic_class
);
2639 ath6kl_dbg(ATH6KL_DBG_WMI
,
2640 "sending delete_pstream_cmd: traffic class: %d tsid=%d\n",
2641 traffic_class
, tsid
);
2643 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DELETE_PSTREAM_CMDID
,
2644 SYNC_BEFORE_WMIFLAG
);
2646 spin_lock_bh(&wmi
->lock
);
2647 wmi
->stream_exist_for_ac
[traffic_class
] &= ~(1 << tsid
);
2648 active_tsids
= wmi
->stream_exist_for_ac
[traffic_class
];
2649 spin_unlock_bh(&wmi
->lock
);
2652 * Indicate stream inactivity to driver layer only if all tsids
2653 * within this AC are deleted.
2655 if (!active_tsids
) {
2656 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2657 traffic_class
, false);
2658 wmi
->fat_pipe_exist
&= ~(1 << traffic_class
);
2664 int ath6kl_wmi_set_ip_cmd(struct wmi
*wmi
, u8 if_idx
,
2665 __be32 ips0
, __be32 ips1
)
2667 struct sk_buff
*skb
;
2668 struct wmi_set_ip_cmd
*cmd
;
2671 /* Multicast address are not valid */
2672 if (ipv4_is_multicast(ips0
) ||
2673 ipv4_is_multicast(ips1
))
2676 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_ip_cmd
));
2680 cmd
= (struct wmi_set_ip_cmd
*) skb
->data
;
2684 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_IP_CMDID
,
2689 static void ath6kl_wmi_relinquish_implicit_pstream_credits(struct wmi
*wmi
)
2696 * Relinquish credits from all implicitly created pstreams
2697 * since when we go to sleep. If user created explicit
2698 * thinstreams exists with in a fatpipe leave them intact
2699 * for the user to delete.
2701 spin_lock_bh(&wmi
->lock
);
2702 stream_exist
= wmi
->fat_pipe_exist
;
2703 spin_unlock_bh(&wmi
->lock
);
2705 for (i
= 0; i
< WMM_NUM_AC
; i
++) {
2706 if (stream_exist
& (1 << i
)) {
2709 * FIXME: Is this lock & unlock inside
2710 * for loop correct? may need rework.
2712 spin_lock_bh(&wmi
->lock
);
2713 active_tsids
= wmi
->stream_exist_for_ac
[i
];
2714 spin_unlock_bh(&wmi
->lock
);
2717 * If there are no user created thin streams
2718 * delete the fatpipe
2720 if (!active_tsids
) {
2721 stream_exist
&= ~(1 << i
);
2723 * Indicate inactivity to driver layer for
2724 * this fatpipe (pstream)
2726 ath6kl_indicate_tx_activity(wmi
->parent_dev
,
2732 /* FIXME: Can we do this assignment without locking ? */
2733 spin_lock_bh(&wmi
->lock
);
2734 wmi
->fat_pipe_exist
= stream_exist
;
2735 spin_unlock_bh(&wmi
->lock
);
2738 static int ath6kl_set_bitrate_mask64(struct wmi
*wmi
, u8 if_idx
,
2739 const struct cfg80211_bitrate_mask
*mask
)
2741 struct sk_buff
*skb
;
2742 int ret
, mode
, band
;
2743 u64 mcsrate
, ratemask
[ATH6KL_NUM_BANDS
];
2744 struct wmi_set_tx_select_rates64_cmd
*cmd
;
2746 memset(&ratemask
, 0, sizeof(ratemask
));
2748 /* only check 2.4 and 5 GHz bands, skip the rest */
2749 for (band
= 0; band
<= IEEE80211_BAND_5GHZ
; band
++) {
2750 /* copy legacy rate mask */
2751 ratemask
[band
] = mask
->control
[band
].legacy
;
2752 if (band
== IEEE80211_BAND_5GHZ
)
2754 mask
->control
[band
].legacy
<< 4;
2756 /* copy mcs rate mask */
2757 mcsrate
= mask
->control
[band
].mcs
[1];
2759 mcsrate
|= mask
->control
[band
].mcs
[0];
2760 ratemask
[band
] |= mcsrate
<< 12;
2761 ratemask
[band
] |= mcsrate
<< 28;
2764 ath6kl_dbg(ATH6KL_DBG_WMI
,
2765 "Ratemask 64 bit: 2.4:%llx 5:%llx\n",
2766 ratemask
[0], ratemask
[1]);
2768 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
) * WMI_RATES_MODE_MAX
);
2772 cmd
= (struct wmi_set_tx_select_rates64_cmd
*) skb
->data
;
2773 for (mode
= 0; mode
< WMI_RATES_MODE_MAX
; mode
++) {
2774 /* A mode operate in 5GHZ band */
2775 if (mode
== WMI_RATES_MODE_11A
||
2776 mode
== WMI_RATES_MODE_11A_HT20
||
2777 mode
== WMI_RATES_MODE_11A_HT40
)
2778 band
= IEEE80211_BAND_5GHZ
;
2780 band
= IEEE80211_BAND_2GHZ
;
2781 cmd
->ratemask
[mode
] = cpu_to_le64(ratemask
[band
]);
2784 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
2785 WMI_SET_TX_SELECT_RATES_CMDID
,
2790 static int ath6kl_set_bitrate_mask32(struct wmi
*wmi
, u8 if_idx
,
2791 const struct cfg80211_bitrate_mask
*mask
)
2793 struct sk_buff
*skb
;
2794 int ret
, mode
, band
;
2795 u32 mcsrate
, ratemask
[ATH6KL_NUM_BANDS
];
2796 struct wmi_set_tx_select_rates32_cmd
*cmd
;
2798 memset(&ratemask
, 0, sizeof(ratemask
));
2800 /* only check 2.4 and 5 GHz bands, skip the rest */
2801 for (band
= 0; band
<= IEEE80211_BAND_5GHZ
; band
++) {
2802 /* copy legacy rate mask */
2803 ratemask
[band
] = mask
->control
[band
].legacy
;
2804 if (band
== IEEE80211_BAND_5GHZ
)
2806 mask
->control
[band
].legacy
<< 4;
2808 /* copy mcs rate mask */
2809 mcsrate
= mask
->control
[band
].mcs
[0];
2810 ratemask
[band
] |= mcsrate
<< 12;
2811 ratemask
[band
] |= mcsrate
<< 20;
2814 ath6kl_dbg(ATH6KL_DBG_WMI
,
2815 "Ratemask 32 bit: 2.4:%x 5:%x\n",
2816 ratemask
[0], ratemask
[1]);
2818 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
) * WMI_RATES_MODE_MAX
);
2822 cmd
= (struct wmi_set_tx_select_rates32_cmd
*) skb
->data
;
2823 for (mode
= 0; mode
< WMI_RATES_MODE_MAX
; mode
++) {
2824 /* A mode operate in 5GHZ band */
2825 if (mode
== WMI_RATES_MODE_11A
||
2826 mode
== WMI_RATES_MODE_11A_HT20
||
2827 mode
== WMI_RATES_MODE_11A_HT40
)
2828 band
= IEEE80211_BAND_5GHZ
;
2830 band
= IEEE80211_BAND_2GHZ
;
2831 cmd
->ratemask
[mode
] = cpu_to_le32(ratemask
[band
]);
2834 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
2835 WMI_SET_TX_SELECT_RATES_CMDID
,
2840 int ath6kl_wmi_set_bitrate_mask(struct wmi
*wmi
, u8 if_idx
,
2841 const struct cfg80211_bitrate_mask
*mask
)
2843 struct ath6kl
*ar
= wmi
->parent_dev
;
2845 if (ar
->hw
.flags
& ATH6KL_HW_64BIT_RATES
)
2846 return ath6kl_set_bitrate_mask64(wmi
, if_idx
, mask
);
2848 return ath6kl_set_bitrate_mask32(wmi
, if_idx
, mask
);
2851 int ath6kl_wmi_set_host_sleep_mode_cmd(struct wmi
*wmi
, u8 if_idx
,
2852 enum ath6kl_host_mode host_mode
)
2854 struct sk_buff
*skb
;
2855 struct wmi_set_host_sleep_mode_cmd
*cmd
;
2858 if ((host_mode
!= ATH6KL_HOST_MODE_ASLEEP
) &&
2859 (host_mode
!= ATH6KL_HOST_MODE_AWAKE
)) {
2860 ath6kl_err("invalid host sleep mode: %d\n", host_mode
);
2864 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2868 cmd
= (struct wmi_set_host_sleep_mode_cmd
*) skb
->data
;
2870 if (host_mode
== ATH6KL_HOST_MODE_ASLEEP
) {
2871 ath6kl_wmi_relinquish_implicit_pstream_credits(wmi
);
2872 cmd
->asleep
= cpu_to_le32(1);
2874 cmd
->awake
= cpu_to_le32(1);
2876 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
2877 WMI_SET_HOST_SLEEP_MODE_CMDID
,
2882 /* This command has zero length payload */
2883 static int ath6kl_wmi_host_sleep_mode_cmd_prcd_evt_rx(struct wmi
*wmi
,
2884 struct ath6kl_vif
*vif
)
2886 struct ath6kl
*ar
= wmi
->parent_dev
;
2888 set_bit(HOST_SLEEP_MODE_CMD_PROCESSED
, &vif
->flags
);
2889 wake_up(&ar
->event_wq
);
2894 int ath6kl_wmi_set_wow_mode_cmd(struct wmi
*wmi
, u8 if_idx
,
2895 enum ath6kl_wow_mode wow_mode
,
2896 u32 filter
, u16 host_req_delay
)
2898 struct sk_buff
*skb
;
2899 struct wmi_set_wow_mode_cmd
*cmd
;
2902 if ((wow_mode
!= ATH6KL_WOW_MODE_ENABLE
) &&
2903 wow_mode
!= ATH6KL_WOW_MODE_DISABLE
) {
2904 ath6kl_err("invalid wow mode: %d\n", wow_mode
);
2908 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2912 cmd
= (struct wmi_set_wow_mode_cmd
*) skb
->data
;
2913 cmd
->enable_wow
= cpu_to_le32(wow_mode
);
2914 cmd
->filter
= cpu_to_le32(filter
);
2915 cmd
->host_req_delay
= cpu_to_le16(host_req_delay
);
2917 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_WOW_MODE_CMDID
,
2922 int ath6kl_wmi_add_wow_pattern_cmd(struct wmi
*wmi
, u8 if_idx
,
2923 u8 list_id
, u8 filter_size
,
2924 u8 filter_offset
, const u8
*filter
,
2927 struct sk_buff
*skb
;
2928 struct wmi_add_wow_pattern_cmd
*cmd
;
2934 * Allocate additional memory in the buffer to hold
2935 * filter and mask value, which is twice of filter_size.
2937 size
= sizeof(*cmd
) + (2 * filter_size
);
2939 skb
= ath6kl_wmi_get_new_buf(size
);
2943 cmd
= (struct wmi_add_wow_pattern_cmd
*) skb
->data
;
2944 cmd
->filter_list_id
= list_id
;
2945 cmd
->filter_size
= filter_size
;
2946 cmd
->filter_offset
= filter_offset
;
2948 memcpy(cmd
->filter
, filter
, filter_size
);
2950 filter_mask
= (u8
*) (cmd
->filter
+ filter_size
);
2951 memcpy(filter_mask
, mask
, filter_size
);
2953 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_ADD_WOW_PATTERN_CMDID
,
2959 int ath6kl_wmi_del_wow_pattern_cmd(struct wmi
*wmi
, u8 if_idx
,
2960 u16 list_id
, u16 filter_id
)
2962 struct sk_buff
*skb
;
2963 struct wmi_del_wow_pattern_cmd
*cmd
;
2966 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
2970 cmd
= (struct wmi_del_wow_pattern_cmd
*) skb
->data
;
2971 cmd
->filter_list_id
= cpu_to_le16(list_id
);
2972 cmd
->filter_id
= cpu_to_le16(filter_id
);
2974 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_DEL_WOW_PATTERN_CMDID
,
2979 static int ath6kl_wmi_cmd_send_xtnd(struct wmi
*wmi
, struct sk_buff
*skb
,
2980 enum wmix_command_id cmd_id
,
2981 enum wmi_sync_flag sync_flag
)
2983 struct wmix_cmd_hdr
*cmd_hdr
;
2986 skb_push(skb
, sizeof(struct wmix_cmd_hdr
));
2988 cmd_hdr
= (struct wmix_cmd_hdr
*) skb
->data
;
2989 cmd_hdr
->cmd_id
= cpu_to_le32(cmd_id
);
2991 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_EXTENSION_CMDID
, sync_flag
);
2996 int ath6kl_wmi_get_challenge_resp_cmd(struct wmi
*wmi
, u32 cookie
, u32 source
)
2998 struct sk_buff
*skb
;
2999 struct wmix_hb_challenge_resp_cmd
*cmd
;
3002 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3006 cmd
= (struct wmix_hb_challenge_resp_cmd
*) skb
->data
;
3007 cmd
->cookie
= cpu_to_le32(cookie
);
3008 cmd
->source
= cpu_to_le32(source
);
3010 ret
= ath6kl_wmi_cmd_send_xtnd(wmi
, skb
, WMIX_HB_CHALLENGE_RESP_CMDID
,
3015 int ath6kl_wmi_config_debug_module_cmd(struct wmi
*wmi
, u32 valid
, u32 config
)
3017 struct ath6kl_wmix_dbglog_cfg_module_cmd
*cmd
;
3018 struct sk_buff
*skb
;
3021 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3025 cmd
= (struct ath6kl_wmix_dbglog_cfg_module_cmd
*) skb
->data
;
3026 cmd
->valid
= cpu_to_le32(valid
);
3027 cmd
->config
= cpu_to_le32(config
);
3029 ret
= ath6kl_wmi_cmd_send_xtnd(wmi
, skb
, WMIX_DBGLOG_CFG_MODULE_CMDID
,
3034 int ath6kl_wmi_get_stats_cmd(struct wmi
*wmi
, u8 if_idx
)
3036 return ath6kl_wmi_simple_cmd(wmi
, if_idx
, WMI_GET_STATISTICS_CMDID
);
3039 int ath6kl_wmi_set_tx_pwr_cmd(struct wmi
*wmi
, u8 if_idx
, u8 dbM
)
3041 struct sk_buff
*skb
;
3042 struct wmi_set_tx_pwr_cmd
*cmd
;
3045 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_tx_pwr_cmd
));
3049 cmd
= (struct wmi_set_tx_pwr_cmd
*) skb
->data
;
3052 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_TX_PWR_CMDID
,
3058 int ath6kl_wmi_get_tx_pwr_cmd(struct wmi
*wmi
, u8 if_idx
)
3060 return ath6kl_wmi_simple_cmd(wmi
, if_idx
, WMI_GET_TX_PWR_CMDID
);
3063 int ath6kl_wmi_get_roam_tbl_cmd(struct wmi
*wmi
)
3065 return ath6kl_wmi_simple_cmd(wmi
, 0, WMI_GET_ROAM_TBL_CMDID
);
3068 int ath6kl_wmi_set_lpreamble_cmd(struct wmi
*wmi
, u8 if_idx
, u8 status
,
3071 struct sk_buff
*skb
;
3072 struct wmi_set_lpreamble_cmd
*cmd
;
3075 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_lpreamble_cmd
));
3079 cmd
= (struct wmi_set_lpreamble_cmd
*) skb
->data
;
3080 cmd
->status
= status
;
3081 cmd
->preamble_policy
= preamble_policy
;
3083 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_LPREAMBLE_CMDID
,
3088 int ath6kl_wmi_set_rts_cmd(struct wmi
*wmi
, u16 threshold
)
3090 struct sk_buff
*skb
;
3091 struct wmi_set_rts_cmd
*cmd
;
3094 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_rts_cmd
));
3098 cmd
= (struct wmi_set_rts_cmd
*) skb
->data
;
3099 cmd
->threshold
= cpu_to_le16(threshold
);
3101 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_SET_RTS_CMDID
,
3106 int ath6kl_wmi_set_wmm_txop(struct wmi
*wmi
, u8 if_idx
, enum wmi_txop_cfg cfg
)
3108 struct sk_buff
*skb
;
3109 struct wmi_set_wmm_txop_cmd
*cmd
;
3112 if (!((cfg
== WMI_TXOP_DISABLED
) || (cfg
== WMI_TXOP_ENABLED
)))
3115 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_set_wmm_txop_cmd
));
3119 cmd
= (struct wmi_set_wmm_txop_cmd
*) skb
->data
;
3120 cmd
->txop_enable
= cfg
;
3122 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_WMM_TXOP_CMDID
,
3127 int ath6kl_wmi_set_keepalive_cmd(struct wmi
*wmi
, u8 if_idx
,
3128 u8 keep_alive_intvl
)
3130 struct sk_buff
*skb
;
3131 struct wmi_set_keepalive_cmd
*cmd
;
3134 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3138 cmd
= (struct wmi_set_keepalive_cmd
*) skb
->data
;
3139 cmd
->keep_alive_intvl
= keep_alive_intvl
;
3141 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_KEEPALIVE_CMDID
,
3145 ath6kl_debug_set_keepalive(wmi
->parent_dev
, keep_alive_intvl
);
3150 int ath6kl_wmi_set_htcap_cmd(struct wmi
*wmi
, u8 if_idx
,
3151 enum ieee80211_band band
,
3152 struct ath6kl_htcap
*htcap
)
3154 struct sk_buff
*skb
;
3155 struct wmi_set_htcap_cmd
*cmd
;
3157 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3161 cmd
= (struct wmi_set_htcap_cmd
*) skb
->data
;
3164 * NOTE: Band in firmware matches enum ieee80211_band, it is unlikely
3165 * this will be changed in firmware. If at all there is any change in
3166 * band value, the host needs to be fixed.
3169 cmd
->ht_enable
= !!htcap
->ht_enable
;
3170 cmd
->ht20_sgi
= !!(htcap
->cap_info
& IEEE80211_HT_CAP_SGI_20
);
3171 cmd
->ht40_supported
=
3172 !!(htcap
->cap_info
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
);
3173 cmd
->ht40_sgi
= !!(htcap
->cap_info
& IEEE80211_HT_CAP_SGI_40
);
3174 cmd
->intolerant_40mhz
=
3175 !!(htcap
->cap_info
& IEEE80211_HT_CAP_40MHZ_INTOLERANT
);
3176 cmd
->max_ampdu_len_exp
= htcap
->ampdu_factor
;
3178 ath6kl_dbg(ATH6KL_DBG_WMI
,
3179 "Set htcap: band:%d ht_enable:%d 40mhz:%d sgi_20mhz:%d sgi_40mhz:%d 40mhz_intolerant:%d ampdu_len_exp:%d\n",
3180 cmd
->band
, cmd
->ht_enable
, cmd
->ht40_supported
,
3181 cmd
->ht20_sgi
, cmd
->ht40_sgi
, cmd
->intolerant_40mhz
,
3182 cmd
->max_ampdu_len_exp
);
3183 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_HT_CAP_CMDID
,
3187 int ath6kl_wmi_test_cmd(struct wmi
*wmi
, void *buf
, size_t len
)
3189 struct sk_buff
*skb
;
3192 skb
= ath6kl_wmi_get_new_buf(len
);
3196 memcpy(skb
->data
, buf
, len
);
3198 ret
= ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_TEST_CMDID
, NO_SYNC_WMIFLAG
);
3203 int ath6kl_wmi_mcast_filter_cmd(struct wmi
*wmi
, u8 if_idx
, bool mc_all_on
)
3205 struct sk_buff
*skb
;
3206 struct wmi_mcast_filter_cmd
*cmd
;
3209 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3213 cmd
= (struct wmi_mcast_filter_cmd
*) skb
->data
;
3214 cmd
->mcast_all_enable
= mc_all_on
;
3216 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_MCAST_FILTER_CMDID
,
3221 int ath6kl_wmi_add_del_mcast_filter_cmd(struct wmi
*wmi
, u8 if_idx
,
3222 u8
*filter
, bool add_filter
)
3224 struct sk_buff
*skb
;
3225 struct wmi_mcast_filter_add_del_cmd
*cmd
;
3228 if ((filter
[0] != 0x33 || filter
[1] != 0x33) &&
3229 (filter
[0] != 0x01 || filter
[1] != 0x00 ||
3230 filter
[2] != 0x5e || filter
[3] > 0x7f)) {
3231 ath6kl_warn("invalid multicast filter address\n");
3235 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3239 cmd
= (struct wmi_mcast_filter_add_del_cmd
*) skb
->data
;
3240 memcpy(cmd
->mcast_mac
, filter
, ATH6KL_MCAST_FILTER_MAC_ADDR_SIZE
);
3241 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
3242 add_filter
? WMI_SET_MCAST_FILTER_CMDID
:
3243 WMI_DEL_MCAST_FILTER_CMDID
,
3249 int ath6kl_wmi_sta_bmiss_enhance_cmd(struct wmi
*wmi
, u8 if_idx
, bool enhance
)
3251 struct sk_buff
*skb
;
3252 struct wmi_sta_bmiss_enhance_cmd
*cmd
;
3255 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3259 cmd
= (struct wmi_sta_bmiss_enhance_cmd
*) skb
->data
;
3260 cmd
->enable
= enhance
? 1 : 0;
3262 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
3263 WMI_STA_BMISS_ENHANCE_CMDID
,
3268 int ath6kl_wmi_set_regdomain_cmd(struct wmi
*wmi
, const char *alpha2
)
3270 struct sk_buff
*skb
;
3271 struct wmi_set_regdomain_cmd
*cmd
;
3273 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3277 cmd
= (struct wmi_set_regdomain_cmd
*) skb
->data
;
3278 memcpy(cmd
->iso_name
, alpha2
, 2);
3280 return ath6kl_wmi_cmd_send(wmi
, 0, skb
,
3281 WMI_SET_REGDOMAIN_CMDID
,
3285 s32
ath6kl_wmi_get_rate(s8 rate_index
)
3289 if (rate_index
== RATE_AUTO
)
3292 /* SGI is stored as the MSB of the rate_index */
3293 if (rate_index
& RATE_INDEX_MSB
) {
3294 rate_index
&= RATE_INDEX_WITHOUT_SGI_MASK
;
3298 if (WARN_ON(rate_index
> RATE_MCS_7_40
))
3299 rate_index
= RATE_MCS_7_40
;
3301 return wmi_rate_tbl
[(u32
) rate_index
][sgi
];
3304 static int ath6kl_wmi_get_pmkid_list_event_rx(struct wmi
*wmi
, u8
*datap
,
3307 struct wmi_pmkid_list_reply
*reply
;
3310 if (len
< sizeof(struct wmi_pmkid_list_reply
))
3313 reply
= (struct wmi_pmkid_list_reply
*)datap
;
3314 expected_len
= sizeof(reply
->num_pmkid
) +
3315 le32_to_cpu(reply
->num_pmkid
) * WMI_PMKID_LEN
;
3317 if (len
< expected_len
)
3323 static int ath6kl_wmi_addba_req_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
3324 struct ath6kl_vif
*vif
)
3326 struct wmi_addba_req_event
*cmd
= (struct wmi_addba_req_event
*) datap
;
3328 aggr_recv_addba_req_evt(vif
, cmd
->tid
,
3329 le16_to_cpu(cmd
->st_seq_no
), cmd
->win_sz
);
3334 static int ath6kl_wmi_delba_req_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
3335 struct ath6kl_vif
*vif
)
3337 struct wmi_delba_event
*cmd
= (struct wmi_delba_event
*) datap
;
3339 aggr_recv_delba_req_evt(vif
, cmd
->tid
);
3344 /* AP mode functions */
3346 int ath6kl_wmi_ap_profile_commit(struct wmi
*wmip
, u8 if_idx
,
3347 struct wmi_connect_cmd
*p
)
3349 struct sk_buff
*skb
;
3350 struct wmi_connect_cmd
*cm
;
3353 skb
= ath6kl_wmi_get_new_buf(sizeof(*cm
));
3357 cm
= (struct wmi_connect_cmd
*) skb
->data
;
3358 memcpy(cm
, p
, sizeof(*cm
));
3360 res
= ath6kl_wmi_cmd_send(wmip
, if_idx
, skb
, WMI_AP_CONFIG_COMMIT_CMDID
,
3362 ath6kl_dbg(ATH6KL_DBG_WMI
,
3363 "%s: nw_type=%u auth_mode=%u ch=%u ctrl_flags=0x%x-> res=%d\n",
3364 __func__
, p
->nw_type
, p
->auth_mode
, le16_to_cpu(p
->ch
),
3365 le32_to_cpu(p
->ctrl_flags
), res
);
3369 int ath6kl_wmi_ap_set_mlme(struct wmi
*wmip
, u8 if_idx
, u8 cmd
, const u8
*mac
,
3372 struct sk_buff
*skb
;
3373 struct wmi_ap_set_mlme_cmd
*cm
;
3375 skb
= ath6kl_wmi_get_new_buf(sizeof(*cm
));
3379 cm
= (struct wmi_ap_set_mlme_cmd
*) skb
->data
;
3380 memcpy(cm
->mac
, mac
, ETH_ALEN
);
3381 cm
->reason
= cpu_to_le16(reason
);
3384 ath6kl_dbg(ATH6KL_DBG_WMI
, "ap_set_mlme: cmd=%d reason=%d\n", cm
->cmd
,
3387 return ath6kl_wmi_cmd_send(wmip
, if_idx
, skb
, WMI_AP_SET_MLME_CMDID
,
3391 int ath6kl_wmi_ap_hidden_ssid(struct wmi
*wmi
, u8 if_idx
, bool enable
)
3393 struct sk_buff
*skb
;
3394 struct wmi_ap_hidden_ssid_cmd
*cmd
;
3396 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3400 cmd
= (struct wmi_ap_hidden_ssid_cmd
*) skb
->data
;
3401 cmd
->hidden_ssid
= enable
? 1 : 0;
3403 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_HIDDEN_SSID_CMDID
,
3407 /* This command will be used to enable/disable AP uAPSD feature */
3408 int ath6kl_wmi_ap_set_apsd(struct wmi
*wmi
, u8 if_idx
, u8 enable
)
3410 struct wmi_ap_set_apsd_cmd
*cmd
;
3411 struct sk_buff
*skb
;
3413 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3417 cmd
= (struct wmi_ap_set_apsd_cmd
*)skb
->data
;
3418 cmd
->enable
= enable
;
3420 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_SET_APSD_CMDID
,
3424 int ath6kl_wmi_set_apsd_bfrd_traf(struct wmi
*wmi
, u8 if_idx
,
3425 u16 aid
, u16 bitmap
, u32 flags
)
3427 struct wmi_ap_apsd_buffered_traffic_cmd
*cmd
;
3428 struct sk_buff
*skb
;
3430 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3434 cmd
= (struct wmi_ap_apsd_buffered_traffic_cmd
*)skb
->data
;
3435 cmd
->aid
= cpu_to_le16(aid
);
3436 cmd
->bitmap
= cpu_to_le16(bitmap
);
3437 cmd
->flags
= cpu_to_le32(flags
);
3439 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
3440 WMI_AP_APSD_BUFFERED_TRAFFIC_CMDID
,
3444 static int ath6kl_wmi_pspoll_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
3445 struct ath6kl_vif
*vif
)
3447 struct wmi_pspoll_event
*ev
;
3449 if (len
< sizeof(struct wmi_pspoll_event
))
3452 ev
= (struct wmi_pspoll_event
*) datap
;
3454 ath6kl_pspoll_event(vif
, le16_to_cpu(ev
->aid
));
3459 static int ath6kl_wmi_dtimexpiry_event_rx(struct wmi
*wmi
, u8
*datap
, int len
,
3460 struct ath6kl_vif
*vif
)
3462 ath6kl_dtimexpiry_event(vif
);
3467 int ath6kl_wmi_set_pvb_cmd(struct wmi
*wmi
, u8 if_idx
, u16 aid
,
3470 struct sk_buff
*skb
;
3471 struct wmi_ap_set_pvb_cmd
*cmd
;
3474 skb
= ath6kl_wmi_get_new_buf(sizeof(struct wmi_ap_set_pvb_cmd
));
3478 cmd
= (struct wmi_ap_set_pvb_cmd
*) skb
->data
;
3479 cmd
->aid
= cpu_to_le16(aid
);
3480 cmd
->rsvd
= cpu_to_le16(0);
3481 cmd
->flag
= cpu_to_le32(flag
);
3483 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_SET_PVB_CMDID
,
3489 int ath6kl_wmi_set_rx_frame_format_cmd(struct wmi
*wmi
, u8 if_idx
,
3491 bool rx_dot11_hdr
, bool defrag_on_host
)
3493 struct sk_buff
*skb
;
3494 struct wmi_rx_frame_format_cmd
*cmd
;
3497 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3501 cmd
= (struct wmi_rx_frame_format_cmd
*) skb
->data
;
3502 cmd
->dot11_hdr
= rx_dot11_hdr
? 1 : 0;
3503 cmd
->defrag_on_host
= defrag_on_host
? 1 : 0;
3504 cmd
->meta_ver
= rx_meta_ver
;
3506 /* Delete the local aggr state, on host */
3507 ret
= ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_RX_FRAME_FORMAT_CMDID
,
3513 int ath6kl_wmi_set_appie_cmd(struct wmi
*wmi
, u8 if_idx
, u8 mgmt_frm_type
,
3514 const u8
*ie
, u8 ie_len
)
3516 struct sk_buff
*skb
;
3517 struct wmi_set_appie_cmd
*p
;
3519 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + ie_len
);
3523 ath6kl_dbg(ATH6KL_DBG_WMI
,
3524 "set_appie_cmd: mgmt_frm_type=%u ie_len=%u\n",
3525 mgmt_frm_type
, ie_len
);
3526 p
= (struct wmi_set_appie_cmd
*) skb
->data
;
3527 p
->mgmt_frm_type
= mgmt_frm_type
;
3530 if (ie
!= NULL
&& ie_len
> 0)
3531 memcpy(p
->ie_info
, ie
, ie_len
);
3533 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_APPIE_CMDID
,
3537 int ath6kl_wmi_set_ie_cmd(struct wmi
*wmi
, u8 if_idx
, u8 ie_id
, u8 ie_field
,
3538 const u8
*ie_info
, u8 ie_len
)
3540 struct sk_buff
*skb
;
3541 struct wmi_set_ie_cmd
*p
;
3543 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + ie_len
);
3547 ath6kl_dbg(ATH6KL_DBG_WMI
, "set_ie_cmd: ie_id=%u ie_ie_field=%u ie_len=%u\n",
3548 ie_id
, ie_field
, ie_len
);
3549 p
= (struct wmi_set_ie_cmd
*) skb
->data
;
3551 p
->ie_field
= ie_field
;
3553 if (ie_info
&& ie_len
> 0)
3554 memcpy(p
->ie_info
, ie_info
, ie_len
);
3556 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SET_IE_CMDID
,
3560 int ath6kl_wmi_disable_11b_rates_cmd(struct wmi
*wmi
, bool disable
)
3562 struct sk_buff
*skb
;
3563 struct wmi_disable_11b_rates_cmd
*cmd
;
3565 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3569 ath6kl_dbg(ATH6KL_DBG_WMI
, "disable_11b_rates_cmd: disable=%u\n",
3571 cmd
= (struct wmi_disable_11b_rates_cmd
*) skb
->data
;
3572 cmd
->disable
= disable
? 1 : 0;
3574 return ath6kl_wmi_cmd_send(wmi
, 0, skb
, WMI_DISABLE_11B_RATES_CMDID
,
3578 int ath6kl_wmi_remain_on_chnl_cmd(struct wmi
*wmi
, u8 if_idx
, u32 freq
, u32 dur
)
3580 struct sk_buff
*skb
;
3581 struct wmi_remain_on_chnl_cmd
*p
;
3583 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3587 ath6kl_dbg(ATH6KL_DBG_WMI
, "remain_on_chnl_cmd: freq=%u dur=%u\n",
3589 p
= (struct wmi_remain_on_chnl_cmd
*) skb
->data
;
3590 p
->freq
= cpu_to_le32(freq
);
3591 p
->duration
= cpu_to_le32(dur
);
3592 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_REMAIN_ON_CHNL_CMDID
,
3596 /* ath6kl_wmi_send_action_cmd is to be deprecated. Use
3597 * ath6kl_wmi_send_mgmt_cmd instead. The new function supports P2P
3598 * mgmt operations using station interface.
3600 static int ath6kl_wmi_send_action_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
,
3601 u32 freq
, u32 wait
, const u8
*data
,
3604 struct sk_buff
*skb
;
3605 struct wmi_send_action_cmd
*p
;
3609 return -EINVAL
; /* Offload for wait not supported */
3611 buf
= kmalloc(data_len
, GFP_KERNEL
);
3615 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + data_len
);
3621 kfree(wmi
->last_mgmt_tx_frame
);
3622 memcpy(buf
, data
, data_len
);
3623 wmi
->last_mgmt_tx_frame
= buf
;
3624 wmi
->last_mgmt_tx_frame_len
= data_len
;
3626 ath6kl_dbg(ATH6KL_DBG_WMI
,
3627 "send_action_cmd: id=%u freq=%u wait=%u len=%u\n",
3628 id
, freq
, wait
, data_len
);
3629 p
= (struct wmi_send_action_cmd
*) skb
->data
;
3630 p
->id
= cpu_to_le32(id
);
3631 p
->freq
= cpu_to_le32(freq
);
3632 p
->wait
= cpu_to_le32(wait
);
3633 p
->len
= cpu_to_le16(data_len
);
3634 memcpy(p
->data
, data
, data_len
);
3635 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SEND_ACTION_CMDID
,
3639 static int __ath6kl_wmi_send_mgmt_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
,
3640 u32 freq
, u32 wait
, const u8
*data
,
3641 u16 data_len
, u32 no_cck
)
3643 struct sk_buff
*skb
;
3644 struct wmi_send_mgmt_cmd
*p
;
3648 return -EINVAL
; /* Offload for wait not supported */
3650 buf
= kmalloc(data_len
, GFP_KERNEL
);
3654 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
) + data_len
);
3660 kfree(wmi
->last_mgmt_tx_frame
);
3661 memcpy(buf
, data
, data_len
);
3662 wmi
->last_mgmt_tx_frame
= buf
;
3663 wmi
->last_mgmt_tx_frame_len
= data_len
;
3665 ath6kl_dbg(ATH6KL_DBG_WMI
,
3666 "send_action_cmd: id=%u freq=%u wait=%u len=%u\n",
3667 id
, freq
, wait
, data_len
);
3668 p
= (struct wmi_send_mgmt_cmd
*) skb
->data
;
3669 p
->id
= cpu_to_le32(id
);
3670 p
->freq
= cpu_to_le32(freq
);
3671 p
->wait
= cpu_to_le32(wait
);
3672 p
->no_cck
= cpu_to_le32(no_cck
);
3673 p
->len
= cpu_to_le16(data_len
);
3674 memcpy(p
->data
, data
, data_len
);
3675 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_SEND_MGMT_CMDID
,
3679 int ath6kl_wmi_send_mgmt_cmd(struct wmi
*wmi
, u8 if_idx
, u32 id
, u32 freq
,
3680 u32 wait
, const u8
*data
, u16 data_len
,
3684 struct ath6kl
*ar
= wmi
->parent_dev
;
3686 if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX
,
3687 ar
->fw_capabilities
)) {
3689 * If capable of doing P2P mgmt operations using
3690 * station interface, send additional information like
3691 * supported rates to advertise and xmit rates for
3694 status
= __ath6kl_wmi_send_mgmt_cmd(ar
->wmi
, if_idx
, id
, freq
,
3695 wait
, data
, data_len
,
3698 status
= ath6kl_wmi_send_action_cmd(ar
->wmi
, if_idx
, id
, freq
,
3699 wait
, data
, data_len
);
3705 int ath6kl_wmi_send_probe_response_cmd(struct wmi
*wmi
, u8 if_idx
, u32 freq
,
3706 const u8
*dst
, const u8
*data
,
3709 struct sk_buff
*skb
;
3710 struct wmi_p2p_probe_response_cmd
*p
;
3711 size_t cmd_len
= sizeof(*p
) + data_len
;
3714 cmd_len
++; /* work around target minimum length requirement */
3716 skb
= ath6kl_wmi_get_new_buf(cmd_len
);
3720 ath6kl_dbg(ATH6KL_DBG_WMI
,
3721 "send_probe_response_cmd: freq=%u dst=%pM len=%u\n",
3722 freq
, dst
, data_len
);
3723 p
= (struct wmi_p2p_probe_response_cmd
*) skb
->data
;
3724 p
->freq
= cpu_to_le32(freq
);
3725 memcpy(p
->destination_addr
, dst
, ETH_ALEN
);
3726 p
->len
= cpu_to_le16(data_len
);
3727 memcpy(p
->data
, data
, data_len
);
3728 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
,
3729 WMI_SEND_PROBE_RESPONSE_CMDID
,
3733 int ath6kl_wmi_probe_report_req_cmd(struct wmi
*wmi
, u8 if_idx
, bool enable
)
3735 struct sk_buff
*skb
;
3736 struct wmi_probe_req_report_cmd
*p
;
3738 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3742 ath6kl_dbg(ATH6KL_DBG_WMI
, "probe_report_req_cmd: enable=%u\n",
3744 p
= (struct wmi_probe_req_report_cmd
*) skb
->data
;
3745 p
->enable
= enable
? 1 : 0;
3746 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_PROBE_REQ_REPORT_CMDID
,
3750 int ath6kl_wmi_info_req_cmd(struct wmi
*wmi
, u8 if_idx
, u32 info_req_flags
)
3752 struct sk_buff
*skb
;
3753 struct wmi_get_p2p_info
*p
;
3755 skb
= ath6kl_wmi_get_new_buf(sizeof(*p
));
3759 ath6kl_dbg(ATH6KL_DBG_WMI
, "info_req_cmd: flags=%x\n",
3761 p
= (struct wmi_get_p2p_info
*) skb
->data
;
3762 p
->info_req_flags
= cpu_to_le32(info_req_flags
);
3763 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_GET_P2P_INFO_CMDID
,
3767 int ath6kl_wmi_cancel_remain_on_chnl_cmd(struct wmi
*wmi
, u8 if_idx
)
3769 ath6kl_dbg(ATH6KL_DBG_WMI
, "cancel_remain_on_chnl_cmd\n");
3770 return ath6kl_wmi_simple_cmd(wmi
, if_idx
,
3771 WMI_CANCEL_REMAIN_ON_CHNL_CMDID
);
3774 int ath6kl_wmi_set_inact_period(struct wmi
*wmi
, u8 if_idx
, int inact_timeout
)
3776 struct sk_buff
*skb
;
3777 struct wmi_set_inact_period_cmd
*cmd
;
3779 skb
= ath6kl_wmi_get_new_buf(sizeof(*cmd
));
3783 cmd
= (struct wmi_set_inact_period_cmd
*) skb
->data
;
3784 cmd
->inact_period
= cpu_to_le32(inact_timeout
);
3785 cmd
->num_null_func
= 0;
3787 return ath6kl_wmi_cmd_send(wmi
, if_idx
, skb
, WMI_AP_CONN_INACT_CMDID
,
3791 static void ath6kl_wmi_hb_challenge_resp_event(struct wmi
*wmi
, u8
*datap
,
3794 struct wmix_hb_challenge_resp_cmd
*cmd
;
3796 if (len
< sizeof(struct wmix_hb_challenge_resp_cmd
))
3799 cmd
= (struct wmix_hb_challenge_resp_cmd
*) datap
;
3800 ath6kl_recovery_hb_event(wmi
->parent_dev
,
3801 le32_to_cpu(cmd
->cookie
));
3804 static int ath6kl_wmi_control_rx_xtnd(struct wmi
*wmi
, struct sk_buff
*skb
)
3806 struct wmix_cmd_hdr
*cmd
;
3812 if (skb
->len
< sizeof(struct wmix_cmd_hdr
)) {
3813 ath6kl_err("bad packet 1\n");
3817 cmd
= (struct wmix_cmd_hdr
*) skb
->data
;
3818 id
= le32_to_cpu(cmd
->cmd_id
);
3820 skb_pull(skb
, sizeof(struct wmix_cmd_hdr
));
3826 case WMIX_HB_CHALLENGE_RESP_EVENTID
:
3827 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi event hb challenge resp\n");
3828 ath6kl_wmi_hb_challenge_resp_event(wmi
, datap
, len
);
3830 case WMIX_DBGLOG_EVENTID
:
3831 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi event dbglog len %d\n", len
);
3832 ath6kl_debug_fwlog_event(wmi
->parent_dev
, datap
, len
);
3835 ath6kl_warn("unknown cmd id 0x%x\n", id
);
3843 static int ath6kl_wmi_roam_tbl_event_rx(struct wmi
*wmi
, u8
*datap
, int len
)
3845 return ath6kl_debug_roam_tbl_event(wmi
->parent_dev
, datap
, len
);
3848 /* Process interface specific wmi events, caller would free the datap */
3849 static int ath6kl_wmi_proc_events_vif(struct wmi
*wmi
, u16 if_idx
, u16 cmd_id
,
3852 struct ath6kl_vif
*vif
;
3854 vif
= ath6kl_get_vif_by_index(wmi
->parent_dev
, if_idx
);
3856 ath6kl_dbg(ATH6KL_DBG_WMI
,
3857 "Wmi event for unavailable vif, vif_index:%d\n",
3863 case WMI_CONNECT_EVENTID
:
3864 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CONNECT_EVENTID\n");
3865 return ath6kl_wmi_connect_event_rx(wmi
, datap
, len
, vif
);
3866 case WMI_DISCONNECT_EVENTID
:
3867 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DISCONNECT_EVENTID\n");
3868 return ath6kl_wmi_disconnect_event_rx(wmi
, datap
, len
, vif
);
3869 case WMI_TKIP_MICERR_EVENTID
:
3870 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TKIP_MICERR_EVENTID\n");
3871 return ath6kl_wmi_tkip_micerr_event_rx(wmi
, datap
, len
, vif
);
3872 case WMI_BSSINFO_EVENTID
:
3873 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_BSSINFO_EVENTID\n");
3874 return ath6kl_wmi_bssinfo_event_rx(wmi
, datap
, len
, vif
);
3875 case WMI_NEIGHBOR_REPORT_EVENTID
:
3876 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_NEIGHBOR_REPORT_EVENTID\n");
3877 return ath6kl_wmi_neighbor_report_event_rx(wmi
, datap
, len
,
3879 case WMI_SCAN_COMPLETE_EVENTID
:
3880 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SCAN_COMPLETE_EVENTID\n");
3881 return ath6kl_wmi_scan_complete_rx(wmi
, datap
, len
, vif
);
3882 case WMI_REPORT_STATISTICS_EVENTID
:
3883 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_STATISTICS_EVENTID\n");
3884 return ath6kl_wmi_stats_event_rx(wmi
, datap
, len
, vif
);
3885 case WMI_CAC_EVENTID
:
3886 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CAC_EVENTID\n");
3887 return ath6kl_wmi_cac_event_rx(wmi
, datap
, len
, vif
);
3888 case WMI_PSPOLL_EVENTID
:
3889 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PSPOLL_EVENTID\n");
3890 return ath6kl_wmi_pspoll_event_rx(wmi
, datap
, len
, vif
);
3891 case WMI_DTIMEXPIRY_EVENTID
:
3892 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DTIMEXPIRY_EVENTID\n");
3893 return ath6kl_wmi_dtimexpiry_event_rx(wmi
, datap
, len
, vif
);
3894 case WMI_ADDBA_REQ_EVENTID
:
3895 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ADDBA_REQ_EVENTID\n");
3896 return ath6kl_wmi_addba_req_event_rx(wmi
, datap
, len
, vif
);
3897 case WMI_DELBA_REQ_EVENTID
:
3898 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_DELBA_REQ_EVENTID\n");
3899 return ath6kl_wmi_delba_req_event_rx(wmi
, datap
, len
, vif
);
3900 case WMI_SET_HOST_SLEEP_MODE_CMD_PROCESSED_EVENTID
:
3901 ath6kl_dbg(ATH6KL_DBG_WMI
,
3902 "WMI_SET_HOST_SLEEP_MODE_CMD_PROCESSED_EVENTID");
3903 return ath6kl_wmi_host_sleep_mode_cmd_prcd_evt_rx(wmi
, vif
);
3904 case WMI_REMAIN_ON_CHNL_EVENTID
:
3905 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REMAIN_ON_CHNL_EVENTID\n");
3906 return ath6kl_wmi_remain_on_chnl_event_rx(wmi
, datap
, len
, vif
);
3907 case WMI_CANCEL_REMAIN_ON_CHNL_EVENTID
:
3908 ath6kl_dbg(ATH6KL_DBG_WMI
,
3909 "WMI_CANCEL_REMAIN_ON_CHNL_EVENTID\n");
3910 return ath6kl_wmi_cancel_remain_on_chnl_event_rx(wmi
, datap
,
3912 case WMI_TX_STATUS_EVENTID
:
3913 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_STATUS_EVENTID\n");
3914 return ath6kl_wmi_tx_status_event_rx(wmi
, datap
, len
, vif
);
3915 case WMI_RX_PROBE_REQ_EVENTID
:
3916 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RX_PROBE_REQ_EVENTID\n");
3917 return ath6kl_wmi_rx_probe_req_event_rx(wmi
, datap
, len
, vif
);
3918 case WMI_RX_ACTION_EVENTID
:
3919 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RX_ACTION_EVENTID\n");
3920 return ath6kl_wmi_rx_action_event_rx(wmi
, datap
, len
, vif
);
3921 case WMI_TXE_NOTIFY_EVENTID
:
3922 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TXE_NOTIFY_EVENTID\n");
3923 return ath6kl_wmi_txe_notify_event_rx(wmi
, datap
, len
, vif
);
3925 ath6kl_dbg(ATH6KL_DBG_WMI
, "unknown cmd id 0x%x\n", cmd_id
);
3932 static int ath6kl_wmi_proc_events(struct wmi
*wmi
, struct sk_buff
*skb
)
3934 struct wmi_cmd_hdr
*cmd
;
3941 cmd
= (struct wmi_cmd_hdr
*) skb
->data
;
3942 id
= le16_to_cpu(cmd
->cmd_id
);
3943 if_idx
= le16_to_cpu(cmd
->info1
) & WMI_CMD_HDR_IF_ID_MASK
;
3945 skb_pull(skb
, sizeof(struct wmi_cmd_hdr
));
3949 ath6kl_dbg(ATH6KL_DBG_WMI
, "wmi rx id %d len %d\n", id
, len
);
3950 ath6kl_dbg_dump(ATH6KL_DBG_WMI_DUMP
, NULL
, "wmi rx ",
3954 case WMI_GET_BITRATE_CMDID
:
3955 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_BITRATE_CMDID\n");
3956 ret
= ath6kl_wmi_bitrate_reply_rx(wmi
, datap
, len
);
3958 case WMI_GET_CHANNEL_LIST_CMDID
:
3959 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_CHANNEL_LIST_CMDID\n");
3960 ret
= ath6kl_wmi_ch_list_reply_rx(wmi
, datap
, len
);
3962 case WMI_GET_TX_PWR_CMDID
:
3963 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_TX_PWR_CMDID\n");
3964 ret
= ath6kl_wmi_tx_pwr_reply_rx(wmi
, datap
, len
);
3966 case WMI_READY_EVENTID
:
3967 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_READY_EVENTID\n");
3968 ret
= ath6kl_wmi_ready_event_rx(wmi
, datap
, len
);
3970 case WMI_PEER_NODE_EVENTID
:
3971 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PEER_NODE_EVENTID\n");
3972 ret
= ath6kl_wmi_peer_node_event_rx(wmi
, datap
, len
);
3974 case WMI_REGDOMAIN_EVENTID
:
3975 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REGDOMAIN_EVENTID\n");
3976 ath6kl_wmi_regdomain_event(wmi
, datap
, len
);
3978 case WMI_PSTREAM_TIMEOUT_EVENTID
:
3979 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_PSTREAM_TIMEOUT_EVENTID\n");
3980 ret
= ath6kl_wmi_pstream_timeout_event_rx(wmi
, datap
, len
);
3982 case WMI_CMDERROR_EVENTID
:
3983 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CMDERROR_EVENTID\n");
3984 ret
= ath6kl_wmi_error_event_rx(wmi
, datap
, len
);
3986 case WMI_RSSI_THRESHOLD_EVENTID
:
3987 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_RSSI_THRESHOLD_EVENTID\n");
3988 ret
= ath6kl_wmi_rssi_threshold_event_rx(wmi
, datap
, len
);
3990 case WMI_ERROR_REPORT_EVENTID
:
3991 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ERROR_REPORT_EVENTID\n");
3993 case WMI_OPT_RX_FRAME_EVENTID
:
3994 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_OPT_RX_FRAME_EVENTID\n");
3995 /* this event has been deprecated */
3997 case WMI_REPORT_ROAM_TBL_EVENTID
:
3998 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_ROAM_TBL_EVENTID\n");
3999 ret
= ath6kl_wmi_roam_tbl_event_rx(wmi
, datap
, len
);
4001 case WMI_EXTENSION_EVENTID
:
4002 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_EXTENSION_EVENTID\n");
4003 ret
= ath6kl_wmi_control_rx_xtnd(wmi
, skb
);
4005 case WMI_CHANNEL_CHANGE_EVENTID
:
4006 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_CHANNEL_CHANGE_EVENTID\n");
4008 case WMI_REPORT_ROAM_DATA_EVENTID
:
4009 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_REPORT_ROAM_DATA_EVENTID\n");
4011 case WMI_TEST_EVENTID
:
4012 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TEST_EVENTID\n");
4013 ret
= ath6kl_wmi_test_rx(wmi
, datap
, len
);
4015 case WMI_GET_FIXRATES_CMDID
:
4016 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_FIXRATES_CMDID\n");
4017 ret
= ath6kl_wmi_ratemask_reply_rx(wmi
, datap
, len
);
4019 case WMI_TX_RETRY_ERR_EVENTID
:
4020 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_RETRY_ERR_EVENTID\n");
4022 case WMI_SNR_THRESHOLD_EVENTID
:
4023 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SNR_THRESHOLD_EVENTID\n");
4024 ret
= ath6kl_wmi_snr_threshold_event_rx(wmi
, datap
, len
);
4026 case WMI_LQ_THRESHOLD_EVENTID
:
4027 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_LQ_THRESHOLD_EVENTID\n");
4029 case WMI_APLIST_EVENTID
:
4030 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_APLIST_EVENTID\n");
4031 ret
= ath6kl_wmi_aplist_event_rx(wmi
, datap
, len
);
4033 case WMI_GET_KEEPALIVE_CMDID
:
4034 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_KEEPALIVE_CMDID\n");
4035 ret
= ath6kl_wmi_keepalive_reply_rx(wmi
, datap
, len
);
4037 case WMI_GET_WOW_LIST_EVENTID
:
4038 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_WOW_LIST_EVENTID\n");
4040 case WMI_GET_PMKID_LIST_EVENTID
:
4041 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_GET_PMKID_LIST_EVENTID\n");
4042 ret
= ath6kl_wmi_get_pmkid_list_event_rx(wmi
, datap
, len
);
4044 case WMI_SET_PARAMS_REPLY_EVENTID
:
4045 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_SET_PARAMS_REPLY_EVENTID\n");
4047 case WMI_ADDBA_RESP_EVENTID
:
4048 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_ADDBA_RESP_EVENTID\n");
4050 case WMI_REPORT_BTCOEX_CONFIG_EVENTID
:
4051 ath6kl_dbg(ATH6KL_DBG_WMI
,
4052 "WMI_REPORT_BTCOEX_CONFIG_EVENTID\n");
4054 case WMI_REPORT_BTCOEX_STATS_EVENTID
:
4055 ath6kl_dbg(ATH6KL_DBG_WMI
,
4056 "WMI_REPORT_BTCOEX_STATS_EVENTID\n");
4058 case WMI_TX_COMPLETE_EVENTID
:
4059 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_TX_COMPLETE_EVENTID\n");
4060 ret
= ath6kl_wmi_tx_complete_event_rx(datap
, len
);
4062 case WMI_P2P_CAPABILITIES_EVENTID
:
4063 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_P2P_CAPABILITIES_EVENTID\n");
4064 ret
= ath6kl_wmi_p2p_capabilities_event_rx(datap
, len
);
4066 case WMI_P2P_INFO_EVENTID
:
4067 ath6kl_dbg(ATH6KL_DBG_WMI
, "WMI_P2P_INFO_EVENTID\n");
4068 ret
= ath6kl_wmi_p2p_info_event_rx(datap
, len
);
4071 /* may be the event is interface specific */
4072 ret
= ath6kl_wmi_proc_events_vif(wmi
, if_idx
, id
, datap
, len
);
4081 int ath6kl_wmi_control_rx(struct wmi
*wmi
, struct sk_buff
*skb
)
4083 if (WARN_ON(skb
== NULL
))
4086 if (skb
->len
< sizeof(struct wmi_cmd_hdr
)) {
4087 ath6kl_err("bad packet 1\n");
4092 trace_ath6kl_wmi_event(skb
->data
, skb
->len
);
4094 return ath6kl_wmi_proc_events(wmi
, skb
);
4097 void ath6kl_wmi_reset(struct wmi
*wmi
)
4099 spin_lock_bh(&wmi
->lock
);
4101 wmi
->fat_pipe_exist
= 0;
4102 memset(wmi
->stream_exist_for_ac
, 0, sizeof(wmi
->stream_exist_for_ac
));
4104 spin_unlock_bh(&wmi
->lock
);
4107 void *ath6kl_wmi_init(struct ath6kl
*dev
)
4111 wmi
= kzalloc(sizeof(struct wmi
), GFP_KERNEL
);
4115 spin_lock_init(&wmi
->lock
);
4117 wmi
->parent_dev
= dev
;
4119 wmi
->pwr_mode
= REC_POWER
;
4121 ath6kl_wmi_reset(wmi
);
4126 void ath6kl_wmi_shutdown(struct wmi
*wmi
)
4131 kfree(wmi
->last_mgmt_tx_frame
);