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>
24 #include "dhd_proto.h"
28 #define PKTFILTER_BUF_SIZE 128
29 #define BRCMF_ARPOL_MODE 0xb /* agent|snoop|peer_autoreply */
30 #define BRCMF_DEFAULT_BCN_TIMEOUT 3
31 #define BRCMF_DEFAULT_SCAN_CHANNEL_TIME 40
32 #define BRCMF_DEFAULT_SCAN_UNASSOC_TIME 40
33 #define BRCMF_DEFAULT_PACKET_FILTER "100 0 0 0 0x01 0x00"
36 static const char brcmf_version[] =
37 "Dongle Host Driver, version " BRCMF_VERSION_STR "\nCompiled on "
38 __DATE__ " at " __TIME__;
40 static const char brcmf_version[] =
41 "Dongle Host Driver, version " BRCMF_VERSION_STR;
45 bool brcmf_c_prec_enq(struct device *dev, struct pktq *q,
46 struct sk_buff *pkt, int prec)
49 int eprec = -1; /* precedence to evict from */
51 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
52 struct brcmf_pub *drvr = bus_if->drvr;
54 /* Fast case, precedence queue is not full and we are also not
55 * exceeding total queue length
57 if (!pktq_pfull(q, prec) && !pktq_full(q)) {
58 brcmu_pktq_penq(q, prec, pkt);
62 /* Determine precedence from which to evict packet, if any */
63 if (pktq_pfull(q, prec))
65 else if (pktq_full(q)) {
66 p = brcmu_pktq_peek_tail(q, &eprec);
73 /* Detect queueing to unconfigured precedence */
74 discard_oldest = ac_bitmap_tst(drvr->wme_dp, eprec);
75 if (eprec == prec && !discard_oldest)
76 return false; /* refuse newer (incoming) packet */
77 /* Evict packet according to discard policy */
78 p = discard_oldest ? brcmu_pktq_pdeq(q, eprec) :
79 brcmu_pktq_pdeq_tail(q, eprec);
81 brcmf_err("brcmu_pktq_penq() failed, oldest %d\n",
84 brcmu_pkt_buf_free_skb(p);
88 p = brcmu_pktq_penq(q, prec, pkt);
90 brcmf_err("brcmu_pktq_penq() failed\n");
95 /* Convert user's input in hex pattern to byte-size mask */
96 static int brcmf_c_pattern_atoh(char *src, char *dst)
99 if (strncmp(src, "0x", 2) != 0 && strncmp(src, "0X", 2) != 0) {
100 brcmf_err("Mask invalid format. Needs to start with 0x\n");
103 src = src + 2; /* Skip past 0x */
104 if (strlen(src) % 2 != 0) {
105 brcmf_err("Mask invalid format. Length must be even.\n");
108 for (i = 0; *src != '\0'; i++) {
111 strncpy(num, src, 2);
113 if (kstrtoul(num, 16, &res))
122 brcmf_c_pktfilter_offload_enable(struct brcmf_if *ifp, char *arg, int enable,
127 char *arg_save = NULL, *arg_org = NULL;
129 struct brcmf_pkt_filter_enable_le enable_parm;
131 arg_save = kstrdup(arg, GFP_ATOMIC);
137 argv = strsep(&arg_save, " ");
140 brcmf_err("No args provided\n");
144 /* Parse packet filter id. */
146 if (!kstrtoul(argv, 0, &res))
147 enable_parm.id = cpu_to_le32((u32)res);
149 /* Enable/disable the specified filter. */
150 enable_parm.enable = cpu_to_le32(enable);
152 err = brcmf_fil_iovar_data_set(ifp, "pkt_filter_enable", &enable_parm,
153 sizeof(enable_parm));
155 brcmf_err("Set pkt_filter_enable error (%d)\n", err);
157 /* Control the master mode */
158 err = brcmf_fil_iovar_int_set(ifp, "pkt_filter_mode", master_mode);
160 brcmf_err("Set pkt_filter_mode error (%d)\n", err);
166 static void brcmf_c_pktfilter_offload_set(struct brcmf_if *ifp, char *arg)
168 struct brcmf_pkt_filter_le *pkt_filter;
174 char *argv[8], *buf = NULL;
176 char *arg_save = NULL, *arg_org = NULL;
178 arg_save = kstrdup(arg, GFP_ATOMIC);
184 buf = kmalloc(PKTFILTER_BUF_SIZE, GFP_ATOMIC);
188 argv[i] = strsep(&arg_save, " ");
192 brcmf_err("Too many parameters\n");
195 argv[i] = strsep(&arg_save, " ");
199 brcmf_err("Not enough args provided %d\n", i);
203 pkt_filter = (struct brcmf_pkt_filter_le *)buf;
205 /* Parse packet filter id. */
207 if (!kstrtoul(argv[0], 0, &res))
208 pkt_filter->id = cpu_to_le32((u32)res);
210 /* Parse filter polarity. */
211 pkt_filter->negate_match = 0;
212 if (!kstrtoul(argv[1], 0, &res))
213 pkt_filter->negate_match = cpu_to_le32((u32)res);
215 /* Parse filter type. */
216 pkt_filter->type = 0;
217 if (!kstrtoul(argv[2], 0, &res))
218 pkt_filter->type = cpu_to_le32((u32)res);
220 /* Parse pattern filter offset. */
221 pkt_filter->u.pattern.offset = 0;
222 if (!kstrtoul(argv[3], 0, &res))
223 pkt_filter->u.pattern.offset = cpu_to_le32((u32)res);
225 /* Parse pattern filter mask. */
226 mask_size = brcmf_c_pattern_atoh(argv[4],
227 (char *)pkt_filter->u.pattern.mask_and_pattern);
229 /* Parse pattern filter pattern. */
230 pattern_size = brcmf_c_pattern_atoh(argv[5],
231 (char *)&pkt_filter->u.pattern.mask_and_pattern[mask_size]);
233 if (mask_size != pattern_size) {
234 brcmf_err("Mask and pattern not the same size\n");
238 pkt_filter->u.pattern.size_bytes = cpu_to_le32(mask_size);
239 buf_len = offsetof(struct brcmf_pkt_filter_le,
240 u.pattern.mask_and_pattern);
241 buf_len += mask_size + pattern_size;
243 err = brcmf_fil_iovar_data_set(ifp, "pkt_filter_add", pkt_filter,
246 brcmf_err("Set pkt_filter_add error (%d)\n", err);
254 int brcmf_c_preinit_dcmds(struct brcmf_if *ifp)
256 s8 eventmask[BRCMF_EVENTING_MASK_LEN];
257 u8 buf[BRCMF_DCMD_SMLEN];
260 struct brcmf_bus_dcmd *cmdlst;
261 struct list_head *cur, *q;
263 /* retreive mac address */
264 err = brcmf_fil_iovar_data_get(ifp, "cur_etheraddr", ifp->mac_addr,
265 sizeof(ifp->mac_addr));
267 brcmf_err("Retreiving cur_etheraddr failed, %d\n",
271 memcpy(ifp->drvr->mac, ifp->mac_addr, sizeof(ifp->drvr->mac));
273 /* query for 'ver' to get version info from firmware */
274 memset(buf, 0, sizeof(buf));
276 err = brcmf_fil_iovar_data_get(ifp, "ver", buf, sizeof(buf));
278 brcmf_err("Retreiving version information failed, %d\n",
284 /* Print fw version info */
285 brcmf_err("Firmware version = %s\n", buf);
288 * Setup timeout if Beacons are lost and roam is off to report
291 err = brcmf_fil_iovar_int_set(ifp, "bcn_timeout",
292 BRCMF_DEFAULT_BCN_TIMEOUT);
294 brcmf_err("bcn_timeout error (%d)\n", err);
298 /* Enable/Disable build-in roaming to allowed ext supplicant to take
301 err = brcmf_fil_iovar_int_set(ifp, "roam_off", 1);
303 brcmf_err("roam_off error (%d)\n", err);
307 /* Setup event_msgs, enable E_IF */
308 err = brcmf_fil_iovar_data_get(ifp, "event_msgs", eventmask,
309 BRCMF_EVENTING_MASK_LEN);
311 brcmf_err("Get event_msgs error (%d)\n", err);
314 setbit(eventmask, BRCMF_E_IF);
315 err = brcmf_fil_iovar_data_set(ifp, "event_msgs", eventmask,
316 BRCMF_EVENTING_MASK_LEN);
318 brcmf_err("Set event_msgs error (%d)\n", err);
322 /* Setup default scan channel time */
323 err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_CHANNEL_TIME,
324 BRCMF_DEFAULT_SCAN_CHANNEL_TIME);
326 brcmf_err("BRCMF_C_SET_SCAN_CHANNEL_TIME error (%d)\n",
331 /* Setup default scan unassoc time */
332 err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_UNASSOC_TIME,
333 BRCMF_DEFAULT_SCAN_UNASSOC_TIME);
335 brcmf_err("BRCMF_C_SET_SCAN_UNASSOC_TIME error (%d)\n",
340 /* Try to set and enable ARP offload feature, this may fail */
341 err = brcmf_fil_iovar_int_set(ifp, "arp_ol", BRCMF_ARPOL_MODE);
343 brcmf_dbg(TRACE, "failed to set ARP offload mode to 0x%x, err = %d\n",
344 BRCMF_ARPOL_MODE, err);
347 err = brcmf_fil_iovar_int_set(ifp, "arpoe", 1);
349 brcmf_dbg(TRACE, "failed to enable ARP offload err = %d\n",
353 brcmf_dbg(TRACE, "successfully enabled ARP offload to 0x%x\n",
357 /* Setup packet filter */
358 brcmf_c_pktfilter_offload_set(ifp, BRCMF_DEFAULT_PACKET_FILTER);
359 brcmf_c_pktfilter_offload_enable(ifp, BRCMF_DEFAULT_PACKET_FILTER,
362 /* set bus specific command if there is any */
363 list_for_each_safe(cur, q, &ifp->drvr->bus_if->dcmd_list) {
364 cmdlst = list_entry(cur, struct brcmf_bus_dcmd, list);
365 if (cmdlst->name && cmdlst->param && cmdlst->param_len) {
366 brcmf_fil_iovar_data_set(ifp, cmdlst->name,