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 #include <linux/kernel.h>
18 #include <linux/string.h>
19 #include <linux/netdevice.h>
20 #include <brcmu_wifi.h>
21 #include <brcmu_utils.h>
26 #include "tracepoint.h"
28 #define PKTFILTER_BUF_SIZE 128
29 #define BRCMF_DEFAULT_BCN_TIMEOUT 3
30 #define BRCMF_DEFAULT_SCAN_CHANNEL_TIME 40
31 #define BRCMF_DEFAULT_SCAN_UNASSOC_TIME 40
32 #define BRCMF_DEFAULT_PACKET_FILTER "100 0 0 0 0x01 0x00"
35 static const char brcmf_version
[] =
36 "Dongle Host Driver, version " BRCMF_VERSION_STR
"\nCompiled on "
37 __DATE__
" at " __TIME__
;
39 static const char brcmf_version
[] =
40 "Dongle Host Driver, version " BRCMF_VERSION_STR
;
44 bool brcmf_c_prec_enq(struct device
*dev
, struct pktq
*q
,
45 struct sk_buff
*pkt
, int prec
)
48 int eprec
= -1; /* precedence to evict from */
50 struct brcmf_bus
*bus_if
= dev_get_drvdata(dev
);
51 struct brcmf_pub
*drvr
= bus_if
->drvr
;
53 /* Fast case, precedence queue is not full and we are also not
54 * exceeding total queue length
56 if (!pktq_pfull(q
, prec
) && !pktq_full(q
)) {
57 brcmu_pktq_penq(q
, prec
, pkt
);
61 /* Determine precedence from which to evict packet, if any */
62 if (pktq_pfull(q
, prec
))
64 else if (pktq_full(q
)) {
65 p
= brcmu_pktq_peek_tail(q
, &eprec
);
72 /* Detect queueing to unconfigured precedence */
73 discard_oldest
= ac_bitmap_tst(drvr
->wme_dp
, eprec
);
74 if (eprec
== prec
&& !discard_oldest
)
75 return false; /* refuse newer (incoming) packet */
76 /* Evict packet according to discard policy */
77 p
= discard_oldest
? brcmu_pktq_pdeq(q
, eprec
) :
78 brcmu_pktq_pdeq_tail(q
, eprec
);
80 brcmf_err("brcmu_pktq_penq() failed, oldest %d\n",
83 brcmu_pkt_buf_free_skb(p
);
87 p
= brcmu_pktq_penq(q
, prec
, pkt
);
89 brcmf_err("brcmu_pktq_penq() failed\n");
94 /* Convert user's input in hex pattern to byte-size mask */
95 static int brcmf_c_pattern_atoh(char *src
, char *dst
)
98 if (strncmp(src
, "0x", 2) != 0 && strncmp(src
, "0X", 2) != 0) {
99 brcmf_err("Mask invalid format. Needs to start with 0x\n");
102 src
= src
+ 2; /* Skip past 0x */
103 if (strlen(src
) % 2 != 0) {
104 brcmf_err("Mask invalid format. Length must be even.\n");
107 for (i
= 0; *src
!= '\0'; i
++) {
110 strncpy(num
, src
, 2);
112 if (kstrtoul(num
, 16, &res
))
121 brcmf_c_pktfilter_offload_enable(struct brcmf_if
*ifp
, char *arg
, int enable
,
126 char *arg_save
= NULL
, *arg_org
= NULL
;
128 struct brcmf_pkt_filter_enable_le enable_parm
;
130 arg_save
= kstrdup(arg
, GFP_ATOMIC
);
136 argv
= strsep(&arg_save
, " ");
139 brcmf_err("No args provided\n");
143 /* Parse packet filter id. */
145 if (!kstrtoul(argv
, 0, &res
))
146 enable_parm
.id
= cpu_to_le32((u32
)res
);
148 /* Enable/disable the specified filter. */
149 enable_parm
.enable
= cpu_to_le32(enable
);
151 err
= brcmf_fil_iovar_data_set(ifp
, "pkt_filter_enable", &enable_parm
,
152 sizeof(enable_parm
));
154 brcmf_err("Set pkt_filter_enable error (%d)\n", err
);
156 /* Control the master mode */
157 err
= brcmf_fil_iovar_int_set(ifp
, "pkt_filter_mode", master_mode
);
159 brcmf_err("Set pkt_filter_mode error (%d)\n", err
);
165 static void brcmf_c_pktfilter_offload_set(struct brcmf_if
*ifp
, char *arg
)
167 struct brcmf_pkt_filter_le
*pkt_filter
;
173 char *argv
[8], *buf
= NULL
;
175 char *arg_save
= NULL
, *arg_org
= NULL
;
177 arg_save
= kstrdup(arg
, GFP_ATOMIC
);
183 buf
= kmalloc(PKTFILTER_BUF_SIZE
, GFP_ATOMIC
);
187 argv
[i
] = strsep(&arg_save
, " ");
191 brcmf_err("Too many parameters\n");
194 argv
[i
] = strsep(&arg_save
, " ");
198 brcmf_err("Not enough args provided %d\n", i
);
202 pkt_filter
= (struct brcmf_pkt_filter_le
*)buf
;
204 /* Parse packet filter id. */
206 if (!kstrtoul(argv
[0], 0, &res
))
207 pkt_filter
->id
= cpu_to_le32((u32
)res
);
209 /* Parse filter polarity. */
210 pkt_filter
->negate_match
= 0;
211 if (!kstrtoul(argv
[1], 0, &res
))
212 pkt_filter
->negate_match
= cpu_to_le32((u32
)res
);
214 /* Parse filter type. */
215 pkt_filter
->type
= 0;
216 if (!kstrtoul(argv
[2], 0, &res
))
217 pkt_filter
->type
= cpu_to_le32((u32
)res
);
219 /* Parse pattern filter offset. */
220 pkt_filter
->u
.pattern
.offset
= 0;
221 if (!kstrtoul(argv
[3], 0, &res
))
222 pkt_filter
->u
.pattern
.offset
= cpu_to_le32((u32
)res
);
224 /* Parse pattern filter mask. */
225 mask_size
= brcmf_c_pattern_atoh(argv
[4],
226 (char *)pkt_filter
->u
.pattern
.mask_and_pattern
);
228 /* Parse pattern filter pattern. */
229 pattern_size
= brcmf_c_pattern_atoh(argv
[5],
230 (char *)&pkt_filter
->u
.pattern
.mask_and_pattern
[mask_size
]);
232 if (mask_size
!= pattern_size
) {
233 brcmf_err("Mask and pattern not the same size\n");
237 pkt_filter
->u
.pattern
.size_bytes
= cpu_to_le32(mask_size
);
238 buf_len
= offsetof(struct brcmf_pkt_filter_le
,
239 u
.pattern
.mask_and_pattern
);
240 buf_len
+= mask_size
+ pattern_size
;
242 err
= brcmf_fil_iovar_data_set(ifp
, "pkt_filter_add", pkt_filter
,
245 brcmf_err("Set pkt_filter_add error (%d)\n", err
);
253 int brcmf_c_preinit_dcmds(struct brcmf_if
*ifp
)
255 s8 eventmask
[BRCMF_EVENTING_MASK_LEN
];
256 u8 buf
[BRCMF_DCMD_SMLEN
];
260 /* retreive mac address */
261 err
= brcmf_fil_iovar_data_get(ifp
, "cur_etheraddr", ifp
->mac_addr
,
262 sizeof(ifp
->mac_addr
));
264 brcmf_err("Retreiving cur_etheraddr failed, %d\n",
268 memcpy(ifp
->drvr
->mac
, ifp
->mac_addr
, sizeof(ifp
->drvr
->mac
));
270 /* query for 'ver' to get version info from firmware */
271 memset(buf
, 0, sizeof(buf
));
273 err
= brcmf_fil_iovar_data_get(ifp
, "ver", buf
, sizeof(buf
));
275 brcmf_err("Retreiving version information failed, %d\n",
281 /* Print fw version info */
282 brcmf_err("Firmware version = %s\n", buf
);
285 * Setup timeout if Beacons are lost and roam is off to report
288 err
= brcmf_fil_iovar_int_set(ifp
, "bcn_timeout",
289 BRCMF_DEFAULT_BCN_TIMEOUT
);
291 brcmf_err("bcn_timeout error (%d)\n", err
);
295 /* Enable/Disable build-in roaming to allowed ext supplicant to take
298 err
= brcmf_fil_iovar_int_set(ifp
, "roam_off", 1);
300 brcmf_err("roam_off error (%d)\n", err
);
304 /* Setup event_msgs, enable E_IF */
305 err
= brcmf_fil_iovar_data_get(ifp
, "event_msgs", eventmask
,
306 BRCMF_EVENTING_MASK_LEN
);
308 brcmf_err("Get event_msgs error (%d)\n", err
);
311 setbit(eventmask
, BRCMF_E_IF
);
312 err
= brcmf_fil_iovar_data_set(ifp
, "event_msgs", eventmask
,
313 BRCMF_EVENTING_MASK_LEN
);
315 brcmf_err("Set event_msgs error (%d)\n", err
);
319 /* Setup default scan channel time */
320 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_SCAN_CHANNEL_TIME
,
321 BRCMF_DEFAULT_SCAN_CHANNEL_TIME
);
323 brcmf_err("BRCMF_C_SET_SCAN_CHANNEL_TIME error (%d)\n",
328 /* Setup default scan unassoc time */
329 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_SCAN_UNASSOC_TIME
,
330 BRCMF_DEFAULT_SCAN_UNASSOC_TIME
);
332 brcmf_err("BRCMF_C_SET_SCAN_UNASSOC_TIME error (%d)\n",
337 /* Setup packet filter */
338 brcmf_c_pktfilter_offload_set(ifp
, BRCMF_DEFAULT_PACKET_FILTER
);
339 brcmf_c_pktfilter_offload_enable(ifp
, BRCMF_DEFAULT_PACKET_FILTER
,
342 /* do bus specific preinit here */
343 err
= brcmf_bus_preinit(ifp
->drvr
->bus_if
);
348 #ifdef CONFIG_BRCM_TRACING
349 void __brcmf_err(const char *func
, const char *fmt
, ...)
351 struct va_format vaf
= {
358 pr_err("%s: %pV", func
, &vaf
);
359 trace_brcmf_err(func
, &vaf
);
363 #if defined(CONFIG_BRCM_TRACING) || defined(CONFIG_BRCMDBG)
364 void __brcmf_dbg(u32 level
, const char *func
, const char *fmt
, ...)
366 struct va_format vaf
= {
373 if (brcmf_msg_level
& level
)
374 pr_debug("%s %pV", func
, &vaf
);
375 trace_brcmf_dbg(level
, func
, &vaf
);