if_usb.c 24 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001
  1. /**
  2. * This file contains functions used in USB interface module.
  3. */
  4. #include <linux/delay.h>
  5. #include <linux/firmware.h>
  6. #include <linux/netdevice.h>
  7. #include <linux/usb.h>
  8. #include "host.h"
  9. #include "decl.h"
  10. #include "defs.h"
  11. #include "dev.h"
  12. #include "if_usb.h"
  13. #define MESSAGE_HEADER_LEN 4
  14. static const char usbdriver_name[] = "usb8xxx";
  15. #define MAX_DEVS 5
  16. static struct net_device *libertas_devs[MAX_DEVS];
  17. static int libertas_found = 0;
  18. static struct usb_device_id if_usb_table[] = {
  19. /* Enter the device signature inside */
  20. { USB_DEVICE(0x1286, 0x2001) },
  21. { USB_DEVICE(0x05a3, 0x8388) },
  22. {} /* Terminating entry */
  23. };
  24. MODULE_DEVICE_TABLE(usb, if_usb_table);
  25. static void if_usb_receive(struct urb *urb);
  26. static void if_usb_receive_fwload(struct urb *urb);
  27. static int reset_device(wlan_private *priv);
  28. static int if_usb_register_dev(wlan_private * priv);
  29. static int if_usb_unregister_dev(wlan_private *);
  30. static int if_usb_prog_firmware(wlan_private *);
  31. static int if_usb_host_to_card(wlan_private * priv, u8 type, u8 * payload, u16 nb);
  32. static int if_usb_get_int_status(wlan_private * priv, u8 *);
  33. static int if_usb_read_event_cause(wlan_private *);
  34. /**
  35. * @brief call back function to handle the status of the URB
  36. * @param urb pointer to urb structure
  37. * @return N/A
  38. */
  39. static void if_usb_write_bulk_callback(struct urb *urb)
  40. {
  41. wlan_private *priv = (wlan_private *) (urb->context);
  42. wlan_adapter *adapter = priv->adapter;
  43. struct net_device *dev = priv->wlan_dev.netdev;
  44. /* handle the transmission complete validations */
  45. if (urb->status != 0) {
  46. /* print the failure status number for debug */
  47. lbs_pr_info("URB in failure status\n");
  48. } else {
  49. /*
  50. lbs_deb_usbd(&urb->dev->dev, "URB status is successfull\n");
  51. lbs_deb_usbd(&urb->dev->dev, "Actual length transmitted %d\n",
  52. urb->actual_length);
  53. */
  54. priv->wlan_dev.dnld_sent = DNLD_RES_RECEIVED;
  55. /* Wake main thread if commands are pending */
  56. if (!adapter->cur_cmd)
  57. wake_up_interruptible(&priv->mainthread.waitq);
  58. if ((adapter->connect_status == libertas_connected)) {
  59. netif_wake_queue(dev);
  60. netif_wake_queue(priv->mesh_dev);
  61. }
  62. }
  63. return;
  64. }
  65. /**
  66. * @brief free tx/rx urb, skb and rx buffer
  67. * @param cardp pointer usb_card_rec
  68. * @return N/A
  69. */
  70. void if_usb_free(struct usb_card_rec *cardp)
  71. {
  72. lbs_deb_enter(LBS_DEB_USB);
  73. /* Unlink tx & rx urb */
  74. usb_kill_urb(cardp->tx_urb);
  75. usb_kill_urb(cardp->rx_urb);
  76. usb_free_urb(cardp->tx_urb);
  77. cardp->tx_urb = NULL;
  78. usb_free_urb(cardp->rx_urb);
  79. cardp->rx_urb = NULL;
  80. kfree(cardp->bulk_out_buffer);
  81. cardp->bulk_out_buffer = NULL;
  82. lbs_deb_leave(LBS_DEB_USB);
  83. }
  84. /**
  85. * @brief sets the configuration values
  86. * @param ifnum interface number
  87. * @param id pointer to usb_device_id
  88. * @return 0 on success, error code on failure
  89. */
  90. static int if_usb_probe(struct usb_interface *intf,
  91. const struct usb_device_id *id)
  92. {
  93. struct usb_device *udev;
  94. struct usb_host_interface *iface_desc;
  95. struct usb_endpoint_descriptor *endpoint;
  96. wlan_private *priv;
  97. struct usb_card_rec *usb_cardp;
  98. int i;
  99. udev = interface_to_usbdev(intf);
  100. usb_cardp = kzalloc(sizeof(struct usb_card_rec), GFP_KERNEL);
  101. if (!usb_cardp) {
  102. lbs_pr_err("Out of memory allocating private data.\n");
  103. goto error;
  104. }
  105. usb_cardp->udev = udev;
  106. iface_desc = intf->cur_altsetting;
  107. lbs_deb_usbd(&udev->dev, "bcdUSB = 0x%X bDeviceClass = 0x%X"
  108. " bDeviceSubClass = 0x%X, bDeviceProtocol = 0x%X\n",
  109. udev->descriptor.bcdUSB,
  110. udev->descriptor.bDeviceClass,
  111. udev->descriptor.bDeviceSubClass,
  112. udev->descriptor.bDeviceProtocol);
  113. for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
  114. endpoint = &iface_desc->endpoint[i].desc;
  115. if ((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK)
  116. && ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
  117. USB_ENDPOINT_XFER_BULK)) {
  118. /* we found a bulk in endpoint */
  119. lbs_deb_usbd(&udev->dev, "Bulk in size is %d\n",
  120. endpoint->wMaxPacketSize);
  121. if (!
  122. (usb_cardp->rx_urb =
  123. usb_alloc_urb(0, GFP_KERNEL))) {
  124. lbs_deb_usbd(&udev->dev,
  125. "Rx URB allocation failed\n");
  126. goto dealloc;
  127. }
  128. usb_cardp->rx_urb_recall = 0;
  129. usb_cardp->bulk_in_size =
  130. endpoint->wMaxPacketSize;
  131. usb_cardp->bulk_in_endpointAddr =
  132. (endpoint->
  133. bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
  134. lbs_deb_usbd(&udev->dev, "in_endpoint = %d\n",
  135. endpoint->bEndpointAddress);
  136. }
  137. if (((endpoint->
  138. bEndpointAddress & USB_ENDPOINT_DIR_MASK) ==
  139. USB_DIR_OUT)
  140. && ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
  141. USB_ENDPOINT_XFER_BULK)) {
  142. /* We found bulk out endpoint */
  143. if (!
  144. (usb_cardp->tx_urb =
  145. usb_alloc_urb(0, GFP_KERNEL))) {
  146. lbs_deb_usbd(&udev->dev,
  147. "Tx URB allocation failed\n");
  148. goto dealloc;
  149. }
  150. usb_cardp->bulk_out_size =
  151. endpoint->wMaxPacketSize;
  152. lbs_deb_usbd(&udev->dev,
  153. "Bulk out size is %d\n",
  154. endpoint->wMaxPacketSize);
  155. usb_cardp->bulk_out_endpointAddr =
  156. endpoint->bEndpointAddress;
  157. lbs_deb_usbd(&udev->dev, "out_endpoint = %d\n",
  158. endpoint->bEndpointAddress);
  159. usb_cardp->bulk_out_buffer =
  160. kmalloc(MRVDRV_ETH_TX_PACKET_BUFFER_SIZE,
  161. GFP_KERNEL);
  162. if (!usb_cardp->bulk_out_buffer) {
  163. lbs_deb_usbd(&udev->dev,
  164. "Could not allocate buffer\n");
  165. goto dealloc;
  166. }
  167. }
  168. }
  169. /* At this point wlan_add_card() will be called. Don't worry
  170. * about keeping pwlanpriv around since it will be set on our
  171. * usb device data in -> add() -> hw_register_dev() -> if_usb_register_dev.
  172. */
  173. if (!(priv = wlan_add_card(usb_cardp)))
  174. goto dealloc;
  175. if (wlan_add_mesh(priv))
  176. goto err_add_mesh;
  177. priv->hw_register_dev = if_usb_register_dev;
  178. priv->hw_unregister_dev = if_usb_unregister_dev;
  179. priv->hw_prog_firmware = if_usb_prog_firmware;
  180. priv->hw_host_to_card = if_usb_host_to_card;
  181. priv->hw_get_int_status = if_usb_get_int_status;
  182. priv->hw_read_event_cause = if_usb_read_event_cause;
  183. if (libertas_activate_card(priv))
  184. goto err_activate_card;
  185. if (libertas_found < MAX_DEVS) {
  186. libertas_devs[libertas_found] = priv->wlan_dev.netdev;
  187. libertas_found++;
  188. }
  189. usb_get_dev(udev);
  190. usb_set_intfdata(intf, usb_cardp);
  191. /*
  192. * return card structure, which can be got back in the
  193. * diconnect function as the ptr
  194. * argument.
  195. */
  196. return 0;
  197. err_activate_card:
  198. unregister_netdev(priv->mesh_dev);
  199. free_netdev(priv->mesh_dev);
  200. err_add_mesh:
  201. free_netdev(priv->wlan_dev.netdev);
  202. kfree(priv->adapter);
  203. dealloc:
  204. if_usb_free(usb_cardp);
  205. error:
  206. return -ENOMEM;
  207. }
  208. /**
  209. * @brief free resource and cleanup
  210. * @param udev pointer to usb_device
  211. * @param ptr pointer to usb_cardp
  212. * @return N/A
  213. */
  214. static void if_usb_disconnect(struct usb_interface *intf)
  215. {
  216. struct usb_card_rec *cardp = usb_get_intfdata(intf);
  217. wlan_private *priv = (wlan_private *) cardp->priv;
  218. wlan_adapter *adapter = NULL;
  219. int i;
  220. adapter = priv->adapter;
  221. /*
  222. * Update Surprise removed to TRUE
  223. */
  224. adapter->surpriseremoved = 1;
  225. for (i = 0; i<libertas_found; i++) {
  226. if (libertas_devs[i]==priv->wlan_dev.netdev) {
  227. libertas_devs[i] = libertas_devs[--libertas_found];
  228. libertas_devs[libertas_found] = NULL ;
  229. break;
  230. }
  231. }
  232. /* card is removed and we can call wlan_remove_card */
  233. lbs_deb_usbd(&cardp->udev->dev, "call remove card\n");
  234. wlan_remove_mesh(priv);
  235. wlan_remove_card(priv);
  236. /* Unlink and free urb */
  237. if_usb_free(cardp);
  238. usb_set_intfdata(intf, NULL);
  239. usb_put_dev(interface_to_usbdev(intf));
  240. return;
  241. }
  242. /**
  243. * @brief This function download FW
  244. * @param priv pointer to wlan_private
  245. * @return 0
  246. */
  247. static int if_prog_firmware(wlan_private * priv)
  248. {
  249. struct usb_card_rec *cardp = priv->wlan_dev.card;
  250. struct FWData *fwdata;
  251. struct fwheader *fwheader;
  252. u8 *firmware = priv->firmware->data;
  253. fwdata = kmalloc(sizeof(struct FWData), GFP_ATOMIC);
  254. if (!fwdata)
  255. return -1;
  256. fwheader = &fwdata->fwheader;
  257. if (!cardp->CRC_OK) {
  258. cardp->totalbytes = cardp->fwlastblksent;
  259. cardp->fwseqnum = cardp->lastseqnum - 1;
  260. }
  261. /*
  262. lbs_deb_usbd(&cardp->udev->dev, "totalbytes = %d\n",
  263. cardp->totalbytes);
  264. */
  265. memcpy(fwheader, &firmware[cardp->totalbytes],
  266. sizeof(struct fwheader));
  267. cardp->fwlastblksent = cardp->totalbytes;
  268. cardp->totalbytes += sizeof(struct fwheader);
  269. /* lbs_deb_usbd(&cardp->udev->dev,"Copy Data\n"); */
  270. memcpy(fwdata->data, &firmware[cardp->totalbytes],
  271. fwdata->fwheader.datalength);
  272. /*
  273. lbs_deb_usbd(&cardp->udev->dev,
  274. "Data length = %d\n", fwdata->fwheader.datalength);
  275. */
  276. cardp->fwseqnum = cardp->fwseqnum + 1;
  277. fwdata->seqnum = cardp->fwseqnum;
  278. cardp->lastseqnum = fwdata->seqnum;
  279. cardp->totalbytes += fwdata->fwheader.datalength;
  280. if (fwheader->dnldcmd == FW_HAS_DATA_TO_RECV) {
  281. /*
  282. lbs_deb_usbd(&cardp->udev->dev, "There is data to follow\n");
  283. lbs_deb_usbd(&cardp->udev->dev,
  284. "seqnum = %d totalbytes = %d\n", cardp->fwseqnum,
  285. cardp->totalbytes);
  286. */
  287. memcpy(cardp->bulk_out_buffer, fwheader, FW_DATA_XMIT_SIZE);
  288. usb_tx_block(priv, cardp->bulk_out_buffer, FW_DATA_XMIT_SIZE);
  289. } else if (fwdata->fwheader.dnldcmd == FW_HAS_LAST_BLOCK) {
  290. /*
  291. lbs_deb_usbd(&cardp->udev->dev,
  292. "Host has finished FW downloading\n");
  293. lbs_deb_usbd(&cardp->udev->dev,
  294. "Donwloading FW JUMP BLOCK\n");
  295. */
  296. memcpy(cardp->bulk_out_buffer, fwheader, FW_DATA_XMIT_SIZE);
  297. usb_tx_block(priv, cardp->bulk_out_buffer, FW_DATA_XMIT_SIZE);
  298. cardp->fwfinalblk = 1;
  299. }
  300. /*
  301. lbs_deb_usbd(&cardp->udev->dev,
  302. "The firmware download is done size is %d\n",
  303. cardp->totalbytes);
  304. */
  305. kfree(fwdata);
  306. return 0;
  307. }
  308. static int libertas_do_reset(wlan_private *priv)
  309. {
  310. int ret;
  311. struct usb_card_rec *cardp = priv->wlan_dev.card;
  312. lbs_deb_enter(LBS_DEB_USB);
  313. ret = usb_reset_device(cardp->udev);
  314. if (!ret) {
  315. msleep(10);
  316. reset_device(priv);
  317. msleep(10);
  318. }
  319. lbs_deb_leave_args(LBS_DEB_USB, "ret %d", ret);
  320. return ret;
  321. }
  322. /**
  323. * @brief This function transfer the data to the device.
  324. * @param priv pointer to wlan_private
  325. * @param payload pointer to payload data
  326. * @param nb data length
  327. * @return 0 or -1
  328. */
  329. int usb_tx_block(wlan_private * priv, u8 * payload, u16 nb)
  330. {
  331. /* pointer to card structure */
  332. struct usb_card_rec *cardp = priv->wlan_dev.card;
  333. int ret = -1;
  334. /* check if device is removed */
  335. if (priv->adapter->surpriseremoved) {
  336. lbs_deb_usbd(&cardp->udev->dev, "Device removed\n");
  337. goto tx_ret;
  338. }
  339. usb_fill_bulk_urb(cardp->tx_urb, cardp->udev,
  340. usb_sndbulkpipe(cardp->udev,
  341. cardp->bulk_out_endpointAddr),
  342. payload, nb, if_usb_write_bulk_callback, priv);
  343. cardp->tx_urb->transfer_flags |= URB_ZERO_PACKET;
  344. if ((ret = usb_submit_urb(cardp->tx_urb, GFP_ATOMIC))) {
  345. /* transfer failed */
  346. lbs_deb_usbd(&cardp->udev->dev, "usb_submit_urb failed\n");
  347. ret = -1;
  348. } else {
  349. /* lbs_deb_usbd(&cardp->udev->dev, "usb_submit_urb success\n"); */
  350. ret = 0;
  351. }
  352. tx_ret:
  353. return ret;
  354. }
  355. static int __if_usb_submit_rx_urb(wlan_private * priv,
  356. void (*callbackfn)
  357. (struct urb *urb))
  358. {
  359. struct usb_card_rec *cardp = priv->wlan_dev.card;
  360. struct sk_buff *skb;
  361. struct read_cb_info *rinfo = &cardp->rinfo;
  362. int ret = -1;
  363. if (!(skb = dev_alloc_skb(MRVDRV_ETH_RX_PACKET_BUFFER_SIZE))) {
  364. lbs_pr_err("No free skb\n");
  365. goto rx_ret;
  366. }
  367. rinfo->skb = skb;
  368. /* Fill the receive configuration URB and initialise the Rx call back */
  369. usb_fill_bulk_urb(cardp->rx_urb, cardp->udev,
  370. usb_rcvbulkpipe(cardp->udev,
  371. cardp->bulk_in_endpointAddr),
  372. (void *) (skb->tail + (size_t) IPFIELD_ALIGN_OFFSET),
  373. MRVDRV_ETH_RX_PACKET_BUFFER_SIZE, callbackfn,
  374. rinfo);
  375. cardp->rx_urb->transfer_flags |= URB_ZERO_PACKET;
  376. /* lbs_deb_usbd(&cardp->udev->dev, "Pointer for rx_urb %p\n", cardp->rx_urb); */
  377. if ((ret = usb_submit_urb(cardp->rx_urb, GFP_ATOMIC))) {
  378. /* handle failure conditions */
  379. lbs_deb_usbd(&cardp->udev->dev, "Submit Rx URB failed\n");
  380. ret = -1;
  381. } else {
  382. /* lbs_deb_usbd(&cardp->udev->dev, "Submit Rx URB success\n"); */
  383. ret = 0;
  384. }
  385. rx_ret:
  386. return ret;
  387. }
  388. static inline int if_usb_submit_rx_urb_fwload(wlan_private * priv)
  389. {
  390. return __if_usb_submit_rx_urb(priv, &if_usb_receive_fwload);
  391. }
  392. static inline int if_usb_submit_rx_urb(wlan_private * priv)
  393. {
  394. return __if_usb_submit_rx_urb(priv, &if_usb_receive);
  395. }
  396. static void if_usb_receive_fwload(struct urb *urb)
  397. {
  398. struct read_cb_info *rinfo = (struct read_cb_info *)urb->context;
  399. wlan_private *priv = rinfo->priv;
  400. struct sk_buff *skb = rinfo->skb;
  401. struct usb_card_rec *cardp = (struct usb_card_rec *)priv->wlan_dev.card;
  402. struct fwsyncheader *syncfwheader;
  403. struct bootcmdrespStr bootcmdresp;
  404. if (urb->status) {
  405. lbs_deb_usbd(&cardp->udev->dev,
  406. "URB status is failed during fw load\n");
  407. kfree_skb(skb);
  408. return;
  409. }
  410. if (cardp->bootcmdresp == 0) {
  411. memcpy (&bootcmdresp, skb->data + IPFIELD_ALIGN_OFFSET,
  412. sizeof(bootcmdresp));
  413. if (cardp->udev->descriptor.bcdDevice < 0x3106) {
  414. kfree_skb(skb);
  415. if_usb_submit_rx_urb_fwload(priv);
  416. cardp->bootcmdresp = 1;
  417. lbs_deb_usbd(&cardp->udev->dev,
  418. "Received valid boot command response\n");
  419. return;
  420. }
  421. if (bootcmdresp.u32magicnumber != BOOT_CMD_MAGIC_NUMBER) {
  422. lbs_pr_info(
  423. "boot cmd response wrong magic number (0x%x)\n",
  424. bootcmdresp.u32magicnumber);
  425. } else if (bootcmdresp.u8cmd_tag != BOOT_CMD_FW_BY_USB) {
  426. lbs_pr_info(
  427. "boot cmd response cmd_tag error (%d)\n",
  428. bootcmdresp.u8cmd_tag);
  429. } else if (bootcmdresp.u8result != BOOT_CMD_RESP_OK) {
  430. lbs_pr_info(
  431. "boot cmd response result error (%d)\n",
  432. bootcmdresp.u8result);
  433. } else {
  434. cardp->bootcmdresp = 1;
  435. lbs_deb_usbd(&cardp->udev->dev,
  436. "Received valid boot command response\n");
  437. }
  438. kfree_skb(skb);
  439. if_usb_submit_rx_urb_fwload(priv);
  440. return;
  441. }
  442. syncfwheader = kmalloc(sizeof(struct fwsyncheader), GFP_ATOMIC);
  443. if (!syncfwheader) {
  444. lbs_deb_usbd(&cardp->udev->dev, "Failure to allocate syncfwheader\n");
  445. kfree_skb(skb);
  446. return;
  447. }
  448. memcpy(syncfwheader, skb->data + IPFIELD_ALIGN_OFFSET,
  449. sizeof(struct fwsyncheader));
  450. if (!syncfwheader->cmd) {
  451. /*
  452. lbs_deb_usbd(&cardp->udev->dev,
  453. "FW received Blk with correct CRC\n");
  454. lbs_deb_usbd(&cardp->udev->dev,
  455. "FW received Blk seqnum = %d\n",
  456. syncfwheader->seqnum);
  457. */
  458. cardp->CRC_OK = 1;
  459. } else {
  460. lbs_deb_usbd(&cardp->udev->dev,
  461. "FW received Blk with CRC error\n");
  462. cardp->CRC_OK = 0;
  463. }
  464. kfree_skb(skb);
  465. if (cardp->fwfinalblk) {
  466. cardp->fwdnldover = 1;
  467. goto exit;
  468. }
  469. if_prog_firmware(priv);
  470. if_usb_submit_rx_urb_fwload(priv);
  471. exit:
  472. kfree(syncfwheader);
  473. return;
  474. }
  475. #define MRVDRV_MIN_PKT_LEN 30
  476. static inline void process_cmdtypedata(int recvlength, struct sk_buff *skb,
  477. struct usb_card_rec *cardp,
  478. wlan_private *priv)
  479. {
  480. if (recvlength > MRVDRV_ETH_RX_PACKET_BUFFER_SIZE +
  481. MESSAGE_HEADER_LEN || recvlength < MRVDRV_MIN_PKT_LEN) {
  482. lbs_deb_usbd(&cardp->udev->dev,
  483. "Packet length is Invalid\n");
  484. kfree_skb(skb);
  485. return;
  486. }
  487. skb_reserve(skb, IPFIELD_ALIGN_OFFSET);
  488. skb_put(skb, recvlength);
  489. skb_pull(skb, MESSAGE_HEADER_LEN);
  490. libertas_process_rxed_packet(priv, skb);
  491. priv->wlan_dev.upld_len = (recvlength - MESSAGE_HEADER_LEN);
  492. }
  493. static inline void process_cmdrequest(int recvlength, u8 *recvbuff,
  494. struct sk_buff *skb,
  495. struct usb_card_rec *cardp,
  496. wlan_private *priv)
  497. {
  498. u8 *cmdbuf;
  499. if (recvlength > MRVDRV_SIZE_OF_CMD_BUFFER) {
  500. lbs_deb_usbd(&cardp->udev->dev,
  501. "The receive buffer is too large\n");
  502. kfree_skb(skb);
  503. return;
  504. }
  505. if (!in_interrupt())
  506. BUG();
  507. spin_lock(&priv->adapter->driver_lock);
  508. /* take care of cur_cmd = NULL case by reading the
  509. * data to clear the interrupt */
  510. if (!priv->adapter->cur_cmd) {
  511. cmdbuf = priv->wlan_dev.upld_buf;
  512. priv->adapter->hisregcpy &= ~his_cmdupldrdy;
  513. } else
  514. cmdbuf = priv->adapter->cur_cmd->bufvirtualaddr;
  515. cardp->usb_int_cause |= his_cmdupldrdy;
  516. priv->wlan_dev.upld_len = (recvlength - MESSAGE_HEADER_LEN);
  517. memcpy(cmdbuf, recvbuff + MESSAGE_HEADER_LEN,
  518. priv->wlan_dev.upld_len);
  519. kfree_skb(skb);
  520. libertas_interrupt(priv->wlan_dev.netdev);
  521. spin_unlock(&priv->adapter->driver_lock);
  522. lbs_deb_usbd(&cardp->udev->dev,
  523. "Wake up main thread to handle cmd response\n");
  524. return;
  525. }
  526. /**
  527. * @brief This function reads of the packet into the upload buff,
  528. * wake up the main thread and initialise the Rx callack.
  529. *
  530. * @param urb pointer to struct urb
  531. * @return N/A
  532. */
  533. static void if_usb_receive(struct urb *urb)
  534. {
  535. struct read_cb_info *rinfo = (struct read_cb_info *)urb->context;
  536. wlan_private *priv = rinfo->priv;
  537. struct sk_buff *skb = rinfo->skb;
  538. struct usb_card_rec *cardp = (struct usb_card_rec *)priv->wlan_dev.card;
  539. int recvlength = urb->actual_length;
  540. u8 *recvbuff = NULL;
  541. u32 recvtype;
  542. lbs_deb_enter(LBS_DEB_USB);
  543. if (recvlength) {
  544. if (urb->status) {
  545. lbs_deb_usbd(&cardp->udev->dev,
  546. "URB status is failed\n");
  547. kfree_skb(skb);
  548. goto setup_for_next;
  549. }
  550. recvbuff = skb->data + IPFIELD_ALIGN_OFFSET;
  551. memcpy(&recvtype, recvbuff, sizeof(u32));
  552. lbs_deb_usbd(&cardp->udev->dev,
  553. "Recv length = 0x%x\n", recvlength);
  554. lbs_deb_usbd(&cardp->udev->dev,
  555. "Receive type = 0x%X\n", recvtype);
  556. recvtype = le32_to_cpu(recvtype);
  557. lbs_deb_usbd(&cardp->udev->dev,
  558. "Receive type after = 0x%X\n", recvtype);
  559. } else if (urb->status)
  560. goto rx_exit;
  561. switch (recvtype) {
  562. case CMD_TYPE_DATA:
  563. process_cmdtypedata(recvlength, skb, cardp, priv);
  564. break;
  565. case CMD_TYPE_REQUEST:
  566. process_cmdrequest(recvlength, recvbuff, skb, cardp, priv);
  567. break;
  568. case CMD_TYPE_INDICATION:
  569. /* Event cause handling */
  570. spin_lock(&priv->adapter->driver_lock);
  571. cardp->usb_event_cause = *(u32 *) (recvbuff + MESSAGE_HEADER_LEN);
  572. lbs_deb_usbd(&cardp->udev->dev,"**EVENT** 0x%X\n",
  573. cardp->usb_event_cause);
  574. if (cardp->usb_event_cause & 0xffff0000) {
  575. libertas_send_tx_feedback(priv);
  576. spin_unlock(&priv->adapter->driver_lock);
  577. break;
  578. }
  579. cardp->usb_event_cause = le32_to_cpu(cardp->usb_event_cause) << 3;
  580. cardp->usb_int_cause |= his_cardevent;
  581. kfree_skb(skb);
  582. libertas_interrupt(priv->wlan_dev.netdev);
  583. spin_unlock(&priv->adapter->driver_lock);
  584. goto rx_exit;
  585. default:
  586. kfree_skb(skb);
  587. break;
  588. }
  589. setup_for_next:
  590. if_usb_submit_rx_urb(priv);
  591. rx_exit:
  592. lbs_deb_leave(LBS_DEB_USB);
  593. }
  594. /**
  595. * @brief This function downloads data to FW
  596. * @param priv pointer to wlan_private structure
  597. * @param type type of data
  598. * @param buf pointer to data buffer
  599. * @param len number of bytes
  600. * @return 0 or -1
  601. */
  602. static int if_usb_host_to_card(wlan_private * priv, u8 type, u8 * payload, u16 nb)
  603. {
  604. int ret = -1;
  605. u32 tmp;
  606. struct usb_card_rec *cardp = (struct usb_card_rec *)priv->wlan_dev.card;
  607. lbs_deb_usbd(&cardp->udev->dev,"*** type = %u\n", type);
  608. lbs_deb_usbd(&cardp->udev->dev,"size after = %d\n", nb);
  609. if (type == MVMS_CMD) {
  610. tmp = cpu_to_le32(CMD_TYPE_REQUEST);
  611. priv->wlan_dev.dnld_sent = DNLD_CMD_SENT;
  612. memcpy(cardp->bulk_out_buffer, (u8 *) & tmp,
  613. MESSAGE_HEADER_LEN);
  614. } else {
  615. tmp = cpu_to_le32(CMD_TYPE_DATA);
  616. priv->wlan_dev.dnld_sent = DNLD_DATA_SENT;
  617. memcpy(cardp->bulk_out_buffer, (u8 *) & tmp,
  618. MESSAGE_HEADER_LEN);
  619. }
  620. memcpy((cardp->bulk_out_buffer + MESSAGE_HEADER_LEN), payload, nb);
  621. ret =
  622. usb_tx_block(priv, cardp->bulk_out_buffer, nb + MESSAGE_HEADER_LEN);
  623. return ret;
  624. }
  625. /* called with adapter->driver_lock held */
  626. static int if_usb_get_int_status(wlan_private * priv, u8 * ireg)
  627. {
  628. struct usb_card_rec *cardp = priv->wlan_dev.card;
  629. *ireg = cardp->usb_int_cause;
  630. cardp->usb_int_cause = 0;
  631. lbs_deb_usbd(&cardp->udev->dev,"Int cause is 0x%X\n", *ireg);
  632. return 0;
  633. }
  634. static int if_usb_read_event_cause(wlan_private * priv)
  635. {
  636. struct usb_card_rec *cardp = priv->wlan_dev.card;
  637. priv->adapter->eventcause = cardp->usb_event_cause;
  638. /* Re-submit rx urb here to avoid event lost issue */
  639. if_usb_submit_rx_urb(priv);
  640. return 0;
  641. }
  642. static int reset_device(wlan_private *priv)
  643. {
  644. int ret;
  645. lbs_deb_enter(LBS_DEB_USB);
  646. ret = libertas_prepare_and_send_command(priv, cmd_802_11_reset,
  647. cmd_act_halt, 0, 0, NULL);
  648. msleep_interruptible(10);
  649. lbs_deb_leave_args(LBS_DEB_USB, "ret %d", ret);
  650. return ret;
  651. }
  652. static int if_usb_unregister_dev(wlan_private * priv)
  653. {
  654. int ret = 0;
  655. /* Need to send a Reset command to device before USB resources freed
  656. * and wlan_remove_card() called, then device can handle FW download
  657. * again.
  658. */
  659. if (priv)
  660. reset_device(priv);
  661. return ret;
  662. }
  663. /**
  664. * @brief This function register usb device and initialize parameter
  665. * @param priv pointer to wlan_private
  666. * @return 0 or -1
  667. */
  668. static int if_usb_register_dev(wlan_private * priv)
  669. {
  670. struct usb_card_rec *cardp = (struct usb_card_rec *)priv->wlan_dev.card;
  671. lbs_deb_enter(LBS_DEB_USB);
  672. cardp->priv = priv;
  673. cardp->eth_dev = priv->wlan_dev.netdev;
  674. priv->hotplug_device = &(cardp->udev->dev);
  675. SET_NETDEV_DEV(cardp->eth_dev, &(cardp->udev->dev));
  676. SET_NETDEV_DEV(priv->mesh_dev, &(cardp->udev->dev));
  677. lbs_deb_usbd(&cardp->udev->dev, "udev pointer is at %p\n",
  678. cardp->udev);
  679. lbs_deb_leave(LBS_DEB_USB);
  680. return 0;
  681. }
  682. static int if_usb_prog_firmware(wlan_private * priv)
  683. {
  684. struct usb_card_rec *cardp = priv->wlan_dev.card;
  685. int i = 0;
  686. static int reset_count = 10;
  687. int ret = 0;
  688. lbs_deb_enter(LBS_DEB_USB);
  689. cardp->rinfo.priv = priv;
  690. restart:
  691. if (if_usb_submit_rx_urb_fwload(priv) < 0) {
  692. lbs_deb_usbd(&cardp->udev->dev, "URB submission is failed\n");
  693. ret = -1;
  694. goto done;
  695. }
  696. cardp->bootcmdresp = 0;
  697. do {
  698. int j = 0;
  699. i++;
  700. /* Issue Boot command = 1, Boot from Download-FW */
  701. if_usb_issue_boot_command(priv, BOOT_CMD_FW_BY_USB);
  702. /* wait for command response */
  703. do {
  704. j++;
  705. msleep_interruptible(100);
  706. } while (cardp->bootcmdresp == 0 && j < 10);
  707. } while (cardp->bootcmdresp == 0 && i < 5);
  708. if (cardp->bootcmdresp == 0) {
  709. if (--reset_count >= 0) {
  710. libertas_do_reset(priv);
  711. goto restart;
  712. }
  713. return -1;
  714. }
  715. i = 0;
  716. priv->adapter->fw_ready = 0;
  717. cardp->totalbytes = 0;
  718. cardp->fwlastblksent = 0;
  719. cardp->CRC_OK = 1;
  720. cardp->fwdnldover = 0;
  721. cardp->fwseqnum = -1;
  722. cardp->totalbytes = 0;
  723. cardp->fwfinalblk = 0;
  724. if_prog_firmware(priv);
  725. do {
  726. lbs_deb_usbd(&cardp->udev->dev,"Wlan sched timeout\n");
  727. i++;
  728. msleep_interruptible(100);
  729. if (priv->adapter->surpriseremoved || i >= 20)
  730. break;
  731. } while (!cardp->fwdnldover);
  732. if (!cardp->fwdnldover) {
  733. lbs_pr_info("failed to load fw, resetting device!\n");
  734. if (--reset_count >= 0) {
  735. libertas_do_reset(priv);
  736. goto restart;
  737. }
  738. lbs_pr_info("FW download failure, time = %d ms\n", i * 100);
  739. ret = -1;
  740. goto done;
  741. }
  742. if_usb_submit_rx_urb(priv);
  743. /* Delay 200 ms to waiting for the FW ready */
  744. msleep_interruptible(200);
  745. priv->adapter->fw_ready = 1;
  746. done:
  747. lbs_deb_leave_args(LBS_DEB_USB, "ret %d", ret);
  748. return ret;
  749. }
  750. #ifdef CONFIG_PM
  751. static int if_usb_suspend(struct usb_interface *intf, pm_message_t message)
  752. {
  753. struct usb_card_rec *cardp = usb_get_intfdata(intf);
  754. wlan_private *priv = cardp->priv;
  755. lbs_deb_enter(LBS_DEB_USB);
  756. if (priv->adapter->psstate != PS_STATE_FULL_POWER)
  757. return -1;
  758. netif_device_detach(cardp->eth_dev);
  759. netif_device_detach(priv->mesh_dev);
  760. /* Unlink tx & rx urb */
  761. usb_kill_urb(cardp->tx_urb);
  762. usb_kill_urb(cardp->rx_urb);
  763. cardp->rx_urb_recall = 1;
  764. lbs_deb_leave(LBS_DEB_USB);
  765. return 0;
  766. }
  767. static int if_usb_resume(struct usb_interface *intf)
  768. {
  769. struct usb_card_rec *cardp = usb_get_intfdata(intf);
  770. wlan_private *priv = cardp->priv;
  771. lbs_deb_enter(LBS_DEB_USB);
  772. cardp->rx_urb_recall = 0;
  773. if_usb_submit_rx_urb(cardp->priv);
  774. netif_device_attach(cardp->eth_dev);
  775. netif_device_attach(priv->mesh_dev);
  776. lbs_deb_leave(LBS_DEB_USB);
  777. return 0;
  778. }
  779. #else
  780. #define if_usb_suspend NULL
  781. #define if_usb_resume NULL
  782. #endif
  783. static struct usb_driver if_usb_driver = {
  784. /* driver name */
  785. .name = usbdriver_name,
  786. /* probe function name */
  787. .probe = if_usb_probe,
  788. /* disconnect function name */
  789. .disconnect = if_usb_disconnect,
  790. /* device signature table */
  791. .id_table = if_usb_table,
  792. .suspend = if_usb_suspend,
  793. .resume = if_usb_resume,
  794. };
  795. /**
  796. * @brief This function registers driver.
  797. * @param add pointer to add_card callback function
  798. * @param remove pointer to remove card callback function
  799. * @param arg pointer to call back function parameter
  800. * @return dummy success variable
  801. */
  802. int if_usb_register(void)
  803. {
  804. /*
  805. * API registers the Marvell USB driver
  806. * to the USB system
  807. */
  808. usb_register(&if_usb_driver);
  809. /* Return success to wlan layer */
  810. return 0;
  811. }
  812. /**
  813. * @brief This function removes usb driver.
  814. * @return N/A
  815. */
  816. void if_usb_unregister(void)
  817. {
  818. int i;
  819. for (i = 0; i<libertas_found; i++) {
  820. wlan_private *priv = libertas_devs[i]->priv;
  821. reset_device(priv);
  822. }
  823. /* API unregisters the driver from USB subsystem */
  824. usb_deregister(&if_usb_driver);
  825. }