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

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

644
	lbs_deb_enter(LBS_DEB_USB);
645 646

	if (recvlength) {
647 648
		__le32 tmp;

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

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

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

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

	} else {
726
		__le32 tmp = cpu_to_le32(CMD_TYPE_DATA);
727
		priv->dnld_sent = DNLD_DATA_SENT;
728 729 730 731 732 733
		memcpy(cardp->bulk_out_buffer, (u8 *) & tmp,
		       MESSAGE_HEADER_LEN);
	}

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

734 735
	return usb_tx_block(priv, cardp->bulk_out_buffer,
	                    nb + MESSAGE_HEADER_LEN);
736 737 738
}

/* called with adapter->driver_lock held */
739
static int if_usb_get_int_status(wlan_private * priv, u8 * ireg)
740
{
741
	struct usb_card_rec *cardp = priv->card;
742 743 744 745

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

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

	return 0;
}

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

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

	return ret;
}


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

	lbs_deb_enter(LBS_DEB_USB);
785 786

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

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

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

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


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

830
	lbs_deb_enter(LBS_DEB_USB);
831 832 833 834 835

	cardp->rinfo.priv = priv;

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

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

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

	if_usb_submit_rx_urb(priv);

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

	priv->adapter->fw_ready = 1;

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

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


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

987
	lbs_deb_enter(LBS_DEB_USB);
988 989 990 991

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

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

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

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

	cardp->rx_urb_recall = 1;

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

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

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

	cardp->rx_urb_recall = 0;

	if_usb_submit_rx_urb(cardp->priv);

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

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

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

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

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

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

1086 1087
	lbs_deb_enter(LBS_DEB_MAIN);

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

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

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

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