if_usb.c 27 KB

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