projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge branch 'master' of git://git.kernel.org/pub/scm/linux/kernel/git/linville/wirel...
[deliverable/linux.git] / drivers / net / wireless / brcm80211 / brcmfmac / dhd_common.c
CommitLineData
5b435de0
AS		 1/*
2 * Copyright (c) 2010 Broadcom Corporation
3 *
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.
7 *
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.
15 */
02f77195
JP		 16
17#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
18
5b435de0
AS		 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>
24#include <defs.h>
25#include <brcmu_wifi.h>
26#include <brcmu_utils.h>
27#include "dhd.h"
28#include "dhd_bus.h"
29#include "dhd_proto.h"
30#include "dhd_dbg.h"
31
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 */
37
5b435de0
AS		 38#define MSGTRACE_VERSION 1
39
f7264adb 40#define BRCMF_PKT_FILTER_FIXED_LEN offsetof(struct brcmf_pkt_filter_le, u)
5b435de0 41#define BRCMF_PKT_FILTER_PATTERN_FIXED_LEN \
f7264adb 42 offsetof(struct brcmf_pkt_filter_pattern_le, mask_and_pattern)
5b435de0 43
8ae74654 44#ifdef DEBUG
5b435de0
AS		 45static const char brcmf_version[] =
46 "Dongle Host Driver, version " BRCMF_VERSION_STR "\nCompiled on "
47 __DATE__ " at " __TIME__;
48#else
49static const char brcmf_version[] =
50 "Dongle Host Driver, version " BRCMF_VERSION_STR;
51#endif
52
53/* Message trace header */
54struct msgtrace_hdr {
55 u8 version;
56 u8 spare;
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
61 * (ex: SDIO Func2)
62 */
63 __be32 discarded_bytes; /* Number of discarded bytes because of
64 trace overflow */
65 __be32 discarded_printf; /* Number of discarded printf
66 because of trace overflow */
67} __packed;
68
53a2277d
AB		 69
70uint
71brcmf_c_mkiovar(char *name, char *data, uint datalen, char *buf, uint buflen)
72{
73 uint len;
74
75 len = strlen(name) + 1;
76
77 if ((len + datalen) > buflen)
78 return 0;
79
80 strncpy(buf, name, buflen);
81
82 /* append data onto the end of the name string */
83 memcpy(&buf[len], data, datalen);
84 len += datalen;
85
86 return len;
87}
88
b63487ed 89bool brcmf_c_prec_enq(struct device *dev, struct pktq *q,
5b435de0
AS		 90 struct sk_buff *pkt, int prec)
91{
92 struct sk_buff *p;
93 int eprec = -1; /* precedence to evict from */
94 bool discard_oldest;
b63487ed
FL		 95 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
96 struct brcmf_pub *drvr = bus_if->drvr;
5b435de0
AS		 97
98 /* Fast case, precedence queue is not full and we are also not
99 * exceeding total queue length
100 */
101 if (!pktq_pfull(q, prec) && !pktq_full(q)) {
102 brcmu_pktq_penq(q, prec, pkt);
103 return true;
104 }
105
106 /* Determine precedence from which to evict packet, if any */
107 if (pktq_pfull(q, prec))
108 eprec = prec;
109 else if (pktq_full(q)) {
110 p = brcmu_pktq_peek_tail(q, &eprec);
111 if (eprec > prec)
112 return false;
113 }
114
115 /* Evict if needed */
116 if (eprec >= 0) {
117 /* Detect queueing to unconfigured precedence */
118 discard_oldest = ac_bitmap_tst(drvr->wme_dp, eprec);
119 if (eprec == prec && !discard_oldest)
120 return false; /* refuse newer (incoming) packet */
121 /* Evict packet according to discard policy */
122 p = discard_oldest ? brcmu_pktq_pdeq(q, eprec) :
123 brcmu_pktq_pdeq_tail(q, eprec);
124 if (p == NULL)
125 brcmf_dbg(ERROR, "brcmu_pktq_penq() failed, oldest %d\n",
126 discard_oldest);
127
128 brcmu_pkt_buf_free_skb(p);
129 }
130
131 /* Enqueue */
132 p = brcmu_pktq_penq(q, prec, pkt);
133 if (p == NULL)
134 brcmf_dbg(ERROR, "brcmu_pktq_penq() failed\n");
135
136 return p != NULL;
137}
138
8ae74654 139#ifdef DEBUG
5b435de0
AS		 140static void
141brcmf_c_show_host_event(struct brcmf_event_msg *event, void *event_data)
142{
143 uint i, status, reason;
144 bool group = false, flush_txq = false, link = false;
145 char *auth_str, *event_name;
146 unsigned char *buf;
147 char err_msg[256], eabuf[ETHER_ADDR_STR_LEN];
148 static struct {
149 uint event;
150 char *event_name;
151 } event_names[] = {
152 {
153 BRCMF_E_SET_SSID, "SET_SSID"}, {
154 BRCMF_E_JOIN, "JOIN"}, {
155 BRCMF_E_START, "START"}, {
156 BRCMF_E_AUTH, "AUTH"}, {
157 BRCMF_E_AUTH_IND, "AUTH_IND"}, {
158 BRCMF_E_DEAUTH, "DEAUTH"}, {
159 BRCMF_E_DEAUTH_IND, "DEAUTH_IND"}, {
160 BRCMF_E_ASSOC, "ASSOC"}, {
161 BRCMF_E_ASSOC_IND, "ASSOC_IND"}, {
162 BRCMF_E_REASSOC, "REASSOC"}, {
163 BRCMF_E_REASSOC_IND, "REASSOC_IND"}, {
164 BRCMF_E_DISASSOC, "DISASSOC"}, {
165 BRCMF_E_DISASSOC_IND, "DISASSOC_IND"}, {
166 BRCMF_E_QUIET_START, "START_QUIET"}, {
167 BRCMF_E_QUIET_END, "END_QUIET"}, {
168 BRCMF_E_BEACON_RX, "BEACON_RX"}, {
169 BRCMF_E_LINK, "LINK"}, {
170 BRCMF_E_MIC_ERROR, "MIC_ERROR"}, {
171 BRCMF_E_NDIS_LINK, "NDIS_LINK"}, {
172 BRCMF_E_ROAM, "ROAM"}, {
173 BRCMF_E_TXFAIL, "TXFAIL"}, {
174 BRCMF_E_PMKID_CACHE, "PMKID_CACHE"}, {
175 BRCMF_E_RETROGRADE_TSF, "RETROGRADE_TSF"}, {
176 BRCMF_E_PRUNE, "PRUNE"}, {
177 BRCMF_E_AUTOAUTH, "AUTOAUTH"}, {
178 BRCMF_E_EAPOL_MSG, "EAPOL_MSG"}, {
179 BRCMF_E_SCAN_COMPLETE, "SCAN_COMPLETE"}, {
180 BRCMF_E_ADDTS_IND, "ADDTS_IND"}, {
181 BRCMF_E_DELTS_IND, "DELTS_IND"}, {
182 BRCMF_E_BCNSENT_IND, "BCNSENT_IND"}, {
183 BRCMF_E_BCNRX_MSG, "BCNRX_MSG"}, {
184 BRCMF_E_BCNLOST_MSG, "BCNLOST_MSG"}, {
185 BRCMF_E_ROAM_PREP, "ROAM_PREP"}, {
186 BRCMF_E_PFN_NET_FOUND, "PNO_NET_FOUND"}, {
187 BRCMF_E_PFN_NET_LOST, "PNO_NET_LOST"}, {
188 BRCMF_E_RESET_COMPLETE, "RESET_COMPLETE"}, {
189 BRCMF_E_JOIN_START, "JOIN_START"}, {
190 BRCMF_E_ROAM_START, "ROAM_START"}, {
191 BRCMF_E_ASSOC_START, "ASSOC_START"}, {
192 BRCMF_E_IBSS_ASSOC, "IBSS_ASSOC"}, {
193 BRCMF_E_RADIO, "RADIO"}, {
194 BRCMF_E_PSM_WATCHDOG, "PSM_WATCHDOG"}, {
195 BRCMF_E_PROBREQ_MSG, "PROBREQ_MSG"}, {
196 BRCMF_E_SCAN_CONFIRM_IND, "SCAN_CONFIRM_IND"}, {
197 BRCMF_E_PSK_SUP, "PSK_SUP"}, {
198 BRCMF_E_COUNTRY_CODE_CHANGED, "COUNTRY_CODE_CHANGED"}, {
199 BRCMF_E_EXCEEDED_MEDIUM_TIME, "EXCEEDED_MEDIUM_TIME"}, {
200 BRCMF_E_ICV_ERROR, "ICV_ERROR"}, {
201 BRCMF_E_UNICAST_DECODE_ERROR, "UNICAST_DECODE_ERROR"}, {
202 BRCMF_E_MULTICAST_DECODE_ERROR, "MULTICAST_DECODE_ERROR"}, {
203 BRCMF_E_TRACE, "TRACE"}, {
204 BRCMF_E_ACTION_FRAME, "ACTION FRAME"}, {
205 BRCMF_E_ACTION_FRAME_COMPLETE, "ACTION FRAME TX COMPLETE"}, {
206 BRCMF_E_IF, "IF"}, {
207 BRCMF_E_RSSI, "RSSI"}, {
208 BRCMF_E_PFN_SCAN_COMPLETE, "SCAN_COMPLETE"}
209 };
210 uint event_type, flags, auth_type, datalen;
211 static u32 seqnum_prev;
212 struct msgtrace_hdr hdr;
213 u32 nblost;
214 char *s, *p;
215
216 event_type = be32_to_cpu(event->event_type);
217 flags = be16_to_cpu(event->flags);
218 status = be32_to_cpu(event->status);
219 reason = be32_to_cpu(event->reason);
220 auth_type = be32_to_cpu(event->auth_type);
221 datalen = be32_to_cpu(event->datalen);
222 /* debug dump of event messages */
223 sprintf(eabuf, "%pM", event->addr);
224
225 event_name = "UNKNOWN";
226 for (i = 0; i < ARRAY_SIZE(event_names); i++) {
227 if (event_names[i].event == event_type)
228 event_name = event_names[i].event_name;
229 }
230
231 brcmf_dbg(EVENT, "EVENT: %s, event ID = %d\n", event_name, event_type);
232 brcmf_dbg(EVENT, "flags 0x%04x, status %d, reason %d, auth_type %d MAC %s\n",
233 flags, status, reason, auth_type, eabuf);
234
235 if (flags & BRCMF_EVENT_MSG_LINK)
236 link = true;
237 if (flags & BRCMF_EVENT_MSG_GROUP)
238 group = true;
239 if (flags & BRCMF_EVENT_MSG_FLUSHTXQ)
240 flush_txq = true;
241
242 switch (event_type) {
243 case BRCMF_E_START:
244 case BRCMF_E_DEAUTH:
245 case BRCMF_E_DISASSOC:
246 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s\n", event_name, eabuf);
247 break;
248
249 case BRCMF_E_ASSOC_IND:
250 case BRCMF_E_REASSOC_IND:
251 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s\n", event_name, eabuf);
252 break;
253
254 case BRCMF_E_ASSOC:
255 case BRCMF_E_REASSOC:
256 if (status == BRCMF_E_STATUS_SUCCESS)
257 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, SUCCESS\n",
258 event_name, eabuf);
259 else if (status == BRCMF_E_STATUS_TIMEOUT)
260 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, TIMEOUT\n",
261 event_name, eabuf);
262 else if (status == BRCMF_E_STATUS_FAIL)
263 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, FAILURE, reason %d\n",
264 event_name, eabuf, (int)reason);
265 else
266 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, unexpected status %d\n",
267 event_name, eabuf, (int)status);
268 break;
269
270 case BRCMF_E_DEAUTH_IND:
271 case BRCMF_E_DISASSOC_IND:
272 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, reason %d\n",
273 event_name, eabuf, (int)reason);
274 break;
275
276 case BRCMF_E_AUTH:
277 case BRCMF_E_AUTH_IND:
278 if (auth_type == WLAN_AUTH_OPEN)
279 auth_str = "Open System";
280 else if (auth_type == WLAN_AUTH_SHARED_KEY)
281 auth_str = "Shared Key";
282 else {
283 sprintf(err_msg, "AUTH unknown: %d", (int)auth_type);
284 auth_str = err_msg;
285 }
286 if (event_type == BRCMF_E_AUTH_IND)
287 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, %s\n",
288 event_name, eabuf, auth_str);
289 else if (status == BRCMF_E_STATUS_SUCCESS)
290 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, %s, SUCCESS\n",
291 event_name, eabuf, auth_str);
292 else if (status == BRCMF_E_STATUS_TIMEOUT)
293 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, %s, TIMEOUT\n",
294 event_name, eabuf, auth_str);
295 else if (status == BRCMF_E_STATUS_FAIL) {
296 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, %s, FAILURE, reason %d\n",
297 event_name, eabuf, auth_str, (int)reason);
298 }
299
300 break;
301
302 case BRCMF_E_JOIN:
303 case BRCMF_E_ROAM:
304 case BRCMF_E_SET_SSID:
305 if (status == BRCMF_E_STATUS_SUCCESS)
306 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s\n",
307 event_name, eabuf);
308 else if (status == BRCMF_E_STATUS_FAIL)
309 brcmf_dbg(EVENT, "MACEVENT: %s, failed\n", event_name);
310 else if (status == BRCMF_E_STATUS_NO_NETWORKS)
311 brcmf_dbg(EVENT, "MACEVENT: %s, no networks found\n",
312 event_name);
313 else
314 brcmf_dbg(EVENT, "MACEVENT: %s, unexpected status %d\n",
315 event_name, (int)status);
316 break;
317
318 case BRCMF_E_BEACON_RX:
319 if (status == BRCMF_E_STATUS_SUCCESS)
320 brcmf_dbg(EVENT, "MACEVENT: %s, SUCCESS\n", event_name);
321 else if (status == BRCMF_E_STATUS_FAIL)
322 brcmf_dbg(EVENT, "MACEVENT: %s, FAIL\n", event_name);
323 else
324 brcmf_dbg(EVENT, "MACEVENT: %s, status %d\n",
325 event_name, status);
326 break;
327
328 case BRCMF_E_LINK:
329 brcmf_dbg(EVENT, "MACEVENT: %s %s\n",
330 event_name, link ? "UP" : "DOWN");
331 break;
332
333 case BRCMF_E_MIC_ERROR:
334 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, Group %d, Flush %d\n",
335 event_name, eabuf, group, flush_txq);
336 break;
337
338 case BRCMF_E_ICV_ERROR:
339 case BRCMF_E_UNICAST_DECODE_ERROR:
340 case BRCMF_E_MULTICAST_DECODE_ERROR:
341 brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s\n", event_name, eabuf);
342 break;
343
344 case BRCMF_E_TXFAIL:
345 brcmf_dbg(EVENT, "MACEVENT: %s, RA %s\n", event_name, eabuf);
346 break;
347
348 case BRCMF_E_SCAN_COMPLETE:
349 case BRCMF_E_PMKID_CACHE:
350 brcmf_dbg(EVENT, "MACEVENT: %s\n", event_name);
351 break;
352
353 case BRCMF_E_PFN_NET_FOUND:
354 case BRCMF_E_PFN_NET_LOST:
355 case BRCMF_E_PFN_SCAN_COMPLETE:
356 brcmf_dbg(EVENT, "PNOEVENT: %s\n", event_name);
357 break;
358
359 case BRCMF_E_PSK_SUP:
360 case BRCMF_E_PRUNE:
361 brcmf_dbg(EVENT, "MACEVENT: %s, status %d, reason %d\n",
362 event_name, (int)status, (int)reason);
363 break;
364
365 case BRCMF_E_TRACE:
366 buf = (unsigned char *) event_data;
367 memcpy(&hdr, buf, sizeof(struct msgtrace_hdr));
368
369 if (hdr.version != MSGTRACE_VERSION) {
370 brcmf_dbg(ERROR,
371 "MACEVENT: %s [unsupported version --> brcmf"
372 " version:%d dongle version:%d]\n",
373 event_name, MSGTRACE_VERSION, hdr.version);
374 /* Reset datalen to avoid display below */
375 datalen = 0;
376 break;
377 }
378
379 /* There are 2 bytes available at the end of data */
380 *(buf + sizeof(struct msgtrace_hdr)
381 + be16_to_cpu(hdr.len)) = '\0';
382
383 if (be32_to_cpu(hdr.discarded_bytes)
384 || be32_to_cpu(hdr.discarded_printf))
385 brcmf_dbg(ERROR,
386 "WLC_E_TRACE: [Discarded traces in dongle -->"
387 " discarded_bytes %d discarded_printf %d]\n",
388 be32_to_cpu(hdr.discarded_bytes),
389 be32_to_cpu(hdr.discarded_printf));
390
391 nblost = be32_to_cpu(hdr.seqnum) - seqnum_prev - 1;
392 if (nblost > 0)
393 brcmf_dbg(ERROR, "WLC_E_TRACE: [Event lost --> seqnum "
394 " %d nblost %d\n", be32_to_cpu(hdr.seqnum),
395 nblost);
396 seqnum_prev = be32_to_cpu(hdr.seqnum);
397
398 /* Display the trace buffer. Advance from \n to \n to
399 * avoid display big
400 * printf (issue with Linux printk )
401 */
402 p = (char *)&buf[sizeof(struct msgtrace_hdr)];
403 while ((s = strstr(p, "\n")) != NULL) {
404 *s = '\0';
18aad4f8 405 pr_debug("%s\n", p);
5b435de0
AS		 406 p = s + 1;
407 }
18aad4f8 408 pr_debug("%s\n", p);
5b435de0
AS		 409
410 /* Reset datalen to avoid display below */
411 datalen = 0;
412 break;
413
414 case BRCMF_E_RSSI:
415 brcmf_dbg(EVENT, "MACEVENT: %s %d\n",
416 event_name, be32_to_cpu(*((__be32 *)event_data)));
417 break;
418
419 default:
420 brcmf_dbg(EVENT,
421 "MACEVENT: %s %d, MAC %s, status %d, reason %d, "
422 "auth %d\n", event_name, event_type, eabuf,
423 (int)status, (int)reason, (int)auth_type);
424 break;
425 }
426
427 /* show any appended data */
428 if (datalen) {
429 buf = (unsigned char *) event_data;
430 brcmf_dbg(EVENT, " data (%d) : ", datalen);
431 for (i = 0; i < datalen; i++)
432 brcmf_dbg(EVENT, " 0x%02x ", *buf++);
433 brcmf_dbg(EVENT, "\n");
434 }
435}
8ae74654 436#endif /* DEBUG */
5b435de0
AS		 437
438int
d08b6a37 439brcmf_c_host_event(struct brcmf_pub *drvr, int *ifidx, void *pktdata,
5b435de0
AS		 440 struct brcmf_event_msg *event, void **data_ptr)
441{
442 /* check whether packet is a BRCM event pkt */
443 struct brcmf_event *pvt_data = (struct brcmf_event *) pktdata;
444 struct brcmf_if_event *ifevent;
445 char *event_data;
446 u32 type, status;
447 u16 flags;
448 int evlen;
449
450 if (memcmp(BRCM_OUI, &pvt_data->hdr.oui[0], DOT11_OUI_LEN)) {
451 brcmf_dbg(ERROR, "mismatched OUI, bailing\n");
452 return -EBADE;
453 }
454
455 /* BRCM event pkt may be unaligned - use xxx_ua to load user_subtype. */
456 if (get_unaligned_be16(&pvt_data->hdr.usr_subtype) !=
457 BCMILCP_BCM_SUBTYPE_EVENT) {
458 brcmf_dbg(ERROR, "mismatched subtype, bailing\n");
459 return -EBADE;
460 }
461
462 *data_ptr = &pvt_data[1];
463 event_data = *data_ptr;
464
465 /* memcpy since BRCM event pkt may be unaligned. */
466 memcpy(event, &pvt_data->msg, sizeof(struct brcmf_event_msg));
467
468 type = get_unaligned_be32(&event->event_type);
469 flags = get_unaligned_be16(&event->flags);
470 status = get_unaligned_be32(&event->status);
471 evlen = get_unaligned_be32(&event->datalen) +
472 sizeof(struct brcmf_event);
473
474 switch (type) {
475 case BRCMF_E_IF:
476 ifevent = (struct brcmf_if_event *) event_data;
477 brcmf_dbg(TRACE, "if event\n");
478
479 if (ifevent->ifidx > 0 && ifevent->ifidx < BRCMF_MAX_IFS) {
480 if (ifevent->action == BRCMF_E_IF_ADD)
55a63bcc 481 brcmf_add_if(drvr->dev, ifevent->ifidx,
5b435de0 482 event->ifname,
15d45b6f 483 pvt_data->eth.h_dest);
5b435de0 484 else
d08b6a37 485 brcmf_del_if(drvr, ifevent->ifidx);
5b435de0
AS		 486 } else {
487 brcmf_dbg(ERROR, "Invalid ifidx %d for %s\n",
488 ifevent->ifidx, event->ifname);
489 }
490
491 /* send up the if event: btamp user needs it */
d08b6a37 492 *ifidx = brcmf_ifname2idx(drvr, event->ifname);
5b435de0
AS		 493 break;
494
495 /* These are what external supplicant/authenticator wants */
496 case BRCMF_E_LINK:
497 case BRCMF_E_ASSOC_IND:
498 case BRCMF_E_REASSOC_IND:
499 case BRCMF_E_DISASSOC_IND:
500 case BRCMF_E_MIC_ERROR:
501 default:
502 /* Fall through: this should get _everything_ */
503
d08b6a37 504 *ifidx = brcmf_ifname2idx(drvr, event->ifname);
5b435de0
AS		 505 brcmf_dbg(TRACE, "MAC event %d, flags %x, status %x\n",
506 type, flags, status);
507
508 /* put it back to BRCMF_E_NDIS_LINK */
509 if (type == BRCMF_E_NDIS_LINK) {
510 u32 temp1;
511 __be32 temp2;
512
513 temp1 = get_unaligned_be32(&event->event_type);
514 brcmf_dbg(TRACE, "Converted to WLC_E_LINK type %d\n",
515 temp1);
516
517 temp2 = cpu_to_be32(BRCMF_E_NDIS_LINK);
518 memcpy((void *)(&pvt_data->msg.event_type), &temp2,
519 sizeof(pvt_data->msg.event_type));
520 }
521 break;
522 }
523
8ae74654 524#ifdef DEBUG
5b435de0 525 brcmf_c_show_host_event(event, event_data);
8ae74654 526#endif /* DEBUG */
5b435de0
AS		 527
528 return 0;
529}
530
531/* Convert user's input in hex pattern to byte-size mask */
532static int brcmf_c_pattern_atoh(char *src, char *dst)
533{
534 int i;
535 if (strncmp(src, "0x", 2) != 0 && strncmp(src, "0X", 2) != 0) {
536 brcmf_dbg(ERROR, "Mask invalid format. Needs to start with 0x\n");
537 return -EINVAL;
538 }
539 src = src + 2; /* Skip past 0x */
540 if (strlen(src) % 2 != 0) {
541 brcmf_dbg(ERROR, "Mask invalid format. Length must be even.\n");
542 return -EINVAL;
543 }
544 for (i = 0; *src != '\0'; i++) {
545 unsigned long res;
546 char num[3];
547 strncpy(num, src, 2);
548 num[2] = '\0';
549 if (kstrtoul(num, 16, &res))
550 return -EINVAL;
551 dst[i] = (u8)res;
552 src += 2;
553 }
554 return i;
555}
556
557void
558brcmf_c_pktfilter_offload_enable(struct brcmf_pub *drvr, char *arg, int enable,
559 int master_mode)
560{
561 unsigned long res;
562 char *argv[8];
563 int i = 0;
564 const char *str;
565 int buf_len;
566 int str_len;
567 char *arg_save = NULL, *arg_org = NULL;
568 int rc;
569 char buf[128];
f7264adb
AS		 570 struct brcmf_pkt_filter_enable_le enable_parm;
571 struct brcmf_pkt_filter_enable_le *pkt_filterp;
572 __le32 mmode_le;
5b435de0
AS		 573
574 arg_save = kmalloc(strlen(arg) + 1, GFP_ATOMIC);
575 if (!arg_save)
576 goto fail;
577
578 arg_org = arg_save;
579 memcpy(arg_save, arg, strlen(arg) + 1);
580
581 argv[i] = strsep(&arg_save, " ");
582
583 i = 0;
584 if (NULL == argv[i]) {
585 brcmf_dbg(ERROR, "No args provided\n");
586 goto fail;
587 }
588
589 str = "pkt_filter_enable";
590 str_len = strlen(str);
591 strncpy(buf, str, str_len);
592 buf[str_len] = '\0';
593 buf_len = str_len + 1;
594
f7264adb 595 pkt_filterp = (struct brcmf_pkt_filter_enable_le *) (buf + str_len + 1);
5b435de0
AS		 596
597 /* Parse packet filter id. */
598 enable_parm.id = 0;
599 if (!kstrtoul(argv[i], 0, &res))
f7264adb 600 enable_parm.id = cpu_to_le32((u32)res);
5b435de0
AS		 601
602 /* Parse enable/disable value. */
f7264adb 603 enable_parm.enable = cpu_to_le32(enable);
5b435de0
AS		 604
605 buf_len += sizeof(enable_parm);
606 memcpy((char *)pkt_filterp, &enable_parm, sizeof(enable_parm));
607
608 /* Enable/disable the specified filter. */
609 rc = brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR, buf, buf_len);
610 rc = rc >= 0 ? 0 : rc;
611 if (rc)
612 brcmf_dbg(TRACE, "failed to add pktfilter %s, retcode = %d\n",
613 arg, rc);
614 else
615 brcmf_dbg(TRACE, "successfully added pktfilter %s\n", arg);
616
617 /* Contorl the master mode */
f7264adb 618 mmode_le = cpu_to_le32(master_mode);
53a2277d 619 brcmf_c_mkiovar("pkt_filter_mode", (char *)&mmode_le, 4, buf,
5b435de0
AS		 620 sizeof(buf));
621 rc = brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR, buf,
622 sizeof(buf));
623 rc = rc >= 0 ? 0 : rc;
624 if (rc)
625 brcmf_dbg(TRACE, "failed to add pktfilter %s, retcode = %d\n",
626 arg, rc);
627
628fail:
629 kfree(arg_org);
630}
631
632void brcmf_c_pktfilter_offload_set(struct brcmf_pub *drvr, char *arg)
633{
634 const char *str;
f7264adb
AS		 635 struct brcmf_pkt_filter_le pkt_filter;
636 struct brcmf_pkt_filter_le *pkt_filterp;
5b435de0
AS		 637 unsigned long res;
638 int buf_len;
639 int str_len;
640 int rc;
641 u32 mask_size;
642 u32 pattern_size;
643 char *argv[8], *buf = NULL;
644 int i = 0;
645 char *arg_save = NULL, *arg_org = NULL;
646
647 arg_save = kstrdup(arg, GFP_ATOMIC);
648 if (!arg_save)
649 goto fail;
650
651 arg_org = arg_save;
652
653 buf = kmalloc(PKTFILTER_BUF_SIZE, GFP_ATOMIC);
654 if (!buf)
655 goto fail;
656
657 argv[i] = strsep(&arg_save, " ");
658 while (argv[i++])
659 argv[i] = strsep(&arg_save, " ");
660
661 i = 0;
662 if (NULL == argv[i]) {
663 brcmf_dbg(ERROR, "No args provided\n");
664 goto fail;
665 }
666
667 str = "pkt_filter_add";
668 strcpy(buf, str);
669 str_len = strlen(str);
670 buf_len = str_len + 1;
671
f7264adb 672 pkt_filterp = (struct brcmf_pkt_filter_le *) (buf + str_len + 1);
5b435de0
AS		 673
674 /* Parse packet filter id. */
675 pkt_filter.id = 0;
676 if (!kstrtoul(argv[i], 0, &res))
f7264adb 677 pkt_filter.id = cpu_to_le32((u32)res);
5b435de0
AS		 678
679 if (NULL == argv[++i]) {
680 brcmf_dbg(ERROR, "Polarity not provided\n");
681 goto fail;
682 }
683
684 /* Parse filter polarity. */
685 pkt_filter.negate_match = 0;
686 if (!kstrtoul(argv[i], 0, &res))
f7264adb 687 pkt_filter.negate_match = cpu_to_le32((u32)res);
5b435de0
AS		 688
689 if (NULL == argv[++i]) {
690 brcmf_dbg(ERROR, "Filter type not provided\n");
691 goto fail;
692 }
693
694 /* Parse filter type. */
695 pkt_filter.type = 0;
696 if (!kstrtoul(argv[i], 0, &res))
f7264adb 697 pkt_filter.type = cpu_to_le32((u32)res);
5b435de0
AS		 698
699 if (NULL == argv[++i]) {
700 brcmf_dbg(ERROR, "Offset not provided\n");
701 goto fail;
702 }
703
704 /* Parse pattern filter offset. */
705 pkt_filter.u.pattern.offset = 0;
706 if (!kstrtoul(argv[i], 0, &res))
f7264adb 707 pkt_filter.u.pattern.offset = cpu_to_le32((u32)res);
5b435de0
AS		 708
709 if (NULL == argv[++i]) {
710 brcmf_dbg(ERROR, "Bitmask not provided\n");
711 goto fail;
712 }
713
714 /* Parse pattern filter mask. */
715 mask_size =
716 brcmf_c_pattern_atoh
717 (argv[i], (char *)pkt_filterp->u.pattern.mask_and_pattern);
718
719 if (NULL == argv[++i]) {
720 brcmf_dbg(ERROR, "Pattern not provided\n");
721 goto fail;
722 }
723
724 /* Parse pattern filter pattern. */
725 pattern_size =
726 brcmf_c_pattern_atoh(argv[i],
727 (char *)&pkt_filterp->u.pattern.
728 mask_and_pattern[mask_size]);
729
730 if (mask_size != pattern_size) {
731 brcmf_dbg(ERROR, "Mask and pattern not the same size\n");
732 goto fail;
733 }
734
f7264adb 735 pkt_filter.u.pattern.size_bytes = cpu_to_le32(mask_size);
5b435de0
AS		 736 buf_len += BRCMF_PKT_FILTER_FIXED_LEN;
737 buf_len += (BRCMF_PKT_FILTER_PATTERN_FIXED_LEN + 2 * mask_size);
738
739 /* Keep-alive attributes are set in local
740 * variable (keep_alive_pkt), and
741 ** then memcpy'ed into buffer (keep_alive_pktp) since there is no
742 ** guarantee that the buffer is properly aligned.
743 */
744 memcpy((char *)pkt_filterp,
745 &pkt_filter,
746 BRCMF_PKT_FILTER_FIXED_LEN + BRCMF_PKT_FILTER_PATTERN_FIXED_LEN);
747
748 rc = brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR, buf, buf_len);
749 rc = rc >= 0 ? 0 : rc;
750
751 if (rc)
752 brcmf_dbg(TRACE, "failed to add pktfilter %s, retcode = %d\n",
753 arg, rc);
754 else
755 brcmf_dbg(TRACE, "successfully added pktfilter %s\n", arg);
756
757fail:
758 kfree(arg_org);
759
760 kfree(buf);
761}
762
763static void brcmf_c_arp_offload_set(struct brcmf_pub *drvr, int arp_mode)
764{
765 char iovbuf[32];
766 int retcode;
767
53a2277d 768 brcmf_c_mkiovar("arp_ol", (char *)&arp_mode, 4, iovbuf, sizeof(iovbuf));
5b435de0
AS		 769 retcode = brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR,
770 iovbuf, sizeof(iovbuf));
771 retcode = retcode >= 0 ? 0 : retcode;
772 if (retcode)
773 brcmf_dbg(TRACE, "failed to set ARP offload mode to 0x%x, retcode = %d\n",
774 arp_mode, retcode);
775 else
776 brcmf_dbg(TRACE, "successfully set ARP offload mode to 0x%x\n",
777 arp_mode);
778}
779
780static void brcmf_c_arp_offload_enable(struct brcmf_pub *drvr, int arp_enable)
781{
782 char iovbuf[32];
783 int retcode;
784
53a2277d
AB		 785 brcmf_c_mkiovar("arpoe", (char *)&arp_enable, 4,
786 iovbuf, sizeof(iovbuf));
5b435de0
AS		 787 retcode = brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR,
788 iovbuf, sizeof(iovbuf));
789 retcode = retcode >= 0 ? 0 : retcode;
790 if (retcode)
791 brcmf_dbg(TRACE, "failed to enable ARP offload to %d, retcode = %d\n",
792 arp_enable, retcode);
793 else
794 brcmf_dbg(TRACE, "successfully enabled ARP offload to %d\n",
795 arp_enable);
796}
797
798int brcmf_c_preinit_dcmds(struct brcmf_pub *drvr)
799{
800 char iovbuf[BRCMF_EVENTING_MASK_LEN + 12]; /* Room for
801 "event_msgs" + '\0' + bitvec */
5b435de0 802 char buf[128], *ptr;
6e3c7128 803 u32 dongle_align = drvr->bus_if->align;
5b435de0
AS		 804 u32 glom = 0;
805 u32 roaming = 1;
806 uint bcn_timeout = 3;
807 int scan_assoc_time = 40;
808 int scan_unassoc_time = 40;
809 int i;
810
1ae00421 811 mutex_lock(&drvr->proto_block);
5b435de0
AS		 812
813 /* Set Country code */
814 if (drvr->country_code[0] != 0) {
815 if (brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_COUNTRY,
816 drvr->country_code,
817 sizeof(drvr->country_code)) < 0)
818 brcmf_dbg(ERROR, "country code setting failed\n");
819 }
820
821 /* query for 'ver' to get version info from firmware */
822 memset(buf, 0, sizeof(buf));
823 ptr = buf;
53a2277d 824 brcmf_c_mkiovar("ver", NULL, 0, buf, sizeof(buf));
5b435de0
AS		 825 brcmf_proto_cdc_query_dcmd(drvr, 0, BRCMF_C_GET_VAR, buf, sizeof(buf));
826 strsep(&ptr, "\n");
827 /* Print fw version info */
828 brcmf_dbg(ERROR, "Firmware version = %s\n", buf);
829
830 /* Match Host and Dongle rx alignment */
53a2277d 831 brcmf_c_mkiovar("bus:txglomalign", (char *)&dongle_align, 4, iovbuf,
5b435de0
AS		 832 sizeof(iovbuf));
833 brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR, iovbuf,
834 sizeof(iovbuf));
835
836 /* disable glom option per default */
53a2277d 837 brcmf_c_mkiovar("bus:txglom", (char *)&glom, 4, iovbuf, sizeof(iovbuf));
5b435de0
AS		 838 brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR, iovbuf,
839 sizeof(iovbuf));
840
841 /* Setup timeout if Beacons are lost and roam is off to report
842 link down */
53a2277d 843 brcmf_c_mkiovar("bcn_timeout", (char *)&bcn_timeout, 4, iovbuf,
5b435de0
AS		 844 sizeof(iovbuf));
845 brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR, iovbuf,
846 sizeof(iovbuf));
847
848 /* Enable/Disable build-in roaming to allowed ext supplicant to take
849 of romaing */
53a2277d 850 brcmf_c_mkiovar("roam_off", (char *)&roaming, 4,
5b435de0
AS		 851 iovbuf, sizeof(iovbuf));
852 brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR, iovbuf,
853 sizeof(iovbuf));
854
5b435de0 855 /* Setup event_msgs */
53a2277d 856 brcmf_c_mkiovar("event_msgs", drvr->eventmask, BRCMF_EVENTING_MASK_LEN,
5b435de0
AS		 857 iovbuf, sizeof(iovbuf));
858 brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_VAR, iovbuf,
859 sizeof(iovbuf));
860
861 brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_SCAN_CHANNEL_TIME,
862 (char *)&scan_assoc_time, sizeof(scan_assoc_time));
863 brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_SET_SCAN_UNASSOC_TIME,
864 (char *)&scan_unassoc_time, sizeof(scan_unassoc_time));
865
866 /* Set and enable ARP offload feature */
867 brcmf_c_arp_offload_set(drvr, BRCMF_ARPOL_MODE);
868 brcmf_c_arp_offload_enable(drvr, true);
869
870 /* Set up pkt filter */
871 for (i = 0; i < drvr->pktfilter_count; i++) {
872 brcmf_c_pktfilter_offload_set(drvr, drvr->pktfilter[i]);
873 brcmf_c_pktfilter_offload_enable(drvr, drvr->pktfilter[i],
874 0, true);
875 }
876
1ae00421 877 mutex_unlock(&drvr->proto_block);
5b435de0
AS		 878
879 return 0;
880}
Linux kernel - Deliverables
This page took 0.117672 seconds and 5 git commands to generate.