if_usb.c 27.0 KB
Newer Older
1 2 3 4
/**
  * This file contains functions used in USB interface module.
  */
#include <linux/delay.h>
5
#include <linux/moduleparam.h>
6 7
#include <linux/firmware.h>
#include <linux/netdevice.h>
8
#include <linux/list.h>
9 10
#include <linux/usb.h>

11 12
#define DRV_NAME "usb8xxx"

13 14 15 16 17
#include "host.h"
#include "decl.h"
#include "defs.h"
#include "dev.h"
#include "if_usb.h"
18
#include "decl.h"
19 20 21 22

#define MESSAGE_HEADER_LEN	4

static const char usbdriver_name[] = "usb8xxx";
23 24
static u8 *default_fw_name = "usb8388.bin";

25
static char *libertas_fw_name = NULL;
26 27
module_param_named(fw_name, libertas_fw_name, charp, 0644);

28 29 30 31 32 33 34 35
/*
 * We need to send a RESET command to all USB devices before
 * we tear down the USB connection. Otherwise we would not
 * be able to re-init device the device if the module gets
 * loaded again. This is a list of all initialized USB devices,
 * for the reset code see if_usb_reset_device()
*/
static LIST_HEAD(usb_devices);
36

37 38
static struct usb_device_id if_usb_table[] = {
	/* Enter the device signature inside */
39 40
	{ USB_DEVICE(0x1286, 0x2001) },
	{ USB_DEVICE(0x05a3, 0x8388) },
41 42 43 44 45 46 47
	{}	/* Terminating entry */
};

MODULE_DEVICE_TABLE(usb, if_usb_table);

static void if_usb_receive(struct urb *urb);
static void if_usb_receive_fwload(struct urb *urb);
48 49 50 51 52 53
static int if_usb_register_dev(wlan_private * priv);
static int if_usb_unregister_dev(wlan_private *);
static int if_usb_prog_firmware(wlan_private *);
static int if_usb_host_to_card(wlan_private * priv, u8 type, u8 * payload, u16 nb);
static int if_usb_get_int_status(wlan_private * priv, u8 *);
static int if_usb_read_event_cause(wlan_private *);
54 55
static int usb_tx_block(wlan_private *priv, u8 *payload, u16 nb);
static void if_usb_free(struct usb_card_rec *cardp);
56 57 58 59 60 61 62 63 64 65

/**
 *  @brief  call back function to handle the status of the URB
 *  @param urb 		pointer to urb structure
 *  @return 	   	N/A
 */
static void if_usb_write_bulk_callback(struct urb *urb)
{
	wlan_private *priv = (wlan_private *) (urb->context);
	wlan_adapter *adapter = priv->adapter;
66
	struct net_device *dev = priv->dev;
67 68 69 70 71

	/* handle the transmission complete validations */

	if (urb->status != 0) {
		/* print the failure status number for debug */
72
		lbs_pr_info("URB in failure status: %d\n", urb->status);
73
	} else {
74 75 76
		/*
		lbs_deb_usbd(&urb->dev->dev, "URB status is successfull\n");
		lbs_deb_usbd(&urb->dev->dev, "Actual length transmitted %d\n",
77
		       urb->actual_length);
78
		*/
79
		priv->dnld_sent = DNLD_RES_RECEIVED;
80 81
		/* Wake main thread if commands are pending */
		if (!adapter->cur_cmd)
82
			wake_up_interruptible(&priv->waitq);
83
		if ((adapter->connect_status == LIBERTAS_CONNECTED)) {
84
			netif_wake_queue(dev);
85 86
			netif_wake_queue(priv->mesh_dev);
		}
87 88 89 90 91 92 93 94 95 96
	}

	return;
}

/**
 *  @brief  free tx/rx urb, skb and rx buffer
 *  @param cardp	pointer usb_card_rec
 *  @return 	   	N/A
 */
97
static void if_usb_free(struct usb_card_rec *cardp)
98
{
99
	lbs_deb_enter(LBS_DEB_USB);
100 101 102 103 104 105 106 107 108 109 110 111 112 113

	/* Unlink tx & rx urb */
	usb_kill_urb(cardp->tx_urb);
	usb_kill_urb(cardp->rx_urb);

	usb_free_urb(cardp->tx_urb);
	cardp->tx_urb = NULL;

	usb_free_urb(cardp->rx_urb);
	cardp->rx_urb = NULL;

	kfree(cardp->bulk_out_buffer);
	cardp->bulk_out_buffer = NULL;

114
	lbs_deb_leave(LBS_DEB_USB);
115 116 117 118 119 120 121 122 123 124 125 126 127 128
}

/**
 *  @brief sets the configuration values
 *  @param ifnum	interface number
 *  @param id		pointer to usb_device_id
 *  @return 	   	0 on success, error code on failure
 */
static int if_usb_probe(struct usb_interface *intf,
			const struct usb_device_id *id)
{
	struct usb_device *udev;
	struct usb_host_interface *iface_desc;
	struct usb_endpoint_descriptor *endpoint;
129
	wlan_private *priv;
130
	struct usb_card_rec *cardp;
131 132 133 134
	int i;

	udev = interface_to_usbdev(intf);

135 136
	cardp = kzalloc(sizeof(struct usb_card_rec), GFP_KERNEL);
	if (!cardp) {
137 138 139 140
		lbs_pr_err("Out of memory allocating private data.\n");
		goto error;
	}

141
	cardp->udev = udev;
142 143
	iface_desc = intf->cur_altsetting;

144
	lbs_deb_usbd(&udev->dev, "bcdUSB = 0x%X bDeviceClass = 0x%X"
145
	       " bDeviceSubClass = 0x%X, bDeviceProtocol = 0x%X\n",
146 147 148 149
		     le16_to_cpu(udev->descriptor.bcdUSB),
		     udev->descriptor.bDeviceClass,
		     udev->descriptor.bDeviceSubClass,
		     udev->descriptor.bDeviceProtocol);
150 151 152 153 154 155 156

	for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
		endpoint = &iface_desc->endpoint[i].desc;
		if ((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK)
		    && ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
			USB_ENDPOINT_XFER_BULK)) {
			/* we found a bulk in endpoint */
157
			lbs_deb_usbd(&udev->dev, "Bulk in size is %d\n",
158 159
				     le16_to_cpu(endpoint->wMaxPacketSize));
			if (!(cardp->rx_urb = usb_alloc_urb(0, GFP_KERNEL))) {
160
				lbs_deb_usbd(&udev->dev,
161 162 163
				       "Rx URB allocation failed\n");
				goto dealloc;
			}
164
			cardp->rx_urb_recall = 0;
165

166
			cardp->bulk_in_size =
167
				le16_to_cpu(endpoint->wMaxPacketSize);
168
			cardp->bulk_in_endpointAddr =
169 170
			    (endpoint->
			     bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
171
			lbs_deb_usbd(&udev->dev, "in_endpoint = %d\n",
172 173 174 175 176 177 178 179 180
			       endpoint->bEndpointAddress);
		}

		if (((endpoint->
		      bEndpointAddress & USB_ENDPOINT_DIR_MASK) ==
		     USB_DIR_OUT)
		    && ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
			USB_ENDPOINT_XFER_BULK)) {
			/* We found bulk out endpoint */
181
			if (!(cardp->tx_urb = usb_alloc_urb(0, GFP_KERNEL))) {
182
				lbs_deb_usbd(&udev->dev,
183 184 185 186
				       "Tx URB allocation failed\n");
				goto dealloc;
			}

187
			cardp->bulk_out_size =
188
				le16_to_cpu(endpoint->wMaxPacketSize);
189
			lbs_deb_usbd(&udev->dev,
190 191
				     "Bulk out size is %d\n",
				     le16_to_cpu(endpoint->wMaxPacketSize));
192
			cardp->bulk_out_endpointAddr =
193
			    endpoint->bEndpointAddress;
194
			lbs_deb_usbd(&udev->dev, "out_endpoint = %d\n",
195
				    endpoint->bEndpointAddress);
196
			cardp->bulk_out_buffer =
197 198 199
			    kmalloc(MRVDRV_ETH_TX_PACKET_BUFFER_SIZE,
				    GFP_KERNEL);

200
			if (!cardp->bulk_out_buffer) {
201
				lbs_deb_usbd(&udev->dev,
202 203 204 205 206 207
				       "Could not allocate buffer\n");
				goto dealloc;
			}
		}
	}

208
	if (!(priv = libertas_add_card(cardp, &udev->dev)))
209
		goto dealloc;
210

211 212
	udev->dev.driver_data = priv;

213
	if (libertas_add_mesh(priv, &udev->dev))
214
		goto err_add_mesh;
215

216 217 218 219 220 221
	priv->hw_register_dev = if_usb_register_dev;
	priv->hw_unregister_dev = if_usb_unregister_dev;
	priv->hw_prog_firmware = if_usb_prog_firmware;
	priv->hw_host_to_card = if_usb_host_to_card;
	priv->hw_get_int_status = if_usb_get_int_status;
	priv->hw_read_event_cause = if_usb_read_event_cause;
222
	priv->boot2_version = udev->descriptor.bcdDevice;
223

H
Holger Schurig 已提交
224
	if (libertas_activate_card(priv))
225
		goto err_activate_card;
226

227
	list_add_tail(&cardp->list, &usb_devices);
228

229
	usb_get_dev(udev);
230
	usb_set_intfdata(intf, cardp);
231 232 233

	return 0;

234
err_activate_card:
235
	libertas_remove_mesh(priv);
236
err_add_mesh:
237
	free_netdev(priv->dev);
238
	kfree(priv->adapter);
239
dealloc:
240
	if_usb_free(cardp);
241 242 243 244 245 246 247

error:
	return -ENOMEM;
}

/**
 *  @brief free resource and cleanup
248
 *  @param intf		USB interface structure
249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
 *  @return 	   	N/A
 */
static void if_usb_disconnect(struct usb_interface *intf)
{
	struct usb_card_rec *cardp = usb_get_intfdata(intf);
	wlan_private *priv = (wlan_private *) cardp->priv;
	wlan_adapter *adapter = NULL;

	adapter = priv->adapter;

	/*
	 * Update Surprise removed to TRUE
	 */
	adapter->surpriseremoved = 1;

264
	list_del(&cardp->list);
265

266
	/* card is removed and we can call wlan_remove_card */
267
	lbs_deb_usbd(&cardp->udev->dev, "call remove card\n");
268 269
	libertas_remove_mesh(priv);
	libertas_remove_card(priv);
270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286

	/* Unlink and free urb */
	if_usb_free(cardp);

	usb_set_intfdata(intf, NULL);
	usb_put_dev(interface_to_usbdev(intf));

	return;
}

/**
 *  @brief  This function download FW
 *  @param priv		pointer to wlan_private
 *  @return 	   	0
 */
static int if_prog_firmware(wlan_private * priv)
{
287
	struct usb_card_rec *cardp = priv->card;
288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303
	struct FWData *fwdata;
	struct fwheader *fwheader;
	u8 *firmware = priv->firmware->data;

	fwdata = kmalloc(sizeof(struct FWData), GFP_ATOMIC);

	if (!fwdata)
		return -1;

	fwheader = &fwdata->fwheader;

	if (!cardp->CRC_OK) {
		cardp->totalbytes = cardp->fwlastblksent;
		cardp->fwseqnum = cardp->lastseqnum - 1;
	}

304 305
	/*
	lbs_deb_usbd(&cardp->udev->dev, "totalbytes = %d\n",
306
		    cardp->totalbytes);
307
	*/
308 309 310 311 312 313 314

	memcpy(fwheader, &firmware[cardp->totalbytes],
	       sizeof(struct fwheader));

	cardp->fwlastblksent = cardp->totalbytes;
	cardp->totalbytes += sizeof(struct fwheader);

315
	/* lbs_deb_usbd(&cardp->udev->dev,"Copy Data\n"); */
316
	memcpy(fwdata->data, &firmware[cardp->totalbytes],
317
	       le32_to_cpu(fwdata->fwheader.datalength));
318

319 320
	/*
	lbs_deb_usbd(&cardp->udev->dev,
321
		    "Data length = %d\n", le32_to_cpu(fwdata->fwheader.datalength));
322
	*/
323 324 325

	cardp->fwseqnum = cardp->fwseqnum + 1;

326 327 328
	fwdata->seqnum = cpu_to_le32(cardp->fwseqnum);
	cardp->lastseqnum = cardp->fwseqnum;
	cardp->totalbytes += le32_to_cpu(fwdata->fwheader.datalength);
329

330
	if (fwheader->dnldcmd == cpu_to_le32(FW_HAS_DATA_TO_RECV)) {
331
		/*
332
		lbs_deb_usbd(&cardp->udev->dev, "There are data to follow\n");
333
		lbs_deb_usbd(&cardp->udev->dev,
334 335
			    "seqnum = %d totalbytes = %d\n", cardp->fwseqnum,
			    cardp->totalbytes);
336
		*/
337 338 339
		memcpy(cardp->bulk_out_buffer, fwheader, FW_DATA_XMIT_SIZE);
		usb_tx_block(priv, cardp->bulk_out_buffer, FW_DATA_XMIT_SIZE);

340
	} else if (fwdata->fwheader.dnldcmd == cpu_to_le32(FW_HAS_LAST_BLOCK)) {
341 342
		/*
		lbs_deb_usbd(&cardp->udev->dev,
343
			    "Host has finished FW downloading\n");
344
		lbs_deb_usbd(&cardp->udev->dev,
345
			    "Donwloading FW JUMP BLOCK\n");
346
		*/
347 348 349 350 351
		memcpy(cardp->bulk_out_buffer, fwheader, FW_DATA_XMIT_SIZE);
		usb_tx_block(priv, cardp->bulk_out_buffer, FW_DATA_XMIT_SIZE);
		cardp->fwfinalblk = 1;
	}

352 353
	/*
	lbs_deb_usbd(&cardp->udev->dev,
354 355
		    "The firmware download is done size is %d\n",
		    cardp->totalbytes);
356
	*/
357 358 359 360 361 362

	kfree(fwdata);

	return 0;
}

363
static int if_usb_reset_device(wlan_private *priv)
364 365
{
	int ret;
366
	struct usb_card_rec *cardp = priv->card;
367

368 369
	lbs_deb_enter(LBS_DEB_USB);

370 371 372
	/* Try a USB port reset first, if that fails send the reset
	 * command to the firmware.
	 */
373 374 375
	ret = usb_reset_device(cardp->udev);
	if (!ret) {
		msleep(10);
376
		ret = libertas_reset_device(priv);
377 378
		msleep(10);
	}
379 380 381

	lbs_deb_leave_args(LBS_DEB_USB, "ret %d", ret);

382 383 384 385 386 387 388 389 390 391
	return ret;
}

/**
 *  @brief This function transfer the data to the device.
 *  @param priv 	pointer to wlan_private
 *  @param payload	pointer to payload data
 *  @param nb		data length
 *  @return 	   	0 or -1
 */
392
static int usb_tx_block(wlan_private * priv, u8 * payload, u16 nb)
393 394
{
	/* pointer to card structure */
395
	struct usb_card_rec *cardp = priv->card;
396 397 398 399
	int ret = -1;

	/* check if device is removed */
	if (priv->adapter->surpriseremoved) {
400
		lbs_deb_usbd(&cardp->udev->dev, "Device removed\n");
401 402 403 404 405 406 407 408 409 410 411 412
		goto tx_ret;
	}

	usb_fill_bulk_urb(cardp->tx_urb, cardp->udev,
			  usb_sndbulkpipe(cardp->udev,
					  cardp->bulk_out_endpointAddr),
			  payload, nb, if_usb_write_bulk_callback, priv);

	cardp->tx_urb->transfer_flags |= URB_ZERO_PACKET;

	if ((ret = usb_submit_urb(cardp->tx_urb, GFP_ATOMIC))) {
		/*  transfer failed */
413
		lbs_deb_usbd(&cardp->udev->dev, "usb_submit_urb failed\n");
414 415
		ret = -1;
	} else {
416
		/* lbs_deb_usbd(&cardp->udev->dev, "usb_submit_urb success\n"); */
417 418 419 420 421 422 423 424 425 426 427
		ret = 0;
	}

tx_ret:
	return ret;
}

static int __if_usb_submit_rx_urb(wlan_private * priv,
				  void (*callbackfn)
				  (struct urb *urb))
{
428
	struct usb_card_rec *cardp = priv->card;
429 430 431 432 433 434 435 436 437 438 439 440 441 442 443
	struct sk_buff *skb;
	struct read_cb_info *rinfo = &cardp->rinfo;
	int ret = -1;

	if (!(skb = dev_alloc_skb(MRVDRV_ETH_RX_PACKET_BUFFER_SIZE))) {
		lbs_pr_err("No free skb\n");
		goto rx_ret;
	}

	rinfo->skb = skb;

	/* Fill the receive configuration URB and initialise the Rx call back */
	usb_fill_bulk_urb(cardp->rx_urb, cardp->udev,
			  usb_rcvbulkpipe(cardp->udev,
					  cardp->bulk_in_endpointAddr),
D
Dan Williams 已提交
444
			  (void *) (skb->tail + (size_t) IPFIELD_ALIGN_OFFSET),
445 446 447 448 449
			  MRVDRV_ETH_RX_PACKET_BUFFER_SIZE, callbackfn,
			  rinfo);

	cardp->rx_urb->transfer_flags |= URB_ZERO_PACKET;

450
	/* lbs_deb_usbd(&cardp->udev->dev, "Pointer for rx_urb %p\n", cardp->rx_urb); */
451 452
	if ((ret = usb_submit_urb(cardp->rx_urb, GFP_ATOMIC))) {
		/* handle failure conditions */
453
		lbs_deb_usbd(&cardp->udev->dev, "Submit Rx URB failed\n");
454 455
		ret = -1;
	} else {
456
		/* lbs_deb_usbd(&cardp->udev->dev, "Submit Rx URB success\n"); */
457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478
		ret = 0;
	}

rx_ret:
	return ret;
}

static inline int if_usb_submit_rx_urb_fwload(wlan_private * priv)
{
	return __if_usb_submit_rx_urb(priv, &if_usb_receive_fwload);
}

static inline int if_usb_submit_rx_urb(wlan_private * priv)
{
	return __if_usb_submit_rx_urb(priv, &if_usb_receive);
}

static void if_usb_receive_fwload(struct urb *urb)
{
	struct read_cb_info *rinfo = (struct read_cb_info *)urb->context;
	wlan_private *priv = rinfo->priv;
	struct sk_buff *skb = rinfo->skb;
479
	struct usb_card_rec *cardp = (struct usb_card_rec *)priv->card;
480 481 482 483
	struct fwsyncheader *syncfwheader;
	struct bootcmdrespStr bootcmdresp;

	if (urb->status) {
484
		lbs_deb_usbd(&cardp->udev->dev,
485 486 487 488 489 490 491 492
			    "URB status is failed during fw load\n");
		kfree_skb(skb);
		return;
	}

	if (cardp->bootcmdresp == 0) {
		memcpy (&bootcmdresp, skb->data + IPFIELD_ALIGN_OFFSET,
			sizeof(bootcmdresp));
493
		if (le16_to_cpu(cardp->udev->descriptor.bcdDevice) < 0x3106) {
494 495 496
			kfree_skb(skb);
			if_usb_submit_rx_urb_fwload(priv);
			cardp->bootcmdresp = 1;
497
			lbs_deb_usbd(&cardp->udev->dev,
498 499 500
				    "Received valid boot command response\n");
			return;
		}
501
		if (bootcmdresp.u32magicnumber != cpu_to_le32(BOOT_CMD_MAGIC_NUMBER)) {
502 503
			lbs_pr_info(
				"boot cmd response wrong magic number (0x%x)\n",
504
				le32_to_cpu(bootcmdresp.u32magicnumber));
505 506 507 508 509 510 511 512 513 514
		} else if (bootcmdresp.u8cmd_tag != BOOT_CMD_FW_BY_USB) {
			lbs_pr_info(
				"boot cmd response cmd_tag error (%d)\n",
				bootcmdresp.u8cmd_tag);
		} else if (bootcmdresp.u8result != BOOT_CMD_RESP_OK) {
			lbs_pr_info(
				"boot cmd response result error (%d)\n",
				bootcmdresp.u8result);
		} else {
			cardp->bootcmdresp = 1;
515
			lbs_deb_usbd(&cardp->udev->dev,
516 517 518 519 520 521 522 523 524
				    "Received valid boot command response\n");
		}
		kfree_skb(skb);
		if_usb_submit_rx_urb_fwload(priv);
		return;
	}

	syncfwheader = kmalloc(sizeof(struct fwsyncheader), GFP_ATOMIC);
	if (!syncfwheader) {
525
		lbs_deb_usbd(&cardp->udev->dev, "Failure to allocate syncfwheader\n");
526 527 528 529 530 531 532 533
		kfree_skb(skb);
		return;
	}

	memcpy(syncfwheader, skb->data + IPFIELD_ALIGN_OFFSET,
			sizeof(struct fwsyncheader));

	if (!syncfwheader->cmd) {
534 535
		/*
		lbs_deb_usbd(&cardp->udev->dev,
536
			    "FW received Blk with correct CRC\n");
537
		lbs_deb_usbd(&cardp->udev->dev,
538 539
			    "FW received Blk seqnum = %d\n",
		       syncfwheader->seqnum);
540
		*/
541 542
		cardp->CRC_OK = 1;
	} else {
543
		lbs_deb_usbd(&cardp->udev->dev,
544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
			    "FW received Blk with CRC error\n");
		cardp->CRC_OK = 0;
	}

	kfree_skb(skb);

	if (cardp->fwfinalblk) {
		cardp->fwdnldover = 1;
		goto exit;
	}

	if_prog_firmware(priv);

	if_usb_submit_rx_urb_fwload(priv);
exit:
	kfree(syncfwheader);

	return;

}

#define MRVDRV_MIN_PKT_LEN	30

static inline void process_cmdtypedata(int recvlength, struct sk_buff *skb,
				       struct usb_card_rec *cardp,
				       wlan_private *priv)
{
	if (recvlength > MRVDRV_ETH_RX_PACKET_BUFFER_SIZE +
	    MESSAGE_HEADER_LEN || recvlength < MRVDRV_MIN_PKT_LEN) {
573
		lbs_deb_usbd(&cardp->udev->dev,
574 575 576 577 578 579 580 581 582
			    "Packet length is Invalid\n");
		kfree_skb(skb);
		return;
	}

	skb_reserve(skb, IPFIELD_ALIGN_OFFSET);
	skb_put(skb, recvlength);
	skb_pull(skb, MESSAGE_HEADER_LEN);
	libertas_process_rxed_packet(priv, skb);
583
	priv->upld_len = (recvlength - MESSAGE_HEADER_LEN);
584 585 586 587 588 589 590 591 592
}

static inline void process_cmdrequest(int recvlength, u8 *recvbuff,
				      struct sk_buff *skb,
				      struct usb_card_rec *cardp,
				      wlan_private *priv)
{
	u8 *cmdbuf;
	if (recvlength > MRVDRV_SIZE_OF_CMD_BUFFER) {
593
		lbs_deb_usbd(&cardp->udev->dev,
594 595 596 597 598 599 600 601 602 603 604 605
			    "The receive buffer is too large\n");
		kfree_skb(skb);
		return;
	}

	if (!in_interrupt())
		BUG();

	spin_lock(&priv->adapter->driver_lock);
	/* take care of cur_cmd = NULL case by reading the
	 * data to clear the interrupt */
	if (!priv->adapter->cur_cmd) {
606
		cmdbuf = priv->upld_buf;
607
		priv->adapter->hisregcpy &= ~MRVDRV_CMD_UPLD_RDY;
608 609 610
	} else
		cmdbuf = priv->adapter->cur_cmd->bufvirtualaddr;

611
	cardp->usb_int_cause |= MRVDRV_CMD_UPLD_RDY;
612
	priv->upld_len = (recvlength - MESSAGE_HEADER_LEN);
613
	memcpy(cmdbuf, recvbuff + MESSAGE_HEADER_LEN,
614
	       priv->upld_len);
615 616

	kfree_skb(skb);
617
	libertas_interrupt(priv->dev);
618 619
	spin_unlock(&priv->adapter->driver_lock);

620
	lbs_deb_usbd(&cardp->udev->dev,
621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637
		    "Wake up main thread to handle cmd response\n");

	return;
}

/**
 *  @brief This function reads of the packet into the upload buff,
 *  wake up the main thread and initialise the Rx callack.
 *
 *  @param urb		pointer to struct urb
 *  @return 	   	N/A
 */
static void if_usb_receive(struct urb *urb)
{
	struct read_cb_info *rinfo = (struct read_cb_info *)urb->context;
	wlan_private *priv = rinfo->priv;
	struct sk_buff *skb = rinfo->skb;
638
	struct usb_card_rec *cardp = (struct usb_card_rec *)priv->card;
639 640 641 642 643

	int recvlength = urb->actual_length;
	u8 *recvbuff = NULL;
	u32 recvtype;

644
	lbs_deb_enter(LBS_DEB_USB);
645 646 647

	if (recvlength) {
		if (urb->status) {
648
			lbs_deb_usbd(&cardp->udev->dev,
649 650 651 652 653 654 655
				    "URB status is failed\n");
			kfree_skb(skb);
			goto setup_for_next;
		}

		recvbuff = skb->data + IPFIELD_ALIGN_OFFSET;
		memcpy(&recvtype, recvbuff, sizeof(u32));
656
		lbs_deb_usbd(&cardp->udev->dev,
657
			    "Recv length = 0x%x\n", recvlength);
658
		lbs_deb_usbd(&cardp->udev->dev,
659 660
			    "Receive type = 0x%X\n", recvtype);
		recvtype = le32_to_cpu(recvtype);
661
		lbs_deb_usbd(&cardp->udev->dev,
662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678
			    "Receive type after = 0x%X\n", recvtype);
	} else if (urb->status)
		goto rx_exit;


	switch (recvtype) {
	case CMD_TYPE_DATA:
		process_cmdtypedata(recvlength, skb, cardp, priv);
		break;

	case CMD_TYPE_REQUEST:
		process_cmdrequest(recvlength, recvbuff, skb, cardp, priv);
		break;

	case CMD_TYPE_INDICATION:
		/* Event cause handling */
		spin_lock(&priv->adapter->driver_lock);
679
		cardp->usb_event_cause = le32_to_cpu(*(__le32 *) (recvbuff + MESSAGE_HEADER_LEN));
680
		lbs_deb_usbd(&cardp->udev->dev,"**EVENT** 0x%X\n",
681 682 683
			    cardp->usb_event_cause);
		if (cardp->usb_event_cause & 0xffff0000) {
			libertas_send_tx_feedback(priv);
684
			spin_unlock(&priv->adapter->driver_lock);
685 686
			break;
		}
687
		cardp->usb_event_cause <<= 3;
688
		cardp->usb_int_cause |= MRVDRV_CARDEVENT;
689
		kfree_skb(skb);
690
		libertas_interrupt(priv->dev);
691 692 693 694 695 696 697 698 699 700
		spin_unlock(&priv->adapter->driver_lock);
		goto rx_exit;
	default:
		kfree_skb(skb);
		break;
	}

setup_for_next:
	if_usb_submit_rx_urb(priv);
rx_exit:
701
	lbs_deb_leave(LBS_DEB_USB);
702 703 704 705 706 707 708 709 710 711
}

/**
 *  @brief This function downloads data to FW
 *  @param priv		pointer to wlan_private structure
 *  @param type		type of data
 *  @param buf		pointer to data buffer
 *  @param len		number of bytes
 *  @return 	   	0 or -1
 */
712
static int if_usb_host_to_card(wlan_private * priv, u8 type, u8 * payload, u16 nb)
713 714 715
{
	int ret = -1;
	u32 tmp;
716
	struct usb_card_rec *cardp = (struct usb_card_rec *)priv->card;
717

718 719
	lbs_deb_usbd(&cardp->udev->dev,"*** type = %u\n", type);
	lbs_deb_usbd(&cardp->udev->dev,"size after = %d\n", nb);
720 721 722

	if (type == MVMS_CMD) {
		tmp = cpu_to_le32(CMD_TYPE_REQUEST);
723
		priv->dnld_sent = DNLD_CMD_SENT;
724 725 726 727 728
		memcpy(cardp->bulk_out_buffer, (u8 *) & tmp,
		       MESSAGE_HEADER_LEN);

	} else {
		tmp = cpu_to_le32(CMD_TYPE_DATA);
729
		priv->dnld_sent = DNLD_DATA_SENT;
730 731 732 733 734 735 736 737 738 739 740 741 742
		memcpy(cardp->bulk_out_buffer, (u8 *) & tmp,
		       MESSAGE_HEADER_LEN);
	}

	memcpy((cardp->bulk_out_buffer + MESSAGE_HEADER_LEN), payload, nb);

	ret =
	    usb_tx_block(priv, cardp->bulk_out_buffer, nb + MESSAGE_HEADER_LEN);

	return ret;
}

/* called with adapter->driver_lock held */
743
static int if_usb_get_int_status(wlan_private * priv, u8 * ireg)
744
{
745
	struct usb_card_rec *cardp = priv->card;
746 747 748 749

	*ireg = cardp->usb_int_cause;
	cardp->usb_int_cause = 0;

750
	lbs_deb_usbd(&cardp->udev->dev,"Int cause is 0x%X\n", *ireg);
751 752 753 754

	return 0;
}

755
static int if_usb_read_event_cause(wlan_private * priv)
756
{
757
	struct usb_card_rec *cardp = priv->card;
758 759 760 761 762 763
	priv->adapter->eventcause = cardp->usb_event_cause;
	/* Re-submit rx urb here to avoid event lost issue */
	if_usb_submit_rx_urb(priv);
	return 0;
}

764
static int if_usb_unregister_dev(wlan_private * priv)
765 766 767 768 769 770 771 772
{
	int ret = 0;

	/* Need to send a Reset command to device before USB resources freed
	 * and wlan_remove_card() called, then device can handle FW download
	 * again.
	 */
	if (priv)
773
		libertas_reset_device(priv);
774 775 776 777 778 779 780 781 782 783

	return ret;
}


/**
 *  @brief  This function register usb device and initialize parameter
 *  @param		priv pointer to wlan_private
 *  @return		0 or -1
 */
784
static int if_usb_register_dev(wlan_private * priv)
785
{
786
	struct usb_card_rec *cardp = (struct usb_card_rec *)priv->card;
787 788

	lbs_deb_enter(LBS_DEB_USB);
789 790

	cardp->priv = priv;
791
	cardp->eth_dev = priv->dev;
792 793
	priv->hotplug_device = &(cardp->udev->dev);

794
	lbs_deb_usbd(&cardp->udev->dev, "udev pointer is at %p\n",
795 796
		    cardp->udev);

797
	lbs_deb_leave(LBS_DEB_USB);
798 799 800
	return 0;
}

801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824
/**
 *  @brief This function issues Boot command to the Boot2 code
 *  @param ivalue   1:Boot from FW by USB-Download
 *                  2:Boot from FW in EEPROM
 *  @return 	   	0
 */
static int if_usb_issue_boot_command(wlan_private *priv, int ivalue)
{
	struct usb_card_rec	*cardp = priv->card;
	struct bootcmdstr	sbootcmd;
	int i;

	/* Prepare command */
	sbootcmd.u32magicnumber = cpu_to_le32(BOOT_CMD_MAGIC_NUMBER);
	sbootcmd.u8cmd_tag = ivalue;
	for (i=0; i<11; i++)
		sbootcmd.au8dumy[i]=0x00;
	memcpy(cardp->bulk_out_buffer, &sbootcmd, sizeof(struct bootcmdstr));

	/* Issue command */
	usb_tx_block(priv, cardp->bulk_out_buffer, sizeof(struct bootcmdstr));

	return 0;
}
825 826


H
Holger Schurig 已提交
827
static int if_usb_do_prog_firmware(wlan_private * priv)
828
{
829
	struct usb_card_rec *cardp = priv->card;
830 831
	int i = 0;
	static int reset_count = 10;
832
	int ret = 0;
833

834
	lbs_deb_enter(LBS_DEB_USB);
835 836 837 838 839

	cardp->rinfo.priv = priv;

restart:
	if (if_usb_submit_rx_urb_fwload(priv) < 0) {
840 841 842
		lbs_deb_usbd(&cardp->udev->dev, "URB submission is failed\n");
		ret = -1;
		goto done;
843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859
	}

	cardp->bootcmdresp = 0;
	do {
		int j = 0;
		i++;
		/* Issue Boot command = 1, Boot from Download-FW */
		if_usb_issue_boot_command(priv, BOOT_CMD_FW_BY_USB);
		/* wait for command response */
		do {
			j++;
			msleep_interruptible(100);
		} while (cardp->bootcmdresp == 0 && j < 10);
	} while (cardp->bootcmdresp == 0 && i < 5);

	if (cardp->bootcmdresp == 0) {
		if (--reset_count >= 0) {
860
			if_usb_reset_device(priv);
861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879
			goto restart;
		}
		return -1;
	}

	i = 0;
	priv->adapter->fw_ready = 0;

	cardp->totalbytes = 0;
	cardp->fwlastblksent = 0;
	cardp->CRC_OK = 1;
	cardp->fwdnldover = 0;
	cardp->fwseqnum = -1;
	cardp->totalbytes = 0;
	cardp->fwfinalblk = 0;

	if_prog_firmware(priv);

	do {
880
		lbs_deb_usbd(&cardp->udev->dev,"Wlan sched timeout\n");
881 882 883 884 885 886 887 888 889
		i++;
		msleep_interruptible(100);
		if (priv->adapter->surpriseremoved || i >= 20)
			break;
	} while (!cardp->fwdnldover);

	if (!cardp->fwdnldover) {
		lbs_pr_info("failed to load fw, resetting device!\n");
		if (--reset_count >= 0) {
890
			if_usb_reset_device(priv);
891 892 893 894
			goto restart;
		}

		lbs_pr_info("FW download failure, time = %d ms\n", i * 100);
895 896
		ret = -1;
		goto done;
897 898 899 900 901 902 903 904 905
	}

	if_usb_submit_rx_urb(priv);

	/* Delay 200 ms to waiting for the FW ready */
	msleep_interruptible(200);

	priv->adapter->fw_ready = 1;

906 907 908
done:
	lbs_deb_leave_args(LBS_DEB_USB, "ret %d", ret);
	return ret;
909 910
}

H
Holger Schurig 已提交
911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984
/**
 *  @brief This function checks the validity of Boot2/FW image.
 *
 *  @param data              pointer to image
 *         len               image length
 *  @return     0 or -1
 */
static int check_fwfile_format(u8 *data, u32 totlen)
{
	u32 bincmd, exit;
	u32 blksize, offset, len;
	int ret;

	ret = 1;
	exit = len = 0;

	do {
		struct fwheader *fwh = (void *)data;

		bincmd = le32_to_cpu(fwh->dnldcmd);
		blksize = le32_to_cpu(fwh->datalength);
		switch (bincmd) {
		case FW_HAS_DATA_TO_RECV:
			offset = sizeof(struct fwheader) + blksize;
			data += offset;
			len += offset;
			if (len >= totlen)
				exit = 1;
			break;
		case FW_HAS_LAST_BLOCK:
			exit = 1;
			ret = 0;
			break;
		default:
			exit = 1;
			break;
		}
	} while (!exit);

	if (ret)
		lbs_pr_err("firmware file format check FAIL\n");
	else
		lbs_deb_fw("firmware file format check PASS\n");

	return ret;
}


static int if_usb_prog_firmware(wlan_private *priv)
{
	int ret = -1;

	lbs_deb_enter(LBS_DEB_FW);

	if ((ret = request_firmware(&priv->firmware, libertas_fw_name,
				    priv->hotplug_device)) < 0) {
		lbs_pr_err("request_firmware() failed with %#x\n", ret);
		lbs_pr_err("firmware %s not found\n", libertas_fw_name);
		goto done;
	}

	if (check_fwfile_format(priv->firmware->data, priv->firmware->size)) {
		release_firmware(priv->firmware);
		goto done;
	}

	ret = if_usb_do_prog_firmware(priv);

	release_firmware(priv->firmware);
done:
	return ret;
}


985 986 987 988 989 990
#ifdef CONFIG_PM
static int if_usb_suspend(struct usb_interface *intf, pm_message_t message)
{
	struct usb_card_rec *cardp = usb_get_intfdata(intf);
	wlan_private *priv = cardp->priv;

991
	lbs_deb_enter(LBS_DEB_USB);
992 993 994 995

	if (priv->adapter->psstate != PS_STATE_FULL_POWER)
		return -1;

996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008
	if (priv->mesh_dev && !priv->mesh_autostart_enabled) {
		/* Mesh autostart must be activated while sleeping
		 * On resume it will go back to the current state
		 */
		struct cmd_ds_mesh_access mesh_access;
		memset(&mesh_access, 0, sizeof(mesh_access));
		mesh_access.data[0] = cpu_to_le32(1);
		libertas_prepare_and_send_command(priv,
				CMD_MESH_ACCESS,
				CMD_ACT_MESH_SET_AUTOSTART_ENABLED,
				CMD_OPTION_WAITFORRSP, 0, (void *)&mesh_access);
	}

1009
	netif_device_detach(cardp->eth_dev);
1010
	netif_device_detach(priv->mesh_dev);
1011 1012 1013 1014 1015 1016 1017

	/* Unlink tx & rx urb */
	usb_kill_urb(cardp->tx_urb);
	usb_kill_urb(cardp->rx_urb);

	cardp->rx_urb_recall = 1;

1018
	lbs_deb_leave(LBS_DEB_USB);
1019 1020 1021 1022 1023 1024
	return 0;
}

static int if_usb_resume(struct usb_interface *intf)
{
	struct usb_card_rec *cardp = usb_get_intfdata(intf);
1025
	wlan_private *priv = cardp->priv;
1026

1027
	lbs_deb_enter(LBS_DEB_USB);
1028 1029 1030 1031 1032 1033

	cardp->rx_urb_recall = 0;

	if_usb_submit_rx_urb(cardp->priv);

	netif_device_attach(cardp->eth_dev);
1034
	netif_device_attach(priv->mesh_dev);
1035

1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048
	if (priv->mesh_dev && !priv->mesh_autostart_enabled) {
		/* Mesh autostart was activated while sleeping
		 * Disable it if appropriate
		 */
		struct cmd_ds_mesh_access mesh_access;
		memset(&mesh_access, 0, sizeof(mesh_access));
		mesh_access.data[0] = cpu_to_le32(0);
		libertas_prepare_and_send_command(priv,
				CMD_MESH_ACCESS,
				CMD_ACT_MESH_SET_AUTOSTART_ENABLED,
				CMD_OPTION_WAITFORRSP, 0, (void *)&mesh_access);
	}

1049
	lbs_deb_leave(LBS_DEB_USB);
1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069
	return 0;
}
#else
#define if_usb_suspend NULL
#define if_usb_resume NULL
#endif

static struct usb_driver if_usb_driver = {
	/* driver name */
	.name = usbdriver_name,
	/* probe function name */
	.probe = if_usb_probe,
	/* disconnect function  name */
	.disconnect = if_usb_disconnect,
	/* device signature table */
	.id_table = if_usb_table,
	.suspend = if_usb_suspend,
	.resume = if_usb_resume,
};

1070
static int if_usb_init_module(void)
1071
{
1072
	int ret = 0;
1073

1074 1075 1076 1077 1078 1079 1080 1081 1082 1083
	lbs_deb_enter(LBS_DEB_MAIN);

	if (libertas_fw_name == NULL) {
		libertas_fw_name = default_fw_name;
	}

	ret = usb_register(&if_usb_driver);

	lbs_deb_leave_args(LBS_DEB_MAIN, "ret %d", ret);
	return ret;
1084 1085
}

1086
static void if_usb_exit_module(void)
1087
{
1088
	struct usb_card_rec *cardp, *cardp_temp;
1089

1090 1091
	lbs_deb_enter(LBS_DEB_MAIN);

1092
	list_for_each_entry_safe(cardp, cardp_temp, &usb_devices, list)
1093
		libertas_reset_device((wlan_private *) cardp->priv);
1094

1095 1096
	/* API unregisters the driver from USB subsystem */
	usb_deregister(&if_usb_driver);
1097 1098

	lbs_deb_leave(LBS_DEB_MAIN);
1099
}
1100 1101 1102 1103 1104 1105 1106

module_init(if_usb_init_module);
module_exit(if_usb_exit_module);

MODULE_DESCRIPTION("8388 USB WLAN Driver");
MODULE_AUTHOR("Marvell International Ltd.");
MODULE_LICENSE("GPL");