if_usb.c 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020
  1. /*
  2. * This file contains functions used in USB interface module.
  3. */
  4. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  5. #include <linux/delay.h>
  6. #include <linux/module.h>
  7. #include <linux/firmware.h>
  8. #include <linux/netdevice.h>
  9. #include <linux/slab.h>
  10. #include <linux/usb.h>
  11. #ifdef CONFIG_OLPC
  12. #include <asm/olpc.h>
  13. #endif
  14. #define DRV_NAME "usb8xxx"
  15. #include "host.h"
  16. #include "decl.h"
  17. #include "defs.h"
  18. #include "dev.h"
  19. #include "cmd.h"
  20. #include "if_usb.h"
  21. #define INSANEDEBUG 0
  22. #define lbs_deb_usb2(...) do { if (INSANEDEBUG) lbs_deb_usbd(__VA_ARGS__); } while (0)
  23. #define MESSAGE_HEADER_LEN 4
  24. MODULE_FIRMWARE("libertas/usb8388_v9.bin");
  25. MODULE_FIRMWARE("libertas/usb8388_v5.bin");
  26. MODULE_FIRMWARE("libertas/usb8388.bin");
  27. MODULE_FIRMWARE("libertas/usb8682.bin");
  28. MODULE_FIRMWARE("usb8388.bin");
  29. enum {
  30. MODEL_UNKNOWN = 0x0,
  31. MODEL_8388 = 0x1,
  32. MODEL_8682 = 0x2
  33. };
  34. /* table of firmware file names */
  35. static const struct lbs_fw_table fw_table[] = {
  36. { MODEL_8388, "libertas/usb8388_olpc.bin", NULL },
  37. { MODEL_8388, "libertas/usb8388_v9.bin", NULL },
  38. { MODEL_8388, "libertas/usb8388_v5.bin", NULL },
  39. { MODEL_8388, "libertas/usb8388.bin", NULL },
  40. { MODEL_8388, "usb8388.bin", NULL },
  41. { MODEL_8682, "libertas/usb8682.bin", NULL }
  42. };
  43. static struct usb_device_id if_usb_table[] = {
  44. /* Enter the device signature inside */
  45. { USB_DEVICE(0x1286, 0x2001), .driver_info = MODEL_8388 },
  46. { USB_DEVICE(0x05a3, 0x8388), .driver_info = MODEL_8388 },
  47. {} /* Terminating entry */
  48. };
  49. MODULE_DEVICE_TABLE(usb, if_usb_table);
  50. static void if_usb_receive(struct urb *urb);
  51. static void if_usb_receive_fwload(struct urb *urb);
  52. static void if_usb_prog_firmware(struct lbs_private *priv, int ret,
  53. const struct firmware *fw,
  54. const struct firmware *unused);
  55. static int if_usb_host_to_card(struct lbs_private *priv, uint8_t type,
  56. uint8_t *payload, uint16_t nb);
  57. static int usb_tx_block(struct if_usb_card *cardp, uint8_t *payload,
  58. uint16_t nb);
  59. static void if_usb_free(struct if_usb_card *cardp);
  60. static int if_usb_submit_rx_urb(struct if_usb_card *cardp);
  61. static int if_usb_reset_device(struct if_usb_card *cardp);
  62. /**
  63. * if_usb_write_bulk_callback - callback function to handle the status
  64. * of the URB
  65. * @urb: pointer to &urb structure
  66. * returns: N/A
  67. */
  68. static void if_usb_write_bulk_callback(struct urb *urb)
  69. {
  70. struct if_usb_card *cardp = (struct if_usb_card *) urb->context;
  71. /* handle the transmission complete validations */
  72. if (urb->status == 0) {
  73. struct lbs_private *priv = cardp->priv;
  74. lbs_deb_usb2(&urb->dev->dev, "URB status is successful\n");
  75. lbs_deb_usb2(&urb->dev->dev, "Actual length transmitted %d\n",
  76. urb->actual_length);
  77. /* Boot commands such as UPDATE_FW and UPDATE_BOOT2 are not
  78. * passed up to the lbs level.
  79. */
  80. if (priv && priv->dnld_sent != DNLD_BOOTCMD_SENT)
  81. lbs_host_to_card_done(priv);
  82. } else {
  83. /* print the failure status number for debug */
  84. pr_info("URB in failure status: %d\n", urb->status);
  85. }
  86. }
  87. /**
  88. * if_usb_free - free tx/rx urb, skb and rx buffer
  89. * @cardp: pointer to &if_usb_card
  90. * returns: N/A
  91. */
  92. static void if_usb_free(struct if_usb_card *cardp)
  93. {
  94. lbs_deb_enter(LBS_DEB_USB);
  95. /* Unlink tx & rx urb */
  96. usb_kill_urb(cardp->tx_urb);
  97. usb_kill_urb(cardp->rx_urb);
  98. usb_free_urb(cardp->tx_urb);
  99. cardp->tx_urb = NULL;
  100. usb_free_urb(cardp->rx_urb);
  101. cardp->rx_urb = NULL;
  102. kfree(cardp->ep_out_buf);
  103. cardp->ep_out_buf = NULL;
  104. lbs_deb_leave(LBS_DEB_USB);
  105. }
  106. static void if_usb_setup_firmware(struct lbs_private *priv)
  107. {
  108. struct if_usb_card *cardp = priv->card;
  109. struct cmd_ds_set_boot2_ver b2_cmd;
  110. struct cmd_ds_802_11_fw_wake_method wake_method;
  111. b2_cmd.hdr.size = cpu_to_le16(sizeof(b2_cmd));
  112. b2_cmd.action = 0;
  113. b2_cmd.version = cardp->boot2_version;
  114. if (lbs_cmd_with_response(priv, CMD_SET_BOOT2_VER, &b2_cmd))
  115. lbs_deb_usb("Setting boot2 version failed\n");
  116. priv->wol_gpio = 2; /* Wake via GPIO2... */
  117. priv->wol_gap = 20; /* ... after 20ms */
  118. lbs_host_sleep_cfg(priv, EHS_WAKE_ON_UNICAST_DATA,
  119. (struct wol_config *) NULL);
  120. wake_method.hdr.size = cpu_to_le16(sizeof(wake_method));
  121. wake_method.action = cpu_to_le16(CMD_ACT_GET);
  122. if (lbs_cmd_with_response(priv, CMD_802_11_FW_WAKE_METHOD, &wake_method)) {
  123. netdev_info(priv->dev, "Firmware does not seem to support PS mode\n");
  124. priv->fwcapinfo &= ~FW_CAPINFO_PS;
  125. } else {
  126. if (le16_to_cpu(wake_method.method) == CMD_WAKE_METHOD_COMMAND_INT) {
  127. lbs_deb_usb("Firmware seems to support PS with wake-via-command\n");
  128. } else {
  129. /* The versions which boot up this way don't seem to
  130. work even if we set it to the command interrupt */
  131. priv->fwcapinfo &= ~FW_CAPINFO_PS;
  132. netdev_info(priv->dev,
  133. "Firmware doesn't wake via command interrupt; disabling PS mode\n");
  134. }
  135. }
  136. }
  137. static void if_usb_fw_timeo(unsigned long priv)
  138. {
  139. struct if_usb_card *cardp = (void *)priv;
  140. if (cardp->fwdnldover) {
  141. lbs_deb_usb("Download complete, no event. Assuming success\n");
  142. } else {
  143. pr_err("Download timed out\n");
  144. cardp->surprise_removed = 1;
  145. }
  146. wake_up(&cardp->fw_wq);
  147. }
  148. #ifdef CONFIG_OLPC
  149. static void if_usb_reset_olpc_card(struct lbs_private *priv)
  150. {
  151. printk(KERN_CRIT "Resetting OLPC wireless via EC...\n");
  152. olpc_ec_cmd(0x25, NULL, 0, NULL, 0);
  153. }
  154. #endif
  155. /**
  156. * if_usb_probe - sets the configuration values
  157. * @intf: &usb_interface pointer
  158. * @id: pointer to usb_device_id
  159. * returns: 0 on success, error code on failure
  160. */
  161. static int if_usb_probe(struct usb_interface *intf,
  162. const struct usb_device_id *id)
  163. {
  164. struct usb_device *udev;
  165. struct usb_host_interface *iface_desc;
  166. struct usb_endpoint_descriptor *endpoint;
  167. struct lbs_private *priv;
  168. struct if_usb_card *cardp;
  169. int r = -ENOMEM;
  170. int i;
  171. udev = interface_to_usbdev(intf);
  172. cardp = kzalloc(sizeof(struct if_usb_card), GFP_KERNEL);
  173. if (!cardp)
  174. goto error;
  175. setup_timer(&cardp->fw_timeout, if_usb_fw_timeo, (unsigned long)cardp);
  176. init_waitqueue_head(&cardp->fw_wq);
  177. cardp->udev = udev;
  178. cardp->model = (uint32_t) id->driver_info;
  179. iface_desc = intf->cur_altsetting;
  180. lbs_deb_usbd(&udev->dev, "bcdUSB = 0x%X bDeviceClass = 0x%X"
  181. " bDeviceSubClass = 0x%X, bDeviceProtocol = 0x%X\n",
  182. le16_to_cpu(udev->descriptor.bcdUSB),
  183. udev->descriptor.bDeviceClass,
  184. udev->descriptor.bDeviceSubClass,
  185. udev->descriptor.bDeviceProtocol);
  186. for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
  187. endpoint = &iface_desc->endpoint[i].desc;
  188. if (usb_endpoint_is_bulk_in(endpoint)) {
  189. cardp->ep_in_size = le16_to_cpu(endpoint->wMaxPacketSize);
  190. cardp->ep_in = usb_endpoint_num(endpoint);
  191. lbs_deb_usbd(&udev->dev, "in_endpoint = %d\n", cardp->ep_in);
  192. lbs_deb_usbd(&udev->dev, "Bulk in size is %d\n", cardp->ep_in_size);
  193. } else if (usb_endpoint_is_bulk_out(endpoint)) {
  194. cardp->ep_out_size = le16_to_cpu(endpoint->wMaxPacketSize);
  195. cardp->ep_out = usb_endpoint_num(endpoint);
  196. lbs_deb_usbd(&udev->dev, "out_endpoint = %d\n", cardp->ep_out);
  197. lbs_deb_usbd(&udev->dev, "Bulk out size is %d\n", cardp->ep_out_size);
  198. }
  199. }
  200. if (!cardp->ep_out_size || !cardp->ep_in_size) {
  201. lbs_deb_usbd(&udev->dev, "Endpoints not found\n");
  202. goto dealloc;
  203. }
  204. if (!(cardp->rx_urb = usb_alloc_urb(0, GFP_KERNEL))) {
  205. lbs_deb_usbd(&udev->dev, "Rx URB allocation failed\n");
  206. goto dealloc;
  207. }
  208. if (!(cardp->tx_urb = usb_alloc_urb(0, GFP_KERNEL))) {
  209. lbs_deb_usbd(&udev->dev, "Tx URB allocation failed\n");
  210. goto dealloc;
  211. }
  212. cardp->ep_out_buf = kmalloc(MRVDRV_ETH_TX_PACKET_BUFFER_SIZE, GFP_KERNEL);
  213. if (!cardp->ep_out_buf) {
  214. lbs_deb_usbd(&udev->dev, "Could not allocate buffer\n");
  215. goto dealloc;
  216. }
  217. if (!(priv = lbs_add_card(cardp, &intf->dev)))
  218. goto err_add_card;
  219. cardp->priv = priv;
  220. priv->hw_host_to_card = if_usb_host_to_card;
  221. priv->enter_deep_sleep = NULL;
  222. priv->exit_deep_sleep = NULL;
  223. priv->reset_deep_sleep_wakeup = NULL;
  224. #ifdef CONFIG_OLPC
  225. if (machine_is_olpc())
  226. priv->reset_card = if_usb_reset_olpc_card;
  227. #endif
  228. cardp->boot2_version = udev->descriptor.bcdDevice;
  229. usb_get_dev(udev);
  230. usb_set_intfdata(intf, cardp);
  231. r = lbs_get_firmware_async(priv, &udev->dev, cardp->model,
  232. fw_table, if_usb_prog_firmware);
  233. if (r)
  234. goto err_get_fw;
  235. return 0;
  236. err_get_fw:
  237. lbs_remove_card(priv);
  238. err_add_card:
  239. if_usb_reset_device(cardp);
  240. dealloc:
  241. if_usb_free(cardp);
  242. error:
  243. return r;
  244. }
  245. /**
  246. * if_usb_disconnect - free resource and cleanup
  247. * @intf: USB interface structure
  248. * returns: N/A
  249. */
  250. static void if_usb_disconnect(struct usb_interface *intf)
  251. {
  252. struct if_usb_card *cardp = usb_get_intfdata(intf);
  253. struct lbs_private *priv = cardp->priv;
  254. lbs_deb_enter(LBS_DEB_MAIN);
  255. cardp->surprise_removed = 1;
  256. if (priv) {
  257. lbs_stop_card(priv);
  258. lbs_remove_card(priv);
  259. }
  260. /* Unlink and free urb */
  261. if_usb_free(cardp);
  262. usb_set_intfdata(intf, NULL);
  263. usb_put_dev(interface_to_usbdev(intf));
  264. lbs_deb_leave(LBS_DEB_MAIN);
  265. }
  266. /**
  267. * if_usb_send_fw_pkt - download FW
  268. * @cardp: pointer to &struct if_usb_card
  269. * returns: 0
  270. */
  271. static int if_usb_send_fw_pkt(struct if_usb_card *cardp)
  272. {
  273. struct fwdata *fwdata = cardp->ep_out_buf;
  274. const uint8_t *firmware = cardp->fw->data;
  275. /* If we got a CRC failure on the last block, back
  276. up and retry it */
  277. if (!cardp->CRC_OK) {
  278. cardp->totalbytes = cardp->fwlastblksent;
  279. cardp->fwseqnum--;
  280. }
  281. lbs_deb_usb2(&cardp->udev->dev, "totalbytes = %d\n",
  282. cardp->totalbytes);
  283. /* struct fwdata (which we sent to the card) has an
  284. extra __le32 field in between the header and the data,
  285. which is not in the struct fwheader in the actual
  286. firmware binary. Insert the seqnum in the middle... */
  287. memcpy(&fwdata->hdr, &firmware[cardp->totalbytes],
  288. sizeof(struct fwheader));
  289. cardp->fwlastblksent = cardp->totalbytes;
  290. cardp->totalbytes += sizeof(struct fwheader);
  291. memcpy(fwdata->data, &firmware[cardp->totalbytes],
  292. le32_to_cpu(fwdata->hdr.datalength));
  293. lbs_deb_usb2(&cardp->udev->dev, "Data length = %d\n",
  294. le32_to_cpu(fwdata->hdr.datalength));
  295. fwdata->seqnum = cpu_to_le32(++cardp->fwseqnum);
  296. cardp->totalbytes += le32_to_cpu(fwdata->hdr.datalength);
  297. usb_tx_block(cardp, cardp->ep_out_buf, sizeof(struct fwdata) +
  298. le32_to_cpu(fwdata->hdr.datalength));
  299. if (fwdata->hdr.dnldcmd == cpu_to_le32(FW_HAS_DATA_TO_RECV)) {
  300. lbs_deb_usb2(&cardp->udev->dev, "There are data to follow\n");
  301. lbs_deb_usb2(&cardp->udev->dev, "seqnum = %d totalbytes = %d\n",
  302. cardp->fwseqnum, cardp->totalbytes);
  303. } else if (fwdata->hdr.dnldcmd == cpu_to_le32(FW_HAS_LAST_BLOCK)) {
  304. lbs_deb_usb2(&cardp->udev->dev, "Host has finished FW downloading\n");
  305. lbs_deb_usb2(&cardp->udev->dev, "Donwloading FW JUMP BLOCK\n");
  306. cardp->fwfinalblk = 1;
  307. }
  308. lbs_deb_usb2(&cardp->udev->dev, "Firmware download done; size %d\n",
  309. cardp->totalbytes);
  310. return 0;
  311. }
  312. static int if_usb_reset_device(struct if_usb_card *cardp)
  313. {
  314. struct cmd_header *cmd = cardp->ep_out_buf + 4;
  315. int ret;
  316. lbs_deb_enter(LBS_DEB_USB);
  317. *(__le32 *)cardp->ep_out_buf = cpu_to_le32(CMD_TYPE_REQUEST);
  318. cmd->command = cpu_to_le16(CMD_802_11_RESET);
  319. cmd->size = cpu_to_le16(sizeof(cmd));
  320. cmd->result = cpu_to_le16(0);
  321. cmd->seqnum = cpu_to_le16(0x5a5a);
  322. usb_tx_block(cardp, cardp->ep_out_buf, 4 + sizeof(struct cmd_header));
  323. msleep(100);
  324. ret = usb_reset_device(cardp->udev);
  325. msleep(100);
  326. #ifdef CONFIG_OLPC
  327. if (ret && machine_is_olpc())
  328. if_usb_reset_olpc_card(NULL);
  329. #endif
  330. lbs_deb_leave_args(LBS_DEB_USB, "ret %d", ret);
  331. return ret;
  332. }
  333. /**
  334. * usb_tx_block - transfer the data to the device
  335. * @cardp: pointer to &struct if_usb_card
  336. * @payload: pointer to payload data
  337. * @nb: data length
  338. * returns: 0 for success or negative error code
  339. */
  340. static int usb_tx_block(struct if_usb_card *cardp, uint8_t *payload, uint16_t nb)
  341. {
  342. int ret;
  343. /* check if device is removed */
  344. if (cardp->surprise_removed) {
  345. lbs_deb_usbd(&cardp->udev->dev, "Device removed\n");
  346. ret = -ENODEV;
  347. goto tx_ret;
  348. }
  349. usb_fill_bulk_urb(cardp->tx_urb, cardp->udev,
  350. usb_sndbulkpipe(cardp->udev,
  351. cardp->ep_out),
  352. payload, nb, if_usb_write_bulk_callback, cardp);
  353. cardp->tx_urb->transfer_flags |= URB_ZERO_PACKET;
  354. if ((ret = usb_submit_urb(cardp->tx_urb, GFP_ATOMIC))) {
  355. lbs_deb_usbd(&cardp->udev->dev, "usb_submit_urb failed: %d\n", ret);
  356. } else {
  357. lbs_deb_usb2(&cardp->udev->dev, "usb_submit_urb success\n");
  358. ret = 0;
  359. }
  360. tx_ret:
  361. return ret;
  362. }
  363. static int __if_usb_submit_rx_urb(struct if_usb_card *cardp,
  364. void (*callbackfn)(struct urb *urb))
  365. {
  366. struct sk_buff *skb;
  367. int ret = -1;
  368. if (!(skb = dev_alloc_skb(MRVDRV_ETH_RX_PACKET_BUFFER_SIZE))) {
  369. pr_err("No free skb\n");
  370. goto rx_ret;
  371. }
  372. cardp->rx_skb = skb;
  373. /* Fill the receive configuration URB and initialise the Rx call back */
  374. usb_fill_bulk_urb(cardp->rx_urb, cardp->udev,
  375. usb_rcvbulkpipe(cardp->udev, cardp->ep_in),
  376. skb->data + IPFIELD_ALIGN_OFFSET,
  377. MRVDRV_ETH_RX_PACKET_BUFFER_SIZE, callbackfn,
  378. cardp);
  379. cardp->rx_urb->transfer_flags |= URB_ZERO_PACKET;
  380. lbs_deb_usb2(&cardp->udev->dev, "Pointer for rx_urb %p\n", cardp->rx_urb);
  381. if ((ret = usb_submit_urb(cardp->rx_urb, GFP_ATOMIC))) {
  382. lbs_deb_usbd(&cardp->udev->dev, "Submit Rx URB failed: %d\n", ret);
  383. kfree_skb(skb);
  384. cardp->rx_skb = NULL;
  385. ret = -1;
  386. } else {
  387. lbs_deb_usb2(&cardp->udev->dev, "Submit Rx URB success\n");
  388. ret = 0;
  389. }
  390. rx_ret:
  391. return ret;
  392. }
  393. static int if_usb_submit_rx_urb_fwload(struct if_usb_card *cardp)
  394. {
  395. return __if_usb_submit_rx_urb(cardp, &if_usb_receive_fwload);
  396. }
  397. static int if_usb_submit_rx_urb(struct if_usb_card *cardp)
  398. {
  399. return __if_usb_submit_rx_urb(cardp, &if_usb_receive);
  400. }
  401. static void if_usb_receive_fwload(struct urb *urb)
  402. {
  403. struct if_usb_card *cardp = urb->context;
  404. struct sk_buff *skb = cardp->rx_skb;
  405. struct fwsyncheader *syncfwheader;
  406. struct bootcmdresp bootcmdresp;
  407. if (urb->status) {
  408. lbs_deb_usbd(&cardp->udev->dev,
  409. "URB status is failed during fw load\n");
  410. kfree_skb(skb);
  411. return;
  412. }
  413. if (cardp->fwdnldover) {
  414. __le32 *tmp = (__le32 *)(skb->data + IPFIELD_ALIGN_OFFSET);
  415. if (tmp[0] == cpu_to_le32(CMD_TYPE_INDICATION) &&
  416. tmp[1] == cpu_to_le32(MACREG_INT_CODE_FIRMWARE_READY)) {
  417. pr_info("Firmware ready event received\n");
  418. wake_up(&cardp->fw_wq);
  419. } else {
  420. lbs_deb_usb("Waiting for confirmation; got %x %x\n",
  421. le32_to_cpu(tmp[0]), le32_to_cpu(tmp[1]));
  422. if_usb_submit_rx_urb_fwload(cardp);
  423. }
  424. kfree_skb(skb);
  425. return;
  426. }
  427. if (cardp->bootcmdresp <= 0) {
  428. memcpy (&bootcmdresp, skb->data + IPFIELD_ALIGN_OFFSET,
  429. sizeof(bootcmdresp));
  430. if (le16_to_cpu(cardp->udev->descriptor.bcdDevice) < 0x3106) {
  431. kfree_skb(skb);
  432. if_usb_submit_rx_urb_fwload(cardp);
  433. cardp->bootcmdresp = BOOT_CMD_RESP_OK;
  434. lbs_deb_usbd(&cardp->udev->dev,
  435. "Received valid boot command response\n");
  436. return;
  437. }
  438. if (bootcmdresp.magic != cpu_to_le32(BOOT_CMD_MAGIC_NUMBER)) {
  439. if (bootcmdresp.magic == cpu_to_le32(CMD_TYPE_REQUEST) ||
  440. bootcmdresp.magic == cpu_to_le32(CMD_TYPE_DATA) ||
  441. bootcmdresp.magic == cpu_to_le32(CMD_TYPE_INDICATION)) {
  442. if (!cardp->bootcmdresp)
  443. pr_info("Firmware already seems alive; resetting\n");
  444. cardp->bootcmdresp = -1;
  445. } else {
  446. pr_info("boot cmd response wrong magic number (0x%x)\n",
  447. le32_to_cpu(bootcmdresp.magic));
  448. }
  449. } else if ((bootcmdresp.cmd != BOOT_CMD_FW_BY_USB) &&
  450. (bootcmdresp.cmd != BOOT_CMD_UPDATE_FW) &&
  451. (bootcmdresp.cmd != BOOT_CMD_UPDATE_BOOT2)) {
  452. pr_info("boot cmd response cmd_tag error (%d)\n",
  453. bootcmdresp.cmd);
  454. } else if (bootcmdresp.result != BOOT_CMD_RESP_OK) {
  455. pr_info("boot cmd response result error (%d)\n",
  456. bootcmdresp.result);
  457. } else {
  458. cardp->bootcmdresp = 1;
  459. lbs_deb_usbd(&cardp->udev->dev,
  460. "Received valid boot command response\n");
  461. }
  462. kfree_skb(skb);
  463. if_usb_submit_rx_urb_fwload(cardp);
  464. return;
  465. }
  466. syncfwheader = kmemdup(skb->data + IPFIELD_ALIGN_OFFSET,
  467. sizeof(struct fwsyncheader), GFP_ATOMIC);
  468. if (!syncfwheader) {
  469. lbs_deb_usbd(&cardp->udev->dev, "Failure to allocate syncfwheader\n");
  470. kfree_skb(skb);
  471. return;
  472. }
  473. if (!syncfwheader->cmd) {
  474. lbs_deb_usb2(&cardp->udev->dev, "FW received Blk with correct CRC\n");
  475. lbs_deb_usb2(&cardp->udev->dev, "FW received Blk seqnum = %d\n",
  476. le32_to_cpu(syncfwheader->seqnum));
  477. cardp->CRC_OK = 1;
  478. } else {
  479. lbs_deb_usbd(&cardp->udev->dev, "FW received Blk with CRC error\n");
  480. cardp->CRC_OK = 0;
  481. }
  482. kfree_skb(skb);
  483. /* Give device 5s to either write firmware to its RAM or eeprom */
  484. mod_timer(&cardp->fw_timeout, jiffies + (HZ*5));
  485. if (cardp->fwfinalblk) {
  486. cardp->fwdnldover = 1;
  487. goto exit;
  488. }
  489. if_usb_send_fw_pkt(cardp);
  490. exit:
  491. if_usb_submit_rx_urb_fwload(cardp);
  492. kfree(syncfwheader);
  493. }
  494. #define MRVDRV_MIN_PKT_LEN 30
  495. static inline void process_cmdtypedata(int recvlength, struct sk_buff *skb,
  496. struct if_usb_card *cardp,
  497. struct lbs_private *priv)
  498. {
  499. if (recvlength > MRVDRV_ETH_RX_PACKET_BUFFER_SIZE + MESSAGE_HEADER_LEN
  500. || recvlength < MRVDRV_MIN_PKT_LEN) {
  501. lbs_deb_usbd(&cardp->udev->dev, "Packet length is Invalid\n");
  502. kfree_skb(skb);
  503. return;
  504. }
  505. skb_reserve(skb, IPFIELD_ALIGN_OFFSET);
  506. skb_put(skb, recvlength);
  507. skb_pull(skb, MESSAGE_HEADER_LEN);
  508. lbs_process_rxed_packet(priv, skb);
  509. }
  510. static inline void process_cmdrequest(int recvlength, uint8_t *recvbuff,
  511. struct sk_buff *skb,
  512. struct if_usb_card *cardp,
  513. struct lbs_private *priv)
  514. {
  515. u8 i;
  516. if (recvlength > LBS_CMD_BUFFER_SIZE) {
  517. lbs_deb_usbd(&cardp->udev->dev,
  518. "The receive buffer is too large\n");
  519. kfree_skb(skb);
  520. return;
  521. }
  522. BUG_ON(!in_interrupt());
  523. spin_lock(&priv->driver_lock);
  524. i = (priv->resp_idx == 0) ? 1 : 0;
  525. BUG_ON(priv->resp_len[i]);
  526. priv->resp_len[i] = (recvlength - MESSAGE_HEADER_LEN);
  527. memcpy(priv->resp_buf[i], recvbuff + MESSAGE_HEADER_LEN,
  528. priv->resp_len[i]);
  529. kfree_skb(skb);
  530. lbs_notify_command_response(priv, i);
  531. spin_unlock(&priv->driver_lock);
  532. lbs_deb_usbd(&cardp->udev->dev,
  533. "Wake up main thread to handle cmd response\n");
  534. }
  535. /**
  536. * if_usb_receive - read the packet into the upload buffer,
  537. * wake up the main thread and initialise the Rx callack
  538. *
  539. * @urb: pointer to &struct urb
  540. * returns: N/A
  541. */
  542. static void if_usb_receive(struct urb *urb)
  543. {
  544. struct if_usb_card *cardp = urb->context;
  545. struct sk_buff *skb = cardp->rx_skb;
  546. struct lbs_private *priv = cardp->priv;
  547. int recvlength = urb->actual_length;
  548. uint8_t *recvbuff = NULL;
  549. uint32_t recvtype = 0;
  550. __le32 *pkt = (__le32 *)(skb->data + IPFIELD_ALIGN_OFFSET);
  551. uint32_t event;
  552. lbs_deb_enter(LBS_DEB_USB);
  553. if (recvlength) {
  554. if (urb->status) {
  555. lbs_deb_usbd(&cardp->udev->dev, "RX URB failed: %d\n",
  556. urb->status);
  557. kfree_skb(skb);
  558. goto setup_for_next;
  559. }
  560. recvbuff = skb->data + IPFIELD_ALIGN_OFFSET;
  561. recvtype = le32_to_cpu(pkt[0]);
  562. lbs_deb_usbd(&cardp->udev->dev,
  563. "Recv length = 0x%x, Recv type = 0x%X\n",
  564. recvlength, recvtype);
  565. } else if (urb->status) {
  566. kfree_skb(skb);
  567. goto rx_exit;
  568. }
  569. switch (recvtype) {
  570. case CMD_TYPE_DATA:
  571. process_cmdtypedata(recvlength, skb, cardp, priv);
  572. break;
  573. case CMD_TYPE_REQUEST:
  574. process_cmdrequest(recvlength, recvbuff, skb, cardp, priv);
  575. break;
  576. case CMD_TYPE_INDICATION:
  577. /* Event handling */
  578. event = le32_to_cpu(pkt[1]);
  579. lbs_deb_usbd(&cardp->udev->dev, "**EVENT** 0x%X\n", event);
  580. kfree_skb(skb);
  581. /* Icky undocumented magic special case */
  582. if (event & 0xffff0000) {
  583. u32 trycount = (event & 0xffff0000) >> 16;
  584. lbs_send_tx_feedback(priv, trycount);
  585. } else
  586. lbs_queue_event(priv, event & 0xFF);
  587. break;
  588. default:
  589. lbs_deb_usbd(&cardp->udev->dev, "Unknown command type 0x%X\n",
  590. recvtype);
  591. kfree_skb(skb);
  592. break;
  593. }
  594. setup_for_next:
  595. if_usb_submit_rx_urb(cardp);
  596. rx_exit:
  597. lbs_deb_leave(LBS_DEB_USB);
  598. }
  599. /**
  600. * if_usb_host_to_card - downloads data to FW
  601. * @priv: pointer to &struct lbs_private structure
  602. * @type: type of data
  603. * @payload: pointer to data buffer
  604. * @nb: number of bytes
  605. * returns: 0 for success or negative error code
  606. */
  607. static int if_usb_host_to_card(struct lbs_private *priv, uint8_t type,
  608. uint8_t *payload, uint16_t nb)
  609. {
  610. struct if_usb_card *cardp = priv->card;
  611. lbs_deb_usbd(&cardp->udev->dev,"*** type = %u\n", type);
  612. lbs_deb_usbd(&cardp->udev->dev,"size after = %d\n", nb);
  613. if (type == MVMS_CMD) {
  614. *(__le32 *)cardp->ep_out_buf = cpu_to_le32(CMD_TYPE_REQUEST);
  615. priv->dnld_sent = DNLD_CMD_SENT;
  616. } else {
  617. *(__le32 *)cardp->ep_out_buf = cpu_to_le32(CMD_TYPE_DATA);
  618. priv->dnld_sent = DNLD_DATA_SENT;
  619. }
  620. memcpy((cardp->ep_out_buf + MESSAGE_HEADER_LEN), payload, nb);
  621. return usb_tx_block(cardp, cardp->ep_out_buf, nb + MESSAGE_HEADER_LEN);
  622. }
  623. /**
  624. * if_usb_issue_boot_command - issues Boot command to the Boot2 code
  625. * @cardp: pointer to &if_usb_card
  626. * @ivalue: 1:Boot from FW by USB-Download
  627. * 2:Boot from FW in EEPROM
  628. * returns: 0 for success or negative error code
  629. */
  630. static int if_usb_issue_boot_command(struct if_usb_card *cardp, int ivalue)
  631. {
  632. struct bootcmd *bootcmd = cardp->ep_out_buf;
  633. /* Prepare command */
  634. bootcmd->magic = cpu_to_le32(BOOT_CMD_MAGIC_NUMBER);
  635. bootcmd->cmd = ivalue;
  636. memset(bootcmd->pad, 0, sizeof(bootcmd->pad));
  637. /* Issue command */
  638. usb_tx_block(cardp, cardp->ep_out_buf, sizeof(*bootcmd));
  639. return 0;
  640. }
  641. /**
  642. * check_fwfile_format - check the validity of Boot2/FW image
  643. *
  644. * @data: pointer to image
  645. * @totlen: image length
  646. * returns: 0 (good) or 1 (failure)
  647. */
  648. static int check_fwfile_format(const uint8_t *data, uint32_t totlen)
  649. {
  650. uint32_t bincmd, exit;
  651. uint32_t blksize, offset, len;
  652. int ret;
  653. ret = 1;
  654. exit = len = 0;
  655. do {
  656. struct fwheader *fwh = (void *)data;
  657. bincmd = le32_to_cpu(fwh->dnldcmd);
  658. blksize = le32_to_cpu(fwh->datalength);
  659. switch (bincmd) {
  660. case FW_HAS_DATA_TO_RECV:
  661. offset = sizeof(struct fwheader) + blksize;
  662. data += offset;
  663. len += offset;
  664. if (len >= totlen)
  665. exit = 1;
  666. break;
  667. case FW_HAS_LAST_BLOCK:
  668. exit = 1;
  669. ret = 0;
  670. break;
  671. default:
  672. exit = 1;
  673. break;
  674. }
  675. } while (!exit);
  676. if (ret)
  677. pr_err("firmware file format check FAIL\n");
  678. else
  679. lbs_deb_fw("firmware file format check PASS\n");
  680. return ret;
  681. }
  682. static void if_usb_prog_firmware(struct lbs_private *priv, int ret,
  683. const struct firmware *fw,
  684. const struct firmware *unused)
  685. {
  686. struct if_usb_card *cardp = priv->card;
  687. int i = 0;
  688. static int reset_count = 10;
  689. lbs_deb_enter(LBS_DEB_USB);
  690. if (ret) {
  691. pr_err("failed to find firmware (%d)\n", ret);
  692. goto done;
  693. }
  694. cardp->fw = fw;
  695. if (check_fwfile_format(cardp->fw->data, cardp->fw->size)) {
  696. ret = -EINVAL;
  697. goto release_fw;
  698. }
  699. /* Cancel any pending usb business */
  700. usb_kill_urb(cardp->rx_urb);
  701. usb_kill_urb(cardp->tx_urb);
  702. cardp->fwlastblksent = 0;
  703. cardp->fwdnldover = 0;
  704. cardp->totalbytes = 0;
  705. cardp->fwfinalblk = 0;
  706. cardp->bootcmdresp = 0;
  707. restart:
  708. if (if_usb_submit_rx_urb_fwload(cardp) < 0) {
  709. lbs_deb_usbd(&cardp->udev->dev, "URB submission is failed\n");
  710. ret = -EIO;
  711. goto release_fw;
  712. }
  713. cardp->bootcmdresp = 0;
  714. do {
  715. int j = 0;
  716. i++;
  717. if_usb_issue_boot_command(cardp, BOOT_CMD_FW_BY_USB);
  718. /* wait for command response */
  719. do {
  720. j++;
  721. msleep_interruptible(100);
  722. } while (cardp->bootcmdresp == 0 && j < 10);
  723. } while (cardp->bootcmdresp == 0 && i < 5);
  724. if (cardp->bootcmdresp == BOOT_CMD_RESP_NOT_SUPPORTED) {
  725. /* Return to normal operation */
  726. ret = -EOPNOTSUPP;
  727. usb_kill_urb(cardp->rx_urb);
  728. usb_kill_urb(cardp->tx_urb);
  729. if (if_usb_submit_rx_urb(cardp) < 0)
  730. ret = -EIO;
  731. goto release_fw;
  732. } else if (cardp->bootcmdresp <= 0) {
  733. if (--reset_count >= 0) {
  734. if_usb_reset_device(cardp);
  735. goto restart;
  736. }
  737. ret = -EIO;
  738. goto release_fw;
  739. }
  740. i = 0;
  741. cardp->totalbytes = 0;
  742. cardp->fwlastblksent = 0;
  743. cardp->CRC_OK = 1;
  744. cardp->fwdnldover = 0;
  745. cardp->fwseqnum = -1;
  746. cardp->totalbytes = 0;
  747. cardp->fwfinalblk = 0;
  748. /* Send the first firmware packet... */
  749. if_usb_send_fw_pkt(cardp);
  750. /* ... and wait for the process to complete */
  751. wait_event_interruptible(cardp->fw_wq, cardp->surprise_removed || cardp->fwdnldover);
  752. del_timer_sync(&cardp->fw_timeout);
  753. usb_kill_urb(cardp->rx_urb);
  754. if (!cardp->fwdnldover) {
  755. pr_info("failed to load fw, resetting device!\n");
  756. if (--reset_count >= 0) {
  757. if_usb_reset_device(cardp);
  758. goto restart;
  759. }
  760. pr_info("FW download failure, time = %d ms\n", i * 100);
  761. ret = -EIO;
  762. goto release_fw;
  763. }
  764. cardp->priv->fw_ready = 1;
  765. if_usb_submit_rx_urb(cardp);
  766. if (lbs_start_card(priv))
  767. goto release_fw;
  768. if_usb_setup_firmware(priv);
  769. /*
  770. * EHS_REMOVE_WAKEUP is not supported on all versions of the firmware.
  771. */
  772. priv->wol_criteria = EHS_REMOVE_WAKEUP;
  773. if (lbs_host_sleep_cfg(priv, priv->wol_criteria, NULL))
  774. priv->ehs_remove_supported = false;
  775. release_fw:
  776. release_firmware(cardp->fw);
  777. cardp->fw = NULL;
  778. done:
  779. lbs_deb_leave(LBS_DEB_USB);
  780. }
  781. #ifdef CONFIG_PM
  782. static int if_usb_suspend(struct usb_interface *intf, pm_message_t message)
  783. {
  784. struct if_usb_card *cardp = usb_get_intfdata(intf);
  785. struct lbs_private *priv = cardp->priv;
  786. int ret;
  787. lbs_deb_enter(LBS_DEB_USB);
  788. if (priv->psstate != PS_STATE_FULL_POWER) {
  789. ret = -1;
  790. goto out;
  791. }
  792. #ifdef CONFIG_OLPC
  793. if (machine_is_olpc()) {
  794. if (priv->wol_criteria == EHS_REMOVE_WAKEUP)
  795. olpc_ec_wakeup_clear(EC_SCI_SRC_WLAN);
  796. else
  797. olpc_ec_wakeup_set(EC_SCI_SRC_WLAN);
  798. }
  799. #endif
  800. ret = lbs_suspend(priv);
  801. if (ret)
  802. goto out;
  803. /* Unlink tx & rx urb */
  804. usb_kill_urb(cardp->tx_urb);
  805. usb_kill_urb(cardp->rx_urb);
  806. out:
  807. lbs_deb_leave(LBS_DEB_USB);
  808. return ret;
  809. }
  810. static int if_usb_resume(struct usb_interface *intf)
  811. {
  812. struct if_usb_card *cardp = usb_get_intfdata(intf);
  813. struct lbs_private *priv = cardp->priv;
  814. lbs_deb_enter(LBS_DEB_USB);
  815. if_usb_submit_rx_urb(cardp);
  816. lbs_resume(priv);
  817. lbs_deb_leave(LBS_DEB_USB);
  818. return 0;
  819. }
  820. #else
  821. #define if_usb_suspend NULL
  822. #define if_usb_resume NULL
  823. #endif
  824. static struct usb_driver if_usb_driver = {
  825. .name = DRV_NAME,
  826. .probe = if_usb_probe,
  827. .disconnect = if_usb_disconnect,
  828. .id_table = if_usb_table,
  829. .suspend = if_usb_suspend,
  830. .resume = if_usb_resume,
  831. .reset_resume = if_usb_resume,
  832. .disable_hub_initiated_lpm = 1,
  833. };
  834. module_usb_driver(if_usb_driver);
  835. MODULE_DESCRIPTION("8388 USB WLAN Driver");
  836. MODULE_AUTHOR("Marvell International Ltd. and Red Hat, Inc.");
  837. MODULE_LICENSE("GPL");