• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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  */
rsi_usb_card_write(struct rsi_hw * adapter,u8 * buf,u16 len,u8 endpoint)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  * @addr: Address of the register.
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  */
rsi_write_multiple(struct rsi_hw * adapter,u8 endpoint,u8 * data,u32 count)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  */
rsi_find_bulk_in_and_out_endpoints(struct usb_interface * interface,struct rsi_hw * adapter)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]) &&
153 	    dev->bulkout_endpoint_addr[0])
154 		return -EINVAL;
155 
156 	return 0;
157 }
158 
159 #define RSI_USB_REQ_OUT	(USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE)
160 #define RSI_USB_REQ_IN	(USB_TYPE_VENDOR | USB_DIR_IN | USB_RECIP_DEVICE)
161 
162 /* rsi_usb_reg_read() - This function reads data from given register address.
163  * @usbdev: Pointer to the usb_device structure.
164  * @reg: Address of the register to be read.
165  * @value: Value to be read.
166  * @len: length of data to be read.
167  *
168  * Return: status: 0 on success, a negative error code on failure.
169  */
rsi_usb_reg_read(struct usb_device * usbdev,u32 reg,u16 * value,u16 len)170 static int rsi_usb_reg_read(struct usb_device *usbdev,
171 			    u32 reg,
172 			    u16 *value,
173 			    u16 len)
174 {
175 	u8 *buf;
176 	int status = -ENOMEM;
177 
178 	if (len > RSI_USB_CTRL_BUF_SIZE)
179 		return -EINVAL;
180 
181 	buf  = kmalloc(RSI_USB_CTRL_BUF_SIZE, GFP_KERNEL);
182 	if (!buf)
183 		return status;
184 
185 	status = usb_control_msg(usbdev,
186 				 usb_rcvctrlpipe(usbdev, 0),
187 				 USB_VENDOR_REGISTER_READ,
188 				 RSI_USB_REQ_IN,
189 				 ((reg & 0xffff0000) >> 16), (reg & 0xffff),
190 				 (void *)buf,
191 				 len,
192 				 USB_CTRL_GET_TIMEOUT);
193 
194 	*value = (buf[0] | (buf[1] << 8));
195 	if (status < 0) {
196 		rsi_dbg(ERR_ZONE,
197 			"%s: Reg read failed with error code :%d\n",
198 			__func__, status);
199 	}
200 	kfree(buf);
201 
202 	return status;
203 }
204 
205 /**
206  * rsi_usb_reg_write() - This function writes the given data into the given
207  *			 register address.
208  * @usbdev: Pointer to the usb_device structure.
209  * @reg: Address of the register.
210  * @value: Value to write.
211  * @len: Length of data to be written.
212  *
213  * Return: status: 0 on success, a negative error code on failure.
214  */
rsi_usb_reg_write(struct usb_device * usbdev,u32 reg,u16 value,u16 len)215 static int rsi_usb_reg_write(struct usb_device *usbdev,
216 			     u32 reg,
217 			     u16 value,
218 			     u16 len)
219 {
220 	u8 *usb_reg_buf;
221 	int status = -ENOMEM;
222 
223 	if (len > RSI_USB_CTRL_BUF_SIZE)
224 		return -EINVAL;
225 
226 	usb_reg_buf  = kmalloc(RSI_USB_CTRL_BUF_SIZE, GFP_KERNEL);
227 	if (!usb_reg_buf)
228 		return status;
229 
230 	usb_reg_buf[0] = (value & 0x00ff);
231 	usb_reg_buf[1] = (value & 0xff00) >> 8;
232 	usb_reg_buf[2] = 0x0;
233 	usb_reg_buf[3] = 0x0;
234 
235 	status = usb_control_msg(usbdev,
236 				 usb_sndctrlpipe(usbdev, 0),
237 				 USB_VENDOR_REGISTER_WRITE,
238 				 RSI_USB_REQ_OUT,
239 				 ((reg & 0xffff0000) >> 16),
240 				 (reg & 0xffff),
241 				 (void *)usb_reg_buf,
242 				 len,
243 				 USB_CTRL_SET_TIMEOUT);
244 	if (status < 0) {
245 		rsi_dbg(ERR_ZONE,
246 			"%s: Reg write failed with error code :%d\n",
247 			__func__, status);
248 	}
249 	kfree(usb_reg_buf);
250 
251 	return status;
252 }
253 
254 /**
255  * rsi_rx_done_handler() - This function is called when a packet is received
256  *			   from USB stack. This is callback to recieve done.
257  * @urb: Received URB.
258  *
259  * Return: None.
260  */
rsi_rx_done_handler(struct urb * urb)261 static void rsi_rx_done_handler(struct urb *urb)
262 {
263 	struct rx_usb_ctrl_block *rx_cb = urb->context;
264 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)rx_cb->data;
265 	int status = -EINVAL;
266 
267 	if (urb->status)
268 		goto out;
269 
270 	if (urb->actual_length <= 0 ||
271 	    urb->actual_length > rx_cb->rx_skb->len) {
272 		rsi_dbg(INFO_ZONE, "%s: Invalid packet length = %d\n",
273 			__func__, urb->actual_length);
274 		goto out;
275 	}
276 	if (skb_queue_len(&dev->rx_q) >= RSI_MAX_RX_PKTS) {
277 		rsi_dbg(INFO_ZONE, "Max RX packets reached\n");
278 		goto out;
279 	}
280 	skb_trim(rx_cb->rx_skb, urb->actual_length);
281 	skb_queue_tail(&dev->rx_q, rx_cb->rx_skb);
282 
283 	rsi_set_event(&dev->rx_thread.event);
284 	status = 0;
285 
286 out:
287 	if (rsi_rx_urb_submit(dev->priv, rx_cb->ep_num, GFP_ATOMIC))
288 		rsi_dbg(ERR_ZONE, "%s: Failed in urb submission", __func__);
289 
290 	if (status)
291 		dev_kfree_skb(rx_cb->rx_skb);
292 }
293 
rsi_rx_urb_kill(struct rsi_hw * adapter,u8 ep_num)294 static void rsi_rx_urb_kill(struct rsi_hw *adapter, u8 ep_num)
295 {
296 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
297 	struct rx_usb_ctrl_block *rx_cb = &dev->rx_cb[ep_num - 1];
298 	struct urb *urb = rx_cb->rx_urb;
299 
300 	usb_kill_urb(urb);
301 }
302 
303 /**
304  * rsi_rx_urb_submit() - This function submits the given URB to the USB stack.
305  * @adapter: Pointer to the adapter structure.
306  *
307  * Return: 0 on success, a negative error code on failure.
308  */
rsi_rx_urb_submit(struct rsi_hw * adapter,u8 ep_num,gfp_t mem_flags)309 static int rsi_rx_urb_submit(struct rsi_hw *adapter, u8 ep_num, gfp_t mem_flags)
310 {
311 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
312 	struct rx_usb_ctrl_block *rx_cb = &dev->rx_cb[ep_num - 1];
313 	struct urb *urb = rx_cb->rx_urb;
314 	int status;
315 	struct sk_buff *skb;
316 	u8 dword_align_bytes = 0;
317 
318 #define RSI_MAX_RX_USB_PKT_SIZE	3000
319 	skb = dev_alloc_skb(RSI_MAX_RX_USB_PKT_SIZE);
320 	if (!skb)
321 		return -ENOMEM;
322 	skb_reserve(skb, MAX_DWORD_ALIGN_BYTES);
323 	skb_put(skb, RSI_MAX_RX_USB_PKT_SIZE - MAX_DWORD_ALIGN_BYTES);
324 	dword_align_bytes = (unsigned long)skb->data & 0x3f;
325 	if (dword_align_bytes > 0)
326 		skb_push(skb, dword_align_bytes);
327 	urb->transfer_buffer = skb->data;
328 	rx_cb->rx_skb = skb;
329 
330 	usb_fill_bulk_urb(urb,
331 			  dev->usbdev,
332 			  usb_rcvbulkpipe(dev->usbdev,
333 			  dev->bulkin_endpoint_addr[ep_num - 1]),
334 			  urb->transfer_buffer,
335 			  skb->len,
336 			  rsi_rx_done_handler,
337 			  rx_cb);
338 
339 	status = usb_submit_urb(urb, mem_flags);
340 	if (status) {
341 		rsi_dbg(ERR_ZONE, "%s: Failed in urb submission\n", __func__);
342 		dev_kfree_skb(skb);
343 	}
344 
345 	return status;
346 }
347 
rsi_usb_read_register_multiple(struct rsi_hw * adapter,u32 addr,u8 * data,u16 count)348 static int rsi_usb_read_register_multiple(struct rsi_hw *adapter, u32 addr,
349 					  u8 *data, u16 count)
350 {
351 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
352 	u8 *buf;
353 	u16 transfer;
354 	int status;
355 
356 	if (!addr)
357 		return -EINVAL;
358 
359 	buf = kzalloc(RSI_USB_BUF_SIZE, GFP_KERNEL);
360 	if (!buf)
361 		return -ENOMEM;
362 
363 	while (count) {
364 		transfer = min_t(u16, count, RSI_USB_BUF_SIZE);
365 		status = usb_control_msg(dev->usbdev,
366 					 usb_rcvctrlpipe(dev->usbdev, 0),
367 					 USB_VENDOR_REGISTER_READ,
368 					 RSI_USB_REQ_IN,
369 					 ((addr & 0xffff0000) >> 16),
370 					 (addr & 0xffff), (void *)buf,
371 					 transfer, USB_CTRL_GET_TIMEOUT);
372 		if (status < 0) {
373 			rsi_dbg(ERR_ZONE,
374 				"Reg read failed with error code :%d\n",
375 				 status);
376 			kfree(buf);
377 			return status;
378 		}
379 		memcpy(data, buf, transfer);
380 		count -= transfer;
381 		data += transfer;
382 		addr += transfer;
383 	}
384 	kfree(buf);
385 	return 0;
386 }
387 
388 /**
389  * rsi_usb_write_register_multiple() - This function writes multiple bytes of
390  *				       information to multiple registers.
391  * @adapter: Pointer to the adapter structure.
392  * @addr: Address of the register.
393  * @data: Pointer to the data that has to be written.
394  * @count: Number of multiple bytes to be written on to the registers.
395  *
396  * Return: status: 0 on success, a negative error code on failure.
397  */
rsi_usb_write_register_multiple(struct rsi_hw * adapter,u32 addr,u8 * data,u16 count)398 static int rsi_usb_write_register_multiple(struct rsi_hw *adapter, u32 addr,
399 					   u8 *data, u16 count)
400 {
401 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
402 	u8 *buf;
403 	u16 transfer;
404 	int status = 0;
405 
406 	buf = kzalloc(RSI_USB_BUF_SIZE, GFP_KERNEL);
407 	if (!buf)
408 		return -ENOMEM;
409 
410 	while (count) {
411 		transfer = min_t(u16, count, RSI_USB_BUF_SIZE);
412 		memcpy(buf, data, transfer);
413 		status = usb_control_msg(dev->usbdev,
414 					 usb_sndctrlpipe(dev->usbdev, 0),
415 					 USB_VENDOR_REGISTER_WRITE,
416 					 RSI_USB_REQ_OUT,
417 					 ((addr & 0xffff0000) >> 16),
418 					 (addr & 0xffff),
419 					 (void *)buf,
420 					 transfer,
421 					 USB_CTRL_SET_TIMEOUT);
422 		if (status < 0) {
423 			rsi_dbg(ERR_ZONE,
424 				"Reg write failed with error code :%d\n",
425 				status);
426 			kfree(buf);
427 			return status;
428 		}
429 		count -= transfer;
430 		data += transfer;
431 		addr += transfer;
432 	}
433 
434 	kfree(buf);
435 	return 0;
436 }
437 
438 /**
439  *rsi_usb_host_intf_write_pkt() - This function writes the packet to the
440  *				   USB card.
441  * @adapter: Pointer to the adapter structure.
442  * @pkt: Pointer to the data to be written on to the card.
443  * @len: Length of the data to be written on to the card.
444  *
445  * Return: 0 on success, a negative error code on failure.
446  */
rsi_usb_host_intf_write_pkt(struct rsi_hw * adapter,u8 * pkt,u32 len)447 static int rsi_usb_host_intf_write_pkt(struct rsi_hw *adapter,
448 				       u8 *pkt,
449 				       u32 len)
450 {
451 	u32 queueno = ((pkt[1] >> 4) & 0x7);
452 	u8 endpoint;
453 
454 	endpoint = ((queueno == RSI_WIFI_MGMT_Q || queueno == RSI_WIFI_DATA_Q ||
455 		     queueno == RSI_COEX_Q) ? WLAN_EP : BT_EP);
456 
457 	return rsi_write_multiple(adapter,
458 				  endpoint,
459 				  (u8 *)pkt,
460 				  len);
461 }
462 
rsi_usb_master_reg_read(struct rsi_hw * adapter,u32 reg,u32 * value,u16 len)463 static int rsi_usb_master_reg_read(struct rsi_hw *adapter, u32 reg,
464 				   u32 *value, u16 len)
465 {
466 	struct usb_device *usbdev =
467 		((struct rsi_91x_usbdev *)adapter->rsi_dev)->usbdev;
468 	u16 temp;
469 	int ret;
470 
471 	ret = rsi_usb_reg_read(usbdev, reg, &temp, len);
472 	if (ret < 0)
473 		return ret;
474 	*value = temp;
475 
476 	return 0;
477 }
478 
rsi_usb_master_reg_write(struct rsi_hw * adapter,unsigned long reg,unsigned long value,u16 len)479 static int rsi_usb_master_reg_write(struct rsi_hw *adapter,
480 				    unsigned long reg,
481 				    unsigned long value, u16 len)
482 {
483 	struct usb_device *usbdev =
484 		((struct rsi_91x_usbdev *)adapter->rsi_dev)->usbdev;
485 
486 	return rsi_usb_reg_write(usbdev, reg, value, len);
487 }
488 
rsi_usb_load_data_master_write(struct rsi_hw * adapter,u32 base_address,u32 instructions_sz,u16 block_size,u8 * ta_firmware)489 static int rsi_usb_load_data_master_write(struct rsi_hw *adapter,
490 					  u32 base_address,
491 					  u32 instructions_sz, u16 block_size,
492 					  u8 *ta_firmware)
493 {
494 	u16 num_blocks;
495 	u32 cur_indx, i;
496 	u8 temp_buf[256];
497 	int status;
498 
499 	num_blocks = instructions_sz / block_size;
500 	rsi_dbg(INFO_ZONE, "num_blocks: %d\n", num_blocks);
501 
502 	for (cur_indx = 0, i = 0; i < num_blocks; i++, cur_indx += block_size) {
503 		memcpy(temp_buf, ta_firmware + cur_indx, block_size);
504 		status = rsi_usb_write_register_multiple(adapter, base_address,
505 							 (u8 *)(temp_buf),
506 							 block_size);
507 		if (status < 0)
508 			return status;
509 
510 		rsi_dbg(INFO_ZONE, "%s: loading block: %d\n", __func__, i);
511 		base_address += block_size;
512 	}
513 
514 	if (instructions_sz % block_size) {
515 		memset(temp_buf, 0, block_size);
516 		memcpy(temp_buf, ta_firmware + cur_indx,
517 		       instructions_sz % block_size);
518 		status = rsi_usb_write_register_multiple
519 						(adapter, base_address,
520 						 (u8 *)temp_buf,
521 						 instructions_sz % block_size);
522 		if (status < 0)
523 			return status;
524 		rsi_dbg(INFO_ZONE,
525 			"Written Last Block in Address 0x%x Successfully\n",
526 			cur_indx);
527 	}
528 	return 0;
529 }
530 
531 static struct rsi_host_intf_ops usb_host_intf_ops = {
532 	.write_pkt		= rsi_usb_host_intf_write_pkt,
533 	.read_reg_multiple	= rsi_usb_read_register_multiple,
534 	.write_reg_multiple	= rsi_usb_write_register_multiple,
535 	.master_reg_read	= rsi_usb_master_reg_read,
536 	.master_reg_write	= rsi_usb_master_reg_write,
537 	.load_data_master_write	= rsi_usb_load_data_master_write,
538 };
539 
540 /**
541  * rsi_deinit_usb_interface() - This function deinitializes the usb interface.
542  * @adapter: Pointer to the adapter structure.
543  *
544  * Return: None.
545  */
rsi_deinit_usb_interface(struct rsi_hw * adapter)546 static void rsi_deinit_usb_interface(struct rsi_hw *adapter)
547 {
548 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
549 
550 	rsi_kill_thread(&dev->rx_thread);
551 
552 	usb_free_urb(dev->rx_cb[0].rx_urb);
553 	if (adapter->priv->coex_mode > 1)
554 		usb_free_urb(dev->rx_cb[1].rx_urb);
555 
556 	kfree(dev->tx_buffer);
557 }
558 
rsi_usb_init_rx(struct rsi_hw * adapter)559 static int rsi_usb_init_rx(struct rsi_hw *adapter)
560 {
561 	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
562 	struct rx_usb_ctrl_block *rx_cb;
563 	u8 idx, num_rx_cb;
564 
565 	num_rx_cb = (adapter->priv->coex_mode > 1 ? 2 : 1);
566 
567 	for (idx = 0; idx < num_rx_cb; idx++) {
568 		rx_cb = &dev->rx_cb[idx];
569 
570 		rx_cb->rx_urb = usb_alloc_urb(0, GFP_KERNEL);
571 		if (!rx_cb->rx_urb) {
572 			rsi_dbg(ERR_ZONE, "Failed alloc rx urb[%d]\n", idx);
573 			goto err;
574 		}
575 		rx_cb->ep_num = idx + 1;
576 		rx_cb->data = (void *)dev;
577 	}
578 	skb_queue_head_init(&dev->rx_q);
579 	rsi_init_event(&dev->rx_thread.event);
580 	if (rsi_create_kthread(adapter->priv, &dev->rx_thread,
581 			       rsi_usb_rx_thread, "RX-Thread")) {
582 		rsi_dbg(ERR_ZONE, "%s: Unable to init rx thrd\n", __func__);
583 		goto err;
584 	}
585 
586 	return 0;
587 
588 err:
589 	usb_free_urb(dev->rx_cb[0].rx_urb);
590 	if (adapter->priv->coex_mode > 1)
591 		usb_free_urb(dev->rx_cb[1].rx_urb);
592 
593 	return -1;
594 }
595 
596 /**
597  * rsi_init_usb_interface() - This function initializes the usb interface.
598  * @adapter: Pointer to the adapter structure.
599  * @pfunction: Pointer to USB interface structure.
600  *
601  * Return: 0 on success, a negative error code on failure.
602  */
rsi_init_usb_interface(struct rsi_hw * adapter,struct usb_interface * pfunction)603 static int rsi_init_usb_interface(struct rsi_hw *adapter,
604 				  struct usb_interface *pfunction)
605 {
606 	struct rsi_91x_usbdev *rsi_dev;
607 	int status;
608 
609 	rsi_dev = kzalloc(sizeof(*rsi_dev), GFP_KERNEL);
610 	if (!rsi_dev)
611 		return -ENOMEM;
612 
613 	adapter->rsi_dev = rsi_dev;
614 	rsi_dev->usbdev = interface_to_usbdev(pfunction);
615 	rsi_dev->priv = (void *)adapter;
616 
617 	if (rsi_find_bulk_in_and_out_endpoints(pfunction, adapter)) {
618 		status = -EINVAL;
619 		goto fail_eps;
620 	}
621 
622 	adapter->device = &pfunction->dev;
623 	usb_set_intfdata(pfunction, adapter);
624 
625 	rsi_dev->tx_buffer = kmalloc(2048, GFP_KERNEL);
626 	if (!rsi_dev->tx_buffer) {
627 		status = -ENOMEM;
628 		goto fail_eps;
629 	}
630 
631 	if (rsi_usb_init_rx(adapter)) {
632 		rsi_dbg(ERR_ZONE, "Failed to init RX handle\n");
633 		status = -ENOMEM;
634 		goto fail_rx;
635 	}
636 
637 	rsi_dev->tx_blk_size = 252;
638 	adapter->block_size = rsi_dev->tx_blk_size;
639 
640 	/* Initializing function callbacks */
641 	adapter->check_hw_queue_status = rsi_usb_check_queue_status;
642 	adapter->determine_event_timeout = rsi_usb_event_timeout;
643 	adapter->rsi_host_intf = RSI_HOST_INTF_USB;
644 	adapter->host_intf_ops = &usb_host_intf_ops;
645 
646 #ifdef CONFIG_RSI_DEBUGFS
647 	/* In USB, one less than the MAX_DEBUGFS_ENTRIES entries is required */
648 	adapter->num_debugfs_entries = (MAX_DEBUGFS_ENTRIES - 1);
649 #endif
650 
651 	rsi_dbg(INIT_ZONE, "%s: Enabled the interface\n", __func__);
652 	return 0;
653 
654 fail_rx:
655 	kfree(rsi_dev->tx_buffer);
656 
657 fail_eps:
658 
659 	return status;
660 }
661 
usb_ulp_read_write(struct rsi_hw * adapter,u16 addr,u32 data,u16 len_in_bits)662 static int usb_ulp_read_write(struct rsi_hw *adapter, u16 addr, u32 data,
663 			      u16 len_in_bits)
664 {
665 	int ret;
666 
667 	ret = rsi_usb_master_reg_write
668 			(adapter, RSI_GSPI_DATA_REG1,
669 			 ((addr << 6) | ((data >> 16) & 0xffff)), 2);
670 	if (ret < 0)
671 		return ret;
672 
673 	ret = rsi_usb_master_reg_write(adapter, RSI_GSPI_DATA_REG0,
674 				       (data & 0xffff), 2);
675 	if (ret < 0)
676 		return ret;
677 
678 	/* Initializing GSPI for ULP read/writes */
679 	rsi_usb_master_reg_write(adapter, RSI_GSPI_CTRL_REG0,
680 				 RSI_GSPI_CTRL_REG0_VALUE, 2);
681 
682 	ret = rsi_usb_master_reg_write(adapter, RSI_GSPI_CTRL_REG1,
683 				       ((len_in_bits - 1) | RSI_GSPI_TRIG), 2);
684 	if (ret < 0)
685 		return ret;
686 
687 	msleep(20);
688 
689 	return 0;
690 }
691 
rsi_reset_card(struct rsi_hw * adapter)692 static int rsi_reset_card(struct rsi_hw *adapter)
693 {
694 	int ret;
695 
696 	rsi_dbg(INFO_ZONE, "Resetting Card...\n");
697 	rsi_usb_master_reg_write(adapter, RSI_TA_HOLD_REG, 0xE, 4);
698 
699 	/* This msleep will ensure Thread-Arch processor to go to hold
700 	 * and any pending dma transfers to rf in device to finish.
701 	 */
702 	msleep(100);
703 
704 	ret = rsi_usb_master_reg_write(adapter, SWBL_REGOUT,
705 				       RSI_FW_WDT_DISABLE_REQ,
706 				       RSI_COMMON_REG_SIZE);
707 	if (ret < 0) {
708 		rsi_dbg(ERR_ZONE, "Disabling firmware watchdog timer failed\n");
709 		goto fail;
710 	}
711 
712 	ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_1,
713 				 RSI_ULP_WRITE_2, 32);
714 	if (ret < 0)
715 		goto fail;
716 	ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_2,
717 				 RSI_ULP_WRITE_0, 32);
718 	if (ret < 0)
719 		goto fail;
720 	ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_1,
721 				 RSI_ULP_WRITE_50, 32);
722 	if (ret < 0)
723 		goto fail;
724 	ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_2,
725 				 RSI_ULP_WRITE_0, 32);
726 	if (ret < 0)
727 		goto fail;
728 	ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_ENABLE,
729 				 RSI_ULP_TIMER_ENABLE, 32);
730 	if (ret < 0)
731 		goto fail;
732 
733 	rsi_dbg(INFO_ZONE, "Reset card done\n");
734 	return ret;
735 
736 fail:
737 	rsi_dbg(ERR_ZONE, "Reset card failed\n");
738 	return ret;
739 }
740 
741 /**
742  * rsi_probe() - This function is called by kernel when the driver provided
743  *		 Vendor and device IDs are matched. All the initialization
744  *		 work is done here.
745  * @pfunction: Pointer to the USB interface structure.
746  * @id: Pointer to the usb_device_id structure.
747  *
748  * Return: 0 on success, a negative error code on failure.
749  */
rsi_probe(struct usb_interface * pfunction,const struct usb_device_id * id)750 static int rsi_probe(struct usb_interface *pfunction,
751 		     const struct usb_device_id *id)
752 {
753 	struct rsi_hw *adapter;
754 	struct rsi_91x_usbdev *dev;
755 	u16 fw_status;
756 	int status;
757 
758 	rsi_dbg(INIT_ZONE, "%s: Init function called\n", __func__);
759 
760 	adapter = rsi_91x_init(dev_oper_mode);
761 	if (!adapter) {
762 		rsi_dbg(ERR_ZONE, "%s: Failed to init os intf ops\n",
763 			__func__);
764 		return -ENOMEM;
765 	}
766 	adapter->rsi_host_intf = RSI_HOST_INTF_USB;
767 
768 	status = rsi_init_usb_interface(adapter, pfunction);
769 	if (status) {
770 		rsi_dbg(ERR_ZONE, "%s: Failed to init usb interface\n",
771 			__func__);
772 		goto err;
773 	}
774 
775 	rsi_dbg(ERR_ZONE, "%s: Initialized os intf ops\n", __func__);
776 
777 	dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
778 
779 	status = rsi_usb_reg_read(dev->usbdev, FW_STATUS_REG, &fw_status, 2);
780 	if (status < 0)
781 		goto err1;
782 	else
783 		fw_status &= 1;
784 
785 	if (!fw_status) {
786 		rsi_dbg(INIT_ZONE, "Loading firmware...\n");
787 		status = rsi_hal_device_init(adapter);
788 		if (status) {
789 			rsi_dbg(ERR_ZONE, "%s: Failed in device init\n",
790 				__func__);
791 			goto err1;
792 		}
793 		rsi_dbg(INIT_ZONE, "%s: Device Init Done\n", __func__);
794 	}
795 
796 	status = rsi_rx_urb_submit(adapter, WLAN_EP, GFP_KERNEL);
797 	if (status)
798 		goto err1;
799 
800 	if (adapter->priv->coex_mode > 1) {
801 		status = rsi_rx_urb_submit(adapter, BT_EP, GFP_KERNEL);
802 		if (status)
803 			goto err_kill_wlan_urb;
804 	}
805 
806 	return 0;
807 
808 err_kill_wlan_urb:
809 	rsi_rx_urb_kill(adapter, WLAN_EP);
810 err1:
811 	rsi_deinit_usb_interface(adapter);
812 err:
813 	rsi_91x_deinit(adapter);
814 	rsi_dbg(ERR_ZONE, "%s: Failed in probe...Exiting\n", __func__);
815 	return status;
816 }
817 
818 /**
819  * rsi_disconnect() - This function performs the reverse of the probe function,
820  *		      it deinitialize the driver structure.
821  * @pfunction: Pointer to the USB interface structure.
822  *
823  * Return: None.
824  */
rsi_disconnect(struct usb_interface * pfunction)825 static void rsi_disconnect(struct usb_interface *pfunction)
826 {
827 	struct rsi_hw *adapter = usb_get_intfdata(pfunction);
828 
829 	if (!adapter)
830 		return;
831 
832 	rsi_mac80211_detach(adapter);
833 
834 	if (IS_ENABLED(CONFIG_RSI_COEX) && adapter->priv->coex_mode > 1 &&
835 	    adapter->priv->bt_adapter) {
836 		rsi_bt_ops.detach(adapter->priv->bt_adapter);
837 		adapter->priv->bt_adapter = NULL;
838 	}
839 
840 	if (adapter->priv->coex_mode > 1)
841 		rsi_rx_urb_kill(adapter, BT_EP);
842 	rsi_rx_urb_kill(adapter, WLAN_EP);
843 
844 	rsi_reset_card(adapter);
845 	rsi_deinit_usb_interface(adapter);
846 	rsi_91x_deinit(adapter);
847 
848 	rsi_dbg(INFO_ZONE, "%s: Deinitialization completed\n", __func__);
849 }
850 
851 #ifdef CONFIG_PM
rsi_suspend(struct usb_interface * intf,pm_message_t message)852 static int rsi_suspend(struct usb_interface *intf, pm_message_t message)
853 {
854 	/* Not yet implemented */
855 	return -ENOSYS;
856 }
857 
rsi_resume(struct usb_interface * intf)858 static int rsi_resume(struct usb_interface *intf)
859 {
860 	/* Not yet implemented */
861 	return -ENOSYS;
862 }
863 #endif
864 
865 static const struct usb_device_id rsi_dev_table[] = {
866 	{ USB_DEVICE(RSI_USB_VID_9113, RSI_USB_PID_9113) },
867 	{ /* Blank */},
868 };
869 
870 static struct usb_driver rsi_driver = {
871 	.name       = "RSI-USB WLAN",
872 	.probe      = rsi_probe,
873 	.disconnect = rsi_disconnect,
874 	.id_table   = rsi_dev_table,
875 #ifdef CONFIG_PM
876 	.suspend    = rsi_suspend,
877 	.resume     = rsi_resume,
878 #endif
879 };
880 
881 module_usb_driver(rsi_driver);
882 
883 MODULE_AUTHOR("Redpine Signals Inc");
884 MODULE_DESCRIPTION("Common USB layer for RSI drivers");
885 MODULE_SUPPORTED_DEVICE("RSI-91x");
886 MODULE_DEVICE_TABLE(usb, rsi_dev_table);
887 MODULE_FIRMWARE(FIRMWARE_RSI9113);
888 MODULE_VERSION("0.1");
889 MODULE_LICENSE("Dual BSD/GPL");
890