1 /*
2  * Marvell Wireless LAN device driver: USB specific handling
3  *
4  * Copyright (C) 2012-2014, Marvell International Ltd.
5  *
6  * This software file (the "File") is distributed by Marvell International
7  * Ltd. under the terms of the GNU General Public License Version 2, June 1991
8  * (the "License").  You may use, redistribute and/or modify this File in
9  * accordance with the terms and conditions of the License, a copy of which
10  * is available by writing to the Free Software Foundation, Inc.,
11  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
12  * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
13  *
14  * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
15  * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
16  * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
17  * this warranty disclaimer.
18  */
19 
20 #include "main.h"
21 #include "usb.h"
22 
23 #define USB_VERSION	"1.0"
24 
25 static struct mwifiex_if_ops usb_ops;
26 
27 static const struct usb_device_id mwifiex_usb_table[] = {
28 	/* 8766 */
29 	{USB_DEVICE(USB8XXX_VID, USB8766_PID_1)},
30 	{USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8766_PID_2,
31 				       USB_CLASS_VENDOR_SPEC,
32 				       USB_SUBCLASS_VENDOR_SPEC, 0xff)},
33 	/* 8797 */
34 	{USB_DEVICE(USB8XXX_VID, USB8797_PID_1)},
35 	{USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8797_PID_2,
36 				       USB_CLASS_VENDOR_SPEC,
37 				       USB_SUBCLASS_VENDOR_SPEC, 0xff)},
38 	/* 8801 */
39 	{USB_DEVICE(USB8XXX_VID, USB8801_PID_1)},
40 	{USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8801_PID_2,
41 				       USB_CLASS_VENDOR_SPEC,
42 				       USB_SUBCLASS_VENDOR_SPEC, 0xff)},
43 	/* 8997 */
44 	{USB_DEVICE(USB8XXX_VID, USB8997_PID_1)},
45 	{USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8997_PID_2,
46 				       USB_CLASS_VENDOR_SPEC,
47 				       USB_SUBCLASS_VENDOR_SPEC, 0xff)},
48 	{ }	/* Terminating entry */
49 };
50 
51 MODULE_DEVICE_TABLE(usb, mwifiex_usb_table);
52 
53 static int mwifiex_usb_submit_rx_urb(struct urb_context *ctx, int size);
54 
55 /* This function handles received packet. Necessary action is taken based on
56  * cmd/event/data.
57  */
58 static int mwifiex_usb_recv(struct mwifiex_adapter *adapter,
59 			    struct sk_buff *skb, u8 ep)
60 {
61 	u32 recv_type;
62 	__le32 tmp;
63 	int ret;
64 
65 	if (adapter->hs_activated)
66 		mwifiex_process_hs_config(adapter);
67 
68 	if (skb->len < INTF_HEADER_LEN) {
69 		mwifiex_dbg(adapter, ERROR,
70 			    "%s: invalid skb->len\n", __func__);
71 		return -1;
72 	}
73 
74 	switch (ep) {
75 	case MWIFIEX_USB_EP_CMD_EVENT:
76 		mwifiex_dbg(adapter, EVENT,
77 			    "%s: EP_CMD_EVENT\n", __func__);
78 		skb_copy_from_linear_data(skb, &tmp, INTF_HEADER_LEN);
79 		recv_type = le32_to_cpu(tmp);
80 		skb_pull(skb, INTF_HEADER_LEN);
81 
82 		switch (recv_type) {
83 		case MWIFIEX_USB_TYPE_CMD:
84 			if (skb->len > MWIFIEX_SIZE_OF_CMD_BUFFER) {
85 				mwifiex_dbg(adapter, ERROR,
86 					    "CMD: skb->len too large\n");
87 				ret = -1;
88 				goto exit_restore_skb;
89 			} else if (!adapter->curr_cmd) {
90 				mwifiex_dbg(adapter, WARN, "CMD: no curr_cmd\n");
91 				if (adapter->ps_state == PS_STATE_SLEEP_CFM) {
92 					mwifiex_process_sleep_confirm_resp(
93 							adapter, skb->data,
94 							skb->len);
95 					ret = 0;
96 					goto exit_restore_skb;
97 				}
98 				ret = -1;
99 				goto exit_restore_skb;
100 			}
101 
102 			adapter->curr_cmd->resp_skb = skb;
103 			adapter->cmd_resp_received = true;
104 			break;
105 		case MWIFIEX_USB_TYPE_EVENT:
106 			if (skb->len < sizeof(u32)) {
107 				mwifiex_dbg(adapter, ERROR,
108 					    "EVENT: skb->len too small\n");
109 				ret = -1;
110 				goto exit_restore_skb;
111 			}
112 			skb_copy_from_linear_data(skb, &tmp, sizeof(u32));
113 			adapter->event_cause = le32_to_cpu(tmp);
114 			mwifiex_dbg(adapter, EVENT,
115 				    "event_cause %#x\n", adapter->event_cause);
116 
117 			if (skb->len > MAX_EVENT_SIZE) {
118 				mwifiex_dbg(adapter, ERROR,
119 					    "EVENT: event body too large\n");
120 				ret = -1;
121 				goto exit_restore_skb;
122 			}
123 
124 			memcpy(adapter->event_body, skb->data +
125 			       MWIFIEX_EVENT_HEADER_LEN, skb->len);
126 
127 			adapter->event_received = true;
128 			adapter->event_skb = skb;
129 			break;
130 		default:
131 			mwifiex_dbg(adapter, ERROR,
132 				    "unknown recv_type %#x\n", recv_type);
133 			return -1;
134 		}
135 		break;
136 	case MWIFIEX_USB_EP_DATA:
137 		mwifiex_dbg(adapter, DATA, "%s: EP_DATA\n", __func__);
138 		if (skb->len > MWIFIEX_RX_DATA_BUF_SIZE) {
139 			mwifiex_dbg(adapter, ERROR,
140 				    "DATA: skb->len too large\n");
141 			return -1;
142 		}
143 
144 		skb_queue_tail(&adapter->rx_data_q, skb);
145 		adapter->data_received = true;
146 		atomic_inc(&adapter->rx_pending);
147 		break;
148 	default:
149 		mwifiex_dbg(adapter, ERROR,
150 			    "%s: unknown endport %#x\n", __func__, ep);
151 		return -1;
152 	}
153 
154 	return -EINPROGRESS;
155 
156 exit_restore_skb:
157 	/* The buffer will be reused for further cmds/events */
158 	skb_push(skb, INTF_HEADER_LEN);
159 
160 	return ret;
161 }
162 
163 static void mwifiex_usb_rx_complete(struct urb *urb)
164 {
165 	struct urb_context *context = (struct urb_context *)urb->context;
166 	struct mwifiex_adapter *adapter = context->adapter;
167 	struct sk_buff *skb = context->skb;
168 	struct usb_card_rec *card;
169 	int recv_length = urb->actual_length;
170 	int size, status;
171 
172 	if (!adapter || !adapter->card) {
173 		pr_err("mwifiex adapter or card structure is not valid\n");
174 		return;
175 	}
176 
177 	card = (struct usb_card_rec *)adapter->card;
178 	if (card->rx_cmd_ep == context->ep)
179 		atomic_dec(&card->rx_cmd_urb_pending);
180 	else
181 		atomic_dec(&card->rx_data_urb_pending);
182 
183 	if (recv_length) {
184 		if (urb->status ||
185 		    test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) {
186 			mwifiex_dbg(adapter, ERROR,
187 				    "URB status is failed: %d\n", urb->status);
188 			/* Do not free skb in case of command ep */
189 			if (card->rx_cmd_ep != context->ep)
190 				dev_kfree_skb_any(skb);
191 			goto setup_for_next;
192 		}
193 		if (skb->len > recv_length)
194 			skb_trim(skb, recv_length);
195 		else
196 			skb_put(skb, recv_length - skb->len);
197 
198 		status = mwifiex_usb_recv(adapter, skb, context->ep);
199 
200 		mwifiex_dbg(adapter, INFO,
201 			    "info: recv_length=%d, status=%d\n",
202 			    recv_length, status);
203 		if (status == -EINPROGRESS) {
204 			mwifiex_queue_main_work(adapter);
205 
206 			/* urb for data_ep is re-submitted now;
207 			 * urb for cmd_ep will be re-submitted in callback
208 			 * mwifiex_usb_recv_complete
209 			 */
210 			if (card->rx_cmd_ep == context->ep)
211 				return;
212 		} else {
213 			if (status == -1)
214 				mwifiex_dbg(adapter, ERROR,
215 					    "received data processing failed!\n");
216 
217 			/* Do not free skb in case of command ep */
218 			if (card->rx_cmd_ep != context->ep)
219 				dev_kfree_skb_any(skb);
220 		}
221 	} else if (urb->status) {
222 		if (!test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
223 			mwifiex_dbg(adapter, FATAL,
224 				    "Card is removed: %d\n", urb->status);
225 			set_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags);
226 		}
227 		dev_kfree_skb_any(skb);
228 		return;
229 	} else {
230 		/* Do not free skb in case of command ep */
231 		if (card->rx_cmd_ep != context->ep)
232 			dev_kfree_skb_any(skb);
233 
234 		/* fall through setup_for_next */
235 	}
236 
237 setup_for_next:
238 	if (card->rx_cmd_ep == context->ep)
239 		size = MWIFIEX_RX_CMD_BUF_SIZE;
240 	else
241 		size = MWIFIEX_RX_DATA_BUF_SIZE;
242 
243 	if (card->rx_cmd_ep == context->ep) {
244 		mwifiex_usb_submit_rx_urb(context, size);
245 	} else {
246 		if (atomic_read(&adapter->rx_pending) <= HIGH_RX_PENDING) {
247 			mwifiex_usb_submit_rx_urb(context, size);
248 		} else {
249 			context->skb = NULL;
250 		}
251 	}
252 
253 	return;
254 }
255 
256 static void mwifiex_usb_tx_complete(struct urb *urb)
257 {
258 	struct urb_context *context = (struct urb_context *)(urb->context);
259 	struct mwifiex_adapter *adapter = context->adapter;
260 	struct usb_card_rec *card = adapter->card;
261 	struct usb_tx_data_port *port;
262 	int i;
263 
264 	mwifiex_dbg(adapter, INFO,
265 		    "%s: status: %d\n", __func__, urb->status);
266 
267 	if (context->ep == card->tx_cmd_ep) {
268 		mwifiex_dbg(adapter, CMD,
269 			    "%s: CMD\n", __func__);
270 		atomic_dec(&card->tx_cmd_urb_pending);
271 		adapter->cmd_sent = false;
272 	} else {
273 		mwifiex_dbg(adapter, DATA,
274 			    "%s: DATA\n", __func__);
275 		mwifiex_write_data_complete(adapter, context->skb, 0,
276 					    urb->status ? -1 : 0);
277 		for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
278 			port = &card->port[i];
279 			if (context->ep == port->tx_data_ep) {
280 				atomic_dec(&port->tx_data_urb_pending);
281 				port->block_status = false;
282 				break;
283 			}
284 		}
285 		adapter->data_sent = false;
286 	}
287 
288 	if (card->mc_resync_flag)
289 		mwifiex_multi_chan_resync(adapter);
290 
291 	mwifiex_queue_main_work(adapter);
292 
293 	return;
294 }
295 
296 static int mwifiex_usb_submit_rx_urb(struct urb_context *ctx, int size)
297 {
298 	struct mwifiex_adapter *adapter = ctx->adapter;
299 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
300 
301 	if (test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
302 		if (card->rx_cmd_ep == ctx->ep) {
303 			mwifiex_dbg(adapter, INFO, "%s: free rx_cmd skb\n",
304 				    __func__);
305 			dev_kfree_skb_any(ctx->skb);
306 			ctx->skb = NULL;
307 		}
308 		mwifiex_dbg(adapter, ERROR,
309 			    "%s: card removed/suspended, EP %d rx_cmd URB submit skipped\n",
310 			    __func__, ctx->ep);
311 		return -1;
312 	}
313 
314 	if (card->rx_cmd_ep != ctx->ep) {
315 		ctx->skb = dev_alloc_skb(size);
316 		if (!ctx->skb) {
317 			mwifiex_dbg(adapter, ERROR,
318 				    "%s: dev_alloc_skb failed\n", __func__);
319 			return -ENOMEM;
320 		}
321 	}
322 
323 	if (card->rx_cmd_ep == ctx->ep &&
324 	    card->rx_cmd_ep_type == USB_ENDPOINT_XFER_INT)
325 		usb_fill_int_urb(ctx->urb, card->udev,
326 				 usb_rcvintpipe(card->udev, ctx->ep),
327 				 ctx->skb->data, size, mwifiex_usb_rx_complete,
328 				 (void *)ctx, card->rx_cmd_interval);
329 	else
330 		usb_fill_bulk_urb(ctx->urb, card->udev,
331 				  usb_rcvbulkpipe(card->udev, ctx->ep),
332 				  ctx->skb->data, size, mwifiex_usb_rx_complete,
333 				  (void *)ctx);
334 
335 	if (card->rx_cmd_ep == ctx->ep)
336 		atomic_inc(&card->rx_cmd_urb_pending);
337 	else
338 		atomic_inc(&card->rx_data_urb_pending);
339 
340 	if (usb_submit_urb(ctx->urb, GFP_ATOMIC)) {
341 		mwifiex_dbg(adapter, ERROR, "usb_submit_urb failed\n");
342 		dev_kfree_skb_any(ctx->skb);
343 		ctx->skb = NULL;
344 
345 		if (card->rx_cmd_ep == ctx->ep)
346 			atomic_dec(&card->rx_cmd_urb_pending);
347 		else
348 			atomic_dec(&card->rx_data_urb_pending);
349 
350 		return -1;
351 	}
352 
353 	return 0;
354 }
355 
356 static void mwifiex_usb_free(struct usb_card_rec *card)
357 {
358 	struct usb_tx_data_port *port;
359 	int i, j;
360 
361 	if (atomic_read(&card->rx_cmd_urb_pending) && card->rx_cmd.urb)
362 		usb_kill_urb(card->rx_cmd.urb);
363 
364 	usb_free_urb(card->rx_cmd.urb);
365 	card->rx_cmd.urb = NULL;
366 
367 	if (atomic_read(&card->rx_data_urb_pending))
368 		for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
369 			if (card->rx_data_list[i].urb)
370 				usb_kill_urb(card->rx_data_list[i].urb);
371 
372 	for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
373 		usb_free_urb(card->rx_data_list[i].urb);
374 		card->rx_data_list[i].urb = NULL;
375 	}
376 
377 	for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
378 		port = &card->port[i];
379 		for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
380 			usb_kill_urb(port->tx_data_list[j].urb);
381 			usb_free_urb(port->tx_data_list[j].urb);
382 			port->tx_data_list[j].urb = NULL;
383 		}
384 	}
385 
386 	usb_free_urb(card->tx_cmd.urb);
387 	card->tx_cmd.urb = NULL;
388 
389 	return;
390 }
391 
392 /* This function probes an mwifiex device and registers it. It allocates
393  * the card structure, initiates the device registration and initialization
394  * procedure by adding a logical interface.
395  */
396 static int mwifiex_usb_probe(struct usb_interface *intf,
397 			     const struct usb_device_id *id)
398 {
399 	struct usb_device *udev = interface_to_usbdev(intf);
400 	struct usb_host_interface *iface_desc = intf->cur_altsetting;
401 	struct usb_endpoint_descriptor *epd;
402 	int ret, i;
403 	struct usb_card_rec *card;
404 	u16 id_vendor, id_product, bcd_device;
405 
406 	card = devm_kzalloc(&intf->dev, sizeof(*card), GFP_KERNEL);
407 	if (!card)
408 		return -ENOMEM;
409 
410 	init_completion(&card->fw_done);
411 
412 	id_vendor = le16_to_cpu(udev->descriptor.idVendor);
413 	id_product = le16_to_cpu(udev->descriptor.idProduct);
414 	bcd_device = le16_to_cpu(udev->descriptor.bcdDevice);
415 	pr_debug("info: VID/PID = %X/%X, Boot2 version = %X\n",
416 		 id_vendor, id_product, bcd_device);
417 
418 	/* PID_1 is used for firmware downloading only */
419 	switch (id_product) {
420 	case USB8766_PID_1:
421 	case USB8797_PID_1:
422 	case USB8801_PID_1:
423 	case USB8997_PID_1:
424 		card->usb_boot_state = USB8XXX_FW_DNLD;
425 		break;
426 	case USB8766_PID_2:
427 	case USB8797_PID_2:
428 	case USB8801_PID_2:
429 	case USB8997_PID_2:
430 		card->usb_boot_state = USB8XXX_FW_READY;
431 		break;
432 	default:
433 		pr_warn("unknown id_product %#x\n", id_product);
434 		card->usb_boot_state = USB8XXX_FW_DNLD;
435 		break;
436 	}
437 
438 	card->udev = udev;
439 	card->intf = intf;
440 
441 	pr_debug("info: bcdUSB=%#x Device Class=%#x SubClass=%#x Protocol=%#x\n",
442 		 le16_to_cpu(udev->descriptor.bcdUSB),
443 		 udev->descriptor.bDeviceClass,
444 		 udev->descriptor.bDeviceSubClass,
445 		 udev->descriptor.bDeviceProtocol);
446 
447 	for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
448 		epd = &iface_desc->endpoint[i].desc;
449 		if (usb_endpoint_dir_in(epd) &&
450 		    usb_endpoint_num(epd) == MWIFIEX_USB_EP_CMD_EVENT &&
451 		    (usb_endpoint_xfer_bulk(epd) ||
452 		     usb_endpoint_xfer_int(epd))) {
453 			card->rx_cmd_ep_type = usb_endpoint_type(epd);
454 			card->rx_cmd_interval = epd->bInterval;
455 			pr_debug("info: Rx CMD/EVT:: max pkt size: %d, addr: %d, ep_type: %d\n",
456 				 le16_to_cpu(epd->wMaxPacketSize),
457 				 epd->bEndpointAddress, card->rx_cmd_ep_type);
458 			card->rx_cmd_ep = usb_endpoint_num(epd);
459 			atomic_set(&card->rx_cmd_urb_pending, 0);
460 		}
461 		if (usb_endpoint_dir_in(epd) &&
462 		    usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA &&
463 		    usb_endpoint_xfer_bulk(epd)) {
464 			pr_debug("info: bulk IN: max pkt size: %d, addr: %d\n",
465 				 le16_to_cpu(epd->wMaxPacketSize),
466 				 epd->bEndpointAddress);
467 			card->rx_data_ep = usb_endpoint_num(epd);
468 			atomic_set(&card->rx_data_urb_pending, 0);
469 		}
470 		if (usb_endpoint_dir_out(epd) &&
471 		    usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA &&
472 		    usb_endpoint_xfer_bulk(epd)) {
473 			pr_debug("info: bulk OUT: max pkt size: %d, addr: %d\n",
474 				 le16_to_cpu(epd->wMaxPacketSize),
475 				 epd->bEndpointAddress);
476 			card->port[0].tx_data_ep = usb_endpoint_num(epd);
477 			atomic_set(&card->port[0].tx_data_urb_pending, 0);
478 		}
479 		if (usb_endpoint_dir_out(epd) &&
480 		    usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA_CH2 &&
481 		    usb_endpoint_xfer_bulk(epd)) {
482 			pr_debug("info: bulk OUT chan2:\t"
483 				 "max pkt size: %d, addr: %d\n",
484 				 le16_to_cpu(epd->wMaxPacketSize),
485 				 epd->bEndpointAddress);
486 			card->port[1].tx_data_ep = usb_endpoint_num(epd);
487 			atomic_set(&card->port[1].tx_data_urb_pending, 0);
488 		}
489 		if (usb_endpoint_dir_out(epd) &&
490 		    usb_endpoint_num(epd) == MWIFIEX_USB_EP_CMD_EVENT &&
491 		    (usb_endpoint_xfer_bulk(epd) ||
492 		     usb_endpoint_xfer_int(epd))) {
493 			card->tx_cmd_ep_type = usb_endpoint_type(epd);
494 			card->tx_cmd_interval = epd->bInterval;
495 			pr_debug("info: bulk OUT: max pkt size: %d, addr: %d\n",
496 				 le16_to_cpu(epd->wMaxPacketSize),
497 				 epd->bEndpointAddress);
498 			pr_debug("info: Tx CMD:: max pkt size: %d, addr: %d, ep_type: %d\n",
499 				 le16_to_cpu(epd->wMaxPacketSize),
500 				 epd->bEndpointAddress, card->tx_cmd_ep_type);
501 			card->tx_cmd_ep = usb_endpoint_num(epd);
502 			atomic_set(&card->tx_cmd_urb_pending, 0);
503 			card->bulk_out_maxpktsize =
504 					le16_to_cpu(epd->wMaxPacketSize);
505 		}
506 	}
507 
508 	usb_set_intfdata(intf, card);
509 
510 	ret = mwifiex_add_card(card, &card->fw_done, &usb_ops,
511 			       MWIFIEX_USB, &card->udev->dev);
512 	if (ret) {
513 		pr_err("%s: mwifiex_add_card failed: %d\n", __func__, ret);
514 		usb_reset_device(udev);
515 		return ret;
516 	}
517 
518 	usb_get_dev(udev);
519 
520 	return 0;
521 }
522 
523 /* Kernel needs to suspend all functions separately. Therefore all
524  * registered functions must have drivers with suspend and resume
525  * methods. Failing that the kernel simply removes the whole card.
526  *
527  * If already not suspended, this function allocates and sends a
528  * 'host sleep activate' request to the firmware and turns off the traffic.
529  */
530 static int mwifiex_usb_suspend(struct usb_interface *intf, pm_message_t message)
531 {
532 	struct usb_card_rec *card = usb_get_intfdata(intf);
533 	struct mwifiex_adapter *adapter;
534 	struct usb_tx_data_port *port;
535 	int i, j;
536 
537 	/* Might still be loading firmware */
538 	wait_for_completion(&card->fw_done);
539 
540 	adapter = card->adapter;
541 	if (!adapter) {
542 		dev_err(&intf->dev, "card is not valid\n");
543 		return 0;
544 	}
545 
546 	if (unlikely(test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)))
547 		mwifiex_dbg(adapter, WARN,
548 			    "Device already suspended\n");
549 
550 	/* Enable the Host Sleep */
551 	if (!mwifiex_enable_hs(adapter)) {
552 		mwifiex_dbg(adapter, ERROR,
553 			    "cmd: failed to suspend\n");
554 		clear_bit(MWIFIEX_IS_HS_ENABLING, &adapter->work_flags);
555 		return -EFAULT;
556 	}
557 
558 
559 	/* 'MWIFIEX_IS_SUSPENDED' bit indicates device is suspended.
560 	 * It must be set here before the usb_kill_urb() calls. Reason
561 	 * is in the complete handlers, urb->status(= -ENOENT) and
562 	 * this flag is used in combination to distinguish between a
563 	 * 'suspended' state and a 'disconnect' one.
564 	 */
565 	set_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags);
566 	clear_bit(MWIFIEX_IS_HS_ENABLING, &adapter->work_flags);
567 
568 	if (atomic_read(&card->rx_cmd_urb_pending) && card->rx_cmd.urb)
569 		usb_kill_urb(card->rx_cmd.urb);
570 
571 	if (atomic_read(&card->rx_data_urb_pending))
572 		for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
573 			if (card->rx_data_list[i].urb)
574 				usb_kill_urb(card->rx_data_list[i].urb);
575 
576 	for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
577 		port = &card->port[i];
578 		for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
579 			if (port->tx_data_list[j].urb)
580 				usb_kill_urb(port->tx_data_list[j].urb);
581 		}
582 	}
583 
584 	if (card->tx_cmd.urb)
585 		usb_kill_urb(card->tx_cmd.urb);
586 
587 	return 0;
588 }
589 
590 /* Kernel needs to suspend all functions separately. Therefore all
591  * registered functions must have drivers with suspend and resume
592  * methods. Failing that the kernel simply removes the whole card.
593  *
594  * If already not resumed, this function turns on the traffic and
595  * sends a 'host sleep cancel' request to the firmware.
596  */
597 static int mwifiex_usb_resume(struct usb_interface *intf)
598 {
599 	struct usb_card_rec *card = usb_get_intfdata(intf);
600 	struct mwifiex_adapter *adapter;
601 	int i;
602 
603 	if (!card->adapter) {
604 		dev_err(&intf->dev, "%s: card->adapter is NULL\n",
605 			__func__);
606 		return 0;
607 	}
608 	adapter = card->adapter;
609 
610 	if (unlikely(!test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags))) {
611 		mwifiex_dbg(adapter, WARN,
612 			    "Device already resumed\n");
613 		return 0;
614 	}
615 
616 	/* Indicate device resumed. The netdev queue will be resumed only
617 	 * after the urbs have been re-submitted
618 	 */
619 	clear_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags);
620 
621 	if (!atomic_read(&card->rx_data_urb_pending))
622 		for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
623 			mwifiex_usb_submit_rx_urb(&card->rx_data_list[i],
624 						  MWIFIEX_RX_DATA_BUF_SIZE);
625 
626 	if (!atomic_read(&card->rx_cmd_urb_pending)) {
627 		card->rx_cmd.skb = dev_alloc_skb(MWIFIEX_RX_CMD_BUF_SIZE);
628 		if (card->rx_cmd.skb)
629 			mwifiex_usb_submit_rx_urb(&card->rx_cmd,
630 						  MWIFIEX_RX_CMD_BUF_SIZE);
631 	}
632 
633 	/* Disable Host Sleep */
634 	if (adapter->hs_activated)
635 		mwifiex_cancel_hs(mwifiex_get_priv(adapter,
636 						   MWIFIEX_BSS_ROLE_ANY),
637 				  MWIFIEX_ASYNC_CMD);
638 
639 	return 0;
640 }
641 
642 static void mwifiex_usb_disconnect(struct usb_interface *intf)
643 {
644 	struct usb_card_rec *card = usb_get_intfdata(intf);
645 	struct mwifiex_adapter *adapter;
646 
647 	wait_for_completion(&card->fw_done);
648 
649 	adapter = card->adapter;
650 	if (!adapter || !adapter->priv_num)
651 		return;
652 
653 	if (card->udev->state != USB_STATE_NOTATTACHED && !adapter->mfg_mode) {
654 		mwifiex_deauthenticate_all(adapter);
655 
656 		mwifiex_init_shutdown_fw(mwifiex_get_priv(adapter,
657 							  MWIFIEX_BSS_ROLE_ANY),
658 					 MWIFIEX_FUNC_SHUTDOWN);
659 	}
660 
661 	mwifiex_dbg(adapter, FATAL,
662 		    "%s: removing card\n", __func__);
663 	mwifiex_remove_card(adapter);
664 
665 	usb_put_dev(interface_to_usbdev(intf));
666 }
667 
668 static void mwifiex_usb_coredump(struct device *dev)
669 {
670 	struct usb_interface *intf = to_usb_interface(dev);
671 	struct usb_card_rec *card = usb_get_intfdata(intf);
672 
673 	mwifiex_fw_dump_event(mwifiex_get_priv(card->adapter,
674 					       MWIFIEX_BSS_ROLE_ANY));
675 }
676 
677 static struct usb_driver mwifiex_usb_driver = {
678 	.name = "mwifiex_usb",
679 	.probe = mwifiex_usb_probe,
680 	.disconnect = mwifiex_usb_disconnect,
681 	.id_table = mwifiex_usb_table,
682 	.suspend = mwifiex_usb_suspend,
683 	.resume = mwifiex_usb_resume,
684 	.soft_unbind = 1,
685 	.drvwrap.driver = {
686 		.coredump = mwifiex_usb_coredump,
687 	},
688 };
689 
690 static int mwifiex_write_data_sync(struct mwifiex_adapter *adapter, u8 *pbuf,
691 				   u32 *len, u8 ep, u32 timeout)
692 {
693 	struct usb_card_rec *card = adapter->card;
694 	int actual_length, ret;
695 
696 	if (!(*len % card->bulk_out_maxpktsize))
697 		(*len)++;
698 
699 	/* Send the data block */
700 	ret = usb_bulk_msg(card->udev, usb_sndbulkpipe(card->udev, ep), pbuf,
701 			   *len, &actual_length, timeout);
702 	if (ret) {
703 		mwifiex_dbg(adapter, ERROR,
704 			    "usb_bulk_msg for tx failed: %d\n", ret);
705 		return ret;
706 	}
707 
708 	*len = actual_length;
709 
710 	return ret;
711 }
712 
713 static int mwifiex_read_data_sync(struct mwifiex_adapter *adapter, u8 *pbuf,
714 				  u32 *len, u8 ep, u32 timeout)
715 {
716 	struct usb_card_rec *card = adapter->card;
717 	int actual_length, ret;
718 
719 	/* Receive the data response */
720 	ret = usb_bulk_msg(card->udev, usb_rcvbulkpipe(card->udev, ep), pbuf,
721 			   *len, &actual_length, timeout);
722 	if (ret) {
723 		mwifiex_dbg(adapter, ERROR,
724 			    "usb_bulk_msg for rx failed: %d\n", ret);
725 		return ret;
726 	}
727 
728 	*len = actual_length;
729 
730 	return ret;
731 }
732 
733 static void mwifiex_usb_port_resync(struct mwifiex_adapter *adapter)
734 {
735 	struct usb_card_rec *card = adapter->card;
736 	u8 active_port = MWIFIEX_USB_EP_DATA;
737 	struct mwifiex_private *priv = NULL;
738 	int i;
739 
740 	if (adapter->usb_mc_status) {
741 		for (i = 0; i < adapter->priv_num; i++) {
742 			priv = adapter->priv[i];
743 			if (!priv)
744 				continue;
745 			if ((priv->bss_role == MWIFIEX_BSS_ROLE_UAP &&
746 			     !priv->bss_started) ||
747 			    (priv->bss_role == MWIFIEX_BSS_ROLE_STA &&
748 			     !priv->media_connected))
749 				priv->usb_port = MWIFIEX_USB_EP_DATA;
750 		}
751 		for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++)
752 			card->port[i].block_status = false;
753 	} else {
754 		for (i = 0; i < adapter->priv_num; i++) {
755 			priv = adapter->priv[i];
756 			if (!priv)
757 				continue;
758 			if ((priv->bss_role == MWIFIEX_BSS_ROLE_UAP &&
759 			     priv->bss_started) ||
760 			    (priv->bss_role == MWIFIEX_BSS_ROLE_STA &&
761 			     priv->media_connected)) {
762 				active_port = priv->usb_port;
763 				break;
764 			}
765 		}
766 		for (i = 0; i < adapter->priv_num; i++) {
767 			priv = adapter->priv[i];
768 			if (priv)
769 				priv->usb_port = active_port;
770 		}
771 		for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
772 			if (active_port == card->port[i].tx_data_ep)
773 				card->port[i].block_status = false;
774 			else
775 				card->port[i].block_status = true;
776 		}
777 	}
778 }
779 
780 static bool mwifiex_usb_is_port_ready(struct mwifiex_private *priv)
781 {
782 	struct usb_card_rec *card = priv->adapter->card;
783 	int idx;
784 
785 	for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
786 		if (priv->usb_port == card->port[idx].tx_data_ep)
787 			return !card->port[idx].block_status;
788 	}
789 
790 	return false;
791 }
792 
793 static inline u8 mwifiex_usb_data_sent(struct mwifiex_adapter *adapter)
794 {
795 	struct usb_card_rec *card = adapter->card;
796 	int i;
797 
798 	for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++)
799 		if (!card->port[i].block_status)
800 			return false;
801 
802 	return true;
803 }
804 
805 static int mwifiex_usb_construct_send_urb(struct mwifiex_adapter *adapter,
806 					  struct usb_tx_data_port *port, u8 ep,
807 					  struct urb_context *context,
808 					  struct sk_buff *skb_send)
809 {
810 	struct usb_card_rec *card = adapter->card;
811 	int ret = -EINPROGRESS;
812 	struct urb *tx_urb;
813 
814 	context->adapter = adapter;
815 	context->ep = ep;
816 	context->skb = skb_send;
817 	tx_urb = context->urb;
818 
819 	if (ep == card->tx_cmd_ep &&
820 	    card->tx_cmd_ep_type == USB_ENDPOINT_XFER_INT)
821 		usb_fill_int_urb(tx_urb, card->udev,
822 				 usb_sndintpipe(card->udev, ep), skb_send->data,
823 				 skb_send->len, mwifiex_usb_tx_complete,
824 				 (void *)context, card->tx_cmd_interval);
825 	else
826 		usb_fill_bulk_urb(tx_urb, card->udev,
827 				  usb_sndbulkpipe(card->udev, ep),
828 				  skb_send->data, skb_send->len,
829 				  mwifiex_usb_tx_complete, (void *)context);
830 
831 	tx_urb->transfer_flags |= URB_ZERO_PACKET;
832 
833 	if (ep == card->tx_cmd_ep)
834 		atomic_inc(&card->tx_cmd_urb_pending);
835 	else
836 		atomic_inc(&port->tx_data_urb_pending);
837 
838 	if (ep != card->tx_cmd_ep &&
839 	    atomic_read(&port->tx_data_urb_pending) ==
840 					MWIFIEX_TX_DATA_URB) {
841 		port->block_status = true;
842 		adapter->data_sent = mwifiex_usb_data_sent(adapter);
843 		ret = -ENOSR;
844 	}
845 
846 	if (usb_submit_urb(tx_urb, GFP_ATOMIC)) {
847 		mwifiex_dbg(adapter, ERROR,
848 			    "%s: usb_submit_urb failed\n", __func__);
849 		if (ep == card->tx_cmd_ep) {
850 			atomic_dec(&card->tx_cmd_urb_pending);
851 		} else {
852 			atomic_dec(&port->tx_data_urb_pending);
853 			port->block_status = false;
854 			adapter->data_sent = false;
855 			if (port->tx_data_ix)
856 				port->tx_data_ix--;
857 			else
858 				port->tx_data_ix = MWIFIEX_TX_DATA_URB;
859 		}
860 		ret = -1;
861 	}
862 
863 	return ret;
864 }
865 
866 static int mwifiex_usb_prepare_tx_aggr_skb(struct mwifiex_adapter *adapter,
867 					   struct usb_tx_data_port *port,
868 					   struct sk_buff **skb_send)
869 {
870 	struct sk_buff *skb_aggr, *skb_tmp;
871 	u8 *payload, pad;
872 	u16 align = adapter->bus_aggr.tx_aggr_align;
873 	struct mwifiex_txinfo *tx_info = NULL;
874 	bool is_txinfo_set = false;
875 
876 	/* Packets in aggr_list will be send in either skb_aggr or
877 	 * write complete, delete the tx_aggr timer
878 	 */
879 	if (port->tx_aggr.timer_cnxt.is_hold_timer_set) {
880 		del_timer(&port->tx_aggr.timer_cnxt.hold_timer);
881 		port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
882 		port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
883 	}
884 
885 	skb_aggr = mwifiex_alloc_dma_align_buf(port->tx_aggr.aggr_len,
886 					       GFP_ATOMIC);
887 	if (!skb_aggr) {
888 		mwifiex_dbg(adapter, ERROR,
889 			    "%s: alloc skb_aggr failed\n", __func__);
890 
891 		while ((skb_tmp = skb_dequeue(&port->tx_aggr.aggr_list)))
892 			mwifiex_write_data_complete(adapter, skb_tmp, 0, -1);
893 
894 		port->tx_aggr.aggr_num = 0;
895 		port->tx_aggr.aggr_len = 0;
896 		return -EBUSY;
897 	}
898 
899 	tx_info = MWIFIEX_SKB_TXCB(skb_aggr);
900 	memset(tx_info, 0, sizeof(*tx_info));
901 
902 	while ((skb_tmp = skb_dequeue(&port->tx_aggr.aggr_list))) {
903 		/* padding for aligning next packet header*/
904 		pad = (align - (skb_tmp->len & (align - 1))) % align;
905 		payload = skb_put(skb_aggr, skb_tmp->len + pad);
906 		memcpy(payload, skb_tmp->data, skb_tmp->len);
907 		if (skb_queue_empty(&port->tx_aggr.aggr_list)) {
908 			/* do not padding for last packet*/
909 			*(u16 *)payload = cpu_to_le16(skb_tmp->len);
910 			*(u16 *)&payload[2] =
911 				cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2 | 0x80);
912 			skb_trim(skb_aggr, skb_aggr->len - pad);
913 		} else {
914 			/* add aggregation interface header */
915 			*(u16 *)payload = cpu_to_le16(skb_tmp->len + pad);
916 			*(u16 *)&payload[2] =
917 				cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2);
918 		}
919 
920 		if (!is_txinfo_set) {
921 			tx_info->bss_num = MWIFIEX_SKB_TXCB(skb_tmp)->bss_num;
922 			tx_info->bss_type = MWIFIEX_SKB_TXCB(skb_tmp)->bss_type;
923 			is_txinfo_set = true;
924 		}
925 
926 		port->tx_aggr.aggr_num--;
927 		port->tx_aggr.aggr_len -= (skb_tmp->len + pad);
928 		mwifiex_write_data_complete(adapter, skb_tmp, 0, 0);
929 	}
930 
931 	tx_info->pkt_len = skb_aggr->len -
932 			(sizeof(struct txpd) + adapter->intf_hdr_len);
933 	tx_info->flags |= MWIFIEX_BUF_FLAG_AGGR_PKT;
934 
935 	port->tx_aggr.aggr_num = 0;
936 	port->tx_aggr.aggr_len = 0;
937 	*skb_send = skb_aggr;
938 
939 	return 0;
940 }
941 
942 /* This function prepare data packet to be send under usb tx aggregation
943  * protocol, check current usb aggregation status, link packet to aggrgation
944  * list if possible, work flow as below:
945  * (1) if only 1 packet available, add usb tx aggregation header and send.
946  * (2) if packet is able to aggregated, link it to current aggregation list.
947  * (3) if packet is not able to aggregated, aggregate and send exist packets
948  *     in aggrgation list. Then, link packet in the list if there is more
949  *     packet in transmit queue, otherwise try to transmit single packet.
950  */
951 static int mwifiex_usb_aggr_tx_data(struct mwifiex_adapter *adapter, u8 ep,
952 				    struct sk_buff *skb,
953 				    struct mwifiex_tx_param *tx_param,
954 				    struct usb_tx_data_port *port)
955 {
956 	u8 *payload, pad;
957 	u16 align = adapter->bus_aggr.tx_aggr_align;
958 	struct sk_buff *skb_send = NULL;
959 	struct urb_context *context = NULL;
960 	struct txpd *local_tx_pd =
961 		(struct txpd *)((u8 *)skb->data + adapter->intf_hdr_len);
962 	u8 f_send_aggr_buf = 0;
963 	u8 f_send_cur_buf = 0;
964 	u8 f_precopy_cur_buf = 0;
965 	u8 f_postcopy_cur_buf = 0;
966 	u32 timeout;
967 	int ret;
968 
969 	/* padding to ensure each packet alginment */
970 	pad = (align - (skb->len & (align - 1))) % align;
971 
972 	if (tx_param && tx_param->next_pkt_len) {
973 		/* next packet available in tx queue*/
974 		if (port->tx_aggr.aggr_len + skb->len + pad >
975 		    adapter->bus_aggr.tx_aggr_max_size) {
976 			f_send_aggr_buf = 1;
977 			f_postcopy_cur_buf = 1;
978 		} else {
979 			/* current packet could be aggregated*/
980 			f_precopy_cur_buf = 1;
981 
982 			if (port->tx_aggr.aggr_len + skb->len + pad +
983 			    tx_param->next_pkt_len >
984 			    adapter->bus_aggr.tx_aggr_max_size ||
985 			    port->tx_aggr.aggr_num + 2 >
986 			    adapter->bus_aggr.tx_aggr_max_num) {
987 			    /* next packet could not be aggregated
988 			     * send current aggregation buffer
989 			     */
990 				f_send_aggr_buf = 1;
991 			}
992 		}
993 	} else {
994 		/* last packet in tx queue */
995 		if (port->tx_aggr.aggr_num > 0) {
996 			/* pending packets in aggregation buffer*/
997 			if (port->tx_aggr.aggr_len + skb->len + pad >
998 			    adapter->bus_aggr.tx_aggr_max_size) {
999 				/* current packet not be able to aggregated,
1000 				 * send aggr buffer first, then send packet.
1001 				 */
1002 				f_send_cur_buf = 1;
1003 			} else {
1004 				/* last packet, Aggregation and send */
1005 				f_precopy_cur_buf = 1;
1006 			}
1007 
1008 			f_send_aggr_buf = 1;
1009 		} else {
1010 			/* no pending packets in aggregation buffer,
1011 			 * send current packet immediately
1012 			 */
1013 			 f_send_cur_buf = 1;
1014 		}
1015 	}
1016 
1017 	if (local_tx_pd->flags & MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET) {
1018 		/* Send NULL packet immediately*/
1019 		if (f_precopy_cur_buf) {
1020 			if (skb_queue_empty(&port->tx_aggr.aggr_list)) {
1021 				f_precopy_cur_buf = 0;
1022 				f_send_aggr_buf = 0;
1023 				f_send_cur_buf = 1;
1024 			} else {
1025 				f_send_aggr_buf = 1;
1026 			}
1027 		} else if (f_postcopy_cur_buf) {
1028 			f_send_cur_buf = 1;
1029 			f_postcopy_cur_buf = 0;
1030 		}
1031 	}
1032 
1033 	if (f_precopy_cur_buf) {
1034 		skb_queue_tail(&port->tx_aggr.aggr_list, skb);
1035 		port->tx_aggr.aggr_len += (skb->len + pad);
1036 		port->tx_aggr.aggr_num++;
1037 		if (f_send_aggr_buf)
1038 			goto send_aggr_buf;
1039 
1040 		/* packet will not been send immediately,
1041 		 * set a timer to make sure it will be sent under
1042 		 * strict time limit. Dynamically fit the timeout
1043 		 * value, according to packets number in aggr_list
1044 		 */
1045 		if (!port->tx_aggr.timer_cnxt.is_hold_timer_set) {
1046 			port->tx_aggr.timer_cnxt.hold_tmo_msecs =
1047 					MWIFIEX_USB_TX_AGGR_TMO_MIN;
1048 			timeout =
1049 				port->tx_aggr.timer_cnxt.hold_tmo_msecs;
1050 			mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
1051 				  jiffies + msecs_to_jiffies(timeout));
1052 			port->tx_aggr.timer_cnxt.is_hold_timer_set = true;
1053 		} else {
1054 			if (port->tx_aggr.timer_cnxt.hold_tmo_msecs <
1055 			    MWIFIEX_USB_TX_AGGR_TMO_MAX) {
1056 				/* Dyanmic fit timeout */
1057 				timeout =
1058 				++port->tx_aggr.timer_cnxt.hold_tmo_msecs;
1059 				mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
1060 					  jiffies + msecs_to_jiffies(timeout));
1061 			}
1062 		}
1063 	}
1064 
1065 send_aggr_buf:
1066 	if (f_send_aggr_buf) {
1067 		ret = mwifiex_usb_prepare_tx_aggr_skb(adapter, port, &skb_send);
1068 		if (!ret) {
1069 			context = &port->tx_data_list[port->tx_data_ix++];
1070 			ret = mwifiex_usb_construct_send_urb(adapter, port, ep,
1071 							     context, skb_send);
1072 			if (ret == -1)
1073 				mwifiex_write_data_complete(adapter, skb_send,
1074 							    0, -1);
1075 		}
1076 	}
1077 
1078 	if (f_send_cur_buf) {
1079 		if (f_send_aggr_buf) {
1080 			if (atomic_read(&port->tx_data_urb_pending) >=
1081 			    MWIFIEX_TX_DATA_URB) {
1082 				port->block_status = true;
1083 				adapter->data_sent =
1084 					mwifiex_usb_data_sent(adapter);
1085 				/* no available urb, postcopy packet*/
1086 				f_postcopy_cur_buf = 1;
1087 				goto postcopy_cur_buf;
1088 			}
1089 
1090 			if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
1091 				port->tx_data_ix = 0;
1092 		}
1093 
1094 		payload = skb->data;
1095 		*(u16 *)&payload[2] =
1096 			cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2 | 0x80);
1097 		*(u16 *)payload = cpu_to_le16(skb->len);
1098 		skb_send = skb;
1099 		context = &port->tx_data_list[port->tx_data_ix++];
1100 		return mwifiex_usb_construct_send_urb(adapter, port, ep,
1101 						      context, skb_send);
1102 	}
1103 
1104 postcopy_cur_buf:
1105 	if (f_postcopy_cur_buf) {
1106 		skb_queue_tail(&port->tx_aggr.aggr_list, skb);
1107 		port->tx_aggr.aggr_len += (skb->len + pad);
1108 		port->tx_aggr.aggr_num++;
1109 		/* New aggregation begin, start timer */
1110 		if (!port->tx_aggr.timer_cnxt.is_hold_timer_set) {
1111 			port->tx_aggr.timer_cnxt.hold_tmo_msecs =
1112 					MWIFIEX_USB_TX_AGGR_TMO_MIN;
1113 			timeout = port->tx_aggr.timer_cnxt.hold_tmo_msecs;
1114 			mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
1115 				  jiffies + msecs_to_jiffies(timeout));
1116 			port->tx_aggr.timer_cnxt.is_hold_timer_set = true;
1117 		}
1118 	}
1119 
1120 	return -EINPROGRESS;
1121 }
1122 
1123 static void mwifiex_usb_tx_aggr_tmo(struct timer_list *t)
1124 {
1125 	struct urb_context *urb_cnxt = NULL;
1126 	struct sk_buff *skb_send = NULL;
1127 	struct tx_aggr_tmr_cnxt *timer_context =
1128 		from_timer(timer_context, t, hold_timer);
1129 	struct mwifiex_adapter *adapter = timer_context->adapter;
1130 	struct usb_tx_data_port *port = timer_context->port;
1131 	int err = 0;
1132 
1133 	spin_lock_bh(&port->tx_aggr_lock);
1134 	err = mwifiex_usb_prepare_tx_aggr_skb(adapter, port, &skb_send);
1135 	if (err) {
1136 		mwifiex_dbg(adapter, ERROR,
1137 			    "prepare tx aggr skb failed, err=%d\n", err);
1138 		goto unlock;
1139 	}
1140 
1141 	if (atomic_read(&port->tx_data_urb_pending) >=
1142 	    MWIFIEX_TX_DATA_URB) {
1143 		port->block_status = true;
1144 		adapter->data_sent =
1145 			mwifiex_usb_data_sent(adapter);
1146 		err = -1;
1147 		goto done;
1148 	}
1149 
1150 	if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
1151 		port->tx_data_ix = 0;
1152 
1153 	urb_cnxt = &port->tx_data_list[port->tx_data_ix++];
1154 	err = mwifiex_usb_construct_send_urb(adapter, port, port->tx_data_ep,
1155 					     urb_cnxt, skb_send);
1156 done:
1157 	if (err == -1)
1158 		mwifiex_write_data_complete(adapter, skb_send, 0, -1);
1159 unlock:
1160 	spin_unlock_bh(&port->tx_aggr_lock);
1161 }
1162 
1163 /* This function write a command/data packet to card. */
1164 static int mwifiex_usb_host_to_card(struct mwifiex_adapter *adapter, u8 ep,
1165 				    struct sk_buff *skb,
1166 				    struct mwifiex_tx_param *tx_param)
1167 {
1168 	struct usb_card_rec *card = adapter->card;
1169 	struct urb_context *context = NULL;
1170 	struct usb_tx_data_port *port = NULL;
1171 	int idx, ret;
1172 
1173 	if (test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
1174 		mwifiex_dbg(adapter, ERROR,
1175 			    "%s: not allowed while suspended\n", __func__);
1176 		return -1;
1177 	}
1178 
1179 	if (test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) {
1180 		mwifiex_dbg(adapter, ERROR, "%s: device removed\n", __func__);
1181 		return -1;
1182 	}
1183 
1184 	mwifiex_dbg(adapter, INFO, "%s: ep=%d\n", __func__, ep);
1185 
1186 	if (ep == card->tx_cmd_ep) {
1187 		context = &card->tx_cmd;
1188 	} else {
1189 		/* get the data port structure for endpoint */
1190 		for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
1191 			if (ep == card->port[idx].tx_data_ep) {
1192 				port = &card->port[idx];
1193 				if (atomic_read(&port->tx_data_urb_pending)
1194 				    >= MWIFIEX_TX_DATA_URB) {
1195 					port->block_status = true;
1196 					adapter->data_sent =
1197 						mwifiex_usb_data_sent(adapter);
1198 					return -EBUSY;
1199 				}
1200 				if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
1201 					port->tx_data_ix = 0;
1202 				break;
1203 			}
1204 		}
1205 
1206 		if (!port) {
1207 			mwifiex_dbg(adapter, ERROR, "Wrong usb tx data port\n");
1208 			return -1;
1209 		}
1210 
1211 		if (adapter->bus_aggr.enable) {
1212 			spin_lock_bh(&port->tx_aggr_lock);
1213 			ret =  mwifiex_usb_aggr_tx_data(adapter, ep, skb,
1214 							tx_param, port);
1215 			spin_unlock_bh(&port->tx_aggr_lock);
1216 			return ret;
1217 		}
1218 
1219 		context = &port->tx_data_list[port->tx_data_ix++];
1220 	}
1221 
1222 	return mwifiex_usb_construct_send_urb(adapter, port, ep, context, skb);
1223 }
1224 
1225 static int mwifiex_usb_tx_init(struct mwifiex_adapter *adapter)
1226 {
1227 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
1228 	struct usb_tx_data_port *port;
1229 	int i, j;
1230 
1231 	card->tx_cmd.adapter = adapter;
1232 	card->tx_cmd.ep = card->tx_cmd_ep;
1233 
1234 	card->tx_cmd.urb = usb_alloc_urb(0, GFP_KERNEL);
1235 	if (!card->tx_cmd.urb)
1236 		return -ENOMEM;
1237 
1238 	for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
1239 		port = &card->port[i];
1240 		if (!port->tx_data_ep)
1241 			continue;
1242 		port->tx_data_ix = 0;
1243 		skb_queue_head_init(&port->tx_aggr.aggr_list);
1244 		if (port->tx_data_ep == MWIFIEX_USB_EP_DATA)
1245 			port->block_status = false;
1246 		else
1247 			port->block_status = true;
1248 		for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
1249 			port->tx_data_list[j].adapter = adapter;
1250 			port->tx_data_list[j].ep = port->tx_data_ep;
1251 			port->tx_data_list[j].urb =
1252 					usb_alloc_urb(0, GFP_KERNEL);
1253 			if (!port->tx_data_list[j].urb)
1254 				return -ENOMEM;
1255 		}
1256 
1257 		port->tx_aggr.timer_cnxt.adapter = adapter;
1258 		port->tx_aggr.timer_cnxt.port = port;
1259 		port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
1260 		port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
1261 		timer_setup(&port->tx_aggr.timer_cnxt.hold_timer,
1262 			    mwifiex_usb_tx_aggr_tmo, 0);
1263 	}
1264 
1265 	return 0;
1266 }
1267 
1268 static int mwifiex_usb_rx_init(struct mwifiex_adapter *adapter)
1269 {
1270 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
1271 	int i;
1272 
1273 	card->rx_cmd.adapter = adapter;
1274 	card->rx_cmd.ep = card->rx_cmd_ep;
1275 
1276 	card->rx_cmd.urb = usb_alloc_urb(0, GFP_KERNEL);
1277 	if (!card->rx_cmd.urb)
1278 		return -ENOMEM;
1279 
1280 	card->rx_cmd.skb = dev_alloc_skb(MWIFIEX_RX_CMD_BUF_SIZE);
1281 	if (!card->rx_cmd.skb)
1282 		return -ENOMEM;
1283 
1284 	if (mwifiex_usb_submit_rx_urb(&card->rx_cmd, MWIFIEX_RX_CMD_BUF_SIZE))
1285 		return -1;
1286 
1287 	for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
1288 		card->rx_data_list[i].adapter = adapter;
1289 		card->rx_data_list[i].ep = card->rx_data_ep;
1290 
1291 		card->rx_data_list[i].urb = usb_alloc_urb(0, GFP_KERNEL);
1292 		if (!card->rx_data_list[i].urb)
1293 			return -1;
1294 		if (mwifiex_usb_submit_rx_urb(&card->rx_data_list[i],
1295 					      MWIFIEX_RX_DATA_BUF_SIZE))
1296 			return -1;
1297 	}
1298 
1299 	return 0;
1300 }
1301 
1302 /* This function register usb device and initialize parameter. */
1303 static int mwifiex_register_dev(struct mwifiex_adapter *adapter)
1304 {
1305 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
1306 
1307 	card->adapter = adapter;
1308 
1309 	switch (le16_to_cpu(card->udev->descriptor.idProduct)) {
1310 	case USB8997_PID_1:
1311 	case USB8997_PID_2:
1312 		adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_4K;
1313 		strcpy(adapter->fw_name, USB8997_DEFAULT_FW_NAME);
1314 		adapter->ext_scan = true;
1315 		break;
1316 	case USB8766_PID_1:
1317 	case USB8766_PID_2:
1318 		adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
1319 		strcpy(adapter->fw_name, USB8766_DEFAULT_FW_NAME);
1320 		adapter->ext_scan = true;
1321 		break;
1322 	case USB8801_PID_1:
1323 	case USB8801_PID_2:
1324 		adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
1325 		strcpy(adapter->fw_name, USB8801_DEFAULT_FW_NAME);
1326 		adapter->ext_scan = false;
1327 		break;
1328 	case USB8797_PID_1:
1329 	case USB8797_PID_2:
1330 	default:
1331 		adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
1332 		strcpy(adapter->fw_name, USB8797_DEFAULT_FW_NAME);
1333 		break;
1334 	}
1335 
1336 	adapter->usb_mc_status = false;
1337 	adapter->usb_mc_setup = false;
1338 
1339 	return 0;
1340 }
1341 
1342 static void mwifiex_usb_cleanup_tx_aggr(struct mwifiex_adapter *adapter)
1343 {
1344 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
1345 	struct usb_tx_data_port *port;
1346 	struct sk_buff *skb_tmp;
1347 	int idx;
1348 
1349 	for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
1350 		port = &card->port[idx];
1351 		if (adapter->bus_aggr.enable)
1352 			while ((skb_tmp =
1353 				skb_dequeue(&port->tx_aggr.aggr_list)))
1354 				mwifiex_write_data_complete(adapter, skb_tmp,
1355 							    0, -1);
1356 		del_timer_sync(&port->tx_aggr.timer_cnxt.hold_timer);
1357 		port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
1358 		port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
1359 	}
1360 }
1361 
1362 static void mwifiex_unregister_dev(struct mwifiex_adapter *adapter)
1363 {
1364 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
1365 
1366 	mwifiex_usb_free(card);
1367 
1368 	mwifiex_usb_cleanup_tx_aggr(adapter);
1369 
1370 	card->adapter = NULL;
1371 }
1372 
1373 static int mwifiex_prog_fw_w_helper(struct mwifiex_adapter *adapter,
1374 				    struct mwifiex_fw_image *fw)
1375 {
1376 	int ret = 0;
1377 	u8 *firmware = fw->fw_buf, *recv_buff;
1378 	u32 retries = USB8XXX_FW_MAX_RETRY + 1;
1379 	u32 dlen;
1380 	u32 fw_seqnum = 0, tlen = 0, dnld_cmd = 0;
1381 	struct fw_data *fwdata;
1382 	struct fw_sync_header sync_fw;
1383 	u8 check_winner = 1;
1384 
1385 	if (!firmware) {
1386 		mwifiex_dbg(adapter, ERROR,
1387 			    "No firmware image found! Terminating download\n");
1388 		ret = -1;
1389 		goto fw_exit;
1390 	}
1391 
1392 	/* Allocate memory for transmit */
1393 	fwdata = kzalloc(FW_DNLD_TX_BUF_SIZE, GFP_KERNEL);
1394 	if (!fwdata) {
1395 		ret = -ENOMEM;
1396 		goto fw_exit;
1397 	}
1398 
1399 	/* Allocate memory for receive */
1400 	recv_buff = kzalloc(FW_DNLD_RX_BUF_SIZE, GFP_KERNEL);
1401 	if (!recv_buff) {
1402 		ret = -ENOMEM;
1403 		goto cleanup;
1404 	}
1405 
1406 	do {
1407 		/* Send pseudo data to check winner status first */
1408 		if (check_winner) {
1409 			memset(&fwdata->fw_hdr, 0, sizeof(struct fw_header));
1410 			dlen = 0;
1411 		} else {
1412 			/* copy the header of the fw_data to get the length */
1413 			memcpy(&fwdata->fw_hdr, &firmware[tlen],
1414 			       sizeof(struct fw_header));
1415 
1416 			dlen = le32_to_cpu(fwdata->fw_hdr.data_len);
1417 			dnld_cmd = le32_to_cpu(fwdata->fw_hdr.dnld_cmd);
1418 			tlen += sizeof(struct fw_header);
1419 
1420 			/* Command 7 doesn't have data length field */
1421 			if (dnld_cmd == FW_CMD_7)
1422 				dlen = 0;
1423 
1424 			memcpy(fwdata->data, &firmware[tlen], dlen);
1425 
1426 			fwdata->seq_num = cpu_to_le32(fw_seqnum);
1427 			tlen += dlen;
1428 		}
1429 
1430 		/* If the send/receive fails or CRC occurs then retry */
1431 		while (--retries) {
1432 			u8 *buf = (u8 *)fwdata;
1433 			u32 len = FW_DATA_XMIT_SIZE;
1434 
1435 			/* send the firmware block */
1436 			ret = mwifiex_write_data_sync(adapter, buf, &len,
1437 						MWIFIEX_USB_EP_CMD_EVENT,
1438 						MWIFIEX_USB_TIMEOUT);
1439 			if (ret) {
1440 				mwifiex_dbg(adapter, ERROR,
1441 					    "write_data_sync: failed: %d\n",
1442 					    ret);
1443 				continue;
1444 			}
1445 
1446 			buf = recv_buff;
1447 			len = FW_DNLD_RX_BUF_SIZE;
1448 
1449 			/* Receive the firmware block response */
1450 			ret = mwifiex_read_data_sync(adapter, buf, &len,
1451 						MWIFIEX_USB_EP_CMD_EVENT,
1452 						MWIFIEX_USB_TIMEOUT);
1453 			if (ret) {
1454 				mwifiex_dbg(adapter, ERROR,
1455 					    "read_data_sync: failed: %d\n",
1456 					    ret);
1457 				continue;
1458 			}
1459 
1460 			memcpy(&sync_fw, recv_buff,
1461 			       sizeof(struct fw_sync_header));
1462 
1463 			/* check 1st firmware block resp for highest bit set */
1464 			if (check_winner) {
1465 				if (le32_to_cpu(sync_fw.cmd) & 0x80000000) {
1466 					mwifiex_dbg(adapter, WARN,
1467 						    "USB is not the winner %#x\n",
1468 						    sync_fw.cmd);
1469 
1470 					/* returning success */
1471 					ret = 0;
1472 					goto cleanup;
1473 				}
1474 
1475 				mwifiex_dbg(adapter, MSG,
1476 					    "start to download FW...\n");
1477 
1478 				check_winner = 0;
1479 				break;
1480 			}
1481 
1482 			/* check the firmware block response for CRC errors */
1483 			if (sync_fw.cmd) {
1484 				mwifiex_dbg(adapter, ERROR,
1485 					    "FW received block with CRC %#x\n",
1486 					    sync_fw.cmd);
1487 				ret = -1;
1488 				continue;
1489 			}
1490 
1491 			retries = USB8XXX_FW_MAX_RETRY + 1;
1492 			break;
1493 		}
1494 		fw_seqnum++;
1495 	} while ((dnld_cmd != FW_HAS_LAST_BLOCK) && retries);
1496 
1497 cleanup:
1498 	mwifiex_dbg(adapter, MSG,
1499 		    "info: FW download over, size %d bytes\n", tlen);
1500 
1501 	kfree(recv_buff);
1502 	kfree(fwdata);
1503 
1504 	if (retries)
1505 		ret = 0;
1506 fw_exit:
1507 	return ret;
1508 }
1509 
1510 static int mwifiex_usb_dnld_fw(struct mwifiex_adapter *adapter,
1511 			struct mwifiex_fw_image *fw)
1512 {
1513 	int ret;
1514 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
1515 
1516 	if (card->usb_boot_state == USB8XXX_FW_DNLD) {
1517 		ret = mwifiex_prog_fw_w_helper(adapter, fw);
1518 		if (ret)
1519 			return -1;
1520 
1521 		/* Boot state changes after successful firmware download */
1522 		if (card->usb_boot_state == USB8XXX_FW_DNLD)
1523 			return -1;
1524 	}
1525 
1526 	ret = mwifiex_usb_rx_init(adapter);
1527 	if (!ret)
1528 		ret = mwifiex_usb_tx_init(adapter);
1529 
1530 	return ret;
1531 }
1532 
1533 static void mwifiex_submit_rx_urb(struct mwifiex_adapter *adapter, u8 ep)
1534 {
1535 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
1536 
1537 	skb_push(card->rx_cmd.skb, INTF_HEADER_LEN);
1538 	if ((ep == card->rx_cmd_ep) &&
1539 	    (!atomic_read(&card->rx_cmd_urb_pending)))
1540 		mwifiex_usb_submit_rx_urb(&card->rx_cmd,
1541 					  MWIFIEX_RX_CMD_BUF_SIZE);
1542 
1543 	return;
1544 }
1545 
1546 static int mwifiex_usb_cmd_event_complete(struct mwifiex_adapter *adapter,
1547 				       struct sk_buff *skb)
1548 {
1549 	mwifiex_submit_rx_urb(adapter, MWIFIEX_USB_EP_CMD_EVENT);
1550 
1551 	return 0;
1552 }
1553 
1554 /* This function wakes up the card. */
1555 static int mwifiex_pm_wakeup_card(struct mwifiex_adapter *adapter)
1556 {
1557 	/* Simulation of HS_AWAKE event */
1558 	adapter->pm_wakeup_fw_try = false;
1559 	del_timer(&adapter->wakeup_timer);
1560 	adapter->pm_wakeup_card_req = false;
1561 	adapter->ps_state = PS_STATE_AWAKE;
1562 
1563 	return 0;
1564 }
1565 
1566 static void mwifiex_usb_submit_rem_rx_urbs(struct mwifiex_adapter *adapter)
1567 {
1568 	struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
1569 	int i;
1570 	struct urb_context *ctx;
1571 
1572 	for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
1573 		if (card->rx_data_list[i].skb)
1574 			continue;
1575 		ctx = &card->rx_data_list[i];
1576 		mwifiex_usb_submit_rx_urb(ctx, MWIFIEX_RX_DATA_BUF_SIZE);
1577 	}
1578 }
1579 
1580 /* This function is called after the card has woken up. */
1581 static inline int
1582 mwifiex_pm_wakeup_card_complete(struct mwifiex_adapter *adapter)
1583 {
1584 	return 0;
1585 }
1586 
1587 static struct mwifiex_if_ops usb_ops = {
1588 	.register_dev =		mwifiex_register_dev,
1589 	.unregister_dev =	mwifiex_unregister_dev,
1590 	.wakeup =		mwifiex_pm_wakeup_card,
1591 	.wakeup_complete =	mwifiex_pm_wakeup_card_complete,
1592 
1593 	/* USB specific */
1594 	.dnld_fw =		mwifiex_usb_dnld_fw,
1595 	.cmdrsp_complete =	mwifiex_usb_cmd_event_complete,
1596 	.event_complete =	mwifiex_usb_cmd_event_complete,
1597 	.host_to_card =		mwifiex_usb_host_to_card,
1598 	.submit_rem_rx_urbs =	mwifiex_usb_submit_rem_rx_urbs,
1599 	.multi_port_resync =	mwifiex_usb_port_resync,
1600 	.is_port_ready =	mwifiex_usb_is_port_ready,
1601 };
1602 
1603 module_usb_driver(mwifiex_usb_driver);
1604 
1605 MODULE_AUTHOR("Marvell International Ltd.");
1606 MODULE_DESCRIPTION("Marvell WiFi-Ex USB Driver version" USB_VERSION);
1607 MODULE_VERSION(USB_VERSION);
1608 MODULE_LICENSE("GPL v2");
1609 MODULE_FIRMWARE(USB8766_DEFAULT_FW_NAME);
1610 MODULE_FIRMWARE(USB8797_DEFAULT_FW_NAME);
1611 MODULE_FIRMWARE(USB8801_DEFAULT_FW_NAME);
1612 MODULE_FIRMWARE(USB8997_DEFAULT_FW_NAME);
1613