if_usb.c 27 KB

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