2 * Copyright (c) 2010 Broadcom Corporation
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
14 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19 #include <linux/kernel.h>
20 #include <linux/string.h>
21 #include <linux/sched.h>
22 #include <linux/netdevice.h>
23 #include <asm/unaligned.h>
25 #include <brcmu_wifi.h>
26 #include <brcmu_utils.h>
29 #include "dhd_proto.h"
32 #define BRCM_OUI "\x00\x10\x18"
33 #define DOT11_OUI_LEN 3
34 #define BCMILCP_BCM_SUBTYPE_EVENT 1
35 #define PKTFILTER_BUF_SIZE 2048
36 #define BRCMF_ARPOL_MODE 0xb /* agent|snoop|peer_autoreply */
38 #define MSGTRACE_VERSION 1
40 #define BRCMF_PKT_FILTER_FIXED_LEN offsetof(struct brcmf_pkt_filter_le, u)
41 #define BRCMF_PKT_FILTER_PATTERN_FIXED_LEN \
42 offsetof(struct brcmf_pkt_filter_pattern_le, mask_and_pattern)
45 static const char brcmf_version
[] =
46 "Dongle Host Driver, version " BRCMF_VERSION_STR
"\nCompiled on "
47 __DATE__
" at " __TIME__
;
49 static const char brcmf_version
[] =
50 "Dongle Host Driver, version " BRCMF_VERSION_STR
;
53 /* Message trace header */
57 __be16 len
; /* Len of the trace */
58 __be32 seqnum
; /* Sequence number of message. Useful
59 * if the messsage has been lost
60 * because of DMA error or a bus reset
63 __be32 discarded_bytes
; /* Number of discarded bytes because of
65 __be32 discarded_printf
; /* Number of discarded printf
66 because of trace overflow */
71 brcmf_c_mkiovar(char *name
, char *data
, uint datalen
, char *buf
, uint buflen
)
75 len
= strlen(name
) + 1;
77 if ((len
+ datalen
) > buflen
)
80 strncpy(buf
, name
, buflen
);
82 /* append data onto the end of the name string */
83 if (data
&& datalen
) {
84 memcpy(&buf
[len
], data
, datalen
);
91 bool brcmf_c_prec_enq(struct device
*dev
, struct pktq
*q
,
92 struct sk_buff
*pkt
, int prec
)
95 int eprec
= -1; /* precedence to evict from */
97 struct brcmf_bus
*bus_if
= dev_get_drvdata(dev
);
98 struct brcmf_pub
*drvr
= bus_if
->drvr
;
100 /* Fast case, precedence queue is not full and we are also not
101 * exceeding total queue length
103 if (!pktq_pfull(q
, prec
) && !pktq_full(q
)) {
104 brcmu_pktq_penq(q
, prec
, pkt
);
108 /* Determine precedence from which to evict packet, if any */
109 if (pktq_pfull(q
, prec
))
111 else if (pktq_full(q
)) {
112 p
= brcmu_pktq_peek_tail(q
, &eprec
);
117 /* Evict if needed */
119 /* Detect queueing to unconfigured precedence */
120 discard_oldest
= ac_bitmap_tst(drvr
->wme_dp
, eprec
);
121 if (eprec
== prec
&& !discard_oldest
)
122 return false; /* refuse newer (incoming) packet */
123 /* Evict packet according to discard policy */
124 p
= discard_oldest
? brcmu_pktq_pdeq(q
, eprec
) :
125 brcmu_pktq_pdeq_tail(q
, eprec
);
127 brcmf_dbg(ERROR
, "brcmu_pktq_penq() failed, oldest %d\n",
130 brcmu_pkt_buf_free_skb(p
);
134 p
= brcmu_pktq_penq(q
, prec
, pkt
);
136 brcmf_dbg(ERROR
, "brcmu_pktq_penq() failed\n");
143 brcmf_c_show_host_event(struct brcmf_event_msg
*event
, void *event_data
)
145 uint i
, status
, reason
;
146 bool group
= false, flush_txq
= false, link
= false;
147 char *auth_str
, *event_name
;
149 char err_msg
[256], eabuf
[ETHER_ADDR_STR_LEN
];
155 BRCMF_E_SET_SSID
, "SET_SSID"}, {
156 BRCMF_E_JOIN
, "JOIN"}, {
157 BRCMF_E_START
, "START"}, {
158 BRCMF_E_AUTH
, "AUTH"}, {
159 BRCMF_E_AUTH_IND
, "AUTH_IND"}, {
160 BRCMF_E_DEAUTH
, "DEAUTH"}, {
161 BRCMF_E_DEAUTH_IND
, "DEAUTH_IND"}, {
162 BRCMF_E_ASSOC
, "ASSOC"}, {
163 BRCMF_E_ASSOC_IND
, "ASSOC_IND"}, {
164 BRCMF_E_REASSOC
, "REASSOC"}, {
165 BRCMF_E_REASSOC_IND
, "REASSOC_IND"}, {
166 BRCMF_E_DISASSOC
, "DISASSOC"}, {
167 BRCMF_E_DISASSOC_IND
, "DISASSOC_IND"}, {
168 BRCMF_E_QUIET_START
, "START_QUIET"}, {
169 BRCMF_E_QUIET_END
, "END_QUIET"}, {
170 BRCMF_E_BEACON_RX
, "BEACON_RX"}, {
171 BRCMF_E_LINK
, "LINK"}, {
172 BRCMF_E_MIC_ERROR
, "MIC_ERROR"}, {
173 BRCMF_E_NDIS_LINK
, "NDIS_LINK"}, {
174 BRCMF_E_ROAM
, "ROAM"}, {
175 BRCMF_E_TXFAIL
, "TXFAIL"}, {
176 BRCMF_E_PMKID_CACHE
, "PMKID_CACHE"}, {
177 BRCMF_E_RETROGRADE_TSF
, "RETROGRADE_TSF"}, {
178 BRCMF_E_PRUNE
, "PRUNE"}, {
179 BRCMF_E_AUTOAUTH
, "AUTOAUTH"}, {
180 BRCMF_E_EAPOL_MSG
, "EAPOL_MSG"}, {
181 BRCMF_E_SCAN_COMPLETE
, "SCAN_COMPLETE"}, {
182 BRCMF_E_ADDTS_IND
, "ADDTS_IND"}, {
183 BRCMF_E_DELTS_IND
, "DELTS_IND"}, {
184 BRCMF_E_BCNSENT_IND
, "BCNSENT_IND"}, {
185 BRCMF_E_BCNRX_MSG
, "BCNRX_MSG"}, {
186 BRCMF_E_BCNLOST_MSG
, "BCNLOST_MSG"}, {
187 BRCMF_E_ROAM_PREP
, "ROAM_PREP"}, {
188 BRCMF_E_PFN_NET_FOUND
, "PNO_NET_FOUND"}, {
189 BRCMF_E_PFN_NET_LOST
, "PNO_NET_LOST"}, {
190 BRCMF_E_RESET_COMPLETE
, "RESET_COMPLETE"}, {
191 BRCMF_E_JOIN_START
, "JOIN_START"}, {
192 BRCMF_E_ROAM_START
, "ROAM_START"}, {
193 BRCMF_E_ASSOC_START
, "ASSOC_START"}, {
194 BRCMF_E_IBSS_ASSOC
, "IBSS_ASSOC"}, {
195 BRCMF_E_RADIO
, "RADIO"}, {
196 BRCMF_E_PSM_WATCHDOG
, "PSM_WATCHDOG"}, {
197 BRCMF_E_PROBREQ_MSG
, "PROBREQ_MSG"}, {
198 BRCMF_E_SCAN_CONFIRM_IND
, "SCAN_CONFIRM_IND"}, {
199 BRCMF_E_PSK_SUP
, "PSK_SUP"}, {
200 BRCMF_E_COUNTRY_CODE_CHANGED
, "COUNTRY_CODE_CHANGED"}, {
201 BRCMF_E_EXCEEDED_MEDIUM_TIME
, "EXCEEDED_MEDIUM_TIME"}, {
202 BRCMF_E_ICV_ERROR
, "ICV_ERROR"}, {
203 BRCMF_E_UNICAST_DECODE_ERROR
, "UNICAST_DECODE_ERROR"}, {
204 BRCMF_E_MULTICAST_DECODE_ERROR
, "MULTICAST_DECODE_ERROR"}, {
205 BRCMF_E_TRACE
, "TRACE"}, {
206 BRCMF_E_ACTION_FRAME
, "ACTION FRAME"}, {
207 BRCMF_E_ACTION_FRAME_COMPLETE
, "ACTION FRAME TX COMPLETE"}, {
209 BRCMF_E_RSSI
, "RSSI"}, {
210 BRCMF_E_PFN_SCAN_COMPLETE
, "SCAN_COMPLETE"}, {
211 BRCMF_E_ESCAN_RESULT
, "ESCAN_RESULT"}
213 uint event_type
, flags
, auth_type
, datalen
;
214 static u32 seqnum_prev
;
215 struct msgtrace_hdr hdr
;
219 event_type
= be32_to_cpu(event
->event_type
);
220 flags
= be16_to_cpu(event
->flags
);
221 status
= be32_to_cpu(event
->status
);
222 reason
= be32_to_cpu(event
->reason
);
223 auth_type
= be32_to_cpu(event
->auth_type
);
224 datalen
= be32_to_cpu(event
->datalen
);
225 /* debug dump of event messages */
226 sprintf(eabuf
, "%pM", event
->addr
);
228 event_name
= "UNKNOWN";
229 for (i
= 0; i
< ARRAY_SIZE(event_names
); i
++) {
230 if (event_names
[i
].event
== event_type
)
231 event_name
= event_names
[i
].event_name
;
234 brcmf_dbg(EVENT
, "EVENT: %s, event ID = %d\n", event_name
, event_type
);
235 brcmf_dbg(EVENT
, "flags 0x%04x, status %d, reason %d, auth_type %d MAC %s\n",
236 flags
, status
, reason
, auth_type
, eabuf
);
238 if (flags
& BRCMF_EVENT_MSG_LINK
)
240 if (flags
& BRCMF_EVENT_MSG_GROUP
)
242 if (flags
& BRCMF_EVENT_MSG_FLUSHTXQ
)
245 switch (event_type
) {
248 case BRCMF_E_DISASSOC
:
249 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s\n", event_name
, eabuf
);
252 case BRCMF_E_ASSOC_IND
:
253 case BRCMF_E_REASSOC_IND
:
254 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s\n", event_name
, eabuf
);
258 case BRCMF_E_REASSOC
:
259 if (status
== BRCMF_E_STATUS_SUCCESS
)
260 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, SUCCESS\n",
262 else if (status
== BRCMF_E_STATUS_TIMEOUT
)
263 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, TIMEOUT\n",
265 else if (status
== BRCMF_E_STATUS_FAIL
)
266 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, FAILURE, reason %d\n",
267 event_name
, eabuf
, (int)reason
);
269 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, unexpected status %d\n",
270 event_name
, eabuf
, (int)status
);
273 case BRCMF_E_DEAUTH_IND
:
274 case BRCMF_E_DISASSOC_IND
:
275 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, reason %d\n",
276 event_name
, eabuf
, (int)reason
);
280 case BRCMF_E_AUTH_IND
:
281 if (auth_type
== WLAN_AUTH_OPEN
)
282 auth_str
= "Open System";
283 else if (auth_type
== WLAN_AUTH_SHARED_KEY
)
284 auth_str
= "Shared Key";
286 sprintf(err_msg
, "AUTH unknown: %d", (int)auth_type
);
289 if (event_type
== BRCMF_E_AUTH_IND
)
290 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, %s\n",
291 event_name
, eabuf
, auth_str
);
292 else if (status
== BRCMF_E_STATUS_SUCCESS
)
293 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, %s, SUCCESS\n",
294 event_name
, eabuf
, auth_str
);
295 else if (status
== BRCMF_E_STATUS_TIMEOUT
)
296 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, %s, TIMEOUT\n",
297 event_name
, eabuf
, auth_str
);
298 else if (status
== BRCMF_E_STATUS_FAIL
) {
299 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, %s, FAILURE, reason %d\n",
300 event_name
, eabuf
, auth_str
, (int)reason
);
307 case BRCMF_E_SET_SSID
:
308 if (status
== BRCMF_E_STATUS_SUCCESS
)
309 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s\n",
311 else if (status
== BRCMF_E_STATUS_FAIL
)
312 brcmf_dbg(EVENT
, "MACEVENT: %s, failed\n", event_name
);
313 else if (status
== BRCMF_E_STATUS_NO_NETWORKS
)
314 brcmf_dbg(EVENT
, "MACEVENT: %s, no networks found\n",
317 brcmf_dbg(EVENT
, "MACEVENT: %s, unexpected status %d\n",
318 event_name
, (int)status
);
321 case BRCMF_E_BEACON_RX
:
322 if (status
== BRCMF_E_STATUS_SUCCESS
)
323 brcmf_dbg(EVENT
, "MACEVENT: %s, SUCCESS\n", event_name
);
324 else if (status
== BRCMF_E_STATUS_FAIL
)
325 brcmf_dbg(EVENT
, "MACEVENT: %s, FAIL\n", event_name
);
327 brcmf_dbg(EVENT
, "MACEVENT: %s, status %d\n",
332 brcmf_dbg(EVENT
, "MACEVENT: %s %s\n",
333 event_name
, link
? "UP" : "DOWN");
336 case BRCMF_E_MIC_ERROR
:
337 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s, Group %d, Flush %d\n",
338 event_name
, eabuf
, group
, flush_txq
);
341 case BRCMF_E_ICV_ERROR
:
342 case BRCMF_E_UNICAST_DECODE_ERROR
:
343 case BRCMF_E_MULTICAST_DECODE_ERROR
:
344 brcmf_dbg(EVENT
, "MACEVENT: %s, MAC %s\n", event_name
, eabuf
);
348 brcmf_dbg(EVENT
, "MACEVENT: %s, RA %s\n", event_name
, eabuf
);
351 case BRCMF_E_SCAN_COMPLETE
:
352 case BRCMF_E_PMKID_CACHE
:
353 brcmf_dbg(EVENT
, "MACEVENT: %s\n", event_name
);
356 case BRCMF_E_ESCAN_RESULT
:
357 brcmf_dbg(EVENT
, "MACEVENT: %s\n", event_name
);
361 case BRCMF_E_PFN_NET_FOUND
:
362 case BRCMF_E_PFN_NET_LOST
:
363 case BRCMF_E_PFN_SCAN_COMPLETE
:
364 brcmf_dbg(EVENT
, "PNOEVENT: %s\n", event_name
);
367 case BRCMF_E_PSK_SUP
:
369 brcmf_dbg(EVENT
, "MACEVENT: %s, status %d, reason %d\n",
370 event_name
, (int)status
, (int)reason
);
374 buf
= (unsigned char *) event_data
;
375 memcpy(&hdr
, buf
, sizeof(struct msgtrace_hdr
));
377 if (hdr
.version
!= MSGTRACE_VERSION
) {
379 "MACEVENT: %s [unsupported version --> brcmf"
380 " version:%d dongle version:%d]\n",
381 event_name
, MSGTRACE_VERSION
, hdr
.version
);
382 /* Reset datalen to avoid display below */
387 /* There are 2 bytes available at the end of data */
388 *(buf
+ sizeof(struct msgtrace_hdr
)
389 + be16_to_cpu(hdr
.len
)) = '\0';
391 if (be32_to_cpu(hdr
.discarded_bytes
)
392 || be32_to_cpu(hdr
.discarded_printf
))
394 "WLC_E_TRACE: [Discarded traces in dongle -->"
395 " discarded_bytes %d discarded_printf %d]\n",
396 be32_to_cpu(hdr
.discarded_bytes
),
397 be32_to_cpu(hdr
.discarded_printf
));
399 nblost
= be32_to_cpu(hdr
.seqnum
) - seqnum_prev
- 1;
401 brcmf_dbg(ERROR
, "WLC_E_TRACE: [Event lost --> seqnum "
402 " %d nblost %d\n", be32_to_cpu(hdr
.seqnum
),
404 seqnum_prev
= be32_to_cpu(hdr
.seqnum
);
406 /* Display the trace buffer. Advance from \n to \n to
408 * printf (issue with Linux printk )
410 p
= (char *)&buf
[sizeof(struct msgtrace_hdr
)];
411 while ((s
= strstr(p
, "\n")) != NULL
) {
418 /* Reset datalen to avoid display below */
423 brcmf_dbg(EVENT
, "MACEVENT: %s %d\n",
424 event_name
, be32_to_cpu(*((__be32
*)event_data
)));
429 "MACEVENT: %s %d, MAC %s, status %d, reason %d, "
430 "auth %d\n", event_name
, event_type
, eabuf
,
431 (int)status
, (int)reason
, (int)auth_type
);
435 /* show any appended data */
436 brcmf_dbg_hex_dump(datalen
, event_data
, datalen
, "Received data");
441 brcmf_c_host_event(struct brcmf_pub
*drvr
, int *ifidx
, void *pktdata
,
442 struct brcmf_event_msg
*event
, void **data_ptr
)
444 /* check whether packet is a BRCM event pkt */
445 struct brcmf_event
*pvt_data
= (struct brcmf_event
*) pktdata
;
446 struct brcmf_if_event
*ifevent
;
452 if (memcmp(BRCM_OUI
, &pvt_data
->hdr
.oui
[0], DOT11_OUI_LEN
)) {
453 brcmf_dbg(ERROR
, "mismatched OUI, bailing\n");
457 /* BRCM event pkt may be unaligned - use xxx_ua to load user_subtype. */
458 if (get_unaligned_be16(&pvt_data
->hdr
.usr_subtype
) !=
459 BCMILCP_BCM_SUBTYPE_EVENT
) {
460 brcmf_dbg(ERROR
, "mismatched subtype, bailing\n");
464 *data_ptr
= &pvt_data
[1];
465 event_data
= *data_ptr
;
467 /* memcpy since BRCM event pkt may be unaligned. */
468 memcpy(event
, &pvt_data
->msg
, sizeof(struct brcmf_event_msg
));
470 type
= get_unaligned_be32(&event
->event_type
);
471 flags
= get_unaligned_be16(&event
->flags
);
472 status
= get_unaligned_be32(&event
->status
);
473 evlen
= get_unaligned_be32(&event
->datalen
) +
474 sizeof(struct brcmf_event
);
478 ifevent
= (struct brcmf_if_event
*) event_data
;
479 brcmf_dbg(TRACE
, "if event\n");
481 if (ifevent
->ifidx
> 0 && ifevent
->ifidx
< BRCMF_MAX_IFS
) {
482 if (ifevent
->action
== BRCMF_E_IF_ADD
)
483 brcmf_add_if(drvr
->dev
, ifevent
->ifidx
,
485 pvt_data
->eth
.h_dest
);
487 brcmf_del_if(drvr
, ifevent
->ifidx
);
489 brcmf_dbg(ERROR
, "Invalid ifidx %d for %s\n",
490 ifevent
->ifidx
, event
->ifname
);
493 /* send up the if event: btamp user needs it */
494 *ifidx
= brcmf_ifname2idx(drvr
, event
->ifname
);
497 /* These are what external supplicant/authenticator wants */
499 case BRCMF_E_ASSOC_IND
:
500 case BRCMF_E_REASSOC_IND
:
501 case BRCMF_E_DISASSOC_IND
:
502 case BRCMF_E_MIC_ERROR
:
504 /* Fall through: this should get _everything_ */
506 *ifidx
= brcmf_ifname2idx(drvr
, event
->ifname
);
507 brcmf_dbg(TRACE
, "MAC event %d, flags %x, status %x\n",
508 type
, flags
, status
);
510 /* put it back to BRCMF_E_NDIS_LINK */
511 if (type
== BRCMF_E_NDIS_LINK
) {
515 temp1
= get_unaligned_be32(&event
->event_type
);
516 brcmf_dbg(TRACE
, "Converted to WLC_E_LINK type %d\n",
519 temp2
= cpu_to_be32(BRCMF_E_NDIS_LINK
);
520 memcpy((void *)(&pvt_data
->msg
.event_type
), &temp2
,
521 sizeof(pvt_data
->msg
.event_type
));
527 if (BRCMF_EVENT_ON())
528 brcmf_c_show_host_event(event
, event_data
);
534 /* Convert user's input in hex pattern to byte-size mask */
535 static int brcmf_c_pattern_atoh(char *src
, char *dst
)
538 if (strncmp(src
, "0x", 2) != 0 && strncmp(src
, "0X", 2) != 0) {
539 brcmf_dbg(ERROR
, "Mask invalid format. Needs to start with 0x\n");
542 src
= src
+ 2; /* Skip past 0x */
543 if (strlen(src
) % 2 != 0) {
544 brcmf_dbg(ERROR
, "Mask invalid format. Length must be even.\n");
547 for (i
= 0; *src
!= '\0'; i
++) {
550 strncpy(num
, src
, 2);
552 if (kstrtoul(num
, 16, &res
))
561 brcmf_c_pktfilter_offload_enable(struct brcmf_pub
*drvr
, char *arg
, int enable
,
570 char *arg_save
= NULL
, *arg_org
= NULL
;
573 struct brcmf_pkt_filter_enable_le enable_parm
;
574 struct brcmf_pkt_filter_enable_le
*pkt_filterp
;
577 arg_save
= kmalloc(strlen(arg
) + 1, GFP_ATOMIC
);
582 memcpy(arg_save
, arg
, strlen(arg
) + 1);
584 argv
[i
] = strsep(&arg_save
, " ");
587 if (NULL
== argv
[i
]) {
588 brcmf_dbg(ERROR
, "No args provided\n");
592 str
= "pkt_filter_enable";
593 str_len
= strlen(str
);
594 strncpy(buf
, str
, str_len
);
596 buf_len
= str_len
+ 1;
598 pkt_filterp
= (struct brcmf_pkt_filter_enable_le
*) (buf
+ str_len
+ 1);
600 /* Parse packet filter id. */
602 if (!kstrtoul(argv
[i
], 0, &res
))
603 enable_parm
.id
= cpu_to_le32((u32
)res
);
605 /* Parse enable/disable value. */
606 enable_parm
.enable
= cpu_to_le32(enable
);
608 buf_len
+= sizeof(enable_parm
);
609 memcpy((char *)pkt_filterp
, &enable_parm
, sizeof(enable_parm
));
611 /* Enable/disable the specified filter. */
612 rc
= brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
, buf
, buf_len
);
613 rc
= rc
>= 0 ? 0 : rc
;
615 brcmf_dbg(TRACE
, "failed to add pktfilter %s, retcode = %d\n",
618 brcmf_dbg(TRACE
, "successfully added pktfilter %s\n", arg
);
620 /* Contorl the master mode */
621 mmode_le
= cpu_to_le32(master_mode
);
622 brcmf_c_mkiovar("pkt_filter_mode", (char *)&mmode_le
, 4, buf
,
624 rc
= brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
, buf
,
626 rc
= rc
>= 0 ? 0 : rc
;
628 brcmf_dbg(TRACE
, "failed to add pktfilter %s, retcode = %d\n",
635 void brcmf_c_pktfilter_offload_set(struct brcmf_pub
*drvr
, char *arg
)
638 struct brcmf_pkt_filter_le pkt_filter
;
639 struct brcmf_pkt_filter_le
*pkt_filterp
;
646 char *argv
[8], *buf
= NULL
;
648 char *arg_save
= NULL
, *arg_org
= NULL
;
650 arg_save
= kstrdup(arg
, GFP_ATOMIC
);
656 buf
= kmalloc(PKTFILTER_BUF_SIZE
, GFP_ATOMIC
);
660 argv
[i
] = strsep(&arg_save
, " ");
662 argv
[i
] = strsep(&arg_save
, " ");
665 if (NULL
== argv
[i
]) {
666 brcmf_dbg(ERROR
, "No args provided\n");
670 str
= "pkt_filter_add";
672 str_len
= strlen(str
);
673 buf_len
= str_len
+ 1;
675 pkt_filterp
= (struct brcmf_pkt_filter_le
*) (buf
+ str_len
+ 1);
677 /* Parse packet filter id. */
679 if (!kstrtoul(argv
[i
], 0, &res
))
680 pkt_filter
.id
= cpu_to_le32((u32
)res
);
682 if (NULL
== argv
[++i
]) {
683 brcmf_dbg(ERROR
, "Polarity not provided\n");
687 /* Parse filter polarity. */
688 pkt_filter
.negate_match
= 0;
689 if (!kstrtoul(argv
[i
], 0, &res
))
690 pkt_filter
.negate_match
= cpu_to_le32((u32
)res
);
692 if (NULL
== argv
[++i
]) {
693 brcmf_dbg(ERROR
, "Filter type not provided\n");
697 /* Parse filter type. */
699 if (!kstrtoul(argv
[i
], 0, &res
))
700 pkt_filter
.type
= cpu_to_le32((u32
)res
);
702 if (NULL
== argv
[++i
]) {
703 brcmf_dbg(ERROR
, "Offset not provided\n");
707 /* Parse pattern filter offset. */
708 pkt_filter
.u
.pattern
.offset
= 0;
709 if (!kstrtoul(argv
[i
], 0, &res
))
710 pkt_filter
.u
.pattern
.offset
= cpu_to_le32((u32
)res
);
712 if (NULL
== argv
[++i
]) {
713 brcmf_dbg(ERROR
, "Bitmask not provided\n");
717 /* Parse pattern filter mask. */
720 (argv
[i
], (char *)pkt_filterp
->u
.pattern
.mask_and_pattern
);
722 if (NULL
== argv
[++i
]) {
723 brcmf_dbg(ERROR
, "Pattern not provided\n");
727 /* Parse pattern filter pattern. */
729 brcmf_c_pattern_atoh(argv
[i
],
730 (char *)&pkt_filterp
->u
.pattern
.
731 mask_and_pattern
[mask_size
]);
733 if (mask_size
!= pattern_size
) {
734 brcmf_dbg(ERROR
, "Mask and pattern not the same size\n");
738 pkt_filter
.u
.pattern
.size_bytes
= cpu_to_le32(mask_size
);
739 buf_len
+= BRCMF_PKT_FILTER_FIXED_LEN
;
740 buf_len
+= (BRCMF_PKT_FILTER_PATTERN_FIXED_LEN
+ 2 * mask_size
);
742 /* Keep-alive attributes are set in local
743 * variable (keep_alive_pkt), and
744 ** then memcpy'ed into buffer (keep_alive_pktp) since there is no
745 ** guarantee that the buffer is properly aligned.
747 memcpy((char *)pkt_filterp
,
749 BRCMF_PKT_FILTER_FIXED_LEN
+ BRCMF_PKT_FILTER_PATTERN_FIXED_LEN
);
751 rc
= brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
, buf
, buf_len
);
752 rc
= rc
>= 0 ? 0 : rc
;
755 brcmf_dbg(TRACE
, "failed to add pktfilter %s, retcode = %d\n",
758 brcmf_dbg(TRACE
, "successfully added pktfilter %s\n", arg
);
766 static void brcmf_c_arp_offload_set(struct brcmf_pub
*drvr
, int arp_mode
)
771 brcmf_c_mkiovar("arp_ol", (char *)&arp_mode
, 4, iovbuf
, sizeof(iovbuf
));
772 retcode
= brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
,
773 iovbuf
, sizeof(iovbuf
));
774 retcode
= retcode
>= 0 ? 0 : retcode
;
776 brcmf_dbg(TRACE
, "failed to set ARP offload mode to 0x%x, retcode = %d\n",
779 brcmf_dbg(TRACE
, "successfully set ARP offload mode to 0x%x\n",
783 static void brcmf_c_arp_offload_enable(struct brcmf_pub
*drvr
, int arp_enable
)
788 brcmf_c_mkiovar("arpoe", (char *)&arp_enable
, 4,
789 iovbuf
, sizeof(iovbuf
));
790 retcode
= brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
,
791 iovbuf
, sizeof(iovbuf
));
792 retcode
= retcode
>= 0 ? 0 : retcode
;
794 brcmf_dbg(TRACE
, "failed to enable ARP offload to %d, retcode = %d\n",
795 arp_enable
, retcode
);
797 brcmf_dbg(TRACE
, "successfully enabled ARP offload to %d\n",
801 int brcmf_c_preinit_dcmds(struct brcmf_pub
*drvr
)
803 char iovbuf
[BRCMF_EVENTING_MASK_LEN
+ 12]; /* Room for
804 "event_msgs" + '\0' + bitvec */
807 uint bcn_timeout
= 3;
808 int scan_assoc_time
= 40;
809 int scan_unassoc_time
= 40;
811 struct brcmf_bus_dcmd
*cmdlst
;
812 struct list_head
*cur
, *q
;
814 mutex_lock(&drvr
->proto_block
);
816 /* Set Country code */
817 if (drvr
->country_code
[0] != 0) {
818 if (brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_COUNTRY
,
820 sizeof(drvr
->country_code
)) < 0)
821 brcmf_dbg(ERROR
, "country code setting failed\n");
824 /* query for 'ver' to get version info from firmware */
825 memset(buf
, 0, sizeof(buf
));
827 brcmf_c_mkiovar("ver", NULL
, 0, buf
, sizeof(buf
));
828 brcmf_proto_cdc_query_dcmd(drvr
, 0, BRCMF_C_GET_VAR
, buf
, sizeof(buf
));
830 /* Print fw version info */
831 brcmf_dbg(ERROR
, "Firmware version = %s\n", buf
);
833 /* Setup timeout if Beacons are lost and roam is off to report
835 brcmf_c_mkiovar("bcn_timeout", (char *)&bcn_timeout
, 4, iovbuf
,
837 brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
, iovbuf
,
840 /* Enable/Disable build-in roaming to allowed ext supplicant to take
842 brcmf_c_mkiovar("roam_off", (char *)&roaming
, 4,
843 iovbuf
, sizeof(iovbuf
));
844 brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
, iovbuf
,
847 /* Setup event_msgs */
848 brcmf_c_mkiovar("event_msgs", drvr
->eventmask
, BRCMF_EVENTING_MASK_LEN
,
849 iovbuf
, sizeof(iovbuf
));
850 brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
, iovbuf
,
853 brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_SCAN_CHANNEL_TIME
,
854 (char *)&scan_assoc_time
, sizeof(scan_assoc_time
));
855 brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_SCAN_UNASSOC_TIME
,
856 (char *)&scan_unassoc_time
, sizeof(scan_unassoc_time
));
858 /* Set and enable ARP offload feature */
859 brcmf_c_arp_offload_set(drvr
, BRCMF_ARPOL_MODE
);
860 brcmf_c_arp_offload_enable(drvr
, true);
862 /* Set up pkt filter */
863 for (i
= 0; i
< drvr
->pktfilter_count
; i
++) {
864 brcmf_c_pktfilter_offload_set(drvr
, drvr
->pktfilter
[i
]);
865 brcmf_c_pktfilter_offload_enable(drvr
, drvr
->pktfilter
[i
],
869 /* set bus specific command if there is any */
870 list_for_each_safe(cur
, q
, &drvr
->bus_if
->dcmd_list
) {
871 cmdlst
= list_entry(cur
, struct brcmf_bus_dcmd
, list
);
872 if (cmdlst
->name
&& cmdlst
->param
&& cmdlst
->param_len
) {
873 brcmf_c_mkiovar(cmdlst
->name
, cmdlst
->param
,
874 cmdlst
->param_len
, iovbuf
,
876 brcmf_proto_cdc_set_dcmd(drvr
, 0, BRCMF_C_SET_VAR
,
877 iovbuf
, sizeof(iovbuf
));
883 mutex_unlock(&drvr
->proto_block
);