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 */
26static u16 dev_oper_mode = DEV_OPMODE_STA_BT_DUAL;
27module_param(dev_oper_mode, ushort, 0444);
28MODULE_PARM_DESC(dev_oper_mode, DEV_OPMODE_PARAM_DESC);
29
30static int rsi_rx_urb_submit(struct rsi_hw *adapter, u8 ep_num, gfp_t flags);
31
32/**
33 * rsi_usb_card_write() - This function writes to the USB Card.
34 * @adapter: Pointer to the adapter structure.
35 * @buf: Pointer to the buffer from where the data has to be taken.
36 * @len: Length to be written.
37 * @endpoint: Type of endpoint.
38 *
39 * Return: status: 0 on success, a negative error code on failure.
40 */
41static int rsi_usb_card_write(struct rsi_hw *adapter,
42			      u8 *buf,
43			      u16 len,
44			      u8 endpoint)
45{
46	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
47	int status;
48	u8 *seg = dev->tx_buffer;
49	int transfer;
50	int ep = dev->bulkout_endpoint_addr[endpoint - 1];
51
52	memset(seg, 0, len + RSI_USB_TX_HEAD_ROOM);
53	memcpy(seg + RSI_USB_TX_HEAD_ROOM, buf, len);
54	len += RSI_USB_TX_HEAD_ROOM;
55	transfer = len;
56	status = usb_bulk_msg(dev->usbdev,
57			      usb_sndbulkpipe(dev->usbdev, ep),
58			      (void *)seg,
59			      (int)len,
60			      &transfer,
61			      USB_CTRL_SET_TIMEOUT);
62
63	if (status < 0) {
64		rsi_dbg(ERR_ZONE,
65			"Card write failed with error code :%10d\n", status);
66		dev->write_fail = 1;
67	}
68	return status;
69}
70
71/**
72 * rsi_write_multiple() - This function writes multiple bytes of information
73 *			  to the USB card.
74 * @adapter: Pointer to the adapter structure.
75 * @addr: Address of the register.
76 * @data: Pointer to the data that has to be written.
77 * @count: Number of multiple bytes to be written.
78 *
79 * Return: 0 on success, a negative error code on failure.
80 */
81static int rsi_write_multiple(struct rsi_hw *adapter,
82			      u8 endpoint,
83			      u8 *data,
84			      u32 count)
85{
86	struct rsi_91x_usbdev *dev;
87
88	if (!adapter)
89		return -ENODEV;
90
91	if (endpoint == 0)
92		return -EINVAL;
93
94	dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
95	if (dev->write_fail)
96		return -ENETDOWN;
97
98	return rsi_usb_card_write(adapter, data, count, endpoint);
99}
100
101/**
102 * rsi_find_bulk_in_and_out_endpoints() - This function initializes the bulk
103 *					  endpoints to the device.
104 * @interface: Pointer to the USB interface structure.
105 * @adapter: Pointer to the adapter structure.
106 *
107 * Return: ret_val: 0 on success, -ENOMEM on failure.
108 */
109static int rsi_find_bulk_in_and_out_endpoints(struct usb_interface *interface,
110					      struct rsi_hw *adapter)
111{
112	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
113	struct usb_host_interface *iface_desc;
114	struct usb_endpoint_descriptor *endpoint;
115	__le16 buffer_size;
116	int ii, bin_found = 0, bout_found = 0;
117
118	iface_desc = interface->cur_altsetting;
119
120	for (ii = 0; ii < iface_desc->desc.bNumEndpoints; ++ii) {
121		endpoint = &(iface_desc->endpoint[ii].desc);
122
123		if (!dev->bulkin_endpoint_addr[bin_found] &&
124		    (endpoint->bEndpointAddress & USB_DIR_IN) &&
125		    ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
126		    USB_ENDPOINT_XFER_BULK)) {
127			buffer_size = endpoint->wMaxPacketSize;
128			dev->bulkin_size[bin_found] = buffer_size;
129			dev->bulkin_endpoint_addr[bin_found] =
130				endpoint->bEndpointAddress;
131			bin_found++;
132		}
133
134		if (!dev->bulkout_endpoint_addr[bout_found] &&
135		    !(endpoint->bEndpointAddress & USB_DIR_IN) &&
136		    ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
137		    USB_ENDPOINT_XFER_BULK)) {
138			buffer_size = endpoint->wMaxPacketSize;
139			dev->bulkout_endpoint_addr[bout_found] =
140				endpoint->bEndpointAddress;
141			dev->bulkout_size[bout_found] = buffer_size;
142			bout_found++;
143		}
144
145		if (bin_found >= MAX_BULK_EP || bout_found >= MAX_BULK_EP)
146			break;
147	}
148
149	if (!(dev->bulkin_endpoint_addr[0] && dev->bulkout_endpoint_addr[0])) {
150		dev_err(&interface->dev, "missing wlan bulk endpoints\n");
151		return -EINVAL;
152	}
153
154	if (adapter->priv->coex_mode > 1) {
155		if (!dev->bulkin_endpoint_addr[1]) {
156			dev_err(&interface->dev, "missing bt bulk-in endpoint\n");
157			return -EINVAL;
158		}
159	}
160
161	return 0;
162}
163
164#define RSI_USB_REQ_OUT	(USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE)
165#define RSI_USB_REQ_IN	(USB_TYPE_VENDOR | USB_DIR_IN | USB_RECIP_DEVICE)
166
167/* rsi_usb_reg_read() - This function reads data from given register address.
168 * @usbdev: Pointer to the usb_device structure.
169 * @reg: Address of the register to be read.
170 * @value: Value to be read.
171 * @len: length of data to be read.
172 *
173 * Return: status: 0 on success, a negative error code on failure.
174 */
175static int rsi_usb_reg_read(struct usb_device *usbdev,
176			    u32 reg,
177			    u16 *value,
178			    u16 len)
179{
180	u8 *buf;
181	int status = -ENOMEM;
182
183	if (len > RSI_USB_CTRL_BUF_SIZE)
184		return -EINVAL;
185
186	buf  = kmalloc(RSI_USB_CTRL_BUF_SIZE, GFP_KERNEL);
187	if (!buf)
188		return status;
189
190	status = usb_control_msg(usbdev,
191				 usb_rcvctrlpipe(usbdev, 0),
192				 USB_VENDOR_REGISTER_READ,
193				 RSI_USB_REQ_IN,
194				 ((reg & 0xffff0000) >> 16), (reg & 0xffff),
195				 (void *)buf,
196				 len,
197				 USB_CTRL_GET_TIMEOUT);
198
199	*value = (buf[0] | (buf[1] << 8));
200	if (status < 0) {
201		rsi_dbg(ERR_ZONE,
202			"%s: Reg read failed with error code :%d\n",
203			__func__, status);
204	}
205	kfree(buf);
206
207	return status;
208}
209
210/**
211 * rsi_usb_reg_write() - This function writes the given data into the given
212 *			 register address.
213 * @usbdev: Pointer to the usb_device structure.
214 * @reg: Address of the register.
215 * @value: Value to write.
216 * @len: Length of data to be written.
217 *
218 * Return: status: 0 on success, a negative error code on failure.
219 */
220static int rsi_usb_reg_write(struct usb_device *usbdev,
221			     u32 reg,
222			     u32 value,
223			     u16 len)
224{
225	u8 *usb_reg_buf;
226	int status = -ENOMEM;
227
228	if (len > RSI_USB_CTRL_BUF_SIZE)
229		return -EINVAL;
230
231	usb_reg_buf  = kmalloc(RSI_USB_CTRL_BUF_SIZE, GFP_KERNEL);
232	if (!usb_reg_buf)
233		return status;
234
235	usb_reg_buf[0] = (cpu_to_le32(value) & 0x00ff);
236	usb_reg_buf[1] = (cpu_to_le32(value) & 0xff00) >> 8;
237	usb_reg_buf[2] = (cpu_to_le32(value) & 0x00ff0000) >> 16;
238	usb_reg_buf[3] = (cpu_to_le32(value) & 0xff000000) >> 24;
239
240	status = usb_control_msg(usbdev,
241				 usb_sndctrlpipe(usbdev, 0),
242				 USB_VENDOR_REGISTER_WRITE,
243				 RSI_USB_REQ_OUT,
244				 ((cpu_to_le32(reg) & 0xffff0000) >> 16),
245				 (cpu_to_le32(reg) & 0xffff),
246				 (void *)usb_reg_buf,
247				 len,
248				 USB_CTRL_SET_TIMEOUT);
249	if (status < 0) {
250		rsi_dbg(ERR_ZONE,
251			"%s: Reg write failed with error code :%d\n",
252			__func__, status);
253	}
254	kfree(usb_reg_buf);
255
256	return status;
257}
258
259/**
260 * rsi_rx_done_handler() - This function is called when a packet is received
261 *			   from USB stack. This is callback to receive done.
262 * @urb: Received URB.
263 *
264 * Return: None.
265 */
266static void rsi_rx_done_handler(struct urb *urb)
267{
268	struct rx_usb_ctrl_block *rx_cb = urb->context;
269	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)rx_cb->data;
270	int status = -EINVAL;
271
272	if (!rx_cb->rx_skb)
273		return;
274
275	if (urb->status) {
276		dev_kfree_skb(rx_cb->rx_skb);
277		rx_cb->rx_skb = NULL;
278		return;
279	}
280
281	if (urb->actual_length <= 0 ||
282	    urb->actual_length > rx_cb->rx_skb->len) {
283		rsi_dbg(INFO_ZONE, "%s: Invalid packet length = %d\n",
284			__func__, urb->actual_length);
285		goto out;
286	}
287	if (skb_queue_len(&dev->rx_q) >= RSI_MAX_RX_PKTS) {
288		rsi_dbg(INFO_ZONE, "Max RX packets reached\n");
289		goto out;
290	}
291	skb_trim(rx_cb->rx_skb, urb->actual_length);
292	skb_queue_tail(&dev->rx_q, rx_cb->rx_skb);
293
294	rsi_set_event(&dev->rx_thread.event);
295	status = 0;
296
297out:
298	if (rsi_rx_urb_submit(dev->priv, rx_cb->ep_num, GFP_ATOMIC))
299		rsi_dbg(ERR_ZONE, "%s: Failed in urb submission", __func__);
300
301	if (status) {
302		dev_kfree_skb(rx_cb->rx_skb);
303		rx_cb->rx_skb = NULL;
304	}
305}
306
307static void rsi_rx_urb_kill(struct rsi_hw *adapter, u8 ep_num)
308{
309	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
310	struct rx_usb_ctrl_block *rx_cb = &dev->rx_cb[ep_num - 1];
311	struct urb *urb = rx_cb->rx_urb;
312
313	usb_kill_urb(urb);
314}
315
316/**
317 * rsi_rx_urb_submit() - This function submits the given URB to the USB stack.
318 * @adapter: Pointer to the adapter structure.
319 *
320 * Return: 0 on success, a negative error code on failure.
321 */
322static int rsi_rx_urb_submit(struct rsi_hw *adapter, u8 ep_num, gfp_t mem_flags)
323{
324	struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
325	struct rx_usb_ctrl_block *rx_cb = &dev->rx_cb[ep_num - 1];
326	struct urb *urb = rx_cb->rx_urb;
327	int status;
328	struct sk_buff *skb;
329	u8 dword_align_bytes = 0;
330
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
360static 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 */
410static 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 */
459static 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
475static 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
491static 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
501static 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
543static 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 */
558static 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
571static 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
600err:
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 */
615static 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
666fail_rx:
667	kfree(rsi_dev->tx_buffer);
668
669fail_eps:
670
671	return status;
672}
673
674static 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
704static 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
769fail:
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 */
783static 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		status = -ENODEV;
820		goto err1;
821	}
822
823	dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
824
825	status = rsi_usb_reg_read(dev->usbdev, FW_STATUS_REG, &fw_status, 2);
826	if (status < 0)
827		goto err1;
828	else
829		fw_status &= 1;
830
831	if (!fw_status) {
832		rsi_dbg(INIT_ZONE, "Loading firmware...\n");
833		status = rsi_hal_device_init(adapter);
834		if (status) {
835			rsi_dbg(ERR_ZONE, "%s: Failed in device init\n",
836				__func__);
837			goto err1;
838		}
839		rsi_dbg(INIT_ZONE, "%s: Device Init Done\n", __func__);
840	}
841
842	status = rsi_rx_urb_submit(adapter, WLAN_EP, GFP_KERNEL);
843	if (status)
844		goto err1;
845
846	if (adapter->priv->coex_mode > 1) {
847		status = rsi_rx_urb_submit(adapter, BT_EP, GFP_KERNEL);
848		if (status)
849			goto err_kill_wlan_urb;
850	}
851
852	return 0;
853
854err_kill_wlan_urb:
855	rsi_rx_urb_kill(adapter, WLAN_EP);
856err1:
857	rsi_deinit_usb_interface(adapter);
858err:
859	rsi_91x_deinit(adapter);
860	rsi_dbg(ERR_ZONE, "%s: Failed in probe...Exiting\n", __func__);
861	return status;
862}
863
864/**
865 * rsi_disconnect() - This function performs the reverse of the probe function,
866 *		      it deinitialize the driver structure.
867 * @pfunction: Pointer to the USB interface structure.
868 *
869 * Return: None.
870 */
871static void rsi_disconnect(struct usb_interface *pfunction)
872{
873	struct rsi_hw *adapter = usb_get_intfdata(pfunction);
874
875	if (!adapter)
876		return;
877
878	rsi_mac80211_detach(adapter);
879
880	if (IS_ENABLED(CONFIG_RSI_COEX) && adapter->priv->coex_mode > 1 &&
881	    adapter->priv->bt_adapter) {
882		rsi_bt_ops.detach(adapter->priv->bt_adapter);
883		adapter->priv->bt_adapter = NULL;
884	}
885
886	if (adapter->priv->coex_mode > 1)
887		rsi_rx_urb_kill(adapter, BT_EP);
888	rsi_rx_urb_kill(adapter, WLAN_EP);
889
890	rsi_reset_card(adapter);
891	rsi_deinit_usb_interface(adapter);
892	rsi_91x_deinit(adapter);
893
894	rsi_dbg(INFO_ZONE, "%s: Deinitialization completed\n", __func__);
895}
896
897#ifdef CONFIG_PM
898static int rsi_suspend(struct usb_interface *intf, pm_message_t message)
899{
900	/* Not yet implemented */
901	return -ENOSYS;
902}
903
904static int rsi_resume(struct usb_interface *intf)
905{
906	/* Not yet implemented */
907	return -ENOSYS;
908}
909#endif
910
911static const struct usb_device_id rsi_dev_table[] = {
912	{ USB_DEVICE(RSI_USB_VENDOR_ID, RSI_USB_PID_9113) },
913	{ USB_DEVICE(RSI_USB_VENDOR_ID, RSI_USB_PID_9116) },
914	{ /* Blank */},
915};
916
917static struct usb_driver rsi_driver = {
918	.name       = "RSI-USB WLAN",
919	.probe      = rsi_probe,
920	.disconnect = rsi_disconnect,
921	.id_table   = rsi_dev_table,
922#ifdef CONFIG_PM
923	.suspend    = rsi_suspend,
924	.resume     = rsi_resume,
925#endif
926};
927
928module_usb_driver(rsi_driver);
929
930MODULE_AUTHOR("Redpine Signals Inc");
931MODULE_DESCRIPTION("Common USB layer for RSI drivers");
932MODULE_SUPPORTED_DEVICE("RSI-91x");
933MODULE_DEVICE_TABLE(usb, rsi_dev_table);
934MODULE_FIRMWARE(FIRMWARE_RSI9113);
935MODULE_VERSION("0.1");
936MODULE_LICENSE("Dual BSD/GPL");
937