usb.c 37 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514
  1. /*
  2. * Copyright (c) 2011 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. #include <linux/kernel.h>
  17. #include <linux/module.h>
  18. #include <linux/firmware.h>
  19. #include <linux/usb.h>
  20. #include <linux/vmalloc.h>
  21. #include <brcmu_utils.h>
  22. #include <brcm_hw_ids.h>
  23. #include <brcmu_wifi.h>
  24. #include "bus.h"
  25. #include "debug.h"
  26. #include "firmware.h"
  27. #include "usb.h"
  28. #include "core.h"
  29. #include "common.h"
  30. #include "bcdc.h"
  31. #define IOCTL_RESP_TIMEOUT msecs_to_jiffies(2000)
  32. #define BRCMF_USB_RESET_GETVER_SPINWAIT 100 /* in unit of ms */
  33. #define BRCMF_USB_RESET_GETVER_LOOP_CNT 10
  34. #define BRCMF_POSTBOOT_ID 0xA123 /* ID to detect if dongle
  35. has boot up */
  36. #define BRCMF_USB_NRXQ 50
  37. #define BRCMF_USB_NTXQ 50
  38. #define BRCMF_USB_CBCTL_WRITE 0
  39. #define BRCMF_USB_CBCTL_READ 1
  40. #define BRCMF_USB_MAX_PKT_SIZE 1600
  41. BRCMF_FW_DEF(43143, "brcmfmac43143.bin");
  42. BRCMF_FW_DEF(43236B, "brcmfmac43236b.bin");
  43. BRCMF_FW_DEF(43242A, "brcmfmac43242a.bin");
  44. BRCMF_FW_DEF(43569, "brcmfmac43569.bin");
  45. static struct brcmf_firmware_mapping brcmf_usb_fwnames[] = {
  46. BRCMF_FW_ENTRY(BRCM_CC_43143_CHIP_ID, 0xFFFFFFFF, 43143),
  47. BRCMF_FW_ENTRY(BRCM_CC_43235_CHIP_ID, 0x00000008, 43236B),
  48. BRCMF_FW_ENTRY(BRCM_CC_43236_CHIP_ID, 0x00000008, 43236B),
  49. BRCMF_FW_ENTRY(BRCM_CC_43238_CHIP_ID, 0x00000008, 43236B),
  50. BRCMF_FW_ENTRY(BRCM_CC_43242_CHIP_ID, 0xFFFFFFFF, 43242A),
  51. BRCMF_FW_ENTRY(BRCM_CC_43566_CHIP_ID, 0xFFFFFFFF, 43569),
  52. BRCMF_FW_ENTRY(BRCM_CC_43569_CHIP_ID, 0xFFFFFFFF, 43569)
  53. };
  54. #define TRX_MAGIC 0x30524448 /* "HDR0" */
  55. #define TRX_MAX_OFFSET 3 /* Max number of file offsets */
  56. #define TRX_UNCOMP_IMAGE 0x20 /* Trx holds uncompressed img */
  57. #define TRX_RDL_CHUNK 1500 /* size of each dl transfer */
  58. #define TRX_OFFSETS_DLFWLEN_IDX 0
  59. /* Control messages: bRequest values */
  60. #define DL_GETSTATE 0 /* returns the rdl_state_t struct */
  61. #define DL_CHECK_CRC 1 /* currently unused */
  62. #define DL_GO 2 /* execute downloaded image */
  63. #define DL_START 3 /* initialize dl state */
  64. #define DL_REBOOT 4 /* reboot the device in 2 seconds */
  65. #define DL_GETVER 5 /* returns the bootrom_id_t struct */
  66. #define DL_GO_PROTECTED 6 /* execute the downloaded code and set reset
  67. * event to occur in 2 seconds. It is the
  68. * responsibility of the downloaded code to
  69. * clear this event
  70. */
  71. #define DL_EXEC 7 /* jump to a supplied address */
  72. #define DL_RESETCFG 8 /* To support single enum on dongle
  73. * - Not used by bootloader
  74. */
  75. #define DL_DEFER_RESP_OK 9 /* Potentially defer the response to setup
  76. * if resp unavailable
  77. */
  78. /* states */
  79. #define DL_WAITING 0 /* waiting to rx first pkt */
  80. #define DL_READY 1 /* hdr was good, waiting for more of the
  81. * compressed image
  82. */
  83. #define DL_BAD_HDR 2 /* hdr was corrupted */
  84. #define DL_BAD_CRC 3 /* compressed image was corrupted */
  85. #define DL_RUNNABLE 4 /* download was successful,waiting for go cmd */
  86. #define DL_START_FAIL 5 /* failed to initialize correctly */
  87. #define DL_NVRAM_TOOBIG 6 /* host specified nvram data exceeds DL_NVRAM
  88. * value
  89. */
  90. #define DL_IMAGE_TOOBIG 7 /* firmware image too big */
  91. struct trx_header_le {
  92. __le32 magic; /* "HDR0" */
  93. __le32 len; /* Length of file including header */
  94. __le32 crc32; /* CRC from flag_version to end of file */
  95. __le32 flag_version; /* 0:15 flags, 16:31 version */
  96. __le32 offsets[TRX_MAX_OFFSET]; /* Offsets of partitions from start of
  97. * header
  98. */
  99. };
  100. struct rdl_state_le {
  101. __le32 state;
  102. __le32 bytes;
  103. };
  104. struct bootrom_id_le {
  105. __le32 chip; /* Chip id */
  106. __le32 chiprev; /* Chip rev */
  107. __le32 ramsize; /* Size of RAM */
  108. __le32 remapbase; /* Current remap base address */
  109. __le32 boardtype; /* Type of board */
  110. __le32 boardrev; /* Board revision */
  111. };
  112. struct brcmf_usb_image {
  113. struct list_head list;
  114. s8 *fwname;
  115. u8 *image;
  116. int image_len;
  117. };
  118. struct brcmf_usbdev_info {
  119. struct brcmf_usbdev bus_pub; /* MUST BE FIRST */
  120. spinlock_t qlock;
  121. struct list_head rx_freeq;
  122. struct list_head rx_postq;
  123. struct list_head tx_freeq;
  124. struct list_head tx_postq;
  125. uint rx_pipe, tx_pipe;
  126. int rx_low_watermark;
  127. int tx_low_watermark;
  128. int tx_high_watermark;
  129. int tx_freecount;
  130. bool tx_flowblock;
  131. spinlock_t tx_flowblock_lock;
  132. struct brcmf_usbreq *tx_reqs;
  133. struct brcmf_usbreq *rx_reqs;
  134. char fw_name[BRCMF_FW_NAME_LEN];
  135. const u8 *image; /* buffer for combine fw and nvram */
  136. int image_len;
  137. struct usb_device *usbdev;
  138. struct device *dev;
  139. struct mutex dev_init_lock;
  140. int ctl_in_pipe, ctl_out_pipe;
  141. struct urb *ctl_urb; /* URB for control endpoint */
  142. struct usb_ctrlrequest ctl_write;
  143. struct usb_ctrlrequest ctl_read;
  144. u32 ctl_urb_actual_length;
  145. int ctl_urb_status;
  146. int ctl_completed;
  147. wait_queue_head_t ioctl_resp_wait;
  148. ulong ctl_op;
  149. u8 ifnum;
  150. struct urb *bulk_urb; /* used for FW download */
  151. bool wowl_enabled;
  152. struct brcmf_mp_device *settings;
  153. };
  154. static void brcmf_usb_rx_refill(struct brcmf_usbdev_info *devinfo,
  155. struct brcmf_usbreq *req);
  156. static struct brcmf_usbdev *brcmf_usb_get_buspub(struct device *dev)
  157. {
  158. struct brcmf_bus *bus_if = dev_get_drvdata(dev);
  159. return bus_if->bus_priv.usb;
  160. }
  161. static struct brcmf_usbdev_info *brcmf_usb_get_businfo(struct device *dev)
  162. {
  163. return brcmf_usb_get_buspub(dev)->devinfo;
  164. }
  165. static int brcmf_usb_ioctl_resp_wait(struct brcmf_usbdev_info *devinfo)
  166. {
  167. return wait_event_timeout(devinfo->ioctl_resp_wait,
  168. devinfo->ctl_completed, IOCTL_RESP_TIMEOUT);
  169. }
  170. static void brcmf_usb_ioctl_resp_wake(struct brcmf_usbdev_info *devinfo)
  171. {
  172. wake_up(&devinfo->ioctl_resp_wait);
  173. }
  174. static void
  175. brcmf_usb_ctl_complete(struct brcmf_usbdev_info *devinfo, int type, int status)
  176. {
  177. brcmf_dbg(USB, "Enter, status=%d\n", status);
  178. if (unlikely(devinfo == NULL))
  179. return;
  180. if (type == BRCMF_USB_CBCTL_READ) {
  181. if (status == 0)
  182. devinfo->bus_pub.stats.rx_ctlpkts++;
  183. else
  184. devinfo->bus_pub.stats.rx_ctlerrs++;
  185. } else if (type == BRCMF_USB_CBCTL_WRITE) {
  186. if (status == 0)
  187. devinfo->bus_pub.stats.tx_ctlpkts++;
  188. else
  189. devinfo->bus_pub.stats.tx_ctlerrs++;
  190. }
  191. devinfo->ctl_urb_status = status;
  192. devinfo->ctl_completed = true;
  193. brcmf_usb_ioctl_resp_wake(devinfo);
  194. }
  195. static void
  196. brcmf_usb_ctlread_complete(struct urb *urb)
  197. {
  198. struct brcmf_usbdev_info *devinfo =
  199. (struct brcmf_usbdev_info *)urb->context;
  200. brcmf_dbg(USB, "Enter\n");
  201. devinfo->ctl_urb_actual_length = urb->actual_length;
  202. brcmf_usb_ctl_complete(devinfo, BRCMF_USB_CBCTL_READ,
  203. urb->status);
  204. }
  205. static void
  206. brcmf_usb_ctlwrite_complete(struct urb *urb)
  207. {
  208. struct brcmf_usbdev_info *devinfo =
  209. (struct brcmf_usbdev_info *)urb->context;
  210. brcmf_dbg(USB, "Enter\n");
  211. brcmf_usb_ctl_complete(devinfo, BRCMF_USB_CBCTL_WRITE,
  212. urb->status);
  213. }
  214. static int
  215. brcmf_usb_send_ctl(struct brcmf_usbdev_info *devinfo, u8 *buf, int len)
  216. {
  217. int ret;
  218. u16 size;
  219. brcmf_dbg(USB, "Enter\n");
  220. if (devinfo == NULL || buf == NULL ||
  221. len == 0 || devinfo->ctl_urb == NULL)
  222. return -EINVAL;
  223. size = len;
  224. devinfo->ctl_write.wLength = cpu_to_le16p(&size);
  225. devinfo->ctl_urb->transfer_buffer_length = size;
  226. devinfo->ctl_urb_status = 0;
  227. devinfo->ctl_urb_actual_length = 0;
  228. usb_fill_control_urb(devinfo->ctl_urb,
  229. devinfo->usbdev,
  230. devinfo->ctl_out_pipe,
  231. (unsigned char *) &devinfo->ctl_write,
  232. buf, size,
  233. (usb_complete_t)brcmf_usb_ctlwrite_complete,
  234. devinfo);
  235. ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
  236. if (ret < 0)
  237. brcmf_err("usb_submit_urb failed %d\n", ret);
  238. return ret;
  239. }
  240. static int
  241. brcmf_usb_recv_ctl(struct brcmf_usbdev_info *devinfo, u8 *buf, int len)
  242. {
  243. int ret;
  244. u16 size;
  245. brcmf_dbg(USB, "Enter\n");
  246. if ((devinfo == NULL) || (buf == NULL) || (len == 0)
  247. || (devinfo->ctl_urb == NULL))
  248. return -EINVAL;
  249. size = len;
  250. devinfo->ctl_read.wLength = cpu_to_le16p(&size);
  251. devinfo->ctl_urb->transfer_buffer_length = size;
  252. devinfo->ctl_read.bRequestType = USB_DIR_IN
  253. | USB_TYPE_CLASS | USB_RECIP_INTERFACE;
  254. devinfo->ctl_read.bRequest = 1;
  255. usb_fill_control_urb(devinfo->ctl_urb,
  256. devinfo->usbdev,
  257. devinfo->ctl_in_pipe,
  258. (unsigned char *) &devinfo->ctl_read,
  259. buf, size,
  260. (usb_complete_t)brcmf_usb_ctlread_complete,
  261. devinfo);
  262. ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
  263. if (ret < 0)
  264. brcmf_err("usb_submit_urb failed %d\n", ret);
  265. return ret;
  266. }
  267. static int brcmf_usb_tx_ctlpkt(struct device *dev, u8 *buf, u32 len)
  268. {
  269. int err = 0;
  270. int timeout = 0;
  271. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
  272. brcmf_dbg(USB, "Enter\n");
  273. if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP)
  274. return -EIO;
  275. if (test_and_set_bit(0, &devinfo->ctl_op))
  276. return -EIO;
  277. devinfo->ctl_completed = false;
  278. err = brcmf_usb_send_ctl(devinfo, buf, len);
  279. if (err) {
  280. brcmf_err("fail %d bytes: %d\n", err, len);
  281. clear_bit(0, &devinfo->ctl_op);
  282. return err;
  283. }
  284. timeout = brcmf_usb_ioctl_resp_wait(devinfo);
  285. clear_bit(0, &devinfo->ctl_op);
  286. if (!timeout) {
  287. brcmf_err("Txctl wait timed out\n");
  288. err = -EIO;
  289. }
  290. return err;
  291. }
  292. static int brcmf_usb_rx_ctlpkt(struct device *dev, u8 *buf, u32 len)
  293. {
  294. int err = 0;
  295. int timeout = 0;
  296. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
  297. brcmf_dbg(USB, "Enter\n");
  298. if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP)
  299. return -EIO;
  300. if (test_and_set_bit(0, &devinfo->ctl_op))
  301. return -EIO;
  302. devinfo->ctl_completed = false;
  303. err = brcmf_usb_recv_ctl(devinfo, buf, len);
  304. if (err) {
  305. brcmf_err("fail %d bytes: %d\n", err, len);
  306. clear_bit(0, &devinfo->ctl_op);
  307. return err;
  308. }
  309. timeout = brcmf_usb_ioctl_resp_wait(devinfo);
  310. err = devinfo->ctl_urb_status;
  311. clear_bit(0, &devinfo->ctl_op);
  312. if (!timeout) {
  313. brcmf_err("rxctl wait timed out\n");
  314. err = -EIO;
  315. }
  316. if (!err)
  317. return devinfo->ctl_urb_actual_length;
  318. else
  319. return err;
  320. }
  321. static struct brcmf_usbreq *brcmf_usb_deq(struct brcmf_usbdev_info *devinfo,
  322. struct list_head *q, int *counter)
  323. {
  324. unsigned long flags;
  325. struct brcmf_usbreq *req;
  326. spin_lock_irqsave(&devinfo->qlock, flags);
  327. if (list_empty(q)) {
  328. spin_unlock_irqrestore(&devinfo->qlock, flags);
  329. return NULL;
  330. }
  331. req = list_entry(q->next, struct brcmf_usbreq, list);
  332. list_del_init(q->next);
  333. if (counter)
  334. (*counter)--;
  335. spin_unlock_irqrestore(&devinfo->qlock, flags);
  336. return req;
  337. }
  338. static void brcmf_usb_enq(struct brcmf_usbdev_info *devinfo,
  339. struct list_head *q, struct brcmf_usbreq *req,
  340. int *counter)
  341. {
  342. unsigned long flags;
  343. spin_lock_irqsave(&devinfo->qlock, flags);
  344. list_add_tail(&req->list, q);
  345. if (counter)
  346. (*counter)++;
  347. spin_unlock_irqrestore(&devinfo->qlock, flags);
  348. }
  349. static struct brcmf_usbreq *
  350. brcmf_usbdev_qinit(struct list_head *q, int qsize)
  351. {
  352. int i;
  353. struct brcmf_usbreq *req, *reqs;
  354. reqs = kcalloc(qsize, sizeof(struct brcmf_usbreq), GFP_ATOMIC);
  355. if (reqs == NULL)
  356. return NULL;
  357. req = reqs;
  358. for (i = 0; i < qsize; i++) {
  359. req->urb = usb_alloc_urb(0, GFP_ATOMIC);
  360. if (!req->urb)
  361. goto fail;
  362. INIT_LIST_HEAD(&req->list);
  363. list_add_tail(&req->list, q);
  364. req++;
  365. }
  366. return reqs;
  367. fail:
  368. brcmf_err("fail!\n");
  369. while (!list_empty(q)) {
  370. req = list_entry(q->next, struct brcmf_usbreq, list);
  371. if (req)
  372. usb_free_urb(req->urb);
  373. list_del(q->next);
  374. }
  375. return NULL;
  376. }
  377. static void brcmf_usb_free_q(struct list_head *q, bool pending)
  378. {
  379. struct brcmf_usbreq *req, *next;
  380. int i = 0;
  381. list_for_each_entry_safe(req, next, q, list) {
  382. if (!req->urb) {
  383. brcmf_err("bad req\n");
  384. break;
  385. }
  386. i++;
  387. if (pending) {
  388. usb_kill_urb(req->urb);
  389. } else {
  390. usb_free_urb(req->urb);
  391. list_del_init(&req->list);
  392. }
  393. }
  394. }
  395. static void brcmf_usb_del_fromq(struct brcmf_usbdev_info *devinfo,
  396. struct brcmf_usbreq *req)
  397. {
  398. unsigned long flags;
  399. spin_lock_irqsave(&devinfo->qlock, flags);
  400. list_del_init(&req->list);
  401. spin_unlock_irqrestore(&devinfo->qlock, flags);
  402. }
  403. static void brcmf_usb_tx_complete(struct urb *urb)
  404. {
  405. struct brcmf_usbreq *req = (struct brcmf_usbreq *)urb->context;
  406. struct brcmf_usbdev_info *devinfo = req->devinfo;
  407. unsigned long flags;
  408. brcmf_dbg(USB, "Enter, urb->status=%d, skb=%p\n", urb->status,
  409. req->skb);
  410. brcmf_usb_del_fromq(devinfo, req);
  411. brcmf_proto_bcdc_txcomplete(devinfo->dev, req->skb, urb->status == 0);
  412. req->skb = NULL;
  413. brcmf_usb_enq(devinfo, &devinfo->tx_freeq, req, &devinfo->tx_freecount);
  414. spin_lock_irqsave(&devinfo->tx_flowblock_lock, flags);
  415. if (devinfo->tx_freecount > devinfo->tx_high_watermark &&
  416. devinfo->tx_flowblock) {
  417. brcmf_proto_bcdc_txflowblock(devinfo->dev, false);
  418. devinfo->tx_flowblock = false;
  419. }
  420. spin_unlock_irqrestore(&devinfo->tx_flowblock_lock, flags);
  421. }
  422. static void brcmf_usb_rx_complete(struct urb *urb)
  423. {
  424. struct brcmf_usbreq *req = (struct brcmf_usbreq *)urb->context;
  425. struct brcmf_usbdev_info *devinfo = req->devinfo;
  426. struct sk_buff *skb;
  427. brcmf_dbg(USB, "Enter, urb->status=%d\n", urb->status);
  428. brcmf_usb_del_fromq(devinfo, req);
  429. skb = req->skb;
  430. req->skb = NULL;
  431. /* zero lenght packets indicate usb "failure". Do not refill */
  432. if (urb->status != 0 || !urb->actual_length) {
  433. brcmu_pkt_buf_free_skb(skb);
  434. brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
  435. return;
  436. }
  437. if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_UP) {
  438. skb_put(skb, urb->actual_length);
  439. brcmf_rx_frame(devinfo->dev, skb, true);
  440. brcmf_usb_rx_refill(devinfo, req);
  441. } else {
  442. brcmu_pkt_buf_free_skb(skb);
  443. brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
  444. }
  445. return;
  446. }
  447. static void brcmf_usb_rx_refill(struct brcmf_usbdev_info *devinfo,
  448. struct brcmf_usbreq *req)
  449. {
  450. struct sk_buff *skb;
  451. int ret;
  452. if (!req || !devinfo)
  453. return;
  454. skb = dev_alloc_skb(devinfo->bus_pub.bus_mtu);
  455. if (!skb) {
  456. brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
  457. return;
  458. }
  459. req->skb = skb;
  460. usb_fill_bulk_urb(req->urb, devinfo->usbdev, devinfo->rx_pipe,
  461. skb->data, skb_tailroom(skb), brcmf_usb_rx_complete,
  462. req);
  463. req->devinfo = devinfo;
  464. brcmf_usb_enq(devinfo, &devinfo->rx_postq, req, NULL);
  465. ret = usb_submit_urb(req->urb, GFP_ATOMIC);
  466. if (ret) {
  467. brcmf_usb_del_fromq(devinfo, req);
  468. brcmu_pkt_buf_free_skb(req->skb);
  469. req->skb = NULL;
  470. brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
  471. }
  472. return;
  473. }
  474. static void brcmf_usb_rx_fill_all(struct brcmf_usbdev_info *devinfo)
  475. {
  476. struct brcmf_usbreq *req;
  477. if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP) {
  478. brcmf_err("bus is not up=%d\n", devinfo->bus_pub.state);
  479. return;
  480. }
  481. while ((req = brcmf_usb_deq(devinfo, &devinfo->rx_freeq, NULL)) != NULL)
  482. brcmf_usb_rx_refill(devinfo, req);
  483. }
  484. static void
  485. brcmf_usb_state_change(struct brcmf_usbdev_info *devinfo, int state)
  486. {
  487. struct brcmf_bus *bcmf_bus = devinfo->bus_pub.bus;
  488. int old_state;
  489. brcmf_dbg(USB, "Enter, current state=%d, new state=%d\n",
  490. devinfo->bus_pub.state, state);
  491. if (devinfo->bus_pub.state == state)
  492. return;
  493. old_state = devinfo->bus_pub.state;
  494. devinfo->bus_pub.state = state;
  495. /* update state of upper layer */
  496. if (state == BRCMFMAC_USB_STATE_DOWN) {
  497. brcmf_dbg(USB, "DBUS is down\n");
  498. brcmf_bus_change_state(bcmf_bus, BRCMF_BUS_DOWN);
  499. } else if (state == BRCMFMAC_USB_STATE_UP) {
  500. brcmf_dbg(USB, "DBUS is up\n");
  501. brcmf_bus_change_state(bcmf_bus, BRCMF_BUS_UP);
  502. } else {
  503. brcmf_dbg(USB, "DBUS current state=%d\n", state);
  504. }
  505. }
  506. static int brcmf_usb_tx(struct device *dev, struct sk_buff *skb)
  507. {
  508. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
  509. struct brcmf_usbreq *req;
  510. int ret;
  511. unsigned long flags;
  512. brcmf_dbg(USB, "Enter, skb=%p\n", skb);
  513. if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP) {
  514. ret = -EIO;
  515. goto fail;
  516. }
  517. req = brcmf_usb_deq(devinfo, &devinfo->tx_freeq,
  518. &devinfo->tx_freecount);
  519. if (!req) {
  520. brcmf_err("no req to send\n");
  521. ret = -ENOMEM;
  522. goto fail;
  523. }
  524. req->skb = skb;
  525. req->devinfo = devinfo;
  526. usb_fill_bulk_urb(req->urb, devinfo->usbdev, devinfo->tx_pipe,
  527. skb->data, skb->len, brcmf_usb_tx_complete, req);
  528. req->urb->transfer_flags |= URB_ZERO_PACKET;
  529. brcmf_usb_enq(devinfo, &devinfo->tx_postq, req, NULL);
  530. ret = usb_submit_urb(req->urb, GFP_ATOMIC);
  531. if (ret) {
  532. brcmf_err("brcmf_usb_tx usb_submit_urb FAILED\n");
  533. brcmf_usb_del_fromq(devinfo, req);
  534. req->skb = NULL;
  535. brcmf_usb_enq(devinfo, &devinfo->tx_freeq, req,
  536. &devinfo->tx_freecount);
  537. goto fail;
  538. }
  539. spin_lock_irqsave(&devinfo->tx_flowblock_lock, flags);
  540. if (devinfo->tx_freecount < devinfo->tx_low_watermark &&
  541. !devinfo->tx_flowblock) {
  542. brcmf_proto_bcdc_txflowblock(dev, true);
  543. devinfo->tx_flowblock = true;
  544. }
  545. spin_unlock_irqrestore(&devinfo->tx_flowblock_lock, flags);
  546. return 0;
  547. fail:
  548. return ret;
  549. }
  550. static int brcmf_usb_up(struct device *dev)
  551. {
  552. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
  553. brcmf_dbg(USB, "Enter\n");
  554. if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_UP)
  555. return 0;
  556. /* Success, indicate devinfo is fully up */
  557. brcmf_usb_state_change(devinfo, BRCMFMAC_USB_STATE_UP);
  558. if (devinfo->ctl_urb) {
  559. devinfo->ctl_in_pipe = usb_rcvctrlpipe(devinfo->usbdev, 0);
  560. devinfo->ctl_out_pipe = usb_sndctrlpipe(devinfo->usbdev, 0);
  561. /* CTL Write */
  562. devinfo->ctl_write.bRequestType =
  563. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE;
  564. devinfo->ctl_write.bRequest = 0;
  565. devinfo->ctl_write.wValue = cpu_to_le16(0);
  566. devinfo->ctl_write.wIndex = cpu_to_le16(devinfo->ifnum);
  567. /* CTL Read */
  568. devinfo->ctl_read.bRequestType =
  569. USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE;
  570. devinfo->ctl_read.bRequest = 1;
  571. devinfo->ctl_read.wValue = cpu_to_le16(0);
  572. devinfo->ctl_read.wIndex = cpu_to_le16(devinfo->ifnum);
  573. }
  574. brcmf_usb_rx_fill_all(devinfo);
  575. return 0;
  576. }
  577. static void brcmf_cancel_all_urbs(struct brcmf_usbdev_info *devinfo)
  578. {
  579. if (devinfo->ctl_urb)
  580. usb_kill_urb(devinfo->ctl_urb);
  581. if (devinfo->bulk_urb)
  582. usb_kill_urb(devinfo->bulk_urb);
  583. brcmf_usb_free_q(&devinfo->tx_postq, true);
  584. brcmf_usb_free_q(&devinfo->rx_postq, true);
  585. }
  586. static void brcmf_usb_down(struct device *dev)
  587. {
  588. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
  589. brcmf_dbg(USB, "Enter\n");
  590. if (devinfo == NULL)
  591. return;
  592. if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_DOWN)
  593. return;
  594. brcmf_usb_state_change(devinfo, BRCMFMAC_USB_STATE_DOWN);
  595. brcmf_cancel_all_urbs(devinfo);
  596. }
  597. static void
  598. brcmf_usb_sync_complete(struct urb *urb)
  599. {
  600. struct brcmf_usbdev_info *devinfo =
  601. (struct brcmf_usbdev_info *)urb->context;
  602. devinfo->ctl_completed = true;
  603. brcmf_usb_ioctl_resp_wake(devinfo);
  604. }
  605. static int brcmf_usb_dl_cmd(struct brcmf_usbdev_info *devinfo, u8 cmd,
  606. void *buffer, int buflen)
  607. {
  608. int ret;
  609. char *tmpbuf;
  610. u16 size;
  611. if ((!devinfo) || (devinfo->ctl_urb == NULL))
  612. return -EINVAL;
  613. tmpbuf = kmalloc(buflen, GFP_ATOMIC);
  614. if (!tmpbuf)
  615. return -ENOMEM;
  616. size = buflen;
  617. devinfo->ctl_urb->transfer_buffer_length = size;
  618. devinfo->ctl_read.wLength = cpu_to_le16p(&size);
  619. devinfo->ctl_read.bRequestType = USB_DIR_IN | USB_TYPE_VENDOR |
  620. USB_RECIP_INTERFACE;
  621. devinfo->ctl_read.bRequest = cmd;
  622. usb_fill_control_urb(devinfo->ctl_urb,
  623. devinfo->usbdev,
  624. usb_rcvctrlpipe(devinfo->usbdev, 0),
  625. (unsigned char *) &devinfo->ctl_read,
  626. (void *) tmpbuf, size,
  627. (usb_complete_t)brcmf_usb_sync_complete, devinfo);
  628. devinfo->ctl_completed = false;
  629. ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
  630. if (ret < 0) {
  631. brcmf_err("usb_submit_urb failed %d\n", ret);
  632. goto finalize;
  633. }
  634. if (!brcmf_usb_ioctl_resp_wait(devinfo)) {
  635. usb_kill_urb(devinfo->ctl_urb);
  636. ret = -ETIMEDOUT;
  637. } else {
  638. memcpy(buffer, tmpbuf, buflen);
  639. }
  640. finalize:
  641. kfree(tmpbuf);
  642. return ret;
  643. }
  644. static bool
  645. brcmf_usb_dlneeded(struct brcmf_usbdev_info *devinfo)
  646. {
  647. struct bootrom_id_le id;
  648. u32 chipid, chiprev;
  649. brcmf_dbg(USB, "Enter\n");
  650. if (devinfo == NULL)
  651. return false;
  652. /* Check if firmware downloaded already by querying runtime ID */
  653. id.chip = cpu_to_le32(0xDEAD);
  654. brcmf_usb_dl_cmd(devinfo, DL_GETVER, &id, sizeof(id));
  655. chipid = le32_to_cpu(id.chip);
  656. chiprev = le32_to_cpu(id.chiprev);
  657. if ((chipid & 0x4300) == 0x4300)
  658. brcmf_dbg(USB, "chip %x rev 0x%x\n", chipid, chiprev);
  659. else
  660. brcmf_dbg(USB, "chip %d rev 0x%x\n", chipid, chiprev);
  661. if (chipid == BRCMF_POSTBOOT_ID) {
  662. brcmf_dbg(USB, "firmware already downloaded\n");
  663. brcmf_usb_dl_cmd(devinfo, DL_RESETCFG, &id, sizeof(id));
  664. return false;
  665. } else {
  666. devinfo->bus_pub.devid = chipid;
  667. devinfo->bus_pub.chiprev = chiprev;
  668. }
  669. return true;
  670. }
  671. static int
  672. brcmf_usb_resetcfg(struct brcmf_usbdev_info *devinfo)
  673. {
  674. struct bootrom_id_le id;
  675. u32 loop_cnt;
  676. int err;
  677. brcmf_dbg(USB, "Enter\n");
  678. loop_cnt = 0;
  679. do {
  680. mdelay(BRCMF_USB_RESET_GETVER_SPINWAIT);
  681. loop_cnt++;
  682. id.chip = cpu_to_le32(0xDEAD); /* Get the ID */
  683. err = brcmf_usb_dl_cmd(devinfo, DL_GETVER, &id, sizeof(id));
  684. if ((err) && (err != -ETIMEDOUT))
  685. return err;
  686. if (id.chip == cpu_to_le32(BRCMF_POSTBOOT_ID))
  687. break;
  688. } while (loop_cnt < BRCMF_USB_RESET_GETVER_LOOP_CNT);
  689. if (id.chip == cpu_to_le32(BRCMF_POSTBOOT_ID)) {
  690. brcmf_dbg(USB, "postboot chip 0x%x/rev 0x%x\n",
  691. le32_to_cpu(id.chip), le32_to_cpu(id.chiprev));
  692. brcmf_usb_dl_cmd(devinfo, DL_RESETCFG, &id, sizeof(id));
  693. return 0;
  694. } else {
  695. brcmf_err("Cannot talk to Dongle. Firmware is not UP, %d ms\n",
  696. BRCMF_USB_RESET_GETVER_SPINWAIT * loop_cnt);
  697. return -EINVAL;
  698. }
  699. }
  700. static int
  701. brcmf_usb_dl_send_bulk(struct brcmf_usbdev_info *devinfo, void *buffer, int len)
  702. {
  703. int ret;
  704. if ((devinfo == NULL) || (devinfo->bulk_urb == NULL))
  705. return -EINVAL;
  706. /* Prepare the URB */
  707. usb_fill_bulk_urb(devinfo->bulk_urb, devinfo->usbdev,
  708. devinfo->tx_pipe, buffer, len,
  709. (usb_complete_t)brcmf_usb_sync_complete, devinfo);
  710. devinfo->bulk_urb->transfer_flags |= URB_ZERO_PACKET;
  711. devinfo->ctl_completed = false;
  712. ret = usb_submit_urb(devinfo->bulk_urb, GFP_ATOMIC);
  713. if (ret) {
  714. brcmf_err("usb_submit_urb failed %d\n", ret);
  715. return ret;
  716. }
  717. ret = brcmf_usb_ioctl_resp_wait(devinfo);
  718. return (ret == 0);
  719. }
  720. static int
  721. brcmf_usb_dl_writeimage(struct brcmf_usbdev_info *devinfo, u8 *fw, int fwlen)
  722. {
  723. unsigned int sendlen, sent, dllen;
  724. char *bulkchunk = NULL, *dlpos;
  725. struct rdl_state_le state;
  726. u32 rdlstate, rdlbytes;
  727. int err = 0;
  728. brcmf_dbg(USB, "Enter, fw %p, len %d\n", fw, fwlen);
  729. bulkchunk = kmalloc(TRX_RDL_CHUNK, GFP_ATOMIC);
  730. if (bulkchunk == NULL) {
  731. err = -ENOMEM;
  732. goto fail;
  733. }
  734. /* 1) Prepare USB boot loader for runtime image */
  735. brcmf_usb_dl_cmd(devinfo, DL_START, &state, sizeof(state));
  736. rdlstate = le32_to_cpu(state.state);
  737. rdlbytes = le32_to_cpu(state.bytes);
  738. /* 2) Check we are in the Waiting state */
  739. if (rdlstate != DL_WAITING) {
  740. brcmf_err("Failed to DL_START\n");
  741. err = -EINVAL;
  742. goto fail;
  743. }
  744. sent = 0;
  745. dlpos = fw;
  746. dllen = fwlen;
  747. /* Get chip id and rev */
  748. while (rdlbytes != dllen) {
  749. /* Wait until the usb device reports it received all
  750. * the bytes we sent */
  751. if ((rdlbytes == sent) && (rdlbytes != dllen)) {
  752. if ((dllen-sent) < TRX_RDL_CHUNK)
  753. sendlen = dllen-sent;
  754. else
  755. sendlen = TRX_RDL_CHUNK;
  756. /* simply avoid having to send a ZLP by ensuring we
  757. * never have an even
  758. * multiple of 64
  759. */
  760. if (!(sendlen % 64))
  761. sendlen -= 4;
  762. /* send data */
  763. memcpy(bulkchunk, dlpos, sendlen);
  764. if (brcmf_usb_dl_send_bulk(devinfo, bulkchunk,
  765. sendlen)) {
  766. brcmf_err("send_bulk failed\n");
  767. err = -EINVAL;
  768. goto fail;
  769. }
  770. dlpos += sendlen;
  771. sent += sendlen;
  772. }
  773. err = brcmf_usb_dl_cmd(devinfo, DL_GETSTATE, &state,
  774. sizeof(state));
  775. if (err) {
  776. brcmf_err("DL_GETSTATE Failed\n");
  777. goto fail;
  778. }
  779. rdlstate = le32_to_cpu(state.state);
  780. rdlbytes = le32_to_cpu(state.bytes);
  781. /* restart if an error is reported */
  782. if (rdlstate == DL_BAD_HDR || rdlstate == DL_BAD_CRC) {
  783. brcmf_err("Bad Hdr or Bad CRC state %d\n",
  784. rdlstate);
  785. err = -EINVAL;
  786. goto fail;
  787. }
  788. }
  789. fail:
  790. kfree(bulkchunk);
  791. brcmf_dbg(USB, "Exit, err=%d\n", err);
  792. return err;
  793. }
  794. static int brcmf_usb_dlstart(struct brcmf_usbdev_info *devinfo, u8 *fw, int len)
  795. {
  796. int err;
  797. brcmf_dbg(USB, "Enter\n");
  798. if (devinfo == NULL)
  799. return -EINVAL;
  800. if (devinfo->bus_pub.devid == 0xDEAD)
  801. return -EINVAL;
  802. err = brcmf_usb_dl_writeimage(devinfo, fw, len);
  803. if (err == 0)
  804. devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DL_DONE;
  805. else
  806. devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DL_FAIL;
  807. brcmf_dbg(USB, "Exit, err=%d\n", err);
  808. return err;
  809. }
  810. static int brcmf_usb_dlrun(struct brcmf_usbdev_info *devinfo)
  811. {
  812. struct rdl_state_le state;
  813. brcmf_dbg(USB, "Enter\n");
  814. if (!devinfo)
  815. return -EINVAL;
  816. if (devinfo->bus_pub.devid == 0xDEAD)
  817. return -EINVAL;
  818. /* Check we are runnable */
  819. state.state = 0;
  820. brcmf_usb_dl_cmd(devinfo, DL_GETSTATE, &state, sizeof(state));
  821. /* Start the image */
  822. if (state.state == cpu_to_le32(DL_RUNNABLE)) {
  823. if (brcmf_usb_dl_cmd(devinfo, DL_GO, &state, sizeof(state)))
  824. return -ENODEV;
  825. if (brcmf_usb_resetcfg(devinfo))
  826. return -ENODEV;
  827. /* The Dongle may go for re-enumeration. */
  828. } else {
  829. brcmf_err("Dongle not runnable\n");
  830. return -EINVAL;
  831. }
  832. brcmf_dbg(USB, "Exit\n");
  833. return 0;
  834. }
  835. static int
  836. brcmf_usb_fw_download(struct brcmf_usbdev_info *devinfo)
  837. {
  838. int err;
  839. brcmf_dbg(USB, "Enter\n");
  840. if (devinfo == NULL)
  841. return -ENODEV;
  842. if (!devinfo->image) {
  843. brcmf_err("No firmware!\n");
  844. return -ENOENT;
  845. }
  846. err = brcmf_usb_dlstart(devinfo,
  847. (u8 *)devinfo->image, devinfo->image_len);
  848. if (err == 0)
  849. err = brcmf_usb_dlrun(devinfo);
  850. return err;
  851. }
  852. static void brcmf_usb_detach(struct brcmf_usbdev_info *devinfo)
  853. {
  854. brcmf_dbg(USB, "Enter, devinfo %p\n", devinfo);
  855. /* free the URBS */
  856. brcmf_usb_free_q(&devinfo->rx_freeq, false);
  857. brcmf_usb_free_q(&devinfo->tx_freeq, false);
  858. usb_free_urb(devinfo->ctl_urb);
  859. usb_free_urb(devinfo->bulk_urb);
  860. kfree(devinfo->tx_reqs);
  861. kfree(devinfo->rx_reqs);
  862. if (devinfo->settings)
  863. brcmf_release_module_param(devinfo->settings);
  864. }
  865. static int check_file(const u8 *headers)
  866. {
  867. struct trx_header_le *trx;
  868. int actual_len = -1;
  869. brcmf_dbg(USB, "Enter\n");
  870. /* Extract trx header */
  871. trx = (struct trx_header_le *) headers;
  872. if (trx->magic != cpu_to_le32(TRX_MAGIC))
  873. return -1;
  874. headers += sizeof(struct trx_header_le);
  875. if (le32_to_cpu(trx->flag_version) & TRX_UNCOMP_IMAGE) {
  876. actual_len = le32_to_cpu(trx->offsets[TRX_OFFSETS_DLFWLEN_IDX]);
  877. return actual_len + sizeof(struct trx_header_le);
  878. }
  879. return -1;
  880. }
  881. static
  882. struct brcmf_usbdev *brcmf_usb_attach(struct brcmf_usbdev_info *devinfo,
  883. int nrxq, int ntxq)
  884. {
  885. brcmf_dbg(USB, "Enter\n");
  886. devinfo->bus_pub.nrxq = nrxq;
  887. devinfo->rx_low_watermark = nrxq / 2;
  888. devinfo->bus_pub.devinfo = devinfo;
  889. devinfo->bus_pub.ntxq = ntxq;
  890. devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DOWN;
  891. /* flow control when too many tx urbs posted */
  892. devinfo->tx_low_watermark = ntxq / 4;
  893. devinfo->tx_high_watermark = devinfo->tx_low_watermark * 3;
  894. devinfo->bus_pub.bus_mtu = BRCMF_USB_MAX_PKT_SIZE;
  895. /* Initialize other structure content */
  896. init_waitqueue_head(&devinfo->ioctl_resp_wait);
  897. /* Initialize the spinlocks */
  898. spin_lock_init(&devinfo->qlock);
  899. spin_lock_init(&devinfo->tx_flowblock_lock);
  900. INIT_LIST_HEAD(&devinfo->rx_freeq);
  901. INIT_LIST_HEAD(&devinfo->rx_postq);
  902. INIT_LIST_HEAD(&devinfo->tx_freeq);
  903. INIT_LIST_HEAD(&devinfo->tx_postq);
  904. devinfo->tx_flowblock = false;
  905. devinfo->rx_reqs = brcmf_usbdev_qinit(&devinfo->rx_freeq, nrxq);
  906. if (!devinfo->rx_reqs)
  907. goto error;
  908. devinfo->tx_reqs = brcmf_usbdev_qinit(&devinfo->tx_freeq, ntxq);
  909. if (!devinfo->tx_reqs)
  910. goto error;
  911. devinfo->tx_freecount = ntxq;
  912. devinfo->ctl_urb = usb_alloc_urb(0, GFP_ATOMIC);
  913. if (!devinfo->ctl_urb)
  914. goto error;
  915. devinfo->bulk_urb = usb_alloc_urb(0, GFP_ATOMIC);
  916. if (!devinfo->bulk_urb)
  917. goto error;
  918. return &devinfo->bus_pub;
  919. error:
  920. brcmf_err("failed!\n");
  921. brcmf_usb_detach(devinfo);
  922. return NULL;
  923. }
  924. static void brcmf_usb_wowl_config(struct device *dev, bool enabled)
  925. {
  926. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
  927. brcmf_dbg(USB, "Configuring WOWL, enabled=%d\n", enabled);
  928. devinfo->wowl_enabled = enabled;
  929. if (enabled)
  930. device_set_wakeup_enable(devinfo->dev, true);
  931. else
  932. device_set_wakeup_enable(devinfo->dev, false);
  933. }
  934. static const struct brcmf_bus_ops brcmf_usb_bus_ops = {
  935. .txdata = brcmf_usb_tx,
  936. .stop = brcmf_usb_down,
  937. .txctl = brcmf_usb_tx_ctlpkt,
  938. .rxctl = brcmf_usb_rx_ctlpkt,
  939. .wowl_config = brcmf_usb_wowl_config,
  940. };
  941. static int brcmf_usb_bus_setup(struct brcmf_usbdev_info *devinfo)
  942. {
  943. int ret;
  944. /* Attach to the common driver interface */
  945. ret = brcmf_attach(devinfo->dev, devinfo->settings);
  946. if (ret) {
  947. brcmf_err("brcmf_attach failed\n");
  948. return ret;
  949. }
  950. ret = brcmf_usb_up(devinfo->dev);
  951. if (ret)
  952. goto fail;
  953. ret = brcmf_bus_started(devinfo->dev);
  954. if (ret)
  955. goto fail;
  956. return 0;
  957. fail:
  958. brcmf_detach(devinfo->dev);
  959. return ret;
  960. }
  961. static void brcmf_usb_probe_phase2(struct device *dev,
  962. const struct firmware *fw,
  963. void *nvram, u32 nvlen)
  964. {
  965. struct brcmf_bus *bus = dev_get_drvdata(dev);
  966. struct brcmf_usbdev_info *devinfo;
  967. int ret;
  968. brcmf_dbg(USB, "Start fw downloading\n");
  969. devinfo = bus->bus_priv.usb->devinfo;
  970. ret = check_file(fw->data);
  971. if (ret < 0) {
  972. brcmf_err("invalid firmware\n");
  973. release_firmware(fw);
  974. goto error;
  975. }
  976. devinfo->image = fw->data;
  977. devinfo->image_len = fw->size;
  978. ret = brcmf_usb_fw_download(devinfo);
  979. release_firmware(fw);
  980. if (ret)
  981. goto error;
  982. ret = brcmf_usb_bus_setup(devinfo);
  983. if (ret)
  984. goto error;
  985. mutex_unlock(&devinfo->dev_init_lock);
  986. return;
  987. error:
  988. brcmf_dbg(TRACE, "failed: dev=%s, err=%d\n", dev_name(dev), ret);
  989. mutex_unlock(&devinfo->dev_init_lock);
  990. device_release_driver(dev);
  991. }
  992. static int brcmf_usb_probe_cb(struct brcmf_usbdev_info *devinfo)
  993. {
  994. struct brcmf_bus *bus = NULL;
  995. struct brcmf_usbdev *bus_pub = NULL;
  996. struct device *dev = devinfo->dev;
  997. int ret;
  998. brcmf_dbg(USB, "Enter\n");
  999. bus_pub = brcmf_usb_attach(devinfo, BRCMF_USB_NRXQ, BRCMF_USB_NTXQ);
  1000. if (!bus_pub)
  1001. return -ENODEV;
  1002. bus = kzalloc(sizeof(struct brcmf_bus), GFP_ATOMIC);
  1003. if (!bus) {
  1004. ret = -ENOMEM;
  1005. goto fail;
  1006. }
  1007. bus->dev = dev;
  1008. bus_pub->bus = bus;
  1009. bus->bus_priv.usb = bus_pub;
  1010. dev_set_drvdata(dev, bus);
  1011. bus->ops = &brcmf_usb_bus_ops;
  1012. bus->proto_type = BRCMF_PROTO_BCDC;
  1013. bus->always_use_fws_queue = true;
  1014. #ifdef CONFIG_PM
  1015. bus->wowl_supported = true;
  1016. #endif
  1017. devinfo->settings = brcmf_get_module_param(bus->dev, BRCMF_BUSTYPE_USB,
  1018. bus_pub->devid,
  1019. bus_pub->chiprev);
  1020. if (!devinfo->settings) {
  1021. ret = -ENOMEM;
  1022. goto fail;
  1023. }
  1024. if (!brcmf_usb_dlneeded(devinfo)) {
  1025. ret = brcmf_usb_bus_setup(devinfo);
  1026. if (ret)
  1027. goto fail;
  1028. /* we are done */
  1029. mutex_unlock(&devinfo->dev_init_lock);
  1030. return 0;
  1031. }
  1032. bus->chip = bus_pub->devid;
  1033. bus->chiprev = bus_pub->chiprev;
  1034. ret = brcmf_fw_map_chip_to_name(bus_pub->devid, bus_pub->chiprev,
  1035. brcmf_usb_fwnames,
  1036. ARRAY_SIZE(brcmf_usb_fwnames),
  1037. devinfo->fw_name, NULL);
  1038. if (ret)
  1039. goto fail;
  1040. /* request firmware here */
  1041. ret = brcmf_fw_get_firmwares(dev, 0, devinfo->fw_name, NULL,
  1042. brcmf_usb_probe_phase2);
  1043. if (ret) {
  1044. brcmf_err("firmware request failed: %d\n", ret);
  1045. goto fail;
  1046. }
  1047. return 0;
  1048. fail:
  1049. /* Release resources in reverse order */
  1050. kfree(bus);
  1051. brcmf_usb_detach(devinfo);
  1052. return ret;
  1053. }
  1054. static void
  1055. brcmf_usb_disconnect_cb(struct brcmf_usbdev_info *devinfo)
  1056. {
  1057. if (!devinfo)
  1058. return;
  1059. brcmf_dbg(USB, "Enter, bus_pub %p\n", devinfo);
  1060. brcmf_detach(devinfo->dev);
  1061. kfree(devinfo->bus_pub.bus);
  1062. brcmf_usb_detach(devinfo);
  1063. }
  1064. static int
  1065. brcmf_usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
  1066. {
  1067. struct usb_device *usb = interface_to_usbdev(intf);
  1068. struct brcmf_usbdev_info *devinfo;
  1069. struct usb_interface_descriptor *desc;
  1070. struct usb_endpoint_descriptor *endpoint;
  1071. int ret = 0;
  1072. u32 num_of_eps;
  1073. u8 endpoint_num, ep;
  1074. brcmf_dbg(USB, "Enter 0x%04x:0x%04x\n", id->idVendor, id->idProduct);
  1075. devinfo = kzalloc(sizeof(*devinfo), GFP_ATOMIC);
  1076. if (devinfo == NULL)
  1077. return -ENOMEM;
  1078. devinfo->usbdev = usb;
  1079. devinfo->dev = &usb->dev;
  1080. /* Take an init lock, to protect for disconnect while still loading.
  1081. * Necessary because of the asynchronous firmware load construction
  1082. */
  1083. mutex_init(&devinfo->dev_init_lock);
  1084. mutex_lock(&devinfo->dev_init_lock);
  1085. usb_set_intfdata(intf, devinfo);
  1086. /* Check that the device supports only one configuration */
  1087. if (usb->descriptor.bNumConfigurations != 1) {
  1088. brcmf_err("Number of configurations: %d not supported\n",
  1089. usb->descriptor.bNumConfigurations);
  1090. ret = -ENODEV;
  1091. goto fail;
  1092. }
  1093. if ((usb->descriptor.bDeviceClass != USB_CLASS_VENDOR_SPEC) &&
  1094. (usb->descriptor.bDeviceClass != USB_CLASS_MISC) &&
  1095. (usb->descriptor.bDeviceClass != USB_CLASS_WIRELESS_CONTROLLER)) {
  1096. brcmf_err("Device class: 0x%x not supported\n",
  1097. usb->descriptor.bDeviceClass);
  1098. ret = -ENODEV;
  1099. goto fail;
  1100. }
  1101. desc = &intf->altsetting[0].desc;
  1102. if ((desc->bInterfaceClass != USB_CLASS_VENDOR_SPEC) ||
  1103. (desc->bInterfaceSubClass != 2) ||
  1104. (desc->bInterfaceProtocol != 0xff)) {
  1105. brcmf_err("non WLAN interface %d: 0x%x:0x%x:0x%x\n",
  1106. desc->bInterfaceNumber, desc->bInterfaceClass,
  1107. desc->bInterfaceSubClass, desc->bInterfaceProtocol);
  1108. ret = -ENODEV;
  1109. goto fail;
  1110. }
  1111. num_of_eps = desc->bNumEndpoints;
  1112. for (ep = 0; ep < num_of_eps; ep++) {
  1113. endpoint = &intf->altsetting[0].endpoint[ep].desc;
  1114. endpoint_num = usb_endpoint_num(endpoint);
  1115. if (!usb_endpoint_xfer_bulk(endpoint))
  1116. continue;
  1117. if (usb_endpoint_dir_in(endpoint)) {
  1118. if (!devinfo->rx_pipe)
  1119. devinfo->rx_pipe =
  1120. usb_rcvbulkpipe(usb, endpoint_num);
  1121. } else {
  1122. if (!devinfo->tx_pipe)
  1123. devinfo->tx_pipe =
  1124. usb_sndbulkpipe(usb, endpoint_num);
  1125. }
  1126. }
  1127. if (devinfo->rx_pipe == 0) {
  1128. brcmf_err("No RX (in) Bulk EP found\n");
  1129. ret = -ENODEV;
  1130. goto fail;
  1131. }
  1132. if (devinfo->tx_pipe == 0) {
  1133. brcmf_err("No TX (out) Bulk EP found\n");
  1134. ret = -ENODEV;
  1135. goto fail;
  1136. }
  1137. devinfo->ifnum = desc->bInterfaceNumber;
  1138. if (usb->speed == USB_SPEED_SUPER_PLUS)
  1139. brcmf_dbg(USB, "Broadcom super speed plus USB WLAN interface detected\n");
  1140. else if (usb->speed == USB_SPEED_SUPER)
  1141. brcmf_dbg(USB, "Broadcom super speed USB WLAN interface detected\n");
  1142. else if (usb->speed == USB_SPEED_HIGH)
  1143. brcmf_dbg(USB, "Broadcom high speed USB WLAN interface detected\n");
  1144. else
  1145. brcmf_dbg(USB, "Broadcom full speed USB WLAN interface detected\n");
  1146. ret = brcmf_usb_probe_cb(devinfo);
  1147. if (ret)
  1148. goto fail;
  1149. /* Success */
  1150. return 0;
  1151. fail:
  1152. mutex_unlock(&devinfo->dev_init_lock);
  1153. kfree(devinfo);
  1154. usb_set_intfdata(intf, NULL);
  1155. return ret;
  1156. }
  1157. static void
  1158. brcmf_usb_disconnect(struct usb_interface *intf)
  1159. {
  1160. struct brcmf_usbdev_info *devinfo;
  1161. brcmf_dbg(USB, "Enter\n");
  1162. devinfo = (struct brcmf_usbdev_info *)usb_get_intfdata(intf);
  1163. if (devinfo) {
  1164. mutex_lock(&devinfo->dev_init_lock);
  1165. /* Make sure that devinfo still exists. Firmware probe routines
  1166. * may have released the device and cleared the intfdata.
  1167. */
  1168. if (!usb_get_intfdata(intf))
  1169. goto done;
  1170. brcmf_usb_disconnect_cb(devinfo);
  1171. kfree(devinfo);
  1172. }
  1173. done:
  1174. brcmf_dbg(USB, "Exit\n");
  1175. }
  1176. /*
  1177. * only need to signal the bus being down and update the state.
  1178. */
  1179. static int brcmf_usb_suspend(struct usb_interface *intf, pm_message_t state)
  1180. {
  1181. struct usb_device *usb = interface_to_usbdev(intf);
  1182. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
  1183. brcmf_dbg(USB, "Enter\n");
  1184. devinfo->bus_pub.state = BRCMFMAC_USB_STATE_SLEEP;
  1185. if (devinfo->wowl_enabled)
  1186. brcmf_cancel_all_urbs(devinfo);
  1187. else
  1188. brcmf_detach(&usb->dev);
  1189. return 0;
  1190. }
  1191. /*
  1192. * (re-) start the bus.
  1193. */
  1194. static int brcmf_usb_resume(struct usb_interface *intf)
  1195. {
  1196. struct usb_device *usb = interface_to_usbdev(intf);
  1197. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
  1198. brcmf_dbg(USB, "Enter\n");
  1199. if (!devinfo->wowl_enabled)
  1200. return brcmf_usb_bus_setup(devinfo);
  1201. devinfo->bus_pub.state = BRCMFMAC_USB_STATE_UP;
  1202. brcmf_usb_rx_fill_all(devinfo);
  1203. return 0;
  1204. }
  1205. static int brcmf_usb_reset_resume(struct usb_interface *intf)
  1206. {
  1207. struct usb_device *usb = interface_to_usbdev(intf);
  1208. struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
  1209. brcmf_dbg(USB, "Enter\n");
  1210. return brcmf_fw_get_firmwares(&usb->dev, 0, devinfo->fw_name, NULL,
  1211. brcmf_usb_probe_phase2);
  1212. }
  1213. #define BRCMF_USB_DEVICE(dev_id) \
  1214. { USB_DEVICE(BRCM_USB_VENDOR_ID_BROADCOM, dev_id) }
  1215. #define LINKSYS_USB_DEVICE(dev_id) \
  1216. { USB_DEVICE(BRCM_USB_VENDOR_ID_LINKSYS, dev_id) }
  1217. static struct usb_device_id brcmf_usb_devid_table[] = {
  1218. BRCMF_USB_DEVICE(BRCM_USB_43143_DEVICE_ID),
  1219. BRCMF_USB_DEVICE(BRCM_USB_43236_DEVICE_ID),
  1220. BRCMF_USB_DEVICE(BRCM_USB_43242_DEVICE_ID),
  1221. BRCMF_USB_DEVICE(BRCM_USB_43569_DEVICE_ID),
  1222. LINKSYS_USB_DEVICE(BRCM_USB_43235_LINKSYS_DEVICE_ID),
  1223. { USB_DEVICE(BRCM_USB_VENDOR_ID_LG, BRCM_USB_43242_LG_DEVICE_ID) },
  1224. /* special entry for device with firmware loaded and running */
  1225. BRCMF_USB_DEVICE(BRCM_USB_BCMFW_DEVICE_ID),
  1226. { /* end: all zeroes */ }
  1227. };
  1228. MODULE_DEVICE_TABLE(usb, brcmf_usb_devid_table);
  1229. static struct usb_driver brcmf_usbdrvr = {
  1230. .name = KBUILD_MODNAME,
  1231. .probe = brcmf_usb_probe,
  1232. .disconnect = brcmf_usb_disconnect,
  1233. .id_table = brcmf_usb_devid_table,
  1234. .suspend = brcmf_usb_suspend,
  1235. .resume = brcmf_usb_resume,
  1236. .reset_resume = brcmf_usb_reset_resume,
  1237. .disable_hub_initiated_lpm = 1,
  1238. };
  1239. static int brcmf_usb_reset_device(struct device *dev, void *notused)
  1240. {
  1241. /* device past is the usb interface so we
  1242. * need to use parent here.
  1243. */
  1244. brcmf_dev_reset(dev->parent);
  1245. return 0;
  1246. }
  1247. void brcmf_usb_exit(void)
  1248. {
  1249. struct device_driver *drv = &brcmf_usbdrvr.drvwrap.driver;
  1250. int ret;
  1251. brcmf_dbg(USB, "Enter\n");
  1252. ret = driver_for_each_device(drv, NULL, NULL,
  1253. brcmf_usb_reset_device);
  1254. usb_deregister(&brcmf_usbdrvr);
  1255. }
  1256. void brcmf_usb_register(void)
  1257. {
  1258. brcmf_dbg(USB, "Enter\n");
  1259. usb_register(&brcmf_usbdrvr);
  1260. }