xref: /OK3568_Linux_fs/kernel/drivers/net/wireless/broadcom/brcm80211/brcmfmac/usb.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: ISC
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (c) 2011 Broadcom Corporation
4*4882a593Smuzhiyun  */
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun #include <linux/kernel.h>
7*4882a593Smuzhiyun #include <linux/module.h>
8*4882a593Smuzhiyun #include <linux/firmware.h>
9*4882a593Smuzhiyun #include <linux/usb.h>
10*4882a593Smuzhiyun #include <linux/vmalloc.h>
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <brcmu_utils.h>
13*4882a593Smuzhiyun #include <brcm_hw_ids.h>
14*4882a593Smuzhiyun #include <brcmu_wifi.h>
15*4882a593Smuzhiyun #include "bus.h"
16*4882a593Smuzhiyun #include "debug.h"
17*4882a593Smuzhiyun #include "firmware.h"
18*4882a593Smuzhiyun #include "usb.h"
19*4882a593Smuzhiyun #include "core.h"
20*4882a593Smuzhiyun #include "common.h"
21*4882a593Smuzhiyun #include "bcdc.h"
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun #define IOCTL_RESP_TIMEOUT		msecs_to_jiffies(2000)
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #define BRCMF_USB_RESET_GETVER_SPINWAIT	100	/* in unit of ms */
27*4882a593Smuzhiyun #define BRCMF_USB_RESET_GETVER_LOOP_CNT	10
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #define BRCMF_POSTBOOT_ID		0xA123  /* ID to detect if dongle
30*4882a593Smuzhiyun 						   has boot up */
31*4882a593Smuzhiyun #define BRCMF_USB_NRXQ			50
32*4882a593Smuzhiyun #define BRCMF_USB_NTXQ			50
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun #define BRCMF_USB_CBCTL_WRITE		0
35*4882a593Smuzhiyun #define BRCMF_USB_CBCTL_READ		1
36*4882a593Smuzhiyun #define BRCMF_USB_MAX_PKT_SIZE		1600
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun BRCMF_FW_DEF(43143, "brcmfmac43143");
39*4882a593Smuzhiyun BRCMF_FW_DEF(43236B, "brcmfmac43236b");
40*4882a593Smuzhiyun BRCMF_FW_DEF(43242A, "brcmfmac43242a");
41*4882a593Smuzhiyun BRCMF_FW_DEF(43569, "brcmfmac43569");
42*4882a593Smuzhiyun BRCMF_FW_DEF(4373, "brcmfmac4373");
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun static const struct brcmf_firmware_mapping brcmf_usb_fwnames[] = {
45*4882a593Smuzhiyun 	BRCMF_FW_ENTRY(BRCM_CC_43143_CHIP_ID, 0xFFFFFFFF, 43143),
46*4882a593Smuzhiyun 	BRCMF_FW_ENTRY(BRCM_CC_43235_CHIP_ID, 0x00000008, 43236B),
47*4882a593Smuzhiyun 	BRCMF_FW_ENTRY(BRCM_CC_43236_CHIP_ID, 0x00000008, 43236B),
48*4882a593Smuzhiyun 	BRCMF_FW_ENTRY(BRCM_CC_43238_CHIP_ID, 0x00000008, 43236B),
49*4882a593Smuzhiyun 	BRCMF_FW_ENTRY(BRCM_CC_43242_CHIP_ID, 0xFFFFFFFF, 43242A),
50*4882a593Smuzhiyun 	BRCMF_FW_ENTRY(BRCM_CC_43566_CHIP_ID, 0xFFFFFFFF, 43569),
51*4882a593Smuzhiyun 	BRCMF_FW_ENTRY(BRCM_CC_43569_CHIP_ID, 0xFFFFFFFF, 43569),
52*4882a593Smuzhiyun 	BRCMF_FW_ENTRY(CY_CC_4373_CHIP_ID, 0xFFFFFFFF, 4373)
53*4882a593Smuzhiyun };
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun #define TRX_MAGIC		0x30524448	/* "HDR0" */
56*4882a593Smuzhiyun #define TRX_MAX_OFFSET		3		/* Max number of file offsets */
57*4882a593Smuzhiyun #define TRX_UNCOMP_IMAGE	0x20		/* Trx holds uncompressed img */
58*4882a593Smuzhiyun #define TRX_RDL_CHUNK		1500		/* size of each dl transfer */
59*4882a593Smuzhiyun #define TRX_OFFSETS_DLFWLEN_IDX	0
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun /* Control messages: bRequest values */
62*4882a593Smuzhiyun #define DL_GETSTATE	0	/* returns the rdl_state_t struct */
63*4882a593Smuzhiyun #define DL_CHECK_CRC	1	/* currently unused */
64*4882a593Smuzhiyun #define DL_GO		2	/* execute downloaded image */
65*4882a593Smuzhiyun #define DL_START	3	/* initialize dl state */
66*4882a593Smuzhiyun #define DL_REBOOT	4	/* reboot the device in 2 seconds */
67*4882a593Smuzhiyun #define DL_GETVER	5	/* returns the bootrom_id_t struct */
68*4882a593Smuzhiyun #define DL_GO_PROTECTED	6	/* execute the downloaded code and set reset
69*4882a593Smuzhiyun 				 * event to occur in 2 seconds.  It is the
70*4882a593Smuzhiyun 				 * responsibility of the downloaded code to
71*4882a593Smuzhiyun 				 * clear this event
72*4882a593Smuzhiyun 				 */
73*4882a593Smuzhiyun #define DL_EXEC		7	/* jump to a supplied address */
74*4882a593Smuzhiyun #define DL_RESETCFG	8	/* To support single enum on dongle
75*4882a593Smuzhiyun 				 * - Not used by bootloader
76*4882a593Smuzhiyun 				 */
77*4882a593Smuzhiyun #define DL_DEFER_RESP_OK 9	/* Potentially defer the response to setup
78*4882a593Smuzhiyun 				 * if resp unavailable
79*4882a593Smuzhiyun 				 */
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun /* states */
82*4882a593Smuzhiyun #define DL_WAITING	0	/* waiting to rx first pkt */
83*4882a593Smuzhiyun #define DL_READY	1	/* hdr was good, waiting for more of the
84*4882a593Smuzhiyun 				 * compressed image
85*4882a593Smuzhiyun 				 */
86*4882a593Smuzhiyun #define DL_BAD_HDR	2	/* hdr was corrupted */
87*4882a593Smuzhiyun #define DL_BAD_CRC	3	/* compressed image was corrupted */
88*4882a593Smuzhiyun #define DL_RUNNABLE	4	/* download was successful,waiting for go cmd */
89*4882a593Smuzhiyun #define DL_START_FAIL	5	/* failed to initialize correctly */
90*4882a593Smuzhiyun #define DL_NVRAM_TOOBIG	6	/* host specified nvram data exceeds DL_NVRAM
91*4882a593Smuzhiyun 				 * value
92*4882a593Smuzhiyun 				 */
93*4882a593Smuzhiyun #define DL_IMAGE_TOOBIG	7	/* firmware image too big */
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun 
96*4882a593Smuzhiyun struct trx_header_le {
97*4882a593Smuzhiyun 	__le32 magic;		/* "HDR0" */
98*4882a593Smuzhiyun 	__le32 len;		/* Length of file including header */
99*4882a593Smuzhiyun 	__le32 crc32;		/* CRC from flag_version to end of file */
100*4882a593Smuzhiyun 	__le32 flag_version;	/* 0:15 flags, 16:31 version */
101*4882a593Smuzhiyun 	__le32 offsets[TRX_MAX_OFFSET];	/* Offsets of partitions from start of
102*4882a593Smuzhiyun 					 * header
103*4882a593Smuzhiyun 					 */
104*4882a593Smuzhiyun };
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun struct rdl_state_le {
107*4882a593Smuzhiyun 	__le32 state;
108*4882a593Smuzhiyun 	__le32 bytes;
109*4882a593Smuzhiyun };
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun struct bootrom_id_le {
112*4882a593Smuzhiyun 	__le32 chip;		/* Chip id */
113*4882a593Smuzhiyun 	__le32 chiprev;		/* Chip rev */
114*4882a593Smuzhiyun 	__le32 ramsize;		/* Size of  RAM */
115*4882a593Smuzhiyun 	__le32 remapbase;	/* Current remap base address */
116*4882a593Smuzhiyun 	__le32 boardtype;	/* Type of board */
117*4882a593Smuzhiyun 	__le32 boardrev;	/* Board revision */
118*4882a593Smuzhiyun };
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun struct brcmf_usb_image {
121*4882a593Smuzhiyun 	struct list_head list;
122*4882a593Smuzhiyun 	s8 *fwname;
123*4882a593Smuzhiyun 	u8 *image;
124*4882a593Smuzhiyun 	int image_len;
125*4882a593Smuzhiyun };
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun struct brcmf_usbdev_info {
128*4882a593Smuzhiyun 	struct brcmf_usbdev bus_pub; /* MUST BE FIRST */
129*4882a593Smuzhiyun 	spinlock_t qlock;
130*4882a593Smuzhiyun 	struct list_head rx_freeq;
131*4882a593Smuzhiyun 	struct list_head rx_postq;
132*4882a593Smuzhiyun 	struct list_head tx_freeq;
133*4882a593Smuzhiyun 	struct list_head tx_postq;
134*4882a593Smuzhiyun 	uint rx_pipe, tx_pipe;
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun 	int rx_low_watermark;
137*4882a593Smuzhiyun 	int tx_low_watermark;
138*4882a593Smuzhiyun 	int tx_high_watermark;
139*4882a593Smuzhiyun 	int tx_freecount;
140*4882a593Smuzhiyun 	bool tx_flowblock;
141*4882a593Smuzhiyun 	spinlock_t tx_flowblock_lock;
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 	struct brcmf_usbreq *tx_reqs;
144*4882a593Smuzhiyun 	struct brcmf_usbreq *rx_reqs;
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun 	char fw_name[BRCMF_FW_NAME_LEN];
147*4882a593Smuzhiyun 	const u8 *image;	/* buffer for combine fw and nvram */
148*4882a593Smuzhiyun 	int image_len;
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun 	struct usb_device *usbdev;
151*4882a593Smuzhiyun 	struct device *dev;
152*4882a593Smuzhiyun 	struct completion dev_init_done;
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun 	int ctl_in_pipe, ctl_out_pipe;
155*4882a593Smuzhiyun 	struct urb *ctl_urb; /* URB for control endpoint */
156*4882a593Smuzhiyun 	struct usb_ctrlrequest ctl_write;
157*4882a593Smuzhiyun 	struct usb_ctrlrequest ctl_read;
158*4882a593Smuzhiyun 	u32 ctl_urb_actual_length;
159*4882a593Smuzhiyun 	int ctl_urb_status;
160*4882a593Smuzhiyun 	int ctl_completed;
161*4882a593Smuzhiyun 	wait_queue_head_t ioctl_resp_wait;
162*4882a593Smuzhiyun 	ulong ctl_op;
163*4882a593Smuzhiyun 	u8 ifnum;
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	struct urb *bulk_urb; /* used for FW download */
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun 	struct brcmf_mp_device *settings;
168*4882a593Smuzhiyun };
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun static void brcmf_usb_rx_refill(struct brcmf_usbdev_info *devinfo,
171*4882a593Smuzhiyun 				struct brcmf_usbreq  *req);
172*4882a593Smuzhiyun 
brcmf_usb_get_buspub(struct device * dev)173*4882a593Smuzhiyun static struct brcmf_usbdev *brcmf_usb_get_buspub(struct device *dev)
174*4882a593Smuzhiyun {
175*4882a593Smuzhiyun 	struct brcmf_bus *bus_if = dev_get_drvdata(dev);
176*4882a593Smuzhiyun 	return bus_if->bus_priv.usb;
177*4882a593Smuzhiyun }
178*4882a593Smuzhiyun 
brcmf_usb_get_businfo(struct device * dev)179*4882a593Smuzhiyun static struct brcmf_usbdev_info *brcmf_usb_get_businfo(struct device *dev)
180*4882a593Smuzhiyun {
181*4882a593Smuzhiyun 	return brcmf_usb_get_buspub(dev)->devinfo;
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun 
brcmf_usb_ioctl_resp_wait(struct brcmf_usbdev_info * devinfo)184*4882a593Smuzhiyun static int brcmf_usb_ioctl_resp_wait(struct brcmf_usbdev_info *devinfo)
185*4882a593Smuzhiyun {
186*4882a593Smuzhiyun 	return wait_event_timeout(devinfo->ioctl_resp_wait,
187*4882a593Smuzhiyun 				  devinfo->ctl_completed, IOCTL_RESP_TIMEOUT);
188*4882a593Smuzhiyun }
189*4882a593Smuzhiyun 
brcmf_usb_ioctl_resp_wake(struct brcmf_usbdev_info * devinfo)190*4882a593Smuzhiyun static void brcmf_usb_ioctl_resp_wake(struct brcmf_usbdev_info *devinfo)
191*4882a593Smuzhiyun {
192*4882a593Smuzhiyun 	wake_up(&devinfo->ioctl_resp_wait);
193*4882a593Smuzhiyun }
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun static void
brcmf_usb_ctl_complete(struct brcmf_usbdev_info * devinfo,int type,int status)196*4882a593Smuzhiyun brcmf_usb_ctl_complete(struct brcmf_usbdev_info *devinfo, int type, int status)
197*4882a593Smuzhiyun {
198*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter, status=%d\n", status);
199*4882a593Smuzhiyun 
200*4882a593Smuzhiyun 	if (unlikely(devinfo == NULL))
201*4882a593Smuzhiyun 		return;
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun 	if (type == BRCMF_USB_CBCTL_READ) {
204*4882a593Smuzhiyun 		if (status == 0)
205*4882a593Smuzhiyun 			devinfo->bus_pub.stats.rx_ctlpkts++;
206*4882a593Smuzhiyun 		else
207*4882a593Smuzhiyun 			devinfo->bus_pub.stats.rx_ctlerrs++;
208*4882a593Smuzhiyun 	} else if (type == BRCMF_USB_CBCTL_WRITE) {
209*4882a593Smuzhiyun 		if (status == 0)
210*4882a593Smuzhiyun 			devinfo->bus_pub.stats.tx_ctlpkts++;
211*4882a593Smuzhiyun 		else
212*4882a593Smuzhiyun 			devinfo->bus_pub.stats.tx_ctlerrs++;
213*4882a593Smuzhiyun 	}
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun 	devinfo->ctl_urb_status = status;
216*4882a593Smuzhiyun 	devinfo->ctl_completed = true;
217*4882a593Smuzhiyun 	brcmf_usb_ioctl_resp_wake(devinfo);
218*4882a593Smuzhiyun }
219*4882a593Smuzhiyun 
220*4882a593Smuzhiyun static void
brcmf_usb_ctlread_complete(struct urb * urb)221*4882a593Smuzhiyun brcmf_usb_ctlread_complete(struct urb *urb)
222*4882a593Smuzhiyun {
223*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo =
224*4882a593Smuzhiyun 		(struct brcmf_usbdev_info *)urb->context;
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
227*4882a593Smuzhiyun 	devinfo->ctl_urb_actual_length = urb->actual_length;
228*4882a593Smuzhiyun 	brcmf_usb_ctl_complete(devinfo, BRCMF_USB_CBCTL_READ,
229*4882a593Smuzhiyun 		urb->status);
230*4882a593Smuzhiyun }
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun static void
brcmf_usb_ctlwrite_complete(struct urb * urb)233*4882a593Smuzhiyun brcmf_usb_ctlwrite_complete(struct urb *urb)
234*4882a593Smuzhiyun {
235*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo =
236*4882a593Smuzhiyun 		(struct brcmf_usbdev_info *)urb->context;
237*4882a593Smuzhiyun 
238*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
239*4882a593Smuzhiyun 	brcmf_usb_ctl_complete(devinfo, BRCMF_USB_CBCTL_WRITE,
240*4882a593Smuzhiyun 		urb->status);
241*4882a593Smuzhiyun }
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun static int
brcmf_usb_send_ctl(struct brcmf_usbdev_info * devinfo,u8 * buf,int len)244*4882a593Smuzhiyun brcmf_usb_send_ctl(struct brcmf_usbdev_info *devinfo, u8 *buf, int len)
245*4882a593Smuzhiyun {
246*4882a593Smuzhiyun 	int ret;
247*4882a593Smuzhiyun 	u16 size;
248*4882a593Smuzhiyun 
249*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
250*4882a593Smuzhiyun 	if (devinfo == NULL || buf == NULL ||
251*4882a593Smuzhiyun 	    len == 0 || devinfo->ctl_urb == NULL)
252*4882a593Smuzhiyun 		return -EINVAL;
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	size = len;
255*4882a593Smuzhiyun 	devinfo->ctl_write.wLength = cpu_to_le16p(&size);
256*4882a593Smuzhiyun 	devinfo->ctl_urb->transfer_buffer_length = size;
257*4882a593Smuzhiyun 	devinfo->ctl_urb_status = 0;
258*4882a593Smuzhiyun 	devinfo->ctl_urb_actual_length = 0;
259*4882a593Smuzhiyun 
260*4882a593Smuzhiyun 	usb_fill_control_urb(devinfo->ctl_urb,
261*4882a593Smuzhiyun 		devinfo->usbdev,
262*4882a593Smuzhiyun 		devinfo->ctl_out_pipe,
263*4882a593Smuzhiyun 		(unsigned char *) &devinfo->ctl_write,
264*4882a593Smuzhiyun 		buf, size,
265*4882a593Smuzhiyun 		(usb_complete_t)brcmf_usb_ctlwrite_complete,
266*4882a593Smuzhiyun 		devinfo);
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
269*4882a593Smuzhiyun 	if (ret < 0)
270*4882a593Smuzhiyun 		brcmf_err("usb_submit_urb failed %d\n", ret);
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun 	return ret;
273*4882a593Smuzhiyun }
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun static int
brcmf_usb_recv_ctl(struct brcmf_usbdev_info * devinfo,u8 * buf,int len)276*4882a593Smuzhiyun brcmf_usb_recv_ctl(struct brcmf_usbdev_info *devinfo, u8 *buf, int len)
277*4882a593Smuzhiyun {
278*4882a593Smuzhiyun 	int ret;
279*4882a593Smuzhiyun 	u16 size;
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
282*4882a593Smuzhiyun 	if ((devinfo == NULL) || (buf == NULL) || (len == 0)
283*4882a593Smuzhiyun 		|| (devinfo->ctl_urb == NULL))
284*4882a593Smuzhiyun 		return -EINVAL;
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	size = len;
287*4882a593Smuzhiyun 	devinfo->ctl_read.wLength = cpu_to_le16p(&size);
288*4882a593Smuzhiyun 	devinfo->ctl_urb->transfer_buffer_length = size;
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 	devinfo->ctl_read.bRequestType = USB_DIR_IN
291*4882a593Smuzhiyun 		| USB_TYPE_CLASS | USB_RECIP_INTERFACE;
292*4882a593Smuzhiyun 	devinfo->ctl_read.bRequest = 1;
293*4882a593Smuzhiyun 
294*4882a593Smuzhiyun 	usb_fill_control_urb(devinfo->ctl_urb,
295*4882a593Smuzhiyun 		devinfo->usbdev,
296*4882a593Smuzhiyun 		devinfo->ctl_in_pipe,
297*4882a593Smuzhiyun 		(unsigned char *) &devinfo->ctl_read,
298*4882a593Smuzhiyun 		buf, size,
299*4882a593Smuzhiyun 		(usb_complete_t)brcmf_usb_ctlread_complete,
300*4882a593Smuzhiyun 		devinfo);
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 	ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
303*4882a593Smuzhiyun 	if (ret < 0)
304*4882a593Smuzhiyun 		brcmf_err("usb_submit_urb failed %d\n", ret);
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun 	return ret;
307*4882a593Smuzhiyun }
308*4882a593Smuzhiyun 
brcmf_usb_tx_ctlpkt(struct device * dev,u8 * buf,u32 len)309*4882a593Smuzhiyun static int brcmf_usb_tx_ctlpkt(struct device *dev, u8 *buf, u32 len)
310*4882a593Smuzhiyun {
311*4882a593Smuzhiyun 	int err = 0;
312*4882a593Smuzhiyun 	int timeout = 0;
313*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
314*4882a593Smuzhiyun 	struct usb_interface *intf = to_usb_interface(dev);
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	err = usb_autopm_get_interface(intf);
319*4882a593Smuzhiyun 	if (err)
320*4882a593Smuzhiyun 		goto out;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP) {
323*4882a593Smuzhiyun 		err = -EIO;
324*4882a593Smuzhiyun 		goto fail;
325*4882a593Smuzhiyun 	}
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun 	if (test_and_set_bit(0, &devinfo->ctl_op)) {
328*4882a593Smuzhiyun 		err = -EIO;
329*4882a593Smuzhiyun 		goto fail;
330*4882a593Smuzhiyun 	}
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun 	devinfo->ctl_completed = false;
333*4882a593Smuzhiyun 	err = brcmf_usb_send_ctl(devinfo, buf, len);
334*4882a593Smuzhiyun 	if (err) {
335*4882a593Smuzhiyun 		brcmf_err("fail %d bytes: %d\n", err, len);
336*4882a593Smuzhiyun 		clear_bit(0, &devinfo->ctl_op);
337*4882a593Smuzhiyun 		goto fail;
338*4882a593Smuzhiyun 	}
339*4882a593Smuzhiyun 	timeout = brcmf_usb_ioctl_resp_wait(devinfo);
340*4882a593Smuzhiyun 	if (!timeout) {
341*4882a593Smuzhiyun 		brcmf_err("Txctl wait timed out\n");
342*4882a593Smuzhiyun 		usb_kill_urb(devinfo->ctl_urb);
343*4882a593Smuzhiyun 		err = -EIO;
344*4882a593Smuzhiyun 		goto fail;
345*4882a593Smuzhiyun 	}
346*4882a593Smuzhiyun 	clear_bit(0, &devinfo->ctl_op);
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun fail:
349*4882a593Smuzhiyun 	usb_autopm_put_interface(intf);
350*4882a593Smuzhiyun out:
351*4882a593Smuzhiyun 	return err;
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun 
brcmf_usb_rx_ctlpkt(struct device * dev,u8 * buf,u32 len)354*4882a593Smuzhiyun static int brcmf_usb_rx_ctlpkt(struct device *dev, u8 *buf, u32 len)
355*4882a593Smuzhiyun {
356*4882a593Smuzhiyun 	int err = 0;
357*4882a593Smuzhiyun 	int timeout = 0;
358*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
359*4882a593Smuzhiyun 	struct usb_interface *intf = to_usb_interface(dev);
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	err = usb_autopm_get_interface(intf);
364*4882a593Smuzhiyun 	if (err)
365*4882a593Smuzhiyun 		goto out;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP) {
368*4882a593Smuzhiyun 		err = -EIO;
369*4882a593Smuzhiyun 		goto fail;
370*4882a593Smuzhiyun 	}
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	if (test_and_set_bit(0, &devinfo->ctl_op)) {
373*4882a593Smuzhiyun 		err = -EIO;
374*4882a593Smuzhiyun 		goto fail;
375*4882a593Smuzhiyun 	}
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 	devinfo->ctl_completed = false;
378*4882a593Smuzhiyun 	err = brcmf_usb_recv_ctl(devinfo, buf, len);
379*4882a593Smuzhiyun 	if (err) {
380*4882a593Smuzhiyun 		brcmf_err("fail %d bytes: %d\n", err, len);
381*4882a593Smuzhiyun 		clear_bit(0, &devinfo->ctl_op);
382*4882a593Smuzhiyun 		goto fail;
383*4882a593Smuzhiyun 	}
384*4882a593Smuzhiyun 	timeout = brcmf_usb_ioctl_resp_wait(devinfo);
385*4882a593Smuzhiyun 	err = devinfo->ctl_urb_status;
386*4882a593Smuzhiyun 	if (!timeout) {
387*4882a593Smuzhiyun 		brcmf_err("rxctl wait timed out\n");
388*4882a593Smuzhiyun 		usb_kill_urb(devinfo->ctl_urb);
389*4882a593Smuzhiyun 		err = -EIO;
390*4882a593Smuzhiyun 		goto fail;
391*4882a593Smuzhiyun 	}
392*4882a593Smuzhiyun 	clear_bit(0, &devinfo->ctl_op);
393*4882a593Smuzhiyun fail:
394*4882a593Smuzhiyun 	usb_autopm_put_interface(intf);
395*4882a593Smuzhiyun 	if (!err)
396*4882a593Smuzhiyun 		return devinfo->ctl_urb_actual_length;
397*4882a593Smuzhiyun out:
398*4882a593Smuzhiyun 	return err;
399*4882a593Smuzhiyun }
400*4882a593Smuzhiyun 
brcmf_usb_deq(struct brcmf_usbdev_info * devinfo,struct list_head * q,int * counter)401*4882a593Smuzhiyun static struct brcmf_usbreq *brcmf_usb_deq(struct brcmf_usbdev_info *devinfo,
402*4882a593Smuzhiyun 					  struct list_head *q, int *counter)
403*4882a593Smuzhiyun {
404*4882a593Smuzhiyun 	unsigned long flags;
405*4882a593Smuzhiyun 	struct brcmf_usbreq  *req;
406*4882a593Smuzhiyun 	spin_lock_irqsave(&devinfo->qlock, flags);
407*4882a593Smuzhiyun 	if (list_empty(q)) {
408*4882a593Smuzhiyun 		spin_unlock_irqrestore(&devinfo->qlock, flags);
409*4882a593Smuzhiyun 		return NULL;
410*4882a593Smuzhiyun 	}
411*4882a593Smuzhiyun 	req = list_entry(q->next, struct brcmf_usbreq, list);
412*4882a593Smuzhiyun 	list_del_init(q->next);
413*4882a593Smuzhiyun 	if (counter)
414*4882a593Smuzhiyun 		(*counter)--;
415*4882a593Smuzhiyun 	spin_unlock_irqrestore(&devinfo->qlock, flags);
416*4882a593Smuzhiyun 	return req;
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun }
419*4882a593Smuzhiyun 
brcmf_usb_enq(struct brcmf_usbdev_info * devinfo,struct list_head * q,struct brcmf_usbreq * req,int * counter)420*4882a593Smuzhiyun static void brcmf_usb_enq(struct brcmf_usbdev_info *devinfo,
421*4882a593Smuzhiyun 			  struct list_head *q, struct brcmf_usbreq *req,
422*4882a593Smuzhiyun 			  int *counter)
423*4882a593Smuzhiyun {
424*4882a593Smuzhiyun 	unsigned long flags;
425*4882a593Smuzhiyun 	spin_lock_irqsave(&devinfo->qlock, flags);
426*4882a593Smuzhiyun 	list_add_tail(&req->list, q);
427*4882a593Smuzhiyun 	if (counter)
428*4882a593Smuzhiyun 		(*counter)++;
429*4882a593Smuzhiyun 	spin_unlock_irqrestore(&devinfo->qlock, flags);
430*4882a593Smuzhiyun }
431*4882a593Smuzhiyun 
432*4882a593Smuzhiyun static struct brcmf_usbreq *
brcmf_usbdev_qinit(struct list_head * q,int qsize)433*4882a593Smuzhiyun brcmf_usbdev_qinit(struct list_head *q, int qsize)
434*4882a593Smuzhiyun {
435*4882a593Smuzhiyun 	int i;
436*4882a593Smuzhiyun 	struct brcmf_usbreq *req, *reqs;
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun 	reqs = kcalloc(qsize, sizeof(struct brcmf_usbreq), GFP_ATOMIC);
439*4882a593Smuzhiyun 	if (reqs == NULL)
440*4882a593Smuzhiyun 		return NULL;
441*4882a593Smuzhiyun 
442*4882a593Smuzhiyun 	req = reqs;
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 	for (i = 0; i < qsize; i++) {
445*4882a593Smuzhiyun 		req->urb = usb_alloc_urb(0, GFP_ATOMIC);
446*4882a593Smuzhiyun 		if (!req->urb)
447*4882a593Smuzhiyun 			goto fail;
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun 		INIT_LIST_HEAD(&req->list);
450*4882a593Smuzhiyun 		list_add_tail(&req->list, q);
451*4882a593Smuzhiyun 		req++;
452*4882a593Smuzhiyun 	}
453*4882a593Smuzhiyun 	return reqs;
454*4882a593Smuzhiyun fail:
455*4882a593Smuzhiyun 	brcmf_err("fail!\n");
456*4882a593Smuzhiyun 	while (!list_empty(q)) {
457*4882a593Smuzhiyun 		req = list_entry(q->next, struct brcmf_usbreq, list);
458*4882a593Smuzhiyun 		if (req)
459*4882a593Smuzhiyun 			usb_free_urb(req->urb);
460*4882a593Smuzhiyun 		list_del(q->next);
461*4882a593Smuzhiyun 	}
462*4882a593Smuzhiyun 	kfree(reqs);
463*4882a593Smuzhiyun 	return NULL;
464*4882a593Smuzhiyun 
465*4882a593Smuzhiyun }
466*4882a593Smuzhiyun 
brcmf_usb_free_q(struct list_head * q)467*4882a593Smuzhiyun static void brcmf_usb_free_q(struct list_head *q)
468*4882a593Smuzhiyun {
469*4882a593Smuzhiyun 	struct brcmf_usbreq *req, *next;
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	list_for_each_entry_safe(req, next, q, list) {
472*4882a593Smuzhiyun 		if (!req->urb) {
473*4882a593Smuzhiyun 			brcmf_err("bad req\n");
474*4882a593Smuzhiyun 			break;
475*4882a593Smuzhiyun 		}
476*4882a593Smuzhiyun 		usb_free_urb(req->urb);
477*4882a593Smuzhiyun 		list_del_init(&req->list);
478*4882a593Smuzhiyun 	}
479*4882a593Smuzhiyun }
480*4882a593Smuzhiyun 
brcmf_usb_del_fromq(struct brcmf_usbdev_info * devinfo,struct brcmf_usbreq * req)481*4882a593Smuzhiyun static void brcmf_usb_del_fromq(struct brcmf_usbdev_info *devinfo,
482*4882a593Smuzhiyun 				struct brcmf_usbreq *req)
483*4882a593Smuzhiyun {
484*4882a593Smuzhiyun 	unsigned long flags;
485*4882a593Smuzhiyun 
486*4882a593Smuzhiyun 	spin_lock_irqsave(&devinfo->qlock, flags);
487*4882a593Smuzhiyun 	list_del_init(&req->list);
488*4882a593Smuzhiyun 	spin_unlock_irqrestore(&devinfo->qlock, flags);
489*4882a593Smuzhiyun }
490*4882a593Smuzhiyun 
491*4882a593Smuzhiyun 
brcmf_usb_tx_complete(struct urb * urb)492*4882a593Smuzhiyun static void brcmf_usb_tx_complete(struct urb *urb)
493*4882a593Smuzhiyun {
494*4882a593Smuzhiyun 	struct brcmf_usbreq *req = (struct brcmf_usbreq *)urb->context;
495*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = req->devinfo;
496*4882a593Smuzhiyun 	unsigned long flags;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter, urb->status=%d, skb=%p\n", urb->status,
499*4882a593Smuzhiyun 		  req->skb);
500*4882a593Smuzhiyun 	brcmf_usb_del_fromq(devinfo, req);
501*4882a593Smuzhiyun 
502*4882a593Smuzhiyun 	brcmf_proto_bcdc_txcomplete(devinfo->dev, req->skb, urb->status == 0);
503*4882a593Smuzhiyun 	req->skb = NULL;
504*4882a593Smuzhiyun 	brcmf_usb_enq(devinfo, &devinfo->tx_freeq, req, &devinfo->tx_freecount);
505*4882a593Smuzhiyun 	spin_lock_irqsave(&devinfo->tx_flowblock_lock, flags);
506*4882a593Smuzhiyun 	if (devinfo->tx_freecount > devinfo->tx_high_watermark &&
507*4882a593Smuzhiyun 		devinfo->tx_flowblock) {
508*4882a593Smuzhiyun 		brcmf_proto_bcdc_txflowblock(devinfo->dev, false);
509*4882a593Smuzhiyun 		devinfo->tx_flowblock = false;
510*4882a593Smuzhiyun 	}
511*4882a593Smuzhiyun 	spin_unlock_irqrestore(&devinfo->tx_flowblock_lock, flags);
512*4882a593Smuzhiyun }
513*4882a593Smuzhiyun 
brcmf_usb_rx_complete(struct urb * urb)514*4882a593Smuzhiyun static void brcmf_usb_rx_complete(struct urb *urb)
515*4882a593Smuzhiyun {
516*4882a593Smuzhiyun 	struct brcmf_usbreq  *req = (struct brcmf_usbreq *)urb->context;
517*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = req->devinfo;
518*4882a593Smuzhiyun 	struct sk_buff *skb;
519*4882a593Smuzhiyun 
520*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter, urb->status=%d\n", urb->status);
521*4882a593Smuzhiyun 	brcmf_usb_del_fromq(devinfo, req);
522*4882a593Smuzhiyun 	skb = req->skb;
523*4882a593Smuzhiyun 	req->skb = NULL;
524*4882a593Smuzhiyun 
525*4882a593Smuzhiyun 	/* zero length packets indicate usb "failure". Do not refill */
526*4882a593Smuzhiyun 	if (urb->status != 0 || !urb->actual_length) {
527*4882a593Smuzhiyun 		brcmu_pkt_buf_free_skb(skb);
528*4882a593Smuzhiyun 		brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
529*4882a593Smuzhiyun 		return;
530*4882a593Smuzhiyun 	}
531*4882a593Smuzhiyun 
532*4882a593Smuzhiyun 	if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_UP ||
533*4882a593Smuzhiyun 	    devinfo->bus_pub.state == BRCMFMAC_USB_STATE_SLEEP) {
534*4882a593Smuzhiyun 		skb_put(skb, urb->actual_length);
535*4882a593Smuzhiyun 		brcmf_rx_frame(devinfo->dev, skb, true, true);
536*4882a593Smuzhiyun 		brcmf_usb_rx_refill(devinfo, req);
537*4882a593Smuzhiyun 		usb_mark_last_busy(urb->dev);
538*4882a593Smuzhiyun 	} else {
539*4882a593Smuzhiyun 		brcmu_pkt_buf_free_skb(skb);
540*4882a593Smuzhiyun 		brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
541*4882a593Smuzhiyun 	}
542*4882a593Smuzhiyun 	return;
543*4882a593Smuzhiyun 
544*4882a593Smuzhiyun }
545*4882a593Smuzhiyun 
brcmf_usb_rx_refill(struct brcmf_usbdev_info * devinfo,struct brcmf_usbreq * req)546*4882a593Smuzhiyun static void brcmf_usb_rx_refill(struct brcmf_usbdev_info *devinfo,
547*4882a593Smuzhiyun 				struct brcmf_usbreq  *req)
548*4882a593Smuzhiyun {
549*4882a593Smuzhiyun 	struct sk_buff *skb;
550*4882a593Smuzhiyun 	int ret;
551*4882a593Smuzhiyun 
552*4882a593Smuzhiyun 	if (!req || !devinfo)
553*4882a593Smuzhiyun 		return;
554*4882a593Smuzhiyun 
555*4882a593Smuzhiyun 	skb = dev_alloc_skb(devinfo->bus_pub.bus_mtu);
556*4882a593Smuzhiyun 	if (!skb) {
557*4882a593Smuzhiyun 		brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
558*4882a593Smuzhiyun 		return;
559*4882a593Smuzhiyun 	}
560*4882a593Smuzhiyun 	req->skb = skb;
561*4882a593Smuzhiyun 
562*4882a593Smuzhiyun 	usb_fill_bulk_urb(req->urb, devinfo->usbdev, devinfo->rx_pipe,
563*4882a593Smuzhiyun 			  skb->data, skb_tailroom(skb), brcmf_usb_rx_complete,
564*4882a593Smuzhiyun 			  req);
565*4882a593Smuzhiyun 	req->devinfo = devinfo;
566*4882a593Smuzhiyun 	brcmf_usb_enq(devinfo, &devinfo->rx_postq, req, NULL);
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	ret = usb_submit_urb(req->urb, GFP_ATOMIC);
569*4882a593Smuzhiyun 	if (ret) {
570*4882a593Smuzhiyun 		brcmf_usb_del_fromq(devinfo, req);
571*4882a593Smuzhiyun 		brcmu_pkt_buf_free_skb(req->skb);
572*4882a593Smuzhiyun 		req->skb = NULL;
573*4882a593Smuzhiyun 		brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
574*4882a593Smuzhiyun 	}
575*4882a593Smuzhiyun 	return;
576*4882a593Smuzhiyun }
577*4882a593Smuzhiyun 
brcmf_usb_rx_fill_all(struct brcmf_usbdev_info * devinfo)578*4882a593Smuzhiyun static void brcmf_usb_rx_fill_all(struct brcmf_usbdev_info *devinfo)
579*4882a593Smuzhiyun {
580*4882a593Smuzhiyun 	struct brcmf_usbreq *req;
581*4882a593Smuzhiyun 
582*4882a593Smuzhiyun 	if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP) {
583*4882a593Smuzhiyun 		brcmf_err("bus is not up=%d\n", devinfo->bus_pub.state);
584*4882a593Smuzhiyun 		return;
585*4882a593Smuzhiyun 	}
586*4882a593Smuzhiyun 	while ((req = brcmf_usb_deq(devinfo, &devinfo->rx_freeq, NULL)) != NULL)
587*4882a593Smuzhiyun 		brcmf_usb_rx_refill(devinfo, req);
588*4882a593Smuzhiyun }
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun static void
brcmf_usb_state_change(struct brcmf_usbdev_info * devinfo,int state)591*4882a593Smuzhiyun brcmf_usb_state_change(struct brcmf_usbdev_info *devinfo, int state)
592*4882a593Smuzhiyun {
593*4882a593Smuzhiyun 	struct brcmf_bus *bcmf_bus = devinfo->bus_pub.bus;
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter, current state=%d, new state=%d\n",
596*4882a593Smuzhiyun 		  devinfo->bus_pub.state, state);
597*4882a593Smuzhiyun 
598*4882a593Smuzhiyun 	if (devinfo->bus_pub.state == state)
599*4882a593Smuzhiyun 		return;
600*4882a593Smuzhiyun 
601*4882a593Smuzhiyun 	devinfo->bus_pub.state = state;
602*4882a593Smuzhiyun 
603*4882a593Smuzhiyun 	/* update state of upper layer */
604*4882a593Smuzhiyun 	if (state == BRCMFMAC_USB_STATE_DOWN) {
605*4882a593Smuzhiyun 		brcmf_dbg(USB, "DBUS is down\n");
606*4882a593Smuzhiyun 		brcmf_bus_change_state(bcmf_bus, BRCMF_BUS_DOWN);
607*4882a593Smuzhiyun 	} else if (state == BRCMFMAC_USB_STATE_UP) {
608*4882a593Smuzhiyun 		brcmf_dbg(USB, "DBUS is up\n");
609*4882a593Smuzhiyun 		brcmf_bus_change_state(bcmf_bus, BRCMF_BUS_UP);
610*4882a593Smuzhiyun 	} else {
611*4882a593Smuzhiyun 		brcmf_dbg(USB, "DBUS current state=%d\n", state);
612*4882a593Smuzhiyun 	}
613*4882a593Smuzhiyun }
614*4882a593Smuzhiyun 
brcmf_usb_tx(struct device * dev,struct sk_buff * skb)615*4882a593Smuzhiyun static int brcmf_usb_tx(struct device *dev, struct sk_buff *skb)
616*4882a593Smuzhiyun {
617*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
618*4882a593Smuzhiyun 	struct brcmf_usbreq  *req;
619*4882a593Smuzhiyun 	int ret;
620*4882a593Smuzhiyun 	unsigned long flags;
621*4882a593Smuzhiyun 	struct usb_interface *intf = to_usb_interface(dev);
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 	ret = usb_autopm_get_interface(intf);
624*4882a593Smuzhiyun 	if (ret)
625*4882a593Smuzhiyun 		goto out;
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter, skb=%p\n", skb);
628*4882a593Smuzhiyun 	if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP) {
629*4882a593Smuzhiyun 		ret = -EIO;
630*4882a593Smuzhiyun 		goto fail;
631*4882a593Smuzhiyun 	}
632*4882a593Smuzhiyun 
633*4882a593Smuzhiyun 	req = brcmf_usb_deq(devinfo, &devinfo->tx_freeq,
634*4882a593Smuzhiyun 					&devinfo->tx_freecount);
635*4882a593Smuzhiyun 	if (!req) {
636*4882a593Smuzhiyun 		brcmf_err("no req to send\n");
637*4882a593Smuzhiyun 		ret = -ENOMEM;
638*4882a593Smuzhiyun 		goto fail;
639*4882a593Smuzhiyun 	}
640*4882a593Smuzhiyun 
641*4882a593Smuzhiyun 	req->skb = skb;
642*4882a593Smuzhiyun 	req->devinfo = devinfo;
643*4882a593Smuzhiyun 	usb_fill_bulk_urb(req->urb, devinfo->usbdev, devinfo->tx_pipe,
644*4882a593Smuzhiyun 			  skb->data, skb->len, brcmf_usb_tx_complete, req);
645*4882a593Smuzhiyun 	req->urb->transfer_flags |= URB_ZERO_PACKET;
646*4882a593Smuzhiyun 	brcmf_usb_enq(devinfo, &devinfo->tx_postq, req, NULL);
647*4882a593Smuzhiyun 	ret = usb_submit_urb(req->urb, GFP_ATOMIC);
648*4882a593Smuzhiyun 	if (ret) {
649*4882a593Smuzhiyun 		brcmf_err("brcmf_usb_tx usb_submit_urb FAILED\n");
650*4882a593Smuzhiyun 		brcmf_usb_del_fromq(devinfo, req);
651*4882a593Smuzhiyun 		req->skb = NULL;
652*4882a593Smuzhiyun 		brcmf_usb_enq(devinfo, &devinfo->tx_freeq, req,
653*4882a593Smuzhiyun 			      &devinfo->tx_freecount);
654*4882a593Smuzhiyun 		goto fail;
655*4882a593Smuzhiyun 	}
656*4882a593Smuzhiyun 
657*4882a593Smuzhiyun 	spin_lock_irqsave(&devinfo->tx_flowblock_lock, flags);
658*4882a593Smuzhiyun 	if (devinfo->tx_freecount < devinfo->tx_low_watermark &&
659*4882a593Smuzhiyun 	    !devinfo->tx_flowblock) {
660*4882a593Smuzhiyun 		brcmf_proto_bcdc_txflowblock(dev, true);
661*4882a593Smuzhiyun 		devinfo->tx_flowblock = true;
662*4882a593Smuzhiyun 	}
663*4882a593Smuzhiyun 	spin_unlock_irqrestore(&devinfo->tx_flowblock_lock, flags);
664*4882a593Smuzhiyun 
665*4882a593Smuzhiyun fail:
666*4882a593Smuzhiyun 	usb_autopm_put_interface(intf);
667*4882a593Smuzhiyun out:
668*4882a593Smuzhiyun 	return ret;
669*4882a593Smuzhiyun }
670*4882a593Smuzhiyun 
671*4882a593Smuzhiyun 
brcmf_usb_up(struct device * dev)672*4882a593Smuzhiyun static int brcmf_usb_up(struct device *dev)
673*4882a593Smuzhiyun {
674*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
675*4882a593Smuzhiyun 
676*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
677*4882a593Smuzhiyun 	if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_UP)
678*4882a593Smuzhiyun 		return 0;
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun 	/* Success, indicate devinfo is fully up */
681*4882a593Smuzhiyun 	brcmf_usb_state_change(devinfo, BRCMFMAC_USB_STATE_UP);
682*4882a593Smuzhiyun 
683*4882a593Smuzhiyun 	if (devinfo->ctl_urb) {
684*4882a593Smuzhiyun 		devinfo->ctl_in_pipe = usb_rcvctrlpipe(devinfo->usbdev, 0);
685*4882a593Smuzhiyun 		devinfo->ctl_out_pipe = usb_sndctrlpipe(devinfo->usbdev, 0);
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 		/* CTL Write */
688*4882a593Smuzhiyun 		devinfo->ctl_write.bRequestType =
689*4882a593Smuzhiyun 			USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE;
690*4882a593Smuzhiyun 		devinfo->ctl_write.bRequest = 0;
691*4882a593Smuzhiyun 		devinfo->ctl_write.wValue = cpu_to_le16(0);
692*4882a593Smuzhiyun 		devinfo->ctl_write.wIndex = cpu_to_le16(devinfo->ifnum);
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun 		/* CTL Read */
695*4882a593Smuzhiyun 		devinfo->ctl_read.bRequestType =
696*4882a593Smuzhiyun 			USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE;
697*4882a593Smuzhiyun 		devinfo->ctl_read.bRequest = 1;
698*4882a593Smuzhiyun 		devinfo->ctl_read.wValue = cpu_to_le16(0);
699*4882a593Smuzhiyun 		devinfo->ctl_read.wIndex = cpu_to_le16(devinfo->ifnum);
700*4882a593Smuzhiyun 	}
701*4882a593Smuzhiyun 	brcmf_usb_rx_fill_all(devinfo);
702*4882a593Smuzhiyun 	return 0;
703*4882a593Smuzhiyun }
704*4882a593Smuzhiyun 
brcmf_cancel_all_urbs(struct brcmf_usbdev_info * devinfo)705*4882a593Smuzhiyun static void brcmf_cancel_all_urbs(struct brcmf_usbdev_info *devinfo)
706*4882a593Smuzhiyun {
707*4882a593Smuzhiyun 	int i;
708*4882a593Smuzhiyun 
709*4882a593Smuzhiyun 	if (devinfo->ctl_urb)
710*4882a593Smuzhiyun 		usb_kill_urb(devinfo->ctl_urb);
711*4882a593Smuzhiyun 	if (devinfo->bulk_urb)
712*4882a593Smuzhiyun 		usb_kill_urb(devinfo->bulk_urb);
713*4882a593Smuzhiyun 	if (devinfo->tx_reqs)
714*4882a593Smuzhiyun 		for (i = 0; i < devinfo->bus_pub.ntxq; i++)
715*4882a593Smuzhiyun 			usb_kill_urb(devinfo->tx_reqs[i].urb);
716*4882a593Smuzhiyun 	if (devinfo->rx_reqs)
717*4882a593Smuzhiyun 		for (i = 0; i < devinfo->bus_pub.nrxq; i++)
718*4882a593Smuzhiyun 			usb_kill_urb(devinfo->rx_reqs[i].urb);
719*4882a593Smuzhiyun }
720*4882a593Smuzhiyun 
brcmf_usb_down(struct device * dev)721*4882a593Smuzhiyun static void brcmf_usb_down(struct device *dev)
722*4882a593Smuzhiyun {
723*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
724*4882a593Smuzhiyun 
725*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
726*4882a593Smuzhiyun 	if (devinfo == NULL)
727*4882a593Smuzhiyun 		return;
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 	if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_DOWN)
730*4882a593Smuzhiyun 		return;
731*4882a593Smuzhiyun 
732*4882a593Smuzhiyun 	brcmf_usb_state_change(devinfo, BRCMFMAC_USB_STATE_DOWN);
733*4882a593Smuzhiyun 
734*4882a593Smuzhiyun 	brcmf_cancel_all_urbs(devinfo);
735*4882a593Smuzhiyun }
736*4882a593Smuzhiyun 
737*4882a593Smuzhiyun static void
brcmf_usb_sync_complete(struct urb * urb)738*4882a593Smuzhiyun brcmf_usb_sync_complete(struct urb *urb)
739*4882a593Smuzhiyun {
740*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo =
741*4882a593Smuzhiyun 			(struct brcmf_usbdev_info *)urb->context;
742*4882a593Smuzhiyun 
743*4882a593Smuzhiyun 	devinfo->ctl_completed = true;
744*4882a593Smuzhiyun 	brcmf_usb_ioctl_resp_wake(devinfo);
745*4882a593Smuzhiyun }
746*4882a593Smuzhiyun 
brcmf_usb_dl_cmd(struct brcmf_usbdev_info * devinfo,u8 cmd,void * buffer,int buflen)747*4882a593Smuzhiyun static int brcmf_usb_dl_cmd(struct brcmf_usbdev_info *devinfo, u8 cmd,
748*4882a593Smuzhiyun 			    void *buffer, int buflen)
749*4882a593Smuzhiyun {
750*4882a593Smuzhiyun 	int ret;
751*4882a593Smuzhiyun 	char *tmpbuf;
752*4882a593Smuzhiyun 	u16 size;
753*4882a593Smuzhiyun 
754*4882a593Smuzhiyun 	if ((!devinfo) || (devinfo->ctl_urb == NULL))
755*4882a593Smuzhiyun 		return -EINVAL;
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun 	tmpbuf = kmalloc(buflen, GFP_ATOMIC);
758*4882a593Smuzhiyun 	if (!tmpbuf)
759*4882a593Smuzhiyun 		return -ENOMEM;
760*4882a593Smuzhiyun 
761*4882a593Smuzhiyun 	size = buflen;
762*4882a593Smuzhiyun 	devinfo->ctl_urb->transfer_buffer_length = size;
763*4882a593Smuzhiyun 
764*4882a593Smuzhiyun 	devinfo->ctl_read.wLength = cpu_to_le16p(&size);
765*4882a593Smuzhiyun 	devinfo->ctl_read.bRequestType = USB_DIR_IN | USB_TYPE_VENDOR |
766*4882a593Smuzhiyun 		USB_RECIP_INTERFACE;
767*4882a593Smuzhiyun 	devinfo->ctl_read.bRequest = cmd;
768*4882a593Smuzhiyun 
769*4882a593Smuzhiyun 	usb_fill_control_urb(devinfo->ctl_urb,
770*4882a593Smuzhiyun 		devinfo->usbdev,
771*4882a593Smuzhiyun 		usb_rcvctrlpipe(devinfo->usbdev, 0),
772*4882a593Smuzhiyun 		(unsigned char *) &devinfo->ctl_read,
773*4882a593Smuzhiyun 		(void *) tmpbuf, size,
774*4882a593Smuzhiyun 		(usb_complete_t)brcmf_usb_sync_complete, devinfo);
775*4882a593Smuzhiyun 
776*4882a593Smuzhiyun 	devinfo->ctl_completed = false;
777*4882a593Smuzhiyun 	ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
778*4882a593Smuzhiyun 	if (ret < 0) {
779*4882a593Smuzhiyun 		brcmf_err("usb_submit_urb failed %d\n", ret);
780*4882a593Smuzhiyun 		goto finalize;
781*4882a593Smuzhiyun 	}
782*4882a593Smuzhiyun 
783*4882a593Smuzhiyun 	if (!brcmf_usb_ioctl_resp_wait(devinfo)) {
784*4882a593Smuzhiyun 		usb_kill_urb(devinfo->ctl_urb);
785*4882a593Smuzhiyun 		ret = -ETIMEDOUT;
786*4882a593Smuzhiyun 	} else {
787*4882a593Smuzhiyun 		memcpy(buffer, tmpbuf, buflen);
788*4882a593Smuzhiyun 	}
789*4882a593Smuzhiyun 
790*4882a593Smuzhiyun finalize:
791*4882a593Smuzhiyun 	kfree(tmpbuf);
792*4882a593Smuzhiyun 	return ret;
793*4882a593Smuzhiyun }
794*4882a593Smuzhiyun 
795*4882a593Smuzhiyun static bool
brcmf_usb_dlneeded(struct brcmf_usbdev_info * devinfo)796*4882a593Smuzhiyun brcmf_usb_dlneeded(struct brcmf_usbdev_info *devinfo)
797*4882a593Smuzhiyun {
798*4882a593Smuzhiyun 	struct bootrom_id_le id;
799*4882a593Smuzhiyun 	u32 chipid, chiprev;
800*4882a593Smuzhiyun 
801*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
802*4882a593Smuzhiyun 
803*4882a593Smuzhiyun 	if (devinfo == NULL)
804*4882a593Smuzhiyun 		return false;
805*4882a593Smuzhiyun 
806*4882a593Smuzhiyun 	/* Check if firmware downloaded already by querying runtime ID */
807*4882a593Smuzhiyun 	id.chip = cpu_to_le32(0xDEAD);
808*4882a593Smuzhiyun 	brcmf_usb_dl_cmd(devinfo, DL_GETVER, &id, sizeof(id));
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	chipid = le32_to_cpu(id.chip);
811*4882a593Smuzhiyun 	chiprev = le32_to_cpu(id.chiprev);
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	if ((chipid & 0x4300) == 0x4300)
814*4882a593Smuzhiyun 		brcmf_dbg(USB, "chip %x rev 0x%x\n", chipid, chiprev);
815*4882a593Smuzhiyun 	else
816*4882a593Smuzhiyun 		brcmf_dbg(USB, "chip %d rev 0x%x\n", chipid, chiprev);
817*4882a593Smuzhiyun 	if (chipid == BRCMF_POSTBOOT_ID) {
818*4882a593Smuzhiyun 		brcmf_dbg(USB, "firmware already downloaded\n");
819*4882a593Smuzhiyun 		brcmf_usb_dl_cmd(devinfo, DL_RESETCFG, &id, sizeof(id));
820*4882a593Smuzhiyun 		return false;
821*4882a593Smuzhiyun 	} else {
822*4882a593Smuzhiyun 		devinfo->bus_pub.devid = chipid;
823*4882a593Smuzhiyun 		devinfo->bus_pub.chiprev = chiprev;
824*4882a593Smuzhiyun 	}
825*4882a593Smuzhiyun 	return true;
826*4882a593Smuzhiyun }
827*4882a593Smuzhiyun 
828*4882a593Smuzhiyun static int
brcmf_usb_resetcfg(struct brcmf_usbdev_info * devinfo)829*4882a593Smuzhiyun brcmf_usb_resetcfg(struct brcmf_usbdev_info *devinfo)
830*4882a593Smuzhiyun {
831*4882a593Smuzhiyun 	struct bootrom_id_le id;
832*4882a593Smuzhiyun 	u32 loop_cnt;
833*4882a593Smuzhiyun 	int err;
834*4882a593Smuzhiyun 
835*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
836*4882a593Smuzhiyun 
837*4882a593Smuzhiyun 	loop_cnt = 0;
838*4882a593Smuzhiyun 	do {
839*4882a593Smuzhiyun 		mdelay(BRCMF_USB_RESET_GETVER_SPINWAIT);
840*4882a593Smuzhiyun 		loop_cnt++;
841*4882a593Smuzhiyun 		id.chip = cpu_to_le32(0xDEAD);       /* Get the ID */
842*4882a593Smuzhiyun 		err = brcmf_usb_dl_cmd(devinfo, DL_GETVER, &id, sizeof(id));
843*4882a593Smuzhiyun 		if ((err) && (err != -ETIMEDOUT))
844*4882a593Smuzhiyun 			return err;
845*4882a593Smuzhiyun 		if (id.chip == cpu_to_le32(BRCMF_POSTBOOT_ID))
846*4882a593Smuzhiyun 			break;
847*4882a593Smuzhiyun 	} while (loop_cnt < BRCMF_USB_RESET_GETVER_LOOP_CNT);
848*4882a593Smuzhiyun 
849*4882a593Smuzhiyun 	if (id.chip == cpu_to_le32(BRCMF_POSTBOOT_ID)) {
850*4882a593Smuzhiyun 		brcmf_dbg(USB, "postboot chip 0x%x/rev 0x%x\n",
851*4882a593Smuzhiyun 			  le32_to_cpu(id.chip), le32_to_cpu(id.chiprev));
852*4882a593Smuzhiyun 
853*4882a593Smuzhiyun 		brcmf_usb_dl_cmd(devinfo, DL_RESETCFG, &id, sizeof(id));
854*4882a593Smuzhiyun 		return 0;
855*4882a593Smuzhiyun 	} else {
856*4882a593Smuzhiyun 		brcmf_err("Cannot talk to Dongle. Firmware is not UP, %d ms\n",
857*4882a593Smuzhiyun 			  BRCMF_USB_RESET_GETVER_SPINWAIT * loop_cnt);
858*4882a593Smuzhiyun 		return -EINVAL;
859*4882a593Smuzhiyun 	}
860*4882a593Smuzhiyun }
861*4882a593Smuzhiyun 
862*4882a593Smuzhiyun 
863*4882a593Smuzhiyun static int
brcmf_usb_dl_send_bulk(struct brcmf_usbdev_info * devinfo,void * buffer,int len)864*4882a593Smuzhiyun brcmf_usb_dl_send_bulk(struct brcmf_usbdev_info *devinfo, void *buffer, int len)
865*4882a593Smuzhiyun {
866*4882a593Smuzhiyun 	int ret;
867*4882a593Smuzhiyun 
868*4882a593Smuzhiyun 	if ((devinfo == NULL) || (devinfo->bulk_urb == NULL))
869*4882a593Smuzhiyun 		return -EINVAL;
870*4882a593Smuzhiyun 
871*4882a593Smuzhiyun 	/* Prepare the URB */
872*4882a593Smuzhiyun 	usb_fill_bulk_urb(devinfo->bulk_urb, devinfo->usbdev,
873*4882a593Smuzhiyun 			  devinfo->tx_pipe, buffer, len,
874*4882a593Smuzhiyun 			  (usb_complete_t)brcmf_usb_sync_complete, devinfo);
875*4882a593Smuzhiyun 
876*4882a593Smuzhiyun 	devinfo->bulk_urb->transfer_flags |= URB_ZERO_PACKET;
877*4882a593Smuzhiyun 
878*4882a593Smuzhiyun 	devinfo->ctl_completed = false;
879*4882a593Smuzhiyun 	ret = usb_submit_urb(devinfo->bulk_urb, GFP_ATOMIC);
880*4882a593Smuzhiyun 	if (ret) {
881*4882a593Smuzhiyun 		brcmf_err("usb_submit_urb failed %d\n", ret);
882*4882a593Smuzhiyun 		return ret;
883*4882a593Smuzhiyun 	}
884*4882a593Smuzhiyun 	ret = brcmf_usb_ioctl_resp_wait(devinfo);
885*4882a593Smuzhiyun 	return (ret == 0);
886*4882a593Smuzhiyun }
887*4882a593Smuzhiyun 
888*4882a593Smuzhiyun static int
brcmf_usb_dl_writeimage(struct brcmf_usbdev_info * devinfo,u8 * fw,int fwlen)889*4882a593Smuzhiyun brcmf_usb_dl_writeimage(struct brcmf_usbdev_info *devinfo, u8 *fw, int fwlen)
890*4882a593Smuzhiyun {
891*4882a593Smuzhiyun 	unsigned int sendlen, sent, dllen;
892*4882a593Smuzhiyun 	char *bulkchunk = NULL, *dlpos;
893*4882a593Smuzhiyun 	struct rdl_state_le state;
894*4882a593Smuzhiyun 	u32 rdlstate, rdlbytes;
895*4882a593Smuzhiyun 	int err = 0;
896*4882a593Smuzhiyun 
897*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter, fw %p, len %d\n", fw, fwlen);
898*4882a593Smuzhiyun 
899*4882a593Smuzhiyun 	bulkchunk = kmalloc(TRX_RDL_CHUNK, GFP_ATOMIC);
900*4882a593Smuzhiyun 	if (bulkchunk == NULL) {
901*4882a593Smuzhiyun 		err = -ENOMEM;
902*4882a593Smuzhiyun 		goto fail;
903*4882a593Smuzhiyun 	}
904*4882a593Smuzhiyun 
905*4882a593Smuzhiyun 	/* 1) Prepare USB boot loader for runtime image */
906*4882a593Smuzhiyun 	brcmf_usb_dl_cmd(devinfo, DL_START, &state, sizeof(state));
907*4882a593Smuzhiyun 
908*4882a593Smuzhiyun 	rdlstate = le32_to_cpu(state.state);
909*4882a593Smuzhiyun 	rdlbytes = le32_to_cpu(state.bytes);
910*4882a593Smuzhiyun 
911*4882a593Smuzhiyun 	/* 2) Check we are in the Waiting state */
912*4882a593Smuzhiyun 	if (rdlstate != DL_WAITING) {
913*4882a593Smuzhiyun 		brcmf_err("Failed to DL_START\n");
914*4882a593Smuzhiyun 		err = -EINVAL;
915*4882a593Smuzhiyun 		goto fail;
916*4882a593Smuzhiyun 	}
917*4882a593Smuzhiyun 	sent = 0;
918*4882a593Smuzhiyun 	dlpos = fw;
919*4882a593Smuzhiyun 	dllen = fwlen;
920*4882a593Smuzhiyun 
921*4882a593Smuzhiyun 	/* Get chip id and rev */
922*4882a593Smuzhiyun 	while (rdlbytes != dllen) {
923*4882a593Smuzhiyun 		/* Wait until the usb device reports it received all
924*4882a593Smuzhiyun 		 * the bytes we sent */
925*4882a593Smuzhiyun 		if ((rdlbytes == sent) && (rdlbytes != dllen)) {
926*4882a593Smuzhiyun 			if ((dllen-sent) < TRX_RDL_CHUNK)
927*4882a593Smuzhiyun 				sendlen = dllen-sent;
928*4882a593Smuzhiyun 			else
929*4882a593Smuzhiyun 				sendlen = TRX_RDL_CHUNK;
930*4882a593Smuzhiyun 
931*4882a593Smuzhiyun 			/* simply avoid having to send a ZLP by ensuring we
932*4882a593Smuzhiyun 			 * never have an even
933*4882a593Smuzhiyun 			 * multiple of 64
934*4882a593Smuzhiyun 			 */
935*4882a593Smuzhiyun 			if (!(sendlen % 64))
936*4882a593Smuzhiyun 				sendlen -= 4;
937*4882a593Smuzhiyun 
938*4882a593Smuzhiyun 			/* send data */
939*4882a593Smuzhiyun 			memcpy(bulkchunk, dlpos, sendlen);
940*4882a593Smuzhiyun 			if (brcmf_usb_dl_send_bulk(devinfo, bulkchunk,
941*4882a593Smuzhiyun 						   sendlen)) {
942*4882a593Smuzhiyun 				brcmf_err("send_bulk failed\n");
943*4882a593Smuzhiyun 				err = -EINVAL;
944*4882a593Smuzhiyun 				goto fail;
945*4882a593Smuzhiyun 			}
946*4882a593Smuzhiyun 
947*4882a593Smuzhiyun 			dlpos += sendlen;
948*4882a593Smuzhiyun 			sent += sendlen;
949*4882a593Smuzhiyun 		}
950*4882a593Smuzhiyun 		err = brcmf_usb_dl_cmd(devinfo, DL_GETSTATE, &state,
951*4882a593Smuzhiyun 				       sizeof(state));
952*4882a593Smuzhiyun 		if (err) {
953*4882a593Smuzhiyun 			brcmf_err("DL_GETSTATE Failed\n");
954*4882a593Smuzhiyun 			goto fail;
955*4882a593Smuzhiyun 		}
956*4882a593Smuzhiyun 
957*4882a593Smuzhiyun 		rdlstate = le32_to_cpu(state.state);
958*4882a593Smuzhiyun 		rdlbytes = le32_to_cpu(state.bytes);
959*4882a593Smuzhiyun 
960*4882a593Smuzhiyun 		/* restart if an error is reported */
961*4882a593Smuzhiyun 		if (rdlstate == DL_BAD_HDR || rdlstate == DL_BAD_CRC) {
962*4882a593Smuzhiyun 			brcmf_err("Bad Hdr or Bad CRC state %d\n",
963*4882a593Smuzhiyun 				  rdlstate);
964*4882a593Smuzhiyun 			err = -EINVAL;
965*4882a593Smuzhiyun 			goto fail;
966*4882a593Smuzhiyun 		}
967*4882a593Smuzhiyun 	}
968*4882a593Smuzhiyun 
969*4882a593Smuzhiyun fail:
970*4882a593Smuzhiyun 	kfree(bulkchunk);
971*4882a593Smuzhiyun 	brcmf_dbg(USB, "Exit, err=%d\n", err);
972*4882a593Smuzhiyun 	return err;
973*4882a593Smuzhiyun }
974*4882a593Smuzhiyun 
brcmf_usb_dlstart(struct brcmf_usbdev_info * devinfo,u8 * fw,int len)975*4882a593Smuzhiyun static int brcmf_usb_dlstart(struct brcmf_usbdev_info *devinfo, u8 *fw, int len)
976*4882a593Smuzhiyun {
977*4882a593Smuzhiyun 	int err;
978*4882a593Smuzhiyun 
979*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
980*4882a593Smuzhiyun 
981*4882a593Smuzhiyun 	if (devinfo == NULL)
982*4882a593Smuzhiyun 		return -EINVAL;
983*4882a593Smuzhiyun 
984*4882a593Smuzhiyun 	if (devinfo->bus_pub.devid == 0xDEAD)
985*4882a593Smuzhiyun 		return -EINVAL;
986*4882a593Smuzhiyun 
987*4882a593Smuzhiyun 	err = brcmf_usb_dl_writeimage(devinfo, fw, len);
988*4882a593Smuzhiyun 	if (err == 0)
989*4882a593Smuzhiyun 		devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DL_DONE;
990*4882a593Smuzhiyun 	else
991*4882a593Smuzhiyun 		devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DL_FAIL;
992*4882a593Smuzhiyun 	brcmf_dbg(USB, "Exit, err=%d\n", err);
993*4882a593Smuzhiyun 
994*4882a593Smuzhiyun 	return err;
995*4882a593Smuzhiyun }
996*4882a593Smuzhiyun 
brcmf_usb_dlrun(struct brcmf_usbdev_info * devinfo)997*4882a593Smuzhiyun static int brcmf_usb_dlrun(struct brcmf_usbdev_info *devinfo)
998*4882a593Smuzhiyun {
999*4882a593Smuzhiyun 	struct rdl_state_le state;
1000*4882a593Smuzhiyun 
1001*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1002*4882a593Smuzhiyun 	if (!devinfo)
1003*4882a593Smuzhiyun 		return -EINVAL;
1004*4882a593Smuzhiyun 
1005*4882a593Smuzhiyun 	if (devinfo->bus_pub.devid == 0xDEAD)
1006*4882a593Smuzhiyun 		return -EINVAL;
1007*4882a593Smuzhiyun 
1008*4882a593Smuzhiyun 	/* Check we are runnable */
1009*4882a593Smuzhiyun 	state.state = 0;
1010*4882a593Smuzhiyun 	brcmf_usb_dl_cmd(devinfo, DL_GETSTATE, &state, sizeof(state));
1011*4882a593Smuzhiyun 
1012*4882a593Smuzhiyun 	/* Start the image */
1013*4882a593Smuzhiyun 	if (state.state == cpu_to_le32(DL_RUNNABLE)) {
1014*4882a593Smuzhiyun 		if (brcmf_usb_dl_cmd(devinfo, DL_GO, &state, sizeof(state)))
1015*4882a593Smuzhiyun 			return -ENODEV;
1016*4882a593Smuzhiyun 		if (brcmf_usb_resetcfg(devinfo))
1017*4882a593Smuzhiyun 			return -ENODEV;
1018*4882a593Smuzhiyun 		/* The Dongle may go for re-enumeration. */
1019*4882a593Smuzhiyun 	} else {
1020*4882a593Smuzhiyun 		brcmf_err("Dongle not runnable\n");
1021*4882a593Smuzhiyun 		return -EINVAL;
1022*4882a593Smuzhiyun 	}
1023*4882a593Smuzhiyun 	brcmf_dbg(USB, "Exit\n");
1024*4882a593Smuzhiyun 	return 0;
1025*4882a593Smuzhiyun }
1026*4882a593Smuzhiyun 
1027*4882a593Smuzhiyun static int
brcmf_usb_fw_download(struct brcmf_usbdev_info * devinfo)1028*4882a593Smuzhiyun brcmf_usb_fw_download(struct brcmf_usbdev_info *devinfo)
1029*4882a593Smuzhiyun {
1030*4882a593Smuzhiyun 	int err;
1031*4882a593Smuzhiyun 	struct usb_interface *intf;
1032*4882a593Smuzhiyun 
1033*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1034*4882a593Smuzhiyun 	if (!devinfo) {
1035*4882a593Smuzhiyun 		err = -ENODEV;
1036*4882a593Smuzhiyun 		goto out;
1037*4882a593Smuzhiyun 	}
1038*4882a593Smuzhiyun 
1039*4882a593Smuzhiyun 	if (!devinfo->image) {
1040*4882a593Smuzhiyun 		brcmf_err("No firmware!\n");
1041*4882a593Smuzhiyun 		err = -ENOENT;
1042*4882a593Smuzhiyun 		goto out;
1043*4882a593Smuzhiyun 	}
1044*4882a593Smuzhiyun 
1045*4882a593Smuzhiyun 	intf = to_usb_interface(devinfo->dev);
1046*4882a593Smuzhiyun 	err = usb_autopm_get_interface(intf);
1047*4882a593Smuzhiyun 	if (err)
1048*4882a593Smuzhiyun 		goto out;
1049*4882a593Smuzhiyun 
1050*4882a593Smuzhiyun 	err = brcmf_usb_dlstart(devinfo,
1051*4882a593Smuzhiyun 		(u8 *)devinfo->image, devinfo->image_len);
1052*4882a593Smuzhiyun 	if (err == 0)
1053*4882a593Smuzhiyun 		err = brcmf_usb_dlrun(devinfo);
1054*4882a593Smuzhiyun 
1055*4882a593Smuzhiyun 	usb_autopm_put_interface(intf);
1056*4882a593Smuzhiyun out:
1057*4882a593Smuzhiyun 	return err;
1058*4882a593Smuzhiyun }
1059*4882a593Smuzhiyun 
1060*4882a593Smuzhiyun 
brcmf_usb_detach(struct brcmf_usbdev_info * devinfo)1061*4882a593Smuzhiyun static void brcmf_usb_detach(struct brcmf_usbdev_info *devinfo)
1062*4882a593Smuzhiyun {
1063*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter, devinfo %p\n", devinfo);
1064*4882a593Smuzhiyun 
1065*4882a593Smuzhiyun 	/* free the URBS */
1066*4882a593Smuzhiyun 	brcmf_usb_free_q(&devinfo->rx_freeq);
1067*4882a593Smuzhiyun 	brcmf_usb_free_q(&devinfo->tx_freeq);
1068*4882a593Smuzhiyun 
1069*4882a593Smuzhiyun 	usb_free_urb(devinfo->ctl_urb);
1070*4882a593Smuzhiyun 	usb_free_urb(devinfo->bulk_urb);
1071*4882a593Smuzhiyun 
1072*4882a593Smuzhiyun 	kfree(devinfo->tx_reqs);
1073*4882a593Smuzhiyun 	kfree(devinfo->rx_reqs);
1074*4882a593Smuzhiyun 
1075*4882a593Smuzhiyun 	if (devinfo->settings)
1076*4882a593Smuzhiyun 		brcmf_release_module_param(devinfo->settings);
1077*4882a593Smuzhiyun }
1078*4882a593Smuzhiyun 
1079*4882a593Smuzhiyun 
check_file(const u8 * headers)1080*4882a593Smuzhiyun static int check_file(const u8 *headers)
1081*4882a593Smuzhiyun {
1082*4882a593Smuzhiyun 	struct trx_header_le *trx;
1083*4882a593Smuzhiyun 	int actual_len = -1;
1084*4882a593Smuzhiyun 
1085*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1086*4882a593Smuzhiyun 	/* Extract trx header */
1087*4882a593Smuzhiyun 	trx = (struct trx_header_le *) headers;
1088*4882a593Smuzhiyun 	if (trx->magic != cpu_to_le32(TRX_MAGIC))
1089*4882a593Smuzhiyun 		return -1;
1090*4882a593Smuzhiyun 
1091*4882a593Smuzhiyun 	headers += sizeof(struct trx_header_le);
1092*4882a593Smuzhiyun 
1093*4882a593Smuzhiyun 	if (le32_to_cpu(trx->flag_version) & TRX_UNCOMP_IMAGE) {
1094*4882a593Smuzhiyun 		actual_len = le32_to_cpu(trx->offsets[TRX_OFFSETS_DLFWLEN_IDX]);
1095*4882a593Smuzhiyun 		return actual_len + sizeof(struct trx_header_le);
1096*4882a593Smuzhiyun 	}
1097*4882a593Smuzhiyun 	return -1;
1098*4882a593Smuzhiyun }
1099*4882a593Smuzhiyun 
1100*4882a593Smuzhiyun 
1101*4882a593Smuzhiyun static
brcmf_usb_attach(struct brcmf_usbdev_info * devinfo,int nrxq,int ntxq)1102*4882a593Smuzhiyun struct brcmf_usbdev *brcmf_usb_attach(struct brcmf_usbdev_info *devinfo,
1103*4882a593Smuzhiyun 				      int nrxq, int ntxq)
1104*4882a593Smuzhiyun {
1105*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1106*4882a593Smuzhiyun 
1107*4882a593Smuzhiyun 	devinfo->bus_pub.nrxq = nrxq;
1108*4882a593Smuzhiyun 	devinfo->rx_low_watermark = nrxq / 2;
1109*4882a593Smuzhiyun 	devinfo->bus_pub.devinfo = devinfo;
1110*4882a593Smuzhiyun 	devinfo->bus_pub.ntxq = ntxq;
1111*4882a593Smuzhiyun 	devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DOWN;
1112*4882a593Smuzhiyun 
1113*4882a593Smuzhiyun 	/* flow control when too many tx urbs posted */
1114*4882a593Smuzhiyun 	devinfo->tx_low_watermark = ntxq / 4;
1115*4882a593Smuzhiyun 	devinfo->tx_high_watermark = devinfo->tx_low_watermark * 3;
1116*4882a593Smuzhiyun 	devinfo->bus_pub.bus_mtu = BRCMF_USB_MAX_PKT_SIZE;
1117*4882a593Smuzhiyun 
1118*4882a593Smuzhiyun 	/* Initialize other structure content */
1119*4882a593Smuzhiyun 	init_waitqueue_head(&devinfo->ioctl_resp_wait);
1120*4882a593Smuzhiyun 
1121*4882a593Smuzhiyun 	/* Initialize the spinlocks */
1122*4882a593Smuzhiyun 	spin_lock_init(&devinfo->qlock);
1123*4882a593Smuzhiyun 	spin_lock_init(&devinfo->tx_flowblock_lock);
1124*4882a593Smuzhiyun 
1125*4882a593Smuzhiyun 	INIT_LIST_HEAD(&devinfo->rx_freeq);
1126*4882a593Smuzhiyun 	INIT_LIST_HEAD(&devinfo->rx_postq);
1127*4882a593Smuzhiyun 
1128*4882a593Smuzhiyun 	INIT_LIST_HEAD(&devinfo->tx_freeq);
1129*4882a593Smuzhiyun 	INIT_LIST_HEAD(&devinfo->tx_postq);
1130*4882a593Smuzhiyun 
1131*4882a593Smuzhiyun 	devinfo->tx_flowblock = false;
1132*4882a593Smuzhiyun 
1133*4882a593Smuzhiyun 	devinfo->rx_reqs = brcmf_usbdev_qinit(&devinfo->rx_freeq, nrxq);
1134*4882a593Smuzhiyun 	if (!devinfo->rx_reqs)
1135*4882a593Smuzhiyun 		goto error;
1136*4882a593Smuzhiyun 
1137*4882a593Smuzhiyun 	devinfo->tx_reqs = brcmf_usbdev_qinit(&devinfo->tx_freeq, ntxq);
1138*4882a593Smuzhiyun 	if (!devinfo->tx_reqs)
1139*4882a593Smuzhiyun 		goto error;
1140*4882a593Smuzhiyun 	devinfo->tx_freecount = ntxq;
1141*4882a593Smuzhiyun 
1142*4882a593Smuzhiyun 	devinfo->ctl_urb = usb_alloc_urb(0, GFP_ATOMIC);
1143*4882a593Smuzhiyun 	if (!devinfo->ctl_urb)
1144*4882a593Smuzhiyun 		goto error;
1145*4882a593Smuzhiyun 	devinfo->bulk_urb = usb_alloc_urb(0, GFP_ATOMIC);
1146*4882a593Smuzhiyun 	if (!devinfo->bulk_urb)
1147*4882a593Smuzhiyun 		goto error;
1148*4882a593Smuzhiyun 
1149*4882a593Smuzhiyun 	return &devinfo->bus_pub;
1150*4882a593Smuzhiyun 
1151*4882a593Smuzhiyun error:
1152*4882a593Smuzhiyun 	brcmf_err("failed!\n");
1153*4882a593Smuzhiyun 	brcmf_usb_detach(devinfo);
1154*4882a593Smuzhiyun 	return NULL;
1155*4882a593Smuzhiyun }
1156*4882a593Smuzhiyun 
1157*4882a593Smuzhiyun static
brcmf_usb_get_fwname(struct device * dev,const char * ext,u8 * fw_name)1158*4882a593Smuzhiyun int brcmf_usb_get_fwname(struct device *dev, const char *ext, u8 *fw_name)
1159*4882a593Smuzhiyun {
1160*4882a593Smuzhiyun 	struct brcmf_bus *bus = dev_get_drvdata(dev);
1161*4882a593Smuzhiyun 	struct brcmf_fw_request *fwreq;
1162*4882a593Smuzhiyun 	struct brcmf_fw_name fwnames[] = {
1163*4882a593Smuzhiyun 		{ ext, fw_name },
1164*4882a593Smuzhiyun 	};
1165*4882a593Smuzhiyun 
1166*4882a593Smuzhiyun 	fwreq = brcmf_fw_alloc_request(bus->chip, bus->chiprev,
1167*4882a593Smuzhiyun 				       brcmf_usb_fwnames,
1168*4882a593Smuzhiyun 				       ARRAY_SIZE(brcmf_usb_fwnames),
1169*4882a593Smuzhiyun 				       fwnames, ARRAY_SIZE(fwnames));
1170*4882a593Smuzhiyun 	if (!fwreq)
1171*4882a593Smuzhiyun 		return -ENOMEM;
1172*4882a593Smuzhiyun 
1173*4882a593Smuzhiyun 	kfree(fwreq);
1174*4882a593Smuzhiyun 	return 0;
1175*4882a593Smuzhiyun }
1176*4882a593Smuzhiyun 
1177*4882a593Smuzhiyun static const struct brcmf_bus_ops brcmf_usb_bus_ops = {
1178*4882a593Smuzhiyun 	.preinit = brcmf_usb_up,
1179*4882a593Smuzhiyun 	.stop = brcmf_usb_down,
1180*4882a593Smuzhiyun 	.txdata = brcmf_usb_tx,
1181*4882a593Smuzhiyun 	.txctl = brcmf_usb_tx_ctlpkt,
1182*4882a593Smuzhiyun 	.rxctl = brcmf_usb_rx_ctlpkt,
1183*4882a593Smuzhiyun 	.get_fwname = brcmf_usb_get_fwname,
1184*4882a593Smuzhiyun };
1185*4882a593Smuzhiyun 
1186*4882a593Smuzhiyun #define BRCMF_USB_FW_CODE	0
1187*4882a593Smuzhiyun 
brcmf_usb_probe_phase2(struct device * dev,int ret,struct brcmf_fw_request * fwreq)1188*4882a593Smuzhiyun static void brcmf_usb_probe_phase2(struct device *dev, int ret,
1189*4882a593Smuzhiyun 				   struct brcmf_fw_request *fwreq)
1190*4882a593Smuzhiyun {
1191*4882a593Smuzhiyun 	struct brcmf_bus *bus = dev_get_drvdata(dev);
1192*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = bus->bus_priv.usb->devinfo;
1193*4882a593Smuzhiyun 	const struct firmware *fw;
1194*4882a593Smuzhiyun 
1195*4882a593Smuzhiyun 	if (ret)
1196*4882a593Smuzhiyun 		goto error;
1197*4882a593Smuzhiyun 
1198*4882a593Smuzhiyun 	brcmf_dbg(USB, "Start fw downloading\n");
1199*4882a593Smuzhiyun 
1200*4882a593Smuzhiyun 	fw = fwreq->items[BRCMF_USB_FW_CODE].binary;
1201*4882a593Smuzhiyun 	kfree(fwreq);
1202*4882a593Smuzhiyun 
1203*4882a593Smuzhiyun 	ret = check_file(fw->data);
1204*4882a593Smuzhiyun 	if (ret < 0) {
1205*4882a593Smuzhiyun 		brcmf_err("invalid firmware\n");
1206*4882a593Smuzhiyun 		release_firmware(fw);
1207*4882a593Smuzhiyun 		goto error;
1208*4882a593Smuzhiyun 	}
1209*4882a593Smuzhiyun 
1210*4882a593Smuzhiyun 	devinfo->image = fw->data;
1211*4882a593Smuzhiyun 	devinfo->image_len = fw->size;
1212*4882a593Smuzhiyun 
1213*4882a593Smuzhiyun 	ret = brcmf_usb_fw_download(devinfo);
1214*4882a593Smuzhiyun 	release_firmware(fw);
1215*4882a593Smuzhiyun 	if (ret)
1216*4882a593Smuzhiyun 		goto error;
1217*4882a593Smuzhiyun 
1218*4882a593Smuzhiyun 	ret = brcmf_alloc(devinfo->dev, devinfo->settings);
1219*4882a593Smuzhiyun 	if (ret)
1220*4882a593Smuzhiyun 		goto error;
1221*4882a593Smuzhiyun 
1222*4882a593Smuzhiyun 	/* Attach to the common driver interface */
1223*4882a593Smuzhiyun 	ret = brcmf_attach(devinfo->dev);
1224*4882a593Smuzhiyun 	if (ret)
1225*4882a593Smuzhiyun 		goto error;
1226*4882a593Smuzhiyun 
1227*4882a593Smuzhiyun 	complete(&devinfo->dev_init_done);
1228*4882a593Smuzhiyun 	return;
1229*4882a593Smuzhiyun error:
1230*4882a593Smuzhiyun 	brcmf_dbg(TRACE, "failed: dev=%s, err=%d\n", dev_name(dev), ret);
1231*4882a593Smuzhiyun 	complete(&devinfo->dev_init_done);
1232*4882a593Smuzhiyun 	device_release_driver(dev);
1233*4882a593Smuzhiyun }
1234*4882a593Smuzhiyun 
1235*4882a593Smuzhiyun static struct brcmf_fw_request *
brcmf_usb_prepare_fw_request(struct brcmf_usbdev_info * devinfo)1236*4882a593Smuzhiyun brcmf_usb_prepare_fw_request(struct brcmf_usbdev_info *devinfo)
1237*4882a593Smuzhiyun {
1238*4882a593Smuzhiyun 	struct brcmf_fw_request *fwreq;
1239*4882a593Smuzhiyun 	struct brcmf_fw_name fwnames[] = {
1240*4882a593Smuzhiyun 		{ ".bin", devinfo->fw_name },
1241*4882a593Smuzhiyun 	};
1242*4882a593Smuzhiyun 
1243*4882a593Smuzhiyun 	fwreq = brcmf_fw_alloc_request(devinfo->bus_pub.devid,
1244*4882a593Smuzhiyun 				       devinfo->bus_pub.chiprev,
1245*4882a593Smuzhiyun 				       brcmf_usb_fwnames,
1246*4882a593Smuzhiyun 				       ARRAY_SIZE(brcmf_usb_fwnames),
1247*4882a593Smuzhiyun 				       fwnames, ARRAY_SIZE(fwnames));
1248*4882a593Smuzhiyun 	if (!fwreq)
1249*4882a593Smuzhiyun 		return NULL;
1250*4882a593Smuzhiyun 
1251*4882a593Smuzhiyun 	fwreq->items[BRCMF_USB_FW_CODE].type = BRCMF_FW_TYPE_BINARY;
1252*4882a593Smuzhiyun 
1253*4882a593Smuzhiyun 	return fwreq;
1254*4882a593Smuzhiyun }
1255*4882a593Smuzhiyun 
brcmf_usb_probe_cb(struct brcmf_usbdev_info * devinfo)1256*4882a593Smuzhiyun static int brcmf_usb_probe_cb(struct brcmf_usbdev_info *devinfo)
1257*4882a593Smuzhiyun {
1258*4882a593Smuzhiyun 	struct brcmf_bus *bus = NULL;
1259*4882a593Smuzhiyun 	struct brcmf_usbdev *bus_pub = NULL;
1260*4882a593Smuzhiyun 	struct device *dev = devinfo->dev;
1261*4882a593Smuzhiyun 	struct brcmf_fw_request *fwreq;
1262*4882a593Smuzhiyun 	int ret;
1263*4882a593Smuzhiyun 
1264*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1265*4882a593Smuzhiyun 	bus_pub = brcmf_usb_attach(devinfo, BRCMF_USB_NRXQ, BRCMF_USB_NTXQ);
1266*4882a593Smuzhiyun 	if (!bus_pub)
1267*4882a593Smuzhiyun 		return -ENODEV;
1268*4882a593Smuzhiyun 
1269*4882a593Smuzhiyun 	bus = kzalloc(sizeof(struct brcmf_bus), GFP_ATOMIC);
1270*4882a593Smuzhiyun 	if (!bus) {
1271*4882a593Smuzhiyun 		ret = -ENOMEM;
1272*4882a593Smuzhiyun 		goto fail;
1273*4882a593Smuzhiyun 	}
1274*4882a593Smuzhiyun 
1275*4882a593Smuzhiyun 	bus->dev = dev;
1276*4882a593Smuzhiyun 	bus_pub->bus = bus;
1277*4882a593Smuzhiyun 	bus->bus_priv.usb = bus_pub;
1278*4882a593Smuzhiyun 	dev_set_drvdata(dev, bus);
1279*4882a593Smuzhiyun 	bus->ops = &brcmf_usb_bus_ops;
1280*4882a593Smuzhiyun 	bus->proto_type = BRCMF_PROTO_BCDC;
1281*4882a593Smuzhiyun 	bus->always_use_fws_queue = true;
1282*4882a593Smuzhiyun #ifdef CONFIG_PM
1283*4882a593Smuzhiyun 	bus->wowl_supported = true;
1284*4882a593Smuzhiyun #endif
1285*4882a593Smuzhiyun 
1286*4882a593Smuzhiyun 	devinfo->settings = brcmf_get_module_param(bus->dev, BRCMF_BUSTYPE_USB,
1287*4882a593Smuzhiyun 						   bus_pub->devid,
1288*4882a593Smuzhiyun 						   bus_pub->chiprev);
1289*4882a593Smuzhiyun 	if (!devinfo->settings) {
1290*4882a593Smuzhiyun 		ret = -ENOMEM;
1291*4882a593Smuzhiyun 		goto fail;
1292*4882a593Smuzhiyun 	}
1293*4882a593Smuzhiyun 
1294*4882a593Smuzhiyun 	if (!brcmf_usb_dlneeded(devinfo)) {
1295*4882a593Smuzhiyun 		ret = brcmf_alloc(devinfo->dev, devinfo->settings);
1296*4882a593Smuzhiyun 		if (ret)
1297*4882a593Smuzhiyun 			goto fail;
1298*4882a593Smuzhiyun 		ret = brcmf_attach(devinfo->dev);
1299*4882a593Smuzhiyun 		if (ret)
1300*4882a593Smuzhiyun 			goto fail;
1301*4882a593Smuzhiyun 		/* we are done */
1302*4882a593Smuzhiyun 		complete(&devinfo->dev_init_done);
1303*4882a593Smuzhiyun 		return 0;
1304*4882a593Smuzhiyun 	}
1305*4882a593Smuzhiyun 	bus->chip = bus_pub->devid;
1306*4882a593Smuzhiyun 	bus->chiprev = bus_pub->chiprev;
1307*4882a593Smuzhiyun 
1308*4882a593Smuzhiyun 	fwreq = brcmf_usb_prepare_fw_request(devinfo);
1309*4882a593Smuzhiyun 	if (!fwreq) {
1310*4882a593Smuzhiyun 		ret = -ENOMEM;
1311*4882a593Smuzhiyun 		goto fail;
1312*4882a593Smuzhiyun 	}
1313*4882a593Smuzhiyun 
1314*4882a593Smuzhiyun 	/* request firmware here */
1315*4882a593Smuzhiyun 	ret = brcmf_fw_get_firmwares(dev, fwreq, brcmf_usb_probe_phase2);
1316*4882a593Smuzhiyun 	if (ret) {
1317*4882a593Smuzhiyun 		brcmf_err("firmware request failed: %d\n", ret);
1318*4882a593Smuzhiyun 		kfree(fwreq);
1319*4882a593Smuzhiyun 		goto fail;
1320*4882a593Smuzhiyun 	}
1321*4882a593Smuzhiyun 
1322*4882a593Smuzhiyun 	return 0;
1323*4882a593Smuzhiyun 
1324*4882a593Smuzhiyun fail:
1325*4882a593Smuzhiyun 	/* Release resources in reverse order */
1326*4882a593Smuzhiyun 	brcmf_free(devinfo->dev);
1327*4882a593Smuzhiyun 	kfree(bus);
1328*4882a593Smuzhiyun 	brcmf_usb_detach(devinfo);
1329*4882a593Smuzhiyun 	return ret;
1330*4882a593Smuzhiyun }
1331*4882a593Smuzhiyun 
1332*4882a593Smuzhiyun static void
brcmf_usb_disconnect_cb(struct brcmf_usbdev_info * devinfo)1333*4882a593Smuzhiyun brcmf_usb_disconnect_cb(struct brcmf_usbdev_info *devinfo)
1334*4882a593Smuzhiyun {
1335*4882a593Smuzhiyun 	if (!devinfo)
1336*4882a593Smuzhiyun 		return;
1337*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter, bus_pub %p\n", devinfo);
1338*4882a593Smuzhiyun 
1339*4882a593Smuzhiyun 	brcmf_detach(devinfo->dev);
1340*4882a593Smuzhiyun 	brcmf_free(devinfo->dev);
1341*4882a593Smuzhiyun 	kfree(devinfo->bus_pub.bus);
1342*4882a593Smuzhiyun 	brcmf_usb_detach(devinfo);
1343*4882a593Smuzhiyun }
1344*4882a593Smuzhiyun 
1345*4882a593Smuzhiyun static int
brcmf_usb_probe(struct usb_interface * intf,const struct usb_device_id * id)1346*4882a593Smuzhiyun brcmf_usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
1347*4882a593Smuzhiyun {
1348*4882a593Smuzhiyun 	struct usb_device *usb = interface_to_usbdev(intf);
1349*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo;
1350*4882a593Smuzhiyun 	struct usb_interface_descriptor	*desc;
1351*4882a593Smuzhiyun 	struct usb_endpoint_descriptor *endpoint;
1352*4882a593Smuzhiyun 	int ret = 0;
1353*4882a593Smuzhiyun 	u32 num_of_eps;
1354*4882a593Smuzhiyun 	u8 endpoint_num, ep;
1355*4882a593Smuzhiyun 
1356*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter 0x%04x:0x%04x\n", id->idVendor, id->idProduct);
1357*4882a593Smuzhiyun 
1358*4882a593Smuzhiyun 	devinfo = kzalloc(sizeof(*devinfo), GFP_ATOMIC);
1359*4882a593Smuzhiyun 	if (devinfo == NULL)
1360*4882a593Smuzhiyun 		return -ENOMEM;
1361*4882a593Smuzhiyun 
1362*4882a593Smuzhiyun 	devinfo->usbdev = usb;
1363*4882a593Smuzhiyun 	devinfo->dev = &usb->dev;
1364*4882a593Smuzhiyun 	/* Init completion, to protect for disconnect while still loading.
1365*4882a593Smuzhiyun 	 * Necessary because of the asynchronous firmware load construction
1366*4882a593Smuzhiyun 	 */
1367*4882a593Smuzhiyun 	init_completion(&devinfo->dev_init_done);
1368*4882a593Smuzhiyun 
1369*4882a593Smuzhiyun 	usb_set_intfdata(intf, devinfo);
1370*4882a593Smuzhiyun 
1371*4882a593Smuzhiyun 	intf->needs_remote_wakeup = 1;
1372*4882a593Smuzhiyun 
1373*4882a593Smuzhiyun 	/* Check that the device supports only one configuration */
1374*4882a593Smuzhiyun 	if (usb->descriptor.bNumConfigurations != 1) {
1375*4882a593Smuzhiyun 		brcmf_err("Number of configurations: %d not supported\n",
1376*4882a593Smuzhiyun 			  usb->descriptor.bNumConfigurations);
1377*4882a593Smuzhiyun 		ret = -ENODEV;
1378*4882a593Smuzhiyun 		goto fail;
1379*4882a593Smuzhiyun 	}
1380*4882a593Smuzhiyun 
1381*4882a593Smuzhiyun 	if ((usb->descriptor.bDeviceClass != USB_CLASS_VENDOR_SPEC) &&
1382*4882a593Smuzhiyun 	    (usb->descriptor.bDeviceClass != USB_CLASS_MISC) &&
1383*4882a593Smuzhiyun 	    (usb->descriptor.bDeviceClass != USB_CLASS_WIRELESS_CONTROLLER)) {
1384*4882a593Smuzhiyun 		brcmf_err("Device class: 0x%x not supported\n",
1385*4882a593Smuzhiyun 			  usb->descriptor.bDeviceClass);
1386*4882a593Smuzhiyun 		ret = -ENODEV;
1387*4882a593Smuzhiyun 		goto fail;
1388*4882a593Smuzhiyun 	}
1389*4882a593Smuzhiyun 
1390*4882a593Smuzhiyun 	desc = &intf->cur_altsetting->desc;
1391*4882a593Smuzhiyun 	if ((desc->bInterfaceClass != USB_CLASS_VENDOR_SPEC) ||
1392*4882a593Smuzhiyun 	    (desc->bInterfaceSubClass != 2) ||
1393*4882a593Smuzhiyun 	    (desc->bInterfaceProtocol != 0xff)) {
1394*4882a593Smuzhiyun 		brcmf_err("non WLAN interface %d: 0x%x:0x%x:0x%x\n",
1395*4882a593Smuzhiyun 			  desc->bInterfaceNumber, desc->bInterfaceClass,
1396*4882a593Smuzhiyun 			  desc->bInterfaceSubClass, desc->bInterfaceProtocol);
1397*4882a593Smuzhiyun 		ret = -ENODEV;
1398*4882a593Smuzhiyun 		goto fail;
1399*4882a593Smuzhiyun 	}
1400*4882a593Smuzhiyun 
1401*4882a593Smuzhiyun 	num_of_eps = desc->bNumEndpoints;
1402*4882a593Smuzhiyun 	for (ep = 0; ep < num_of_eps; ep++) {
1403*4882a593Smuzhiyun 		endpoint = &intf->cur_altsetting->endpoint[ep].desc;
1404*4882a593Smuzhiyun 		endpoint_num = usb_endpoint_num(endpoint);
1405*4882a593Smuzhiyun 		if (!usb_endpoint_xfer_bulk(endpoint))
1406*4882a593Smuzhiyun 			continue;
1407*4882a593Smuzhiyun 		if (usb_endpoint_dir_in(endpoint)) {
1408*4882a593Smuzhiyun 			if (!devinfo->rx_pipe)
1409*4882a593Smuzhiyun 				devinfo->rx_pipe =
1410*4882a593Smuzhiyun 					usb_rcvbulkpipe(usb, endpoint_num);
1411*4882a593Smuzhiyun 		} else {
1412*4882a593Smuzhiyun 			if (!devinfo->tx_pipe)
1413*4882a593Smuzhiyun 				devinfo->tx_pipe =
1414*4882a593Smuzhiyun 					usb_sndbulkpipe(usb, endpoint_num);
1415*4882a593Smuzhiyun 		}
1416*4882a593Smuzhiyun 	}
1417*4882a593Smuzhiyun 	if (devinfo->rx_pipe == 0) {
1418*4882a593Smuzhiyun 		brcmf_err("No RX (in) Bulk EP found\n");
1419*4882a593Smuzhiyun 		ret = -ENODEV;
1420*4882a593Smuzhiyun 		goto fail;
1421*4882a593Smuzhiyun 	}
1422*4882a593Smuzhiyun 	if (devinfo->tx_pipe == 0) {
1423*4882a593Smuzhiyun 		brcmf_err("No TX (out) Bulk EP found\n");
1424*4882a593Smuzhiyun 		ret = -ENODEV;
1425*4882a593Smuzhiyun 		goto fail;
1426*4882a593Smuzhiyun 	}
1427*4882a593Smuzhiyun 
1428*4882a593Smuzhiyun 	devinfo->ifnum = desc->bInterfaceNumber;
1429*4882a593Smuzhiyun 
1430*4882a593Smuzhiyun 	if (usb->speed == USB_SPEED_SUPER_PLUS)
1431*4882a593Smuzhiyun 		brcmf_dbg(USB, "Broadcom super speed plus USB WLAN interface detected\n");
1432*4882a593Smuzhiyun 	else if (usb->speed == USB_SPEED_SUPER)
1433*4882a593Smuzhiyun 		brcmf_dbg(USB, "Broadcom super speed USB WLAN interface detected\n");
1434*4882a593Smuzhiyun 	else if (usb->speed == USB_SPEED_HIGH)
1435*4882a593Smuzhiyun 		brcmf_dbg(USB, "Broadcom high speed USB WLAN interface detected\n");
1436*4882a593Smuzhiyun 	else
1437*4882a593Smuzhiyun 		brcmf_dbg(USB, "Broadcom full speed USB WLAN interface detected\n");
1438*4882a593Smuzhiyun 
1439*4882a593Smuzhiyun 	ret = brcmf_usb_probe_cb(devinfo);
1440*4882a593Smuzhiyun 	if (ret)
1441*4882a593Smuzhiyun 		goto fail;
1442*4882a593Smuzhiyun 
1443*4882a593Smuzhiyun 	/* Success */
1444*4882a593Smuzhiyun 	return 0;
1445*4882a593Smuzhiyun 
1446*4882a593Smuzhiyun fail:
1447*4882a593Smuzhiyun 	complete(&devinfo->dev_init_done);
1448*4882a593Smuzhiyun 	kfree(devinfo);
1449*4882a593Smuzhiyun 	usb_set_intfdata(intf, NULL);
1450*4882a593Smuzhiyun 	return ret;
1451*4882a593Smuzhiyun }
1452*4882a593Smuzhiyun 
1453*4882a593Smuzhiyun static void
brcmf_usb_disconnect(struct usb_interface * intf)1454*4882a593Smuzhiyun brcmf_usb_disconnect(struct usb_interface *intf)
1455*4882a593Smuzhiyun {
1456*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo;
1457*4882a593Smuzhiyun 
1458*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1459*4882a593Smuzhiyun 	devinfo = (struct brcmf_usbdev_info *)usb_get_intfdata(intf);
1460*4882a593Smuzhiyun 
1461*4882a593Smuzhiyun 	if (devinfo) {
1462*4882a593Smuzhiyun 		wait_for_completion(&devinfo->dev_init_done);
1463*4882a593Smuzhiyun 		/* Make sure that devinfo still exists. Firmware probe routines
1464*4882a593Smuzhiyun 		 * may have released the device and cleared the intfdata.
1465*4882a593Smuzhiyun 		 */
1466*4882a593Smuzhiyun 		if (!usb_get_intfdata(intf))
1467*4882a593Smuzhiyun 			goto done;
1468*4882a593Smuzhiyun 
1469*4882a593Smuzhiyun 		brcmf_usb_disconnect_cb(devinfo);
1470*4882a593Smuzhiyun 		kfree(devinfo);
1471*4882a593Smuzhiyun 	}
1472*4882a593Smuzhiyun done:
1473*4882a593Smuzhiyun 	brcmf_dbg(USB, "Exit\n");
1474*4882a593Smuzhiyun }
1475*4882a593Smuzhiyun 
1476*4882a593Smuzhiyun /*
1477*4882a593Smuzhiyun  * only need to signal the bus being down and update the state.
1478*4882a593Smuzhiyun  */
brcmf_usb_suspend(struct usb_interface * intf,pm_message_t state)1479*4882a593Smuzhiyun static int brcmf_usb_suspend(struct usb_interface *intf, pm_message_t state)
1480*4882a593Smuzhiyun {
1481*4882a593Smuzhiyun 	struct usb_device *usb = interface_to_usbdev(intf);
1482*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
1483*4882a593Smuzhiyun 
1484*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1485*4882a593Smuzhiyun 	devinfo->bus_pub.state = BRCMFMAC_USB_STATE_SLEEP;
1486*4882a593Smuzhiyun 	brcmf_cancel_all_urbs(devinfo);
1487*4882a593Smuzhiyun 	device_set_wakeup_enable(devinfo->dev, true);
1488*4882a593Smuzhiyun 	return 0;
1489*4882a593Smuzhiyun }
1490*4882a593Smuzhiyun 
1491*4882a593Smuzhiyun /*
1492*4882a593Smuzhiyun  * (re-) start the bus.
1493*4882a593Smuzhiyun  */
brcmf_usb_resume(struct usb_interface * intf)1494*4882a593Smuzhiyun static int brcmf_usb_resume(struct usb_interface *intf)
1495*4882a593Smuzhiyun {
1496*4882a593Smuzhiyun 	struct usb_device *usb = interface_to_usbdev(intf);
1497*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
1498*4882a593Smuzhiyun 
1499*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1500*4882a593Smuzhiyun 
1501*4882a593Smuzhiyun 	devinfo->bus_pub.state = BRCMFMAC_USB_STATE_UP;
1502*4882a593Smuzhiyun 	brcmf_usb_rx_fill_all(devinfo);
1503*4882a593Smuzhiyun 	device_set_wakeup_enable(devinfo->dev, false);
1504*4882a593Smuzhiyun 	return 0;
1505*4882a593Smuzhiyun }
1506*4882a593Smuzhiyun 
brcmf_usb_reset_resume(struct usb_interface * intf)1507*4882a593Smuzhiyun static int brcmf_usb_reset_resume(struct usb_interface *intf)
1508*4882a593Smuzhiyun {
1509*4882a593Smuzhiyun 	struct usb_device *usb = interface_to_usbdev(intf);
1510*4882a593Smuzhiyun 	struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
1511*4882a593Smuzhiyun 	struct brcmf_fw_request *fwreq;
1512*4882a593Smuzhiyun 	int ret;
1513*4882a593Smuzhiyun 
1514*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1515*4882a593Smuzhiyun 
1516*4882a593Smuzhiyun 	fwreq = brcmf_usb_prepare_fw_request(devinfo);
1517*4882a593Smuzhiyun 	if (!fwreq)
1518*4882a593Smuzhiyun 		return -ENOMEM;
1519*4882a593Smuzhiyun 
1520*4882a593Smuzhiyun 	ret = brcmf_fw_get_firmwares(&usb->dev, fwreq, brcmf_usb_probe_phase2);
1521*4882a593Smuzhiyun 	if (ret < 0)
1522*4882a593Smuzhiyun 		kfree(fwreq);
1523*4882a593Smuzhiyun 
1524*4882a593Smuzhiyun 	return ret;
1525*4882a593Smuzhiyun }
1526*4882a593Smuzhiyun 
1527*4882a593Smuzhiyun #define BRCMF_USB_DEVICE(dev_id)	\
1528*4882a593Smuzhiyun 	{ USB_DEVICE(BRCM_USB_VENDOR_ID_BROADCOM, dev_id) }
1529*4882a593Smuzhiyun 
1530*4882a593Smuzhiyun #define LINKSYS_USB_DEVICE(dev_id)	\
1531*4882a593Smuzhiyun 	{ USB_DEVICE(BRCM_USB_VENDOR_ID_LINKSYS, dev_id) }
1532*4882a593Smuzhiyun 
1533*4882a593Smuzhiyun #define CYPRESS_USB_DEVICE(dev_id)	\
1534*4882a593Smuzhiyun 	{ USB_DEVICE(CY_USB_VENDOR_ID_CYPRESS, dev_id) }
1535*4882a593Smuzhiyun 
1536*4882a593Smuzhiyun static const struct usb_device_id brcmf_usb_devid_table[] = {
1537*4882a593Smuzhiyun 	BRCMF_USB_DEVICE(BRCM_USB_43143_DEVICE_ID),
1538*4882a593Smuzhiyun 	BRCMF_USB_DEVICE(BRCM_USB_43236_DEVICE_ID),
1539*4882a593Smuzhiyun 	BRCMF_USB_DEVICE(BRCM_USB_43242_DEVICE_ID),
1540*4882a593Smuzhiyun 	BRCMF_USB_DEVICE(BRCM_USB_43569_DEVICE_ID),
1541*4882a593Smuzhiyun 	LINKSYS_USB_DEVICE(BRCM_USB_43235_LINKSYS_DEVICE_ID),
1542*4882a593Smuzhiyun 	CYPRESS_USB_DEVICE(CY_USB_4373_DEVICE_ID),
1543*4882a593Smuzhiyun 	{ USB_DEVICE(BRCM_USB_VENDOR_ID_LG, BRCM_USB_43242_LG_DEVICE_ID) },
1544*4882a593Smuzhiyun 	/* special entry for device with firmware loaded and running */
1545*4882a593Smuzhiyun 	BRCMF_USB_DEVICE(BRCM_USB_BCMFW_DEVICE_ID),
1546*4882a593Smuzhiyun 	CYPRESS_USB_DEVICE(BRCM_USB_BCMFW_DEVICE_ID),
1547*4882a593Smuzhiyun 	{ /* end: all zeroes */ }
1548*4882a593Smuzhiyun };
1549*4882a593Smuzhiyun 
1550*4882a593Smuzhiyun MODULE_DEVICE_TABLE(usb, brcmf_usb_devid_table);
1551*4882a593Smuzhiyun 
1552*4882a593Smuzhiyun static struct usb_driver brcmf_usbdrvr = {
1553*4882a593Smuzhiyun 	.name = KBUILD_MODNAME,
1554*4882a593Smuzhiyun 	.probe = brcmf_usb_probe,
1555*4882a593Smuzhiyun 	.disconnect = brcmf_usb_disconnect,
1556*4882a593Smuzhiyun 	.id_table = brcmf_usb_devid_table,
1557*4882a593Smuzhiyun 	.suspend = brcmf_usb_suspend,
1558*4882a593Smuzhiyun 	.resume = brcmf_usb_resume,
1559*4882a593Smuzhiyun 	.reset_resume = brcmf_usb_reset_resume,
1560*4882a593Smuzhiyun 	.supports_autosuspend = true,
1561*4882a593Smuzhiyun 	.disable_hub_initiated_lpm = 1,
1562*4882a593Smuzhiyun };
1563*4882a593Smuzhiyun 
brcmf_usb_reset_device(struct device * dev,void * notused)1564*4882a593Smuzhiyun static int brcmf_usb_reset_device(struct device *dev, void *notused)
1565*4882a593Smuzhiyun {
1566*4882a593Smuzhiyun 	/* device past is the usb interface so we
1567*4882a593Smuzhiyun 	 * need to use parent here.
1568*4882a593Smuzhiyun 	 */
1569*4882a593Smuzhiyun 	brcmf_dev_reset(dev->parent);
1570*4882a593Smuzhiyun 	return 0;
1571*4882a593Smuzhiyun }
1572*4882a593Smuzhiyun 
brcmf_usb_exit(void)1573*4882a593Smuzhiyun void brcmf_usb_exit(void)
1574*4882a593Smuzhiyun {
1575*4882a593Smuzhiyun 	struct device_driver *drv = &brcmf_usbdrvr.drvwrap.driver;
1576*4882a593Smuzhiyun 	int ret;
1577*4882a593Smuzhiyun 
1578*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1579*4882a593Smuzhiyun 	ret = driver_for_each_device(drv, NULL, NULL,
1580*4882a593Smuzhiyun 				     brcmf_usb_reset_device);
1581*4882a593Smuzhiyun 	if (ret)
1582*4882a593Smuzhiyun 		brcmf_err("failed to reset all usb devices %d\n", ret);
1583*4882a593Smuzhiyun 
1584*4882a593Smuzhiyun 	usb_deregister(&brcmf_usbdrvr);
1585*4882a593Smuzhiyun }
1586*4882a593Smuzhiyun 
brcmf_usb_register(void)1587*4882a593Smuzhiyun int brcmf_usb_register(void)
1588*4882a593Smuzhiyun {
1589*4882a593Smuzhiyun 	brcmf_dbg(USB, "Enter\n");
1590*4882a593Smuzhiyun 	return usb_register(&brcmf_usbdrvr);
1591*4882a593Smuzhiyun }
1592