1 /*
2  * Copyright (c) 2014 Redpine Signals Inc.
3  *
4  * Permission to use, copy, modify, and/or distribute this software for any
5  * purpose with or without fee is hereby granted, provided that the above
6  * copyright notice and this permission notice appear in all copies.
7  *
8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15  *
16  */
17 
18 #include <linux/module.h>
19 #include <linux/types.h>
20 #include <net/rsi_91x.h>
21 #include "rsi_usb.h"
22 #include "rsi_hal.h"
23 #include "rsi_coex.h"
24 
25 /* Default operating mode is wlan STA + BT */
26 static u16 dev_oper_mode = DEV_OPMODE_STA_BT_DUAL;
27 module_param(dev_oper_mode, ushort, 0444);
28 MODULE_PARM_DESC(dev_oper_mode,
29 		 "1[Wi-Fi], 4[BT], 8[BT LE], 5[Wi-Fi STA + BT classic]\n"
30 		 "9[Wi-Fi STA + BT LE], 13[Wi-Fi STA + BT classic + BT LE]\n"
31 		 "6[AP + BT classic], 14[AP + BT classic + BT LE]");
32 
33 static int rsi_rx_urb_submit(struct rsi_hw *adapter, u8 ep_num, gfp_t flags);
34 
35 /**
36  * rsi_usb_card_write() - This function writes to the USB Card.
37  * @adapter: Pointer to the adapter structure.
38  * @buf: Pointer to the buffer from where the data has to be taken.
39  * @len: Length to be written.
40  * @endpoint: Type of endpoint.
41  *
42  * Return: status: 0 on success, a negative error code on failure.
43  */
44 static int rsi_usb_card_write(struct rsi_hw *adapter,
45 			      u8 *buf,
46 			      u16 len,
47 			      u8 endpoint)
48 {
49 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
50 	int status;
51 	u8 *seg = dev->tx_buffer;
52 	int transfer;
53 	int ep = dev->bulkout_endpoint_addr[endpoint - 1];
54 
55 	memset(seg, 0, len + RSI_USB_TX_HEAD_ROOM);
56 	memcpy(seg + RSI_USB_TX_HEAD_ROOM, buf, len);
57 	len += RSI_USB_TX_HEAD_ROOM;
58 	transfer = len;
59 	status = usb_bulk_msg(dev->usbdev,
60 			      usb_sndbulkpipe(dev->usbdev, ep),
61 			      (void *)seg,
62 			      (int)len,
63 			      &transfer,
64 			      HZ * 5);
65 
66 	if (status < 0) {
67 		rsi_dbg(ERR_ZONE,
68 			"Card write failed with error code :%10d\n", status);
69 		dev->write_fail = 1;
70 	}
71 	return status;
72 }
73 
74 /**
75  * rsi_write_multiple() - This function writes multiple bytes of information
76  *			  to the USB card.
77  * @adapter: Pointer to the adapter structure.
78  * @endpoint: Type of endpoint.
79  * @data: Pointer to the data that has to be written.
80  * @count: Number of multiple bytes to be written.
81  *
82  * Return: 0 on success, a negative error code on failure.
83  */
84 static int rsi_write_multiple(struct rsi_hw *adapter,
85 			      u8 endpoint,
86 			      u8 *data,
87 			      u32 count)
88 {
89 	struct rsi_91x_usbdev *dev;
90 
91 	if (!adapter)
92 		return -ENODEV;
93 
94 	if (endpoint == 0)
95 		return -EINVAL;
96 
97 	dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
98 	if (dev->write_fail)
99 		return -ENETDOWN;
100 
101 	return rsi_usb_card_write(adapter, data, count, endpoint);
102 }
103 
104 /**
105  * rsi_find_bulk_in_and_out_endpoints() - This function initializes the bulk
106  *					  endpoints to the device.
107  * @interface: Pointer to the USB interface structure.
108  * @adapter: Pointer to the adapter structure.
109  *
110  * Return: ret_val: 0 on success, -ENOMEM on failure.
111  */
112 static int rsi_find_bulk_in_and_out_endpoints(struct usb_interface *interface,
113 					      struct rsi_hw *adapter)
114 {
115 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
116 	struct usb_host_interface *iface_desc;
117 	struct usb_endpoint_descriptor *endpoint;
118 	__le16 buffer_size;
119 	int ii, bin_found = 0, bout_found = 0;
120 
121 	iface_desc = interface->cur_altsetting;
122 
123 	for (ii = 0; ii < iface_desc->desc.bNumEndpoints; ++ii) {
124 		endpoint = &(iface_desc->endpoint[ii].desc);
125 
126 		if (!dev->bulkin_endpoint_addr[bin_found] &&
127 		    (endpoint->bEndpointAddress & USB_DIR_IN) &&
128 		    ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
129 		    USB_ENDPOINT_XFER_BULK)) {
130 			buffer_size = endpoint->wMaxPacketSize;
131 			dev->bulkin_size[bin_found] = buffer_size;
132 			dev->bulkin_endpoint_addr[bin_found] =
133 				endpoint->bEndpointAddress;
134 			bin_found++;
135 		}
136 
137 		if (!dev->bulkout_endpoint_addr[bout_found] &&
138 		    !(endpoint->bEndpointAddress & USB_DIR_IN) &&
139 		    ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
140 		    USB_ENDPOINT_XFER_BULK)) {
141 			buffer_size = endpoint->wMaxPacketSize;
142 			dev->bulkout_endpoint_addr[bout_found] =
143 				endpoint->bEndpointAddress;
144 			dev->bulkout_size[bout_found] = buffer_size;
145 			bout_found++;
146 		}
147 
148 		if (bin_found >= MAX_BULK_EP || bout_found >= MAX_BULK_EP)
149 			break;
150 	}
151 
152 	if (!(dev->bulkin_endpoint_addr[0] && dev->bulkout_endpoint_addr[0])) {
153 		dev_err(&interface->dev, "missing wlan bulk endpoints\n");
154 		return -EINVAL;
155 	}
156 
157 	if (adapter->priv->coex_mode > 1) {
158 		if (!dev->bulkin_endpoint_addr[1]) {
159 			dev_err(&interface->dev, "missing bt bulk-in endpoint\n");
160 			return -EINVAL;
161 		}
162 	}
163 
164 	return 0;
165 }
166 
167 #define RSI_USB_REQ_OUT	(USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE)
168 #define RSI_USB_REQ_IN	(USB_TYPE_VENDOR | USB_DIR_IN | USB_RECIP_DEVICE)
169 
170 /* rsi_usb_reg_read() - This function reads data from given register address.
171  * @usbdev: Pointer to the usb_device structure.
172  * @reg: Address of the register to be read.
173  * @value: Value to be read.
174  * @len: length of data to be read.
175  *
176  * Return: status: 0 on success, a negative error code on failure.
177  */
178 static int rsi_usb_reg_read(struct usb_device *usbdev,
179 			    u32 reg,
180 			    u16 *value,
181 			    u16 len)
182 {
183 	u8 *buf;
184 	int status = -ENOMEM;
185 
186 	if (len > RSI_USB_CTRL_BUF_SIZE)
187 		return -EINVAL;
188 
189 	buf  = kmalloc(RSI_USB_CTRL_BUF_SIZE, GFP_KERNEL);
190 	if (!buf)
191 		return status;
192 
193 	status = usb_control_msg(usbdev,
194 				 usb_rcvctrlpipe(usbdev, 0),
195 				 USB_VENDOR_REGISTER_READ,
196 				 RSI_USB_REQ_IN,
197 				 ((reg & 0xffff0000) >> 16), (reg & 0xffff),
198 				 (void *)buf,
199 				 len,
200 				 USB_CTRL_GET_TIMEOUT);
201 
202 	*value = (buf[0] | (buf[1] << 8));
203 	if (status < 0) {
204 		rsi_dbg(ERR_ZONE,
205 			"%s: Reg read failed with error code :%d\n",
206 			__func__, status);
207 	}
208 	kfree(buf);
209 
210 	return status;
211 }
212 
213 /**
214  * rsi_usb_reg_write() - This function writes the given data into the given
215  *			 register address.
216  * @usbdev: Pointer to the usb_device structure.
217  * @reg: Address of the register.
218  * @value: Value to write.
219  * @len: Length of data to be written.
220  *
221  * Return: status: 0 on success, a negative error code on failure.
222  */
223 static int rsi_usb_reg_write(struct usb_device *usbdev,
224 			     u32 reg,
225 			     u32 value,
226 			     u16 len)
227 {
228 	u8 *usb_reg_buf;
229 	int status = -ENOMEM;
230 
231 	if (len > RSI_USB_CTRL_BUF_SIZE)
232 		return -EINVAL;
233 
234 	usb_reg_buf  = kmalloc(RSI_USB_CTRL_BUF_SIZE, GFP_KERNEL);
235 	if (!usb_reg_buf)
236 		return status;
237 
238 	usb_reg_buf[0] = (cpu_to_le32(value) & 0x00ff);
239 	usb_reg_buf[1] = (cpu_to_le32(value) & 0xff00) >> 8;
240 	usb_reg_buf[2] = (cpu_to_le32(value) & 0x00ff0000) >> 16;
241 	usb_reg_buf[3] = (cpu_to_le32(value) & 0xff000000) >> 24;
242 
243 	status = usb_control_msg(usbdev,
244 				 usb_sndctrlpipe(usbdev, 0),
245 				 USB_VENDOR_REGISTER_WRITE,
246 				 RSI_USB_REQ_OUT,
247 				 ((cpu_to_le32(reg) & 0xffff0000) >> 16),
248 				 (cpu_to_le32(reg) & 0xffff),
249 				 (void *)usb_reg_buf,
250 				 len,
251 				 USB_CTRL_SET_TIMEOUT);
252 	if (status < 0) {
253 		rsi_dbg(ERR_ZONE,
254 			"%s: Reg write failed with error code :%d\n",
255 			__func__, status);
256 	}
257 	kfree(usb_reg_buf);
258 
259 	return status;
260 }
261 
262 /**
263  * rsi_rx_done_handler() - This function is called when a packet is received
264  *			   from USB stack. This is callback to receive done.
265  * @urb: Received URB.
266  *
267  * Return: None.
268  */
269 static void rsi_rx_done_handler(struct urb *urb)
270 {
271 	struct rx_usb_ctrl_block *rx_cb = urb->context;
272 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)rx_cb->data;
273 	int status = -EINVAL;
274 
275 	if (urb->status) {
276 		dev_kfree_skb(rx_cb->rx_skb);
277 		return;
278 	}
279 
280 	if (urb->actual_length <= 0 ||
281 	    urb->actual_length > rx_cb->rx_skb->len) {
282 		rsi_dbg(INFO_ZONE, "%s: Invalid packet length = %d\n",
283 			__func__, urb->actual_length);
284 		goto out;
285 	}
286 	if (skb_queue_len(&dev->rx_q) >= RSI_MAX_RX_PKTS) {
287 		rsi_dbg(INFO_ZONE, "Max RX packets reached\n");
288 		goto out;
289 	}
290 	skb_trim(rx_cb->rx_skb, urb->actual_length);
291 	skb_queue_tail(&dev->rx_q, rx_cb->rx_skb);
292 
293 	rsi_set_event(&dev->rx_thread.event);
294 	status = 0;
295 
296 out:
297 	if (rsi_rx_urb_submit(dev->priv, rx_cb->ep_num, GFP_ATOMIC))
298 		rsi_dbg(ERR_ZONE, "%s: Failed in urb submission", __func__);
299 
300 	if (status)
301 		dev_kfree_skb(rx_cb->rx_skb);
302 }
303 
304 static void rsi_rx_urb_kill(struct rsi_hw *adapter, u8 ep_num)
305 {
306 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
307 	struct rx_usb_ctrl_block *rx_cb = &dev->rx_cb[ep_num - 1];
308 	struct urb *urb = rx_cb->rx_urb;
309 
310 	usb_kill_urb(urb);
311 }
312 
313 /**
314  * rsi_rx_urb_submit() - This function submits the given URB to the USB stack.
315  * @adapter: Pointer to the adapter structure.
316  * @ep_num: Endpoint number.
317  * @mem_flags: The type of memory to allocate.
318  *
319  * Return: 0 on success, a negative error code on failure.
320  */
321 static int rsi_rx_urb_submit(struct rsi_hw *adapter, u8 ep_num, gfp_t mem_flags)
322 {
323 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
324 	struct rx_usb_ctrl_block *rx_cb = &dev->rx_cb[ep_num - 1];
325 	struct urb *urb = rx_cb->rx_urb;
326 	int status;
327 	struct sk_buff *skb;
328 	u8 dword_align_bytes = 0;
329 
330 #define RSI_MAX_RX_USB_PKT_SIZE	3000
331 	skb = dev_alloc_skb(RSI_MAX_RX_USB_PKT_SIZE);
332 	if (!skb)
333 		return -ENOMEM;
334 	skb_reserve(skb, MAX_DWORD_ALIGN_BYTES);
335 	skb_put(skb, RSI_MAX_RX_USB_PKT_SIZE - MAX_DWORD_ALIGN_BYTES);
336 	dword_align_bytes = (unsigned long)skb->data & 0x3f;
337 	if (dword_align_bytes > 0)
338 		skb_push(skb, dword_align_bytes);
339 	urb->transfer_buffer = skb->data;
340 	rx_cb->rx_skb = skb;
341 
342 	usb_fill_bulk_urb(urb,
343 			  dev->usbdev,
344 			  usb_rcvbulkpipe(dev->usbdev,
345 			  dev->bulkin_endpoint_addr[ep_num - 1]),
346 			  urb->transfer_buffer,
347 			  skb->len,
348 			  rsi_rx_done_handler,
349 			  rx_cb);
350 
351 	status = usb_submit_urb(urb, mem_flags);
352 	if (status) {
353 		rsi_dbg(ERR_ZONE, "%s: Failed in urb submission\n", __func__);
354 		dev_kfree_skb(skb);
355 	}
356 
357 	return status;
358 }
359 
360 static int rsi_usb_read_register_multiple(struct rsi_hw *adapter, u32 addr,
361 					  u8 *data, u16 count)
362 {
363 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
364 	u8 *buf;
365 	u16 transfer;
366 	int status;
367 
368 	if (!addr)
369 		return -EINVAL;
370 
371 	buf = kzalloc(RSI_USB_BUF_SIZE, GFP_KERNEL);
372 	if (!buf)
373 		return -ENOMEM;
374 
375 	while (count) {
376 		transfer = min_t(u16, count, RSI_USB_BUF_SIZE);
377 		status = usb_control_msg(dev->usbdev,
378 					 usb_rcvctrlpipe(dev->usbdev, 0),
379 					 USB_VENDOR_REGISTER_READ,
380 					 RSI_USB_REQ_IN,
381 					 ((addr & 0xffff0000) >> 16),
382 					 (addr & 0xffff), (void *)buf,
383 					 transfer, USB_CTRL_GET_TIMEOUT);
384 		if (status < 0) {
385 			rsi_dbg(ERR_ZONE,
386 				"Reg read failed with error code :%d\n",
387 				 status);
388 			kfree(buf);
389 			return status;
390 		}
391 		memcpy(data, buf, transfer);
392 		count -= transfer;
393 		data += transfer;
394 		addr += transfer;
395 	}
396 	kfree(buf);
397 	return 0;
398 }
399 
400 /**
401  * rsi_usb_write_register_multiple() - This function writes multiple bytes of
402  *				       information to multiple registers.
403  * @adapter: Pointer to the adapter structure.
404  * @addr: Address of the register.
405  * @data: Pointer to the data that has to be written.
406  * @count: Number of multiple bytes to be written on to the registers.
407  *
408  * Return: status: 0 on success, a negative error code on failure.
409  */
410 static int rsi_usb_write_register_multiple(struct rsi_hw *adapter, u32 addr,
411 					   u8 *data, u16 count)
412 {
413 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
414 	u8 *buf;
415 	u16 transfer;
416 	int status = 0;
417 
418 	buf = kzalloc(RSI_USB_BUF_SIZE, GFP_KERNEL);
419 	if (!buf)
420 		return -ENOMEM;
421 
422 	while (count) {
423 		transfer = min_t(u16, count, RSI_USB_BUF_SIZE);
424 		memcpy(buf, data, transfer);
425 		status = usb_control_msg(dev->usbdev,
426 					 usb_sndctrlpipe(dev->usbdev, 0),
427 					 USB_VENDOR_REGISTER_WRITE,
428 					 RSI_USB_REQ_OUT,
429 					 ((addr & 0xffff0000) >> 16),
430 					 (addr & 0xffff),
431 					 (void *)buf,
432 					 transfer,
433 					 USB_CTRL_SET_TIMEOUT);
434 		if (status < 0) {
435 			rsi_dbg(ERR_ZONE,
436 				"Reg write failed with error code :%d\n",
437 				status);
438 			kfree(buf);
439 			return status;
440 		}
441 		count -= transfer;
442 		data += transfer;
443 		addr += transfer;
444 	}
445 
446 	kfree(buf);
447 	return 0;
448 }
449 
450 /**
451  *rsi_usb_host_intf_write_pkt() - This function writes the packet to the
452  *				   USB card.
453  * @adapter: Pointer to the adapter structure.
454  * @pkt: Pointer to the data to be written on to the card.
455  * @len: Length of the data to be written on to the card.
456  *
457  * Return: 0 on success, a negative error code on failure.
458  */
459 static int rsi_usb_host_intf_write_pkt(struct rsi_hw *adapter,
460 				       u8 *pkt,
461 				       u32 len)
462 {
463 	u32 queueno = ((pkt[1] >> 4) & 0x7);
464 	u8 endpoint;
465 
466 	endpoint = ((queueno == RSI_WIFI_MGMT_Q || queueno == RSI_WIFI_DATA_Q ||
467 		     queueno == RSI_COEX_Q) ? WLAN_EP : BT_EP);
468 
469 	return rsi_write_multiple(adapter,
470 				  endpoint,
471 				  (u8 *)pkt,
472 				  len);
473 }
474 
475 static int rsi_usb_master_reg_read(struct rsi_hw *adapter, u32 reg,
476 				   u32 *value, u16 len)
477 {
478 	struct usb_device *usbdev =
479 		((struct rsi_91x_usbdev *)adapter->rsi_dev)->usbdev;
480 	u16 temp;
481 	int ret;
482 
483 	ret = rsi_usb_reg_read(usbdev, reg, &temp, len);
484 	if (ret < 0)
485 		return ret;
486 	*value = temp;
487 
488 	return 0;
489 }
490 
491 static int rsi_usb_master_reg_write(struct rsi_hw *adapter,
492 				    unsigned long reg,
493 				    unsigned long value, u16 len)
494 {
495 	struct usb_device *usbdev =
496 		((struct rsi_91x_usbdev *)adapter->rsi_dev)->usbdev;
497 
498 	return rsi_usb_reg_write(usbdev, reg, value, len);
499 }
500 
501 static int rsi_usb_load_data_master_write(struct rsi_hw *adapter,
502 					  u32 base_address,
503 					  u32 instructions_sz, u16 block_size,
504 					  u8 *ta_firmware)
505 {
506 	u16 num_blocks;
507 	u32 cur_indx, i;
508 	u8 temp_buf[256];
509 	int status;
510 
511 	num_blocks = instructions_sz / block_size;
512 	rsi_dbg(INFO_ZONE, "num_blocks: %d\n", num_blocks);
513 
514 	for (cur_indx = 0, i = 0; i < num_blocks; i++, cur_indx += block_size) {
515 		memcpy(temp_buf, ta_firmware + cur_indx, block_size);
516 		status = rsi_usb_write_register_multiple(adapter, base_address,
517 							 (u8 *)(temp_buf),
518 							 block_size);
519 		if (status < 0)
520 			return status;
521 
522 		rsi_dbg(INFO_ZONE, "%s: loading block: %d\n", __func__, i);
523 		base_address += block_size;
524 	}
525 
526 	if (instructions_sz % block_size) {
527 		memset(temp_buf, 0, block_size);
528 		memcpy(temp_buf, ta_firmware + cur_indx,
529 		       instructions_sz % block_size);
530 		status = rsi_usb_write_register_multiple
531 						(adapter, base_address,
532 						 (u8 *)temp_buf,
533 						 instructions_sz % block_size);
534 		if (status < 0)
535 			return status;
536 		rsi_dbg(INFO_ZONE,
537 			"Written Last Block in Address 0x%x Successfully\n",
538 			cur_indx);
539 	}
540 	return 0;
541 }
542 
543 static struct rsi_host_intf_ops usb_host_intf_ops = {
544 	.write_pkt		= rsi_usb_host_intf_write_pkt,
545 	.read_reg_multiple	= rsi_usb_read_register_multiple,
546 	.write_reg_multiple	= rsi_usb_write_register_multiple,
547 	.master_reg_read	= rsi_usb_master_reg_read,
548 	.master_reg_write	= rsi_usb_master_reg_write,
549 	.load_data_master_write	= rsi_usb_load_data_master_write,
550 };
551 
552 /**
553  * rsi_deinit_usb_interface() - This function deinitializes the usb interface.
554  * @adapter: Pointer to the adapter structure.
555  *
556  * Return: None.
557  */
558 static void rsi_deinit_usb_interface(struct rsi_hw *adapter)
559 {
560 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
561 
562 	rsi_kill_thread(&dev->rx_thread);
563 
564 	usb_free_urb(dev->rx_cb[0].rx_urb);
565 	if (adapter->priv->coex_mode > 1)
566 		usb_free_urb(dev->rx_cb[1].rx_urb);
567 
568 	kfree(dev->tx_buffer);
569 }
570 
571 static int rsi_usb_init_rx(struct rsi_hw *adapter)
572 {
573 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
574 	struct rx_usb_ctrl_block *rx_cb;
575 	u8 idx, num_rx_cb;
576 
577 	num_rx_cb = (adapter->priv->coex_mode > 1 ? 2 : 1);
578 
579 	for (idx = 0; idx < num_rx_cb; idx++) {
580 		rx_cb = &dev->rx_cb[idx];
581 
582 		rx_cb->rx_urb = usb_alloc_urb(0, GFP_KERNEL);
583 		if (!rx_cb->rx_urb) {
584 			rsi_dbg(ERR_ZONE, "Failed alloc rx urb[%d]\n", idx);
585 			goto err;
586 		}
587 		rx_cb->ep_num = idx + 1;
588 		rx_cb->data = (void *)dev;
589 	}
590 	skb_queue_head_init(&dev->rx_q);
591 	rsi_init_event(&dev->rx_thread.event);
592 	if (rsi_create_kthread(adapter->priv, &dev->rx_thread,
593 			       rsi_usb_rx_thread, "RX-Thread")) {
594 		rsi_dbg(ERR_ZONE, "%s: Unable to init rx thrd\n", __func__);
595 		goto err;
596 	}
597 
598 	return 0;
599 
600 err:
601 	usb_free_urb(dev->rx_cb[0].rx_urb);
602 	if (adapter->priv->coex_mode > 1)
603 		usb_free_urb(dev->rx_cb[1].rx_urb);
604 
605 	return -1;
606 }
607 
608 /**
609  * rsi_init_usb_interface() - This function initializes the usb interface.
610  * @adapter: Pointer to the adapter structure.
611  * @pfunction: Pointer to USB interface structure.
612  *
613  * Return: 0 on success, a negative error code on failure.
614  */
615 static int rsi_init_usb_interface(struct rsi_hw *adapter,
616 				  struct usb_interface *pfunction)
617 {
618 	struct rsi_91x_usbdev *rsi_dev;
619 	int status;
620 
621 	rsi_dev = kzalloc(sizeof(*rsi_dev), GFP_KERNEL);
622 	if (!rsi_dev)
623 		return -ENOMEM;
624 
625 	adapter->rsi_dev = rsi_dev;
626 	rsi_dev->usbdev = interface_to_usbdev(pfunction);
627 	rsi_dev->priv = (void *)adapter;
628 
629 	if (rsi_find_bulk_in_and_out_endpoints(pfunction, adapter)) {
630 		status = -EINVAL;
631 		goto fail_eps;
632 	}
633 
634 	adapter->device = &pfunction->dev;
635 	usb_set_intfdata(pfunction, adapter);
636 
637 	rsi_dev->tx_buffer = kmalloc(2048, GFP_KERNEL);
638 	if (!rsi_dev->tx_buffer) {
639 		status = -ENOMEM;
640 		goto fail_eps;
641 	}
642 
643 	if (rsi_usb_init_rx(adapter)) {
644 		rsi_dbg(ERR_ZONE, "Failed to init RX handle\n");
645 		status = -ENOMEM;
646 		goto fail_rx;
647 	}
648 
649 	rsi_dev->tx_blk_size = 252;
650 	adapter->block_size = rsi_dev->tx_blk_size;
651 
652 	/* Initializing function callbacks */
653 	adapter->check_hw_queue_status = rsi_usb_check_queue_status;
654 	adapter->determine_event_timeout = rsi_usb_event_timeout;
655 	adapter->rsi_host_intf = RSI_HOST_INTF_USB;
656 	adapter->host_intf_ops = &usb_host_intf_ops;
657 
658 #ifdef CONFIG_RSI_DEBUGFS
659 	/* In USB, one less than the MAX_DEBUGFS_ENTRIES entries is required */
660 	adapter->num_debugfs_entries = (MAX_DEBUGFS_ENTRIES - 1);
661 #endif
662 
663 	rsi_dbg(INIT_ZONE, "%s: Enabled the interface\n", __func__);
664 	return 0;
665 
666 fail_rx:
667 	kfree(rsi_dev->tx_buffer);
668 
669 fail_eps:
670 
671 	return status;
672 }
673 
674 static int usb_ulp_read_write(struct rsi_hw *adapter, u16 addr, u32 data,
675 			      u16 len_in_bits)
676 {
677 	int ret;
678 
679 	ret = rsi_usb_master_reg_write
680 			(adapter, RSI_GSPI_DATA_REG1,
681 			 ((addr << 6) | ((data >> 16) & 0xffff)), 2);
682 	if (ret < 0)
683 		return ret;
684 
685 	ret = rsi_usb_master_reg_write(adapter, RSI_GSPI_DATA_REG0,
686 				       (data & 0xffff), 2);
687 	if (ret < 0)
688 		return ret;
689 
690 	/* Initializing GSPI for ULP read/writes */
691 	rsi_usb_master_reg_write(adapter, RSI_GSPI_CTRL_REG0,
692 				 RSI_GSPI_CTRL_REG0_VALUE, 2);
693 
694 	ret = rsi_usb_master_reg_write(adapter, RSI_GSPI_CTRL_REG1,
695 				       ((len_in_bits - 1) | RSI_GSPI_TRIG), 2);
696 	if (ret < 0)
697 		return ret;
698 
699 	msleep(20);
700 
701 	return 0;
702 }
703 
704 static int rsi_reset_card(struct rsi_hw *adapter)
705 {
706 	int ret;
707 
708 	rsi_dbg(INFO_ZONE, "Resetting Card...\n");
709 	rsi_usb_master_reg_write(adapter, RSI_TA_HOLD_REG, 0xE, 4);
710 
711 	/* This msleep will ensure Thread-Arch processor to go to hold
712 	 * and any pending dma transfers to rf in device to finish.
713 	 */
714 	msleep(100);
715 
716 	ret = rsi_usb_master_reg_write(adapter, SWBL_REGOUT,
717 				       RSI_FW_WDT_DISABLE_REQ,
718 				       RSI_COMMON_REG_SIZE);
719 	if (ret < 0) {
720 		rsi_dbg(ERR_ZONE, "Disabling firmware watchdog timer failed\n");
721 		goto fail;
722 	}
723 
724 	if (adapter->device_model != RSI_DEV_9116) {
725 		ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_1,
726 					 RSI_ULP_WRITE_2, 32);
727 		if (ret < 0)
728 			goto fail;
729 		ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_2,
730 					 RSI_ULP_WRITE_0, 32);
731 		if (ret < 0)
732 			goto fail;
733 		ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_1,
734 					 RSI_ULP_WRITE_50, 32);
735 		if (ret < 0)
736 			goto fail;
737 		ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_2,
738 					 RSI_ULP_WRITE_0, 32);
739 		if (ret < 0)
740 			goto fail;
741 		ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_ENABLE,
742 					 RSI_ULP_TIMER_ENABLE, 32);
743 		if (ret < 0)
744 			goto fail;
745 	} else {
746 		ret = rsi_usb_master_reg_write(adapter,
747 					       NWP_WWD_INTERRUPT_TIMER,
748 					       NWP_WWD_INT_TIMER_CLKS,
749 					       RSI_9116_REG_SIZE);
750 		if (ret < 0)
751 			goto fail;
752 		ret = rsi_usb_master_reg_write(adapter,
753 					       NWP_WWD_SYSTEM_RESET_TIMER,
754 					       NWP_WWD_SYS_RESET_TIMER_CLKS,
755 					       RSI_9116_REG_SIZE);
756 		if (ret < 0)
757 			goto fail;
758 		ret = rsi_usb_master_reg_write(adapter,
759 					       NWP_WWD_MODE_AND_RSTART,
760 					       NWP_WWD_TIMER_DISABLE,
761 					       RSI_9116_REG_SIZE);
762 		if (ret < 0)
763 			goto fail;
764 	}
765 
766 	rsi_dbg(INFO_ZONE, "Reset card done\n");
767 	return ret;
768 
769 fail:
770 	rsi_dbg(ERR_ZONE, "Reset card failed\n");
771 	return ret;
772 }
773 
774 /**
775  * rsi_probe() - This function is called by kernel when the driver provided
776  *		 Vendor and device IDs are matched. All the initialization
777  *		 work is done here.
778  * @pfunction: Pointer to the USB interface structure.
779  * @id: Pointer to the usb_device_id structure.
780  *
781  * Return: 0 on success, a negative error code on failure.
782  */
783 static int rsi_probe(struct usb_interface *pfunction,
784 		     const struct usb_device_id *id)
785 {
786 	struct rsi_hw *adapter;
787 	struct rsi_91x_usbdev *dev;
788 	u16 fw_status;
789 	int status;
790 
791 	rsi_dbg(INIT_ZONE, "%s: Init function called\n", __func__);
792 
793 	adapter = rsi_91x_init(dev_oper_mode);
794 	if (!adapter) {
795 		rsi_dbg(ERR_ZONE, "%s: Failed to init os intf ops\n",
796 			__func__);
797 		return -ENOMEM;
798 	}
799 	adapter->rsi_host_intf = RSI_HOST_INTF_USB;
800 
801 	status = rsi_init_usb_interface(adapter, pfunction);
802 	if (status) {
803 		rsi_dbg(ERR_ZONE, "%s: Failed to init usb interface\n",
804 			__func__);
805 		goto err;
806 	}
807 
808 	rsi_dbg(ERR_ZONE, "%s: Initialized os intf ops\n", __func__);
809 
810 	if (id->idProduct == RSI_USB_PID_9113) {
811 		rsi_dbg(INIT_ZONE, "%s: 9113 module detected\n", __func__);
812 		adapter->device_model = RSI_DEV_9113;
813 	} else if (id->idProduct == RSI_USB_PID_9116) {
814 		rsi_dbg(INIT_ZONE, "%s: 9116 module detected\n", __func__);
815 		adapter->device_model = RSI_DEV_9116;
816 	} else {
817 		rsi_dbg(ERR_ZONE, "%s: Unsupported RSI device id 0x%x\n",
818 			__func__, id->idProduct);
819 		goto err1;
820 	}
821 
822 	dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
823 
824 	status = rsi_usb_reg_read(dev->usbdev, FW_STATUS_REG, &fw_status, 2);
825 	if (status < 0)
826 		goto err1;
827 	else
828 		fw_status &= 1;
829 
830 	if (!fw_status) {
831 		rsi_dbg(INIT_ZONE, "Loading firmware...\n");
832 		status = rsi_hal_device_init(adapter);
833 		if (status) {
834 			rsi_dbg(ERR_ZONE, "%s: Failed in device init\n",
835 				__func__);
836 			goto err1;
837 		}
838 		rsi_dbg(INIT_ZONE, "%s: Device Init Done\n", __func__);
839 	}
840 
841 	status = rsi_rx_urb_submit(adapter, WLAN_EP, GFP_KERNEL);
842 	if (status)
843 		goto err1;
844 
845 	if (adapter->priv->coex_mode > 1) {
846 		status = rsi_rx_urb_submit(adapter, BT_EP, GFP_KERNEL);
847 		if (status)
848 			goto err_kill_wlan_urb;
849 	}
850 
851 	return 0;
852 
853 err_kill_wlan_urb:
854 	rsi_rx_urb_kill(adapter, WLAN_EP);
855 err1:
856 	rsi_deinit_usb_interface(adapter);
857 err:
858 	rsi_91x_deinit(adapter);
859 	rsi_dbg(ERR_ZONE, "%s: Failed in probe...Exiting\n", __func__);
860 	return status;
861 }
862 
863 /**
864  * rsi_disconnect() - This function performs the reverse of the probe function,
865  *		      it deinitialize the driver structure.
866  * @pfunction: Pointer to the USB interface structure.
867  *
868  * Return: None.
869  */
870 static void rsi_disconnect(struct usb_interface *pfunction)
871 {
872 	struct rsi_hw *adapter = usb_get_intfdata(pfunction);
873 
874 	if (!adapter)
875 		return;
876 
877 	rsi_mac80211_detach(adapter);
878 
879 	if (IS_ENABLED(CONFIG_RSI_COEX) && adapter->priv->coex_mode > 1 &&
880 	    adapter->priv->bt_adapter) {
881 		rsi_bt_ops.detach(adapter->priv->bt_adapter);
882 		adapter->priv->bt_adapter = NULL;
883 	}
884 
885 	if (adapter->priv->coex_mode > 1)
886 		rsi_rx_urb_kill(adapter, BT_EP);
887 	rsi_rx_urb_kill(adapter, WLAN_EP);
888 
889 	rsi_reset_card(adapter);
890 	rsi_deinit_usb_interface(adapter);
891 	rsi_91x_deinit(adapter);
892 
893 	rsi_dbg(INFO_ZONE, "%s: Deinitialization completed\n", __func__);
894 }
895 
896 #ifdef CONFIG_PM
897 static int rsi_suspend(struct usb_interface *intf, pm_message_t message)
898 {
899 	/* Not yet implemented */
900 	return -ENOSYS;
901 }
902 
903 static int rsi_resume(struct usb_interface *intf)
904 {
905 	/* Not yet implemented */
906 	return -ENOSYS;
907 }
908 #endif
909 
910 static const struct usb_device_id rsi_dev_table[] = {
911 	{ USB_DEVICE(RSI_USB_VENDOR_ID, RSI_USB_PID_9113) },
912 	{ USB_DEVICE(RSI_USB_VENDOR_ID, RSI_USB_PID_9116) },
913 	{ /* Blank */},
914 };
915 
916 static struct usb_driver rsi_driver = {
917 	.name       = "RSI-USB WLAN",
918 	.probe      = rsi_probe,
919 	.disconnect = rsi_disconnect,
920 	.id_table   = rsi_dev_table,
921 #ifdef CONFIG_PM
922 	.suspend    = rsi_suspend,
923 	.resume     = rsi_resume,
924 #endif
925 };
926 
927 module_usb_driver(rsi_driver);
928 
929 MODULE_AUTHOR("Redpine Signals Inc");
930 MODULE_DESCRIPTION("Common USB layer for RSI drivers");
931 MODULE_DEVICE_TABLE(usb, rsi_dev_table);
932 MODULE_FIRMWARE(FIRMWARE_RSI9113);
933 MODULE_VERSION("0.1");
934 MODULE_LICENSE("Dual BSD/GPL");
935