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 222
	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;

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

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

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

	return 0;

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

error:
	return -ENOMEM;
}

/**
 *  @brief free resource and cleanup
247
 *  @param intf		USB interface structure
248 249 250 251 252 253 254 255 256 257 258 259 260 261 262
 *  @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;

263
	list_del(&cardp->list);
264

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

	/* 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)
{
286
	struct usb_card_rec *cardp = priv->card;
287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302
	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;
	}

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

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

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

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

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

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

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

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

339
	} else if (fwdata->fwheader.dnldcmd == cpu_to_le32(FW_HAS_LAST_BLOCK)) {
340 341
		/*
		lbs_deb_usbd(&cardp->udev->dev,
342
			    "Host has finished FW downloading\n");
343
		lbs_deb_usbd(&cardp->udev->dev,
344
			    "Donwloading FW JUMP BLOCK\n");
345
		*/
346 347 348 349 350
		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;
	}

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

	kfree(fwdata);

	return 0;
}

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

367 368
	lbs_deb_enter(LBS_DEB_USB);

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

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

381 382 383 384 385 386 387 388 389 390
	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
 */
391
static int usb_tx_block(wlan_private * priv, u8 * payload, u16 nb)
392 393
{
	/* pointer to card structure */
394
	struct usb_card_rec *cardp = priv->card;
395 396 397 398
	int ret = -1;

	/* check if device is removed */
	if (priv->adapter->surpriseremoved) {
399
		lbs_deb_usbd(&cardp->udev->dev, "Device removed\n");
400 401 402 403 404 405 406 407 408 409 410 411
		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 */
412
		lbs_deb_usbd(&cardp->udev->dev, "usb_submit_urb failed\n");
413 414
		ret = -1;
	} else {
415
		/* lbs_deb_usbd(&cardp->udev->dev, "usb_submit_urb success\n"); */
416 417 418 419 420 421 422 423 424 425 426
		ret = 0;
	}

tx_ret:
	return ret;
}

static int __if_usb_submit_rx_urb(wlan_private * priv,
				  void (*callbackfn)
				  (struct urb *urb))
{
427
	struct usb_card_rec *cardp = priv->card;
428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
	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 已提交
443
			  (void *) (skb->tail + (size_t) IPFIELD_ALIGN_OFFSET),
444 445 446 447 448
			  MRVDRV_ETH_RX_PACKET_BUFFER_SIZE, callbackfn,
			  rinfo);

	cardp->rx_urb->transfer_flags |= URB_ZERO_PACKET;

449
	/* lbs_deb_usbd(&cardp->udev->dev, "Pointer for rx_urb %p\n", cardp->rx_urb); */
450 451
	if ((ret = usb_submit_urb(cardp->rx_urb, GFP_ATOMIC))) {
		/* handle failure conditions */
452
		lbs_deb_usbd(&cardp->udev->dev, "Submit Rx URB failed\n");
453 454
		ret = -1;
	} else {
455
		/* lbs_deb_usbd(&cardp->udev->dev, "Submit Rx URB success\n"); */
456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477
		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;
478
	struct usb_card_rec *cardp = (struct usb_card_rec *)priv->card;
479 480 481 482
	struct fwsyncheader *syncfwheader;
	struct bootcmdrespStr bootcmdresp;

	if (urb->status) {
483
		lbs_deb_usbd(&cardp->udev->dev,
484 485 486 487 488 489 490 491
			    "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));
492
		if (le16_to_cpu(cardp->udev->descriptor.bcdDevice) < 0x3106) {
493 494 495
			kfree_skb(skb);
			if_usb_submit_rx_urb_fwload(priv);
			cardp->bootcmdresp = 1;
496
			lbs_deb_usbd(&cardp->udev->dev,
497 498 499
				    "Received valid boot command response\n");
			return;
		}
500
		if (bootcmdresp.u32magicnumber != cpu_to_le32(BOOT_CMD_MAGIC_NUMBER)) {
501 502
			lbs_pr_info(
				"boot cmd response wrong magic number (0x%x)\n",
503
				le32_to_cpu(bootcmdresp.u32magicnumber));
504 505 506 507 508 509 510 511 512 513
		} 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;
514
			lbs_deb_usbd(&cardp->udev->dev,
515 516 517 518 519 520 521 522 523
				    "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) {
524
		lbs_deb_usbd(&cardp->udev->dev, "Failure to allocate syncfwheader\n");
525 526 527 528 529 530 531 532
		kfree_skb(skb);
		return;
	}

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

	if (!syncfwheader->cmd) {
533 534
		/*
		lbs_deb_usbd(&cardp->udev->dev,
535
			    "FW received Blk with correct CRC\n");
536
		lbs_deb_usbd(&cardp->udev->dev,
537 538
			    "FW received Blk seqnum = %d\n",
		       syncfwheader->seqnum);
539
		*/
540 541
		cardp->CRC_OK = 1;
	} else {
542
		lbs_deb_usbd(&cardp->udev->dev,
543 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
			    "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) {
572
		lbs_deb_usbd(&cardp->udev->dev,
573 574 575 576 577 578 579 580 581
			    "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);
582
	priv->upld_len = (recvlength - MESSAGE_HEADER_LEN);
583 584 585 586 587 588 589 590 591
}

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) {
592
		lbs_deb_usbd(&cardp->udev->dev,
593 594 595 596 597 598 599 600 601 602 603 604
			    "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) {
605
		cmdbuf = priv->upld_buf;
606
		priv->adapter->hisregcpy &= ~MRVDRV_CMD_UPLD_RDY;
607 608 609
	} else
		cmdbuf = priv->adapter->cur_cmd->bufvirtualaddr;

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

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

619
	lbs_deb_usbd(&cardp->udev->dev,
620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636
		    "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;
637
	struct usb_card_rec *cardp = (struct usb_card_rec *)priv->card;
638 639 640 641 642

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

643
	lbs_deb_enter(LBS_DEB_USB);
644 645 646

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

		recvbuff = skb->data + IPFIELD_ALIGN_OFFSET;
		memcpy(&recvtype, recvbuff, sizeof(u32));
655
		lbs_deb_usbd(&cardp->udev->dev,
656
			    "Recv length = 0x%x\n", recvlength);
657
		lbs_deb_usbd(&cardp->udev->dev,
658 659
			    "Receive type = 0x%X\n", recvtype);
		recvtype = le32_to_cpu(recvtype);
660
		lbs_deb_usbd(&cardp->udev->dev,
661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677
			    "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);
678
		cardp->usb_event_cause = le32_to_cpu(*(__le32 *) (recvbuff + MESSAGE_HEADER_LEN));
679
		lbs_deb_usbd(&cardp->udev->dev,"**EVENT** 0x%X\n",
680 681 682
			    cardp->usb_event_cause);
		if (cardp->usb_event_cause & 0xffff0000) {
			libertas_send_tx_feedback(priv);
683
			spin_unlock(&priv->adapter->driver_lock);
684 685
			break;
		}
686
		cardp->usb_event_cause <<= 3;
687
		cardp->usb_int_cause |= MRVDRV_CARDEVENT;
688
		kfree_skb(skb);
689
		libertas_interrupt(priv->dev);
690 691 692 693 694 695 696 697 698 699
		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:
700
	lbs_deb_leave(LBS_DEB_USB);
701 702 703 704 705 706 707 708 709 710
}

/**
 *  @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
 */
711
static int if_usb_host_to_card(wlan_private * priv, u8 type, u8 * payload, u16 nb)
712 713 714
{
	int ret = -1;
	u32 tmp;
715
	struct usb_card_rec *cardp = (struct usb_card_rec *)priv->card;
716

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

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

	} else {
		tmp = cpu_to_le32(CMD_TYPE_DATA);
728
		priv->dnld_sent = DNLD_DATA_SENT;
729 730 731 732 733 734 735 736 737 738 739 740 741
		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 */
742
static int if_usb_get_int_status(wlan_private * priv, u8 * ireg)
743
{
744
	struct usb_card_rec *cardp = priv->card;
745 746 747 748

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

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

	return 0;
}

754
static int if_usb_read_event_cause(wlan_private * priv)
755
{
756
	struct usb_card_rec *cardp = priv->card;
757 758 759 760 761 762
	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;
}

763
static int if_usb_unregister_dev(wlan_private * priv)
764 765 766 767 768 769 770 771
{
	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)
772
		libertas_reset_device(priv);
773 774 775 776 777 778 779 780 781 782

	return ret;
}


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

	lbs_deb_enter(LBS_DEB_USB);
788 789

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

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

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

800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823
/**
 *  @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;
}
824 825


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

833
	lbs_deb_enter(LBS_DEB_USB);
834 835 836 837 838

	cardp->rinfo.priv = priv;

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

	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) {
859
			if_usb_reset_device(priv);
860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878
			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 {
879
		lbs_deb_usbd(&cardp->udev->dev,"Wlan sched timeout\n");
880 881 882 883 884 885 886 887 888
		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) {
889
			if_usb_reset_device(priv);
890 891 892 893
			goto restart;
		}

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

	if_usb_submit_rx_urb(priv);

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

	priv->adapter->fw_ready = 1;

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

H
Holger Schurig 已提交
910 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
/**
 *  @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;
}


984 985 986 987 988 989
#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;

990
	lbs_deb_enter(LBS_DEB_USB);
991 992 993 994

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

995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007
	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);
	}

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

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

	cardp->rx_urb_recall = 1;

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

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

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

	cardp->rx_urb_recall = 0;

	if_usb_submit_rx_urb(cardp->priv);

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

1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047
	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);
	}

1048
	lbs_deb_leave(LBS_DEB_USB);
1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068
	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,
};

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

1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
	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;
1083 1084
}

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

1089 1090
	lbs_deb_enter(LBS_DEB_MAIN);

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

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

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

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");