dhd_common.c 26 KB

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