if_usb.c 26.9 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
	if (libertas_add_mesh(priv, &udev->dev))
212
		goto err_add_mesh;
213

214 215 216 217 218 219 220
	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 已提交
221
	if (libertas_activate_card(priv))
222
		goto err_activate_card;
223

224
	list_add_tail(&cardp->list, &usb_devices);
225

226
	usb_get_dev(udev);
227
	usb_set_intfdata(intf, cardp);
228 229 230

	return 0;

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

error:
	return -ENOMEM;
}

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

261
	list_del(&cardp->list);
262

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

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

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

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

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

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

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

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

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

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

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

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

	kfree(fwdata);

	return 0;
}

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

365 366
	lbs_deb_enter(LBS_DEB_USB);

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

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

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

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

tx_ret:
	return ret;
}

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

	cardp->rx_urb->transfer_flags |= URB_ZERO_PACKET;

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

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

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

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

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

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

	kfree_skb(skb);
614
	libertas_interrupt(priv->dev);
615 616
	spin_unlock(&priv->adapter->driver_lock);

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

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

641
	lbs_deb_enter(LBS_DEB_USB);
642 643 644

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

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

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

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

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

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

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

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

	return 0;
}

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

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

	return ret;
}


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

	lbs_deb_enter(LBS_DEB_USB);
786 787

	cardp->priv = priv;
788
	cardp->eth_dev = priv->dev;
789 790
	priv->hotplug_device = &(cardp->udev->dev);

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

794
	lbs_deb_leave(LBS_DEB_USB);
795 796 797
	return 0;
}

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


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

831
	lbs_deb_enter(LBS_DEB_USB);
832 833 834 835 836

	cardp->rinfo.priv = priv;

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

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

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

	if_usb_submit_rx_urb(priv);

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

	priv->adapter->fw_ready = 1;

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

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


982 983 984 985 986 987
#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;

988
	lbs_deb_enter(LBS_DEB_USB);
989 990 991 992

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

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

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

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

	cardp->rx_urb_recall = 1;

1015
	lbs_deb_leave(LBS_DEB_USB);
1016 1017 1018 1019 1020 1021
	return 0;
}

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

1024
	lbs_deb_enter(LBS_DEB_USB);
1025 1026 1027 1028 1029 1030

	cardp->rx_urb_recall = 0;

	if_usb_submit_rx_urb(cardp->priv);

	netif_device_attach(cardp->eth_dev);
1031
	netif_device_attach(priv->mesh_dev);
1032

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

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

1067
static int if_usb_init_module(void)
1068
{
1069
	int ret = 0;
1070

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

1083
static void if_usb_exit_module(void)
1084
{
1085
	struct usb_card_rec *cardp, *cardp_temp;
1086

1087 1088
	lbs_deb_enter(LBS_DEB_MAIN);

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

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

	lbs_deb_leave(LBS_DEB_MAIN);
1096
}
1097 1098 1099 1100 1101 1102 1103

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