dhd_common.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825
  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. */
  16. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  17. #include <linux/kernel.h>
  18. #include <linux/string.h>
  19. #include <linux/sched.h>
  20. #include <linux/netdevice.h>
  21. #include <asm/unaligned.h>
  22. #include <defs.h>
  23. #include <brcmu_wifi.h>
  24. #include <brcmu_utils.h>
  25. #include "dhd.h"
  26. #include "dhd_bus.h"
  27. #include "dhd_proto.h"
  28. #include "dhd_dbg.h"
  29. #include "fwil.h"
  30. #define BRCM_OUI "\x00\x10\x18"
  31. #define DOT11_OUI_LEN 3
  32. #define BCMILCP_BCM_SUBTYPE_EVENT 1
  33. #define PKTFILTER_BUF_SIZE 128
  34. #define BRCMF_ARPOL_MODE 0xb /* agent|snoop|peer_autoreply */
  35. #define BRCMF_DEFAULT_BCN_TIMEOUT 3
  36. #define BRCMF_DEFAULT_SCAN_CHANNEL_TIME 40
  37. #define BRCMF_DEFAULT_SCAN_UNASSOC_TIME 40
  38. #define BRCMF_DEFAULT_PACKET_FILTER "100 0 0 0 0x01 0x00"
  39. #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)
  43. #ifdef DEBUG
  44. static const char brcmf_version[] =
  45. "Dongle Host Driver, version " BRCMF_VERSION_STR "\nCompiled on "
  46. __DATE__ " at " __TIME__;
  47. #else
  48. static const char brcmf_version[] =
  49. "Dongle Host Driver, version " BRCMF_VERSION_STR;
  50. #endif
  51. /* Message trace header */
  52. struct msgtrace_hdr {
  53. u8 version;
  54. u8 spare;
  55. __be16 len; /* Len of the trace */
  56. __be32 seqnum; /* Sequence number of message. Useful
  57. * if the messsage has been lost
  58. * because of DMA error or a bus reset
  59. * (ex: SDIO Func2)
  60. */
  61. __be32 discarded_bytes; /* Number of discarded bytes because of
  62. trace overflow */
  63. __be32 discarded_printf; /* Number of discarded printf
  64. because of trace overflow */
  65. } __packed;
  66. uint
  67. brcmf_c_mkiovar(char *name, char *data, uint datalen, char *buf, uint buflen)
  68. {
  69. uint len;
  70. len = strlen(name) + 1;
  71. if ((len + datalen) > buflen)
  72. return 0;
  73. strncpy(buf, name, buflen);
  74. /* append data onto the end of the name string */
  75. if (data && datalen) {
  76. memcpy(&buf[len], data, datalen);
  77. len += datalen;
  78. }
  79. return len;
  80. }
  81. bool brcmf_c_prec_enq(struct device *dev, struct pktq *q,
  82. struct sk_buff *pkt, int prec)
  83. {
  84. struct sk_buff *p;
  85. int eprec = -1; /* precedence to evict from */
  86. bool discard_oldest;
  87. struct brcmf_bus *bus_if = dev_get_drvdata(dev);
  88. struct brcmf_pub *drvr = bus_if->drvr;
  89. /* Fast case, precedence queue is not full and we are also not
  90. * exceeding total queue length
  91. */
  92. if (!pktq_pfull(q, prec) && !pktq_full(q)) {
  93. brcmu_pktq_penq(q, prec, pkt);
  94. return true;
  95. }
  96. /* Determine precedence from which to evict packet, if any */
  97. if (pktq_pfull(q, prec))
  98. eprec = prec;
  99. else if (pktq_full(q)) {
  100. p = brcmu_pktq_peek_tail(q, &eprec);
  101. if (eprec > prec)
  102. return false;
  103. }
  104. /* Evict if needed */
  105. if (eprec >= 0) {
  106. /* Detect queueing to unconfigured precedence */
  107. discard_oldest = ac_bitmap_tst(drvr->wme_dp, eprec);
  108. if (eprec == prec && !discard_oldest)
  109. return false; /* refuse newer (incoming) packet */
  110. /* Evict packet according to discard policy */
  111. p = discard_oldest ? brcmu_pktq_pdeq(q, eprec) :
  112. brcmu_pktq_pdeq_tail(q, eprec);
  113. if (p == NULL)
  114. brcmf_dbg(ERROR, "brcmu_pktq_penq() failed, oldest %d\n",
  115. discard_oldest);
  116. brcmu_pkt_buf_free_skb(p);
  117. }
  118. /* Enqueue */
  119. p = brcmu_pktq_penq(q, prec, pkt);
  120. if (p == NULL)
  121. brcmf_dbg(ERROR, "brcmu_pktq_penq() failed\n");
  122. return p != NULL;
  123. }
  124. #ifdef DEBUG
  125. static void
  126. brcmf_c_show_host_event(struct brcmf_event_msg *event, void *event_data)
  127. {
  128. uint i, status, reason;
  129. bool group = false, flush_txq = false, link = false;
  130. char *auth_str, *event_name;
  131. unsigned char *buf;
  132. char err_msg[256], eabuf[ETHER_ADDR_STR_LEN];
  133. static struct {
  134. uint event;
  135. char *event_name;
  136. } event_names[] = {
  137. {
  138. BRCMF_E_SET_SSID, "SET_SSID"}, {
  139. BRCMF_E_JOIN, "JOIN"}, {
  140. BRCMF_E_START, "START"}, {
  141. BRCMF_E_AUTH, "AUTH"}, {
  142. BRCMF_E_AUTH_IND, "AUTH_IND"}, {
  143. BRCMF_E_DEAUTH, "DEAUTH"}, {
  144. BRCMF_E_DEAUTH_IND, "DEAUTH_IND"}, {
  145. BRCMF_E_ASSOC, "ASSOC"}, {
  146. BRCMF_E_ASSOC_IND, "ASSOC_IND"}, {
  147. BRCMF_E_REASSOC, "REASSOC"}, {
  148. BRCMF_E_REASSOC_IND, "REASSOC_IND"}, {
  149. BRCMF_E_DISASSOC, "DISASSOC"}, {
  150. BRCMF_E_DISASSOC_IND, "DISASSOC_IND"}, {
  151. BRCMF_E_QUIET_START, "START_QUIET"}, {
  152. BRCMF_E_QUIET_END, "END_QUIET"}, {
  153. BRCMF_E_BEACON_RX, "BEACON_RX"}, {
  154. BRCMF_E_LINK, "LINK"}, {
  155. BRCMF_E_MIC_ERROR, "MIC_ERROR"}, {
  156. BRCMF_E_NDIS_LINK, "NDIS_LINK"}, {
  157. BRCMF_E_ROAM, "ROAM"}, {
  158. BRCMF_E_TXFAIL, "TXFAIL"}, {
  159. BRCMF_E_PMKID_CACHE, "PMKID_CACHE"}, {
  160. BRCMF_E_RETROGRADE_TSF, "RETROGRADE_TSF"}, {
  161. BRCMF_E_PRUNE, "PRUNE"}, {
  162. BRCMF_E_AUTOAUTH, "AUTOAUTH"}, {
  163. BRCMF_E_EAPOL_MSG, "EAPOL_MSG"}, {
  164. BRCMF_E_SCAN_COMPLETE, "SCAN_COMPLETE"}, {
  165. BRCMF_E_ADDTS_IND, "ADDTS_IND"}, {
  166. BRCMF_E_DELTS_IND, "DELTS_IND"}, {
  167. BRCMF_E_BCNSENT_IND, "BCNSENT_IND"}, {
  168. BRCMF_E_BCNRX_MSG, "BCNRX_MSG"}, {
  169. BRCMF_E_BCNLOST_MSG, "BCNLOST_MSG"}, {
  170. BRCMF_E_ROAM_PREP, "ROAM_PREP"}, {
  171. BRCMF_E_PFN_NET_FOUND, "PNO_NET_FOUND"}, {
  172. BRCMF_E_PFN_NET_LOST, "PNO_NET_LOST"}, {
  173. BRCMF_E_RESET_COMPLETE, "RESET_COMPLETE"}, {
  174. BRCMF_E_JOIN_START, "JOIN_START"}, {
  175. BRCMF_E_ROAM_START, "ROAM_START"}, {
  176. BRCMF_E_ASSOC_START, "ASSOC_START"}, {
  177. BRCMF_E_IBSS_ASSOC, "IBSS_ASSOC"}, {
  178. BRCMF_E_RADIO, "RADIO"}, {
  179. BRCMF_E_PSM_WATCHDOG, "PSM_WATCHDOG"}, {
  180. BRCMF_E_PROBREQ_MSG, "PROBREQ_MSG"}, {
  181. BRCMF_E_SCAN_CONFIRM_IND, "SCAN_CONFIRM_IND"}, {
  182. BRCMF_E_PSK_SUP, "PSK_SUP"}, {
  183. BRCMF_E_COUNTRY_CODE_CHANGED, "COUNTRY_CODE_CHANGED"}, {
  184. BRCMF_E_EXCEEDED_MEDIUM_TIME, "EXCEEDED_MEDIUM_TIME"}, {
  185. BRCMF_E_ICV_ERROR, "ICV_ERROR"}, {
  186. BRCMF_E_UNICAST_DECODE_ERROR, "UNICAST_DECODE_ERROR"}, {
  187. BRCMF_E_MULTICAST_DECODE_ERROR, "MULTICAST_DECODE_ERROR"}, {
  188. BRCMF_E_TRACE, "TRACE"}, {
  189. BRCMF_E_ACTION_FRAME, "ACTION FRAME"}, {
  190. BRCMF_E_ACTION_FRAME_COMPLETE, "ACTION FRAME TX COMPLETE"}, {
  191. BRCMF_E_IF, "IF"}, {
  192. BRCMF_E_RSSI, "RSSI"}, {
  193. BRCMF_E_PFN_SCAN_COMPLETE, "SCAN_COMPLETE"}, {
  194. BRCMF_E_ESCAN_RESULT, "ESCAN_RESULT"}
  195. };
  196. uint event_type, flags, auth_type, datalen;
  197. static u32 seqnum_prev;
  198. struct msgtrace_hdr hdr;
  199. u32 nblost;
  200. char *s, *p;
  201. event_type = be32_to_cpu(event->event_type);
  202. flags = be16_to_cpu(event->flags);
  203. status = be32_to_cpu(event->status);
  204. reason = be32_to_cpu(event->reason);
  205. auth_type = be32_to_cpu(event->auth_type);
  206. datalen = be32_to_cpu(event->datalen);
  207. /* debug dump of event messages */
  208. sprintf(eabuf, "%pM", event->addr);
  209. event_name = "UNKNOWN";
  210. for (i = 0; i < ARRAY_SIZE(event_names); i++) {
  211. if (event_names[i].event == event_type)
  212. event_name = event_names[i].event_name;
  213. }
  214. brcmf_dbg(EVENT, "EVENT: %s, event ID = %d\n", event_name, event_type);
  215. brcmf_dbg(EVENT, "flags 0x%04x, status %d, reason %d, auth_type %d MAC %s\n",
  216. flags, status, reason, auth_type, eabuf);
  217. if (flags & BRCMF_EVENT_MSG_LINK)
  218. link = true;
  219. if (flags & BRCMF_EVENT_MSG_GROUP)
  220. group = true;
  221. if (flags & BRCMF_EVENT_MSG_FLUSHTXQ)
  222. flush_txq = true;
  223. switch (event_type) {
  224. case BRCMF_E_START:
  225. case BRCMF_E_DEAUTH:
  226. case BRCMF_E_DISASSOC:
  227. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s\n", event_name, eabuf);
  228. break;
  229. case BRCMF_E_ASSOC_IND:
  230. case BRCMF_E_REASSOC_IND:
  231. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s\n", event_name, eabuf);
  232. break;
  233. case BRCMF_E_ASSOC:
  234. case BRCMF_E_REASSOC:
  235. if (status == BRCMF_E_STATUS_SUCCESS)
  236. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, SUCCESS\n",
  237. event_name, eabuf);
  238. else if (status == BRCMF_E_STATUS_TIMEOUT)
  239. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, TIMEOUT\n",
  240. event_name, eabuf);
  241. else if (status == BRCMF_E_STATUS_FAIL)
  242. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, FAILURE, reason %d\n",
  243. event_name, eabuf, (int)reason);
  244. else
  245. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, unexpected status %d\n",
  246. event_name, eabuf, (int)status);
  247. break;
  248. case BRCMF_E_DEAUTH_IND:
  249. case BRCMF_E_DISASSOC_IND:
  250. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, reason %d\n",
  251. event_name, eabuf, (int)reason);
  252. break;
  253. case BRCMF_E_AUTH:
  254. case BRCMF_E_AUTH_IND:
  255. if (auth_type == WLAN_AUTH_OPEN)
  256. auth_str = "Open System";
  257. else if (auth_type == WLAN_AUTH_SHARED_KEY)
  258. auth_str = "Shared Key";
  259. else {
  260. sprintf(err_msg, "AUTH unknown: %d", (int)auth_type);
  261. auth_str = err_msg;
  262. }
  263. if (event_type == BRCMF_E_AUTH_IND)
  264. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, %s\n",
  265. event_name, eabuf, auth_str);
  266. else if (status == BRCMF_E_STATUS_SUCCESS)
  267. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, %s, SUCCESS\n",
  268. event_name, eabuf, auth_str);
  269. else if (status == BRCMF_E_STATUS_TIMEOUT)
  270. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, %s, TIMEOUT\n",
  271. event_name, eabuf, auth_str);
  272. else if (status == BRCMF_E_STATUS_FAIL) {
  273. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, %s, FAILURE, reason %d\n",
  274. event_name, eabuf, auth_str, (int)reason);
  275. }
  276. break;
  277. case BRCMF_E_JOIN:
  278. case BRCMF_E_ROAM:
  279. case BRCMF_E_SET_SSID:
  280. if (status == BRCMF_E_STATUS_SUCCESS)
  281. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s\n",
  282. event_name, eabuf);
  283. else if (status == BRCMF_E_STATUS_FAIL)
  284. brcmf_dbg(EVENT, "MACEVENT: %s, failed\n", event_name);
  285. else if (status == BRCMF_E_STATUS_NO_NETWORKS)
  286. brcmf_dbg(EVENT, "MACEVENT: %s, no networks found\n",
  287. event_name);
  288. else
  289. brcmf_dbg(EVENT, "MACEVENT: %s, unexpected status %d\n",
  290. event_name, (int)status);
  291. break;
  292. case BRCMF_E_BEACON_RX:
  293. if (status == BRCMF_E_STATUS_SUCCESS)
  294. brcmf_dbg(EVENT, "MACEVENT: %s, SUCCESS\n", event_name);
  295. else if (status == BRCMF_E_STATUS_FAIL)
  296. brcmf_dbg(EVENT, "MACEVENT: %s, FAIL\n", event_name);
  297. else
  298. brcmf_dbg(EVENT, "MACEVENT: %s, status %d\n",
  299. event_name, status);
  300. break;
  301. case BRCMF_E_LINK:
  302. brcmf_dbg(EVENT, "MACEVENT: %s %s\n",
  303. event_name, link ? "UP" : "DOWN");
  304. break;
  305. case BRCMF_E_MIC_ERROR:
  306. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s, Group %d, Flush %d\n",
  307. event_name, eabuf, group, flush_txq);
  308. break;
  309. case BRCMF_E_ICV_ERROR:
  310. case BRCMF_E_UNICAST_DECODE_ERROR:
  311. case BRCMF_E_MULTICAST_DECODE_ERROR:
  312. brcmf_dbg(EVENT, "MACEVENT: %s, MAC %s\n", event_name, eabuf);
  313. break;
  314. case BRCMF_E_TXFAIL:
  315. brcmf_dbg(EVENT, "MACEVENT: %s, RA %s\n", event_name, eabuf);
  316. break;
  317. case BRCMF_E_SCAN_COMPLETE:
  318. case BRCMF_E_PMKID_CACHE:
  319. brcmf_dbg(EVENT, "MACEVENT: %s\n", event_name);
  320. break;
  321. case BRCMF_E_ESCAN_RESULT:
  322. brcmf_dbg(EVENT, "MACEVENT: %s\n", event_name);
  323. datalen = 0;
  324. break;
  325. case BRCMF_E_PFN_NET_FOUND:
  326. case BRCMF_E_PFN_NET_LOST:
  327. case BRCMF_E_PFN_SCAN_COMPLETE:
  328. brcmf_dbg(EVENT, "PNOEVENT: %s\n", event_name);
  329. break;
  330. case BRCMF_E_PSK_SUP:
  331. case BRCMF_E_PRUNE:
  332. brcmf_dbg(EVENT, "MACEVENT: %s, status %d, reason %d\n",
  333. event_name, (int)status, (int)reason);
  334. break;
  335. case BRCMF_E_TRACE:
  336. buf = (unsigned char *) event_data;
  337. memcpy(&hdr, buf, sizeof(struct msgtrace_hdr));
  338. if (hdr.version != MSGTRACE_VERSION) {
  339. brcmf_dbg(ERROR,
  340. "MACEVENT: %s [unsupported version --> brcmf"
  341. " version:%d dongle version:%d]\n",
  342. event_name, MSGTRACE_VERSION, hdr.version);
  343. /* Reset datalen to avoid display below */
  344. datalen = 0;
  345. break;
  346. }
  347. /* There are 2 bytes available at the end of data */
  348. *(buf + sizeof(struct msgtrace_hdr)
  349. + be16_to_cpu(hdr.len)) = '\0';
  350. if (be32_to_cpu(hdr.discarded_bytes)
  351. || be32_to_cpu(hdr.discarded_printf))
  352. brcmf_dbg(ERROR,
  353. "WLC_E_TRACE: [Discarded traces in dongle -->"
  354. " discarded_bytes %d discarded_printf %d]\n",
  355. be32_to_cpu(hdr.discarded_bytes),
  356. be32_to_cpu(hdr.discarded_printf));
  357. nblost = be32_to_cpu(hdr.seqnum) - seqnum_prev - 1;
  358. if (nblost > 0)
  359. brcmf_dbg(ERROR, "WLC_E_TRACE: [Event lost --> seqnum "
  360. " %d nblost %d\n", be32_to_cpu(hdr.seqnum),
  361. nblost);
  362. seqnum_prev = be32_to_cpu(hdr.seqnum);
  363. /* Display the trace buffer. Advance from \n to \n to
  364. * avoid display big
  365. * printf (issue with Linux printk )
  366. */
  367. p = (char *)&buf[sizeof(struct msgtrace_hdr)];
  368. while ((s = strstr(p, "\n")) != NULL) {
  369. *s = '\0';
  370. pr_debug("%s\n", p);
  371. p = s + 1;
  372. }
  373. pr_debug("%s\n", p);
  374. /* Reset datalen to avoid display below */
  375. datalen = 0;
  376. break;
  377. case BRCMF_E_RSSI:
  378. brcmf_dbg(EVENT, "MACEVENT: %s %d\n",
  379. event_name, be32_to_cpu(*((__be32 *)event_data)));
  380. break;
  381. default:
  382. brcmf_dbg(EVENT,
  383. "MACEVENT: %s %d, MAC %s, status %d, reason %d, "
  384. "auth %d\n", event_name, event_type, eabuf,
  385. (int)status, (int)reason, (int)auth_type);
  386. break;
  387. }
  388. /* show any appended data */
  389. brcmf_dbg_hex_dump(datalen, event_data, datalen, "Received data");
  390. }
  391. #endif /* DEBUG */
  392. int
  393. brcmf_c_host_event(struct brcmf_pub *drvr, int *ifidx, void *pktdata,
  394. struct brcmf_event_msg *event, void **data_ptr)
  395. {
  396. /* check whether packet is a BRCM event pkt */
  397. struct brcmf_event *pvt_data = (struct brcmf_event *) pktdata;
  398. struct brcmf_if_event *ifevent;
  399. struct brcmf_if *ifp;
  400. char *event_data;
  401. u32 type, status;
  402. u16 flags;
  403. int evlen;
  404. if (memcmp(BRCM_OUI, &pvt_data->hdr.oui[0], DOT11_OUI_LEN)) {
  405. brcmf_dbg(ERROR, "mismatched OUI, bailing\n");
  406. return -EBADE;
  407. }
  408. /* BRCM event pkt may be unaligned - use xxx_ua to load user_subtype. */
  409. if (get_unaligned_be16(&pvt_data->hdr.usr_subtype) !=
  410. BCMILCP_BCM_SUBTYPE_EVENT) {
  411. brcmf_dbg(ERROR, "mismatched subtype, bailing\n");
  412. return -EBADE;
  413. }
  414. *data_ptr = &pvt_data[1];
  415. event_data = *data_ptr;
  416. /* memcpy since BRCM event pkt may be unaligned. */
  417. memcpy(event, &pvt_data->msg, sizeof(struct brcmf_event_msg));
  418. type = get_unaligned_be32(&event->event_type);
  419. flags = get_unaligned_be16(&event->flags);
  420. status = get_unaligned_be32(&event->status);
  421. evlen = get_unaligned_be32(&event->datalen) +
  422. sizeof(struct brcmf_event);
  423. switch (type) {
  424. case BRCMF_E_IF:
  425. ifevent = (struct brcmf_if_event *) event_data;
  426. brcmf_dbg(TRACE, "if event\n");
  427. if (ifevent->ifidx > 0 && ifevent->ifidx < BRCMF_MAX_IFS) {
  428. if (ifevent->action == BRCMF_E_IF_ADD) {
  429. ifp = brcmf_add_if(drvr->dev, ifevent->ifidx,
  430. ifevent->bssidx,
  431. event->ifname,
  432. pvt_data->eth.h_dest);
  433. if (IS_ERR(ifp))
  434. return PTR_ERR(ifp);
  435. brcmf_net_attach(ifp);
  436. } else {
  437. brcmf_del_if(drvr, ifevent->ifidx);
  438. }
  439. } else {
  440. brcmf_dbg(ERROR, "Invalid ifidx %d for %s\n",
  441. ifevent->ifidx, event->ifname);
  442. }
  443. /* send up the if event: btamp user needs it */
  444. *ifidx = brcmf_ifname2idx(drvr, event->ifname);
  445. break;
  446. /* These are what external supplicant/authenticator wants */
  447. case BRCMF_E_LINK:
  448. case BRCMF_E_ASSOC_IND:
  449. case BRCMF_E_REASSOC_IND:
  450. case BRCMF_E_DISASSOC_IND:
  451. case BRCMF_E_MIC_ERROR:
  452. default:
  453. /* Fall through: this should get _everything_ */
  454. *ifidx = brcmf_ifname2idx(drvr, event->ifname);
  455. brcmf_dbg(TRACE, "MAC event %d, flags %x, status %x\n",
  456. type, flags, status);
  457. /* put it back to BRCMF_E_NDIS_LINK */
  458. if (type == BRCMF_E_NDIS_LINK) {
  459. u32 temp1;
  460. __be32 temp2;
  461. temp1 = get_unaligned_be32(&event->event_type);
  462. brcmf_dbg(TRACE, "Converted to WLC_E_LINK type %d\n",
  463. temp1);
  464. temp2 = cpu_to_be32(BRCMF_E_NDIS_LINK);
  465. memcpy((void *)(&pvt_data->msg.event_type), &temp2,
  466. sizeof(pvt_data->msg.event_type));
  467. }
  468. break;
  469. }
  470. #ifdef DEBUG
  471. if (BRCMF_EVENT_ON())
  472. brcmf_c_show_host_event(event, event_data);
  473. #endif /* DEBUG */
  474. return 0;
  475. }
  476. /* Convert user's input in hex pattern to byte-size mask */
  477. static int brcmf_c_pattern_atoh(char *src, char *dst)
  478. {
  479. int i;
  480. if (strncmp(src, "0x", 2) != 0 && strncmp(src, "0X", 2) != 0) {
  481. brcmf_dbg(ERROR, "Mask invalid format. Needs to start with 0x\n");
  482. return -EINVAL;
  483. }
  484. src = src + 2; /* Skip past 0x */
  485. if (strlen(src) % 2 != 0) {
  486. brcmf_dbg(ERROR, "Mask invalid format. Length must be even.\n");
  487. return -EINVAL;
  488. }
  489. for (i = 0; *src != '\0'; i++) {
  490. unsigned long res;
  491. char num[3];
  492. strncpy(num, src, 2);
  493. num[2] = '\0';
  494. if (kstrtoul(num, 16, &res))
  495. return -EINVAL;
  496. dst[i] = (u8)res;
  497. src += 2;
  498. }
  499. return i;
  500. }
  501. static void
  502. brcmf_c_pktfilter_offload_enable(struct brcmf_if *ifp, char *arg, int enable,
  503. int master_mode)
  504. {
  505. unsigned long res;
  506. char *argv;
  507. char *arg_save = NULL, *arg_org = NULL;
  508. s32 err;
  509. struct brcmf_pkt_filter_enable_le enable_parm;
  510. arg_save = kstrdup(arg, GFP_ATOMIC);
  511. if (!arg_save)
  512. goto fail;
  513. arg_org = arg_save;
  514. argv = strsep(&arg_save, " ");
  515. if (argv == NULL) {
  516. brcmf_dbg(ERROR, "No args provided\n");
  517. goto fail;
  518. }
  519. /* Parse packet filter id. */
  520. enable_parm.id = 0;
  521. if (!kstrtoul(argv, 0, &res))
  522. enable_parm.id = cpu_to_le32((u32)res);
  523. /* Enable/disable the specified filter. */
  524. enable_parm.enable = cpu_to_le32(enable);
  525. err = brcmf_fil_iovar_data_set(ifp, "pkt_filter_enable", &enable_parm,
  526. sizeof(enable_parm));
  527. if (err)
  528. brcmf_dbg(ERROR, "Set pkt_filter_enable error (%d)\n", err);
  529. /* Control the master mode */
  530. err = brcmf_fil_iovar_int_set(ifp, "pkt_filter_mode", master_mode);
  531. if (err)
  532. brcmf_dbg(ERROR, "Set pkt_filter_mode error (%d)\n", err);
  533. fail:
  534. kfree(arg_org);
  535. }
  536. static void brcmf_c_pktfilter_offload_set(struct brcmf_if *ifp, char *arg)
  537. {
  538. struct brcmf_pkt_filter_le *pkt_filter;
  539. unsigned long res;
  540. int buf_len;
  541. s32 err;
  542. u32 mask_size;
  543. u32 pattern_size;
  544. char *argv[8], *buf = NULL;
  545. int i = 0;
  546. char *arg_save = NULL, *arg_org = NULL;
  547. arg_save = kstrdup(arg, GFP_ATOMIC);
  548. if (!arg_save)
  549. goto fail;
  550. arg_org = arg_save;
  551. buf = kmalloc(PKTFILTER_BUF_SIZE, GFP_ATOMIC);
  552. if (!buf)
  553. goto fail;
  554. argv[i] = strsep(&arg_save, " ");
  555. while (argv[i]) {
  556. i++;
  557. if (i >= 8) {
  558. brcmf_dbg(ERROR, "Too many parameters\n");
  559. goto fail;
  560. }
  561. argv[i] = strsep(&arg_save, " ");
  562. }
  563. if (i != 6) {
  564. brcmf_dbg(ERROR, "Not enough args provided %d\n", i);
  565. goto fail;
  566. }
  567. pkt_filter = (struct brcmf_pkt_filter_le *)buf;
  568. /* Parse packet filter id. */
  569. pkt_filter->id = 0;
  570. if (!kstrtoul(argv[0], 0, &res))
  571. pkt_filter->id = cpu_to_le32((u32)res);
  572. /* Parse filter polarity. */
  573. pkt_filter->negate_match = 0;
  574. if (!kstrtoul(argv[1], 0, &res))
  575. pkt_filter->negate_match = cpu_to_le32((u32)res);
  576. /* Parse filter type. */
  577. pkt_filter->type = 0;
  578. if (!kstrtoul(argv[2], 0, &res))
  579. pkt_filter->type = cpu_to_le32((u32)res);
  580. /* Parse pattern filter offset. */
  581. pkt_filter->u.pattern.offset = 0;
  582. if (!kstrtoul(argv[3], 0, &res))
  583. pkt_filter->u.pattern.offset = cpu_to_le32((u32)res);
  584. /* Parse pattern filter mask. */
  585. mask_size = brcmf_c_pattern_atoh(argv[4],
  586. (char *)pkt_filter->u.pattern.mask_and_pattern);
  587. /* Parse pattern filter pattern. */
  588. pattern_size = brcmf_c_pattern_atoh(argv[5],
  589. (char *)&pkt_filter->u.pattern.mask_and_pattern[mask_size]);
  590. if (mask_size != pattern_size) {
  591. brcmf_dbg(ERROR, "Mask and pattern not the same size\n");
  592. goto fail;
  593. }
  594. pkt_filter->u.pattern.size_bytes = cpu_to_le32(mask_size);
  595. buf_len = sizeof(*pkt_filter);
  596. buf_len -= sizeof(pkt_filter->u.pattern.mask_and_pattern);
  597. buf_len += mask_size + pattern_size;
  598. err = brcmf_fil_iovar_data_set(ifp, "pkt_filter_add", pkt_filter,
  599. buf_len);
  600. if (err)
  601. brcmf_dbg(ERROR, "Set pkt_filter_add error (%d)\n", err);
  602. fail:
  603. kfree(arg_org);
  604. kfree(buf);
  605. }
  606. int brcmf_c_preinit_dcmds(struct brcmf_if *ifp)
  607. {
  608. s8 eventmask[BRCMF_EVENTING_MASK_LEN];
  609. u8 buf[BRCMF_DCMD_SMLEN];
  610. char *ptr;
  611. s32 err;
  612. struct brcmf_bus_dcmd *cmdlst;
  613. struct list_head *cur, *q;
  614. /* retreive mac address */
  615. err = brcmf_fil_iovar_data_get(ifp, "cur_etheraddr", ifp->mac_addr,
  616. sizeof(ifp->mac_addr));
  617. if (err < 0) {
  618. brcmf_dbg(ERROR, "Retreiving cur_etheraddr failed, %d\n",
  619. err);
  620. goto done;
  621. }
  622. memcpy(ifp->drvr->mac, ifp->mac_addr, sizeof(ifp->drvr->mac));
  623. /* query for 'ver' to get version info from firmware */
  624. memset(buf, 0, sizeof(buf));
  625. strcpy(buf, "ver");
  626. err = brcmf_fil_iovar_data_get(ifp, "ver", buf, sizeof(buf));
  627. if (err < 0) {
  628. brcmf_dbg(ERROR, "Retreiving version information failed, %d\n",
  629. err);
  630. goto done;
  631. }
  632. ptr = (char *)buf;
  633. strsep(&ptr, "\n");
  634. /* Print fw version info */
  635. brcmf_dbg(ERROR, "Firmware version = %s\n", buf);
  636. /*
  637. * Setup timeout if Beacons are lost and roam is off to report
  638. * link down
  639. */
  640. err = brcmf_fil_iovar_int_set(ifp, "bcn_timeout",
  641. BRCMF_DEFAULT_BCN_TIMEOUT);
  642. if (err) {
  643. brcmf_dbg(ERROR, "bcn_timeout error (%d)\n", err);
  644. goto done;
  645. }
  646. /* Enable/Disable build-in roaming to allowed ext supplicant to take
  647. * of romaing
  648. */
  649. err = brcmf_fil_iovar_int_set(ifp, "roam_off", 1);
  650. if (err) {
  651. brcmf_dbg(ERROR, "roam_off error (%d)\n", err);
  652. goto done;
  653. }
  654. /* Setup event_msgs, enable E_IF */
  655. err = brcmf_fil_iovar_data_get(ifp, "event_msgs", eventmask,
  656. BRCMF_EVENTING_MASK_LEN);
  657. if (err) {
  658. brcmf_dbg(ERROR, "Get event_msgs error (%d)\n", err);
  659. goto done;
  660. }
  661. setbit(eventmask, BRCMF_E_IF);
  662. err = brcmf_fil_iovar_data_set(ifp, "event_msgs", eventmask,
  663. BRCMF_EVENTING_MASK_LEN);
  664. if (err) {
  665. brcmf_dbg(ERROR, "Set event_msgs error (%d)\n", err);
  666. goto done;
  667. }
  668. /* Setup default scan channel time */
  669. err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_CHANNEL_TIME,
  670. BRCMF_DEFAULT_SCAN_CHANNEL_TIME);
  671. if (err) {
  672. brcmf_dbg(ERROR, "BRCMF_C_SET_SCAN_CHANNEL_TIME error (%d)\n",
  673. err);
  674. goto done;
  675. }
  676. /* Setup default scan unassoc time */
  677. err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_UNASSOC_TIME,
  678. BRCMF_DEFAULT_SCAN_UNASSOC_TIME);
  679. if (err) {
  680. brcmf_dbg(ERROR, "BRCMF_C_SET_SCAN_UNASSOC_TIME error (%d)\n",
  681. err);
  682. goto done;
  683. }
  684. /* Try to set and enable ARP offload feature, this may fail */
  685. err = brcmf_fil_iovar_int_set(ifp, "arp_ol", BRCMF_ARPOL_MODE);
  686. if (err) {
  687. brcmf_dbg(TRACE, "failed to set ARP offload mode to 0x%x, err = %d\n",
  688. BRCMF_ARPOL_MODE, err);
  689. err = 0;
  690. } else {
  691. err = brcmf_fil_iovar_int_set(ifp, "arpoe", 1);
  692. if (err) {
  693. brcmf_dbg(TRACE, "failed to enable ARP offload err = %d\n",
  694. err);
  695. err = 0;
  696. } else
  697. brcmf_dbg(TRACE, "successfully enabled ARP offload to 0x%x\n",
  698. BRCMF_ARPOL_MODE);
  699. }
  700. /* Setup packet filter */
  701. brcmf_c_pktfilter_offload_set(ifp, BRCMF_DEFAULT_PACKET_FILTER);
  702. brcmf_c_pktfilter_offload_enable(ifp, BRCMF_DEFAULT_PACKET_FILTER,
  703. 0, true);
  704. /* set bus specific command if there is any */
  705. list_for_each_safe(cur, q, &ifp->drvr->bus_if->dcmd_list) {
  706. cmdlst = list_entry(cur, struct brcmf_bus_dcmd, list);
  707. if (cmdlst->name && cmdlst->param && cmdlst->param_len) {
  708. brcmf_fil_iovar_data_set(ifp, cmdlst->name,
  709. cmdlst->param,
  710. cmdlst->param_len);
  711. }
  712. list_del(cur);
  713. kfree(cmdlst);
  714. }
  715. done:
  716. return err;
  717. }