1 /******************************************************************************
2  *
3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms of version 2 of the GNU General Public License as
7  * published by the Free Software Foundation.
8  *
9  * This program is distributed in the hope that it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12  * more details.
13  *
14  ******************************************************************************/
15 #define _HCI_INTF_C_
16 
17 #include <osdep_service.h>
18 #include <drv_types.h>
19 #include <recv_osdep.h>
20 #include <xmit_osdep.h>
21 #include <hal_intf.h>
22 #include <rtw_version.h>
23 #include <osdep_intf.h>
24 #include <usb_ops.h>
25 #include <rtl8723a_hal.h>
26 
27 static int rtw_suspend(struct usb_interface *intf, pm_message_t message);
28 static int rtw_resume(struct usb_interface *intf);
29 static int rtw_drv_init(struct usb_interface *pusb_intf,
30 			const struct usb_device_id *pdid);
31 static void rtw_disconnect(struct usb_interface *pusb_intf);
32 
33 #define USB_VENDER_ID_REALTEK		0x0BDA
34 
35 #define RTL8723A_USB_IDS \
36 	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x8724,	\
37 	 0xff, 0xff, 0xff)}, /* 8723AU 1*1 */ \
38 	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x1724,	\
39 	 0xff, 0xff, 0xff)}, /* 8723AU 1*1 */ \
40 	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x0724,	\
41 	 0xff, 0xff, 0xff)}, /* 8723AU 1*1 */
42 
43 static struct usb_device_id rtl8723a_usb_id_tbl[] = {
44 	RTL8723A_USB_IDS
45 	{}	/* Terminating entry */
46 };
47 
48 MODULE_DEVICE_TABLE(usb, rtl8723a_usb_id_tbl);
49 
50 static struct usb_driver rtl8723a_usb_drv = {
51 	.name = (char *)"rtl8723au",
52 	.probe = rtw_drv_init,
53 	.disconnect = rtw_disconnect,
54 	.id_table = rtl8723a_usb_id_tbl,
55 	.suspend = rtw_suspend,
56 	.resume = rtw_resume,
57 	.reset_resume  = rtw_resume,
58 };
59 
60 static struct usb_driver *usb_drv = &rtl8723a_usb_drv;
61 
rtw_init_intf_priv(struct dvobj_priv * dvobj)62 static int rtw_init_intf_priv(struct dvobj_priv *dvobj)
63 {
64 	mutex_init(&dvobj->usb_vendor_req_mutex);
65 
66 	return _SUCCESS;
67 }
68 
rtw_deinit_intf_priv(struct dvobj_priv * dvobj)69 static int rtw_deinit_intf_priv(struct dvobj_priv *dvobj)
70 {
71 	mutex_destroy(&dvobj->usb_vendor_req_mutex);
72 
73 	return _SUCCESS;
74 }
75 
usb_dvobj_init(struct usb_interface * usb_intf)76 static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf)
77 {
78 	struct dvobj_priv *pdvobjpriv;
79 	struct usb_host_config	 *phost_conf;
80 	struct usb_config_descriptor *pconf_desc;
81 	struct usb_host_interface *phost_iface;
82 	struct usb_interface_descriptor *piface_desc;
83 	struct usb_endpoint_descriptor *pendp_desc;
84 	struct usb_device *pusbd;
85 	int i, status = _FAIL;
86 
87 	pdvobjpriv = kzalloc(sizeof(*pdvobjpriv), GFP_KERNEL);
88 	if (!pdvobjpriv)
89 		goto exit;
90 
91 	mutex_init(&pdvobjpriv->hw_init_mutex);
92 	mutex_init(&pdvobjpriv->h2c_fwcmd_mutex);
93 	mutex_init(&pdvobjpriv->setch_mutex);
94 	mutex_init(&pdvobjpriv->setbw_mutex);
95 
96 	pdvobjpriv->pusbintf = usb_intf;
97 	pusbd = interface_to_usbdev(usb_intf);
98 	pdvobjpriv->pusbdev = pusbd;
99 	usb_set_intfdata(usb_intf, pdvobjpriv);
100 
101 	pdvobjpriv->RtNumInPipes = 0;
102 	pdvobjpriv->RtNumOutPipes = 0;
103 
104 	phost_conf = pusbd->actconfig;
105 	pconf_desc = &phost_conf->desc;
106 
107 	phost_iface = &usb_intf->altsetting[0];
108 	piface_desc = &phost_iface->desc;
109 
110 	pdvobjpriv->NumInterfaces = pconf_desc->bNumInterfaces;
111 	pdvobjpriv->InterfaceNumber = piface_desc->bInterfaceNumber;
112 	pdvobjpriv->nr_endpoint = piface_desc->bNumEndpoints;
113 
114 	for (i = 0; i < pdvobjpriv->nr_endpoint; i++) {
115 		pendp_desc = &phost_iface->endpoint[i].desc;
116 
117 		DBG_8723A("\nusb_endpoint_descriptor(%d):\n", i);
118 		DBG_8723A("bLength =%x\n", pendp_desc->bLength);
119 		DBG_8723A("bDescriptorType =%x\n", pendp_desc->bDescriptorType);
120 		DBG_8723A("bEndpointAddress =%x\n",
121 			  pendp_desc->bEndpointAddress);
122 		DBG_8723A("wMaxPacketSize =%d\n",
123 			  le16_to_cpu(pendp_desc->wMaxPacketSize));
124 		DBG_8723A("bInterval =%x\n", pendp_desc->bInterval);
125 
126 		if (usb_endpoint_is_bulk_in(pendp_desc)) {
127 			DBG_8723A("usb_endpoint_is_bulk_in = %x\n",
128 				  usb_endpoint_num(pendp_desc));
129 			pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] =
130 				usb_endpoint_num(pendp_desc);
131 			pdvobjpriv->RtNumInPipes++;
132 		} else if (usb_endpoint_is_int_in(pendp_desc)) {
133 			DBG_8723A("usb_endpoint_is_int_in = %x, Interval = "
134 				  "%x\n", usb_endpoint_num(pendp_desc),
135 				  pendp_desc->bInterval);
136 			pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] =
137 				usb_endpoint_num(pendp_desc);
138 			pdvobjpriv->RtNumInPipes++;
139 		} else if (usb_endpoint_is_bulk_out(pendp_desc)) {
140 			DBG_8723A("usb_endpoint_is_bulk_out = %x\n",
141 				  usb_endpoint_num(pendp_desc));
142 			pdvobjpriv->RtOutPipe[pdvobjpriv->RtNumOutPipes] =
143 				usb_endpoint_num(pendp_desc);
144 			pdvobjpriv->RtNumOutPipes++;
145 		}
146 		pdvobjpriv->ep_num[i] = usb_endpoint_num(pendp_desc);
147 	}
148 	DBG_8723A("nr_endpoint =%d, in_num =%d, out_num =%d\n\n",
149 		  pdvobjpriv->nr_endpoint, pdvobjpriv->RtNumInPipes,
150 		  pdvobjpriv->RtNumOutPipes);
151 
152 	if (pusbd->speed == USB_SPEED_HIGH) {
153 		pdvobjpriv->ishighspeed = true;
154 		DBG_8723A("USB_SPEED_HIGH\n");
155 	} else {
156 		pdvobjpriv->ishighspeed = false;
157 		DBG_8723A("NON USB_SPEED_HIGH\n");
158 	}
159 
160 	if (rtw_init_intf_priv(pdvobjpriv) == _FAIL) {
161 		RT_TRACE(_module_os_intfs_c_, _drv_err_,
162 			 "Can't INIT rtw_init_intf_priv\n");
163 		goto free_dvobj;
164 	}
165 	/* 3 misc */
166 	rtw_reset_continual_urb_error(pdvobjpriv);
167 	usb_get_dev(pusbd);
168 	status = _SUCCESS;
169 free_dvobj:
170 	if (status != _SUCCESS && pdvobjpriv) {
171 		usb_set_intfdata(usb_intf, NULL);
172 		mutex_destroy(&pdvobjpriv->hw_init_mutex);
173 		mutex_destroy(&pdvobjpriv->h2c_fwcmd_mutex);
174 		mutex_destroy(&pdvobjpriv->setch_mutex);
175 		mutex_destroy(&pdvobjpriv->setbw_mutex);
176 		kfree(pdvobjpriv);
177 		pdvobjpriv = NULL;
178 	}
179 exit:
180 	return pdvobjpriv;
181 }
182 
usb_dvobj_deinit(struct usb_interface * usb_intf)183 static void usb_dvobj_deinit(struct usb_interface *usb_intf)
184 {
185 	struct dvobj_priv *dvobj = usb_get_intfdata(usb_intf);
186 
187 	usb_set_intfdata(usb_intf, NULL);
188 	if (dvobj) {
189 		/* Modify condition for 92DU DMDP 2010.11.18, by Thomas */
190 		if ((dvobj->NumInterfaces != 2 && dvobj->NumInterfaces != 3) ||
191 		    (dvobj->InterfaceNumber == 1)) {
192 			if (interface_to_usbdev(usb_intf)->state !=
193 			    USB_STATE_NOTATTACHED) {
194 				/* If we didn't unplug usb dongle and
195 				 * remove/insert module, driver fails on
196 				 * sitesurvey for the first time when
197 				 * device is up .
198 				 * Reset usb port for sitesurvey fail issue.
199 				 */
200 				DBG_8723A("usb attached..., try to reset usb device\n");
201 				usb_reset_device(interface_to_usbdev(usb_intf));
202 			}
203 		}
204 		rtw_deinit_intf_priv(dvobj);
205 		mutex_destroy(&dvobj->hw_init_mutex);
206 		mutex_destroy(&dvobj->h2c_fwcmd_mutex);
207 		mutex_destroy(&dvobj->setch_mutex);
208 		mutex_destroy(&dvobj->setbw_mutex);
209 		kfree(dvobj);
210 	}
211 	usb_put_dev(interface_to_usbdev(usb_intf));
212 }
213 
rtl8723a_usb_intf_stop(struct rtw_adapter * padapter)214 void rtl8723a_usb_intf_stop(struct rtw_adapter *padapter)
215 {
216 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+usb_intf_stop\n");
217 
218 	/* disable_hw_interrupt */
219 	if (!padapter->bSurpriseRemoved) {
220 		/* device still exists, so driver can do i/o operation
221 		 * TODO:
222 		 */
223 		RT_TRACE(_module_hci_intfs_c_, _drv_err_,
224 			 "SurpriseRemoved == false\n");
225 	}
226 
227 	/* cancel in irp */
228 	rtl8723au_inirp_deinit(padapter);
229 
230 	/* cancel out irp */
231 	rtl8723au_write_port_cancel(padapter);
232 
233 	/* todo:cancel other irps */
234 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-usb_intf_stop\n");
235 }
236 
rtw_dev_unload(struct rtw_adapter * padapter)237 static void rtw_dev_unload(struct rtw_adapter *padapter)
238 {
239 	struct submit_ctx *pack_tx_ops = &padapter->xmitpriv.ack_tx_ops;
240 
241 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_dev_unload\n");
242 
243 	if (padapter->bup) {
244 		DBG_8723A("===> rtw_dev_unload\n");
245 
246 		padapter->bDriverStopped = true;
247 		if (padapter->xmitpriv.ack_tx)
248 			rtw23a_sctx_done_err(&pack_tx_ops,
249 					     RTW_SCTX_DONE_DRV_STOP);
250 
251 		/* s3. */
252 		rtl8723a_usb_intf_stop(padapter);
253 
254 		/* s4. */
255 		flush_workqueue(padapter->cmdpriv.wq);
256 
257 		/* s5. */
258 		if (!padapter->bSurpriseRemoved) {
259 			rtl8723au_hal_deinit(padapter);
260 			padapter->bSurpriseRemoved = true;
261 		}
262 		padapter->bup = false;
263 	} else {
264 		RT_TRACE(_module_hci_intfs_c_, _drv_err_,
265 			 "r871x_dev_unload():padapter->bup == false\n");
266 	}
267 	DBG_8723A("<=== rtw_dev_unload\n");
268 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-rtw_dev_unload\n");
269 }
270 
rtw_suspend(struct usb_interface * pusb_intf,pm_message_t message)271 static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message)
272 {
273 	struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
274 	struct rtw_adapter *padapter = dvobj->if1;
275 	struct net_device *pnetdev = padapter->pnetdev;
276 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
277 	struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
278 	int ret = 0;
279 	unsigned long start_time = jiffies;
280 
281 	DBG_8723A("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
282 
283 	if ((!padapter->bup) || (padapter->bDriverStopped) ||
284 	    (padapter->bSurpriseRemoved)) {
285 		DBG_8723A("padapter->bup =%d bDriverStopped =%d bSurpriseRemoved = %d\n",
286 			  padapter->bup, padapter->bDriverStopped,
287 			  padapter->bSurpriseRemoved);
288 		goto exit;
289 	}
290 	pwrpriv->bInSuspend = true;
291 	rtw_cancel_all_timer23a(padapter);
292 	LeaveAllPowerSaveMode23a(padapter);
293 
294 	down(&pwrpriv->lock);
295 	/* padapter->net_closed = true; */
296 	/* s1. */
297 	if (pnetdev) {
298 		netif_carrier_off(pnetdev);
299 		netif_tx_stop_all_queues(pnetdev);
300 	}
301 
302 	/* s2. */
303 	rtw_disassoc_cmd23a(padapter, 0, false);
304 
305 	if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) &&
306 	    check_fwstate(pmlmepriv, _FW_LINKED)) {
307 		DBG_8723A("%s:%d %s(%pM), length:%d assoc_ssid.length:%d\n",
308 			  __func__, __LINE__,
309 			  pmlmepriv->cur_network.network.Ssid.ssid,
310 			  pmlmepriv->cur_network.network.MacAddress,
311 			  pmlmepriv->cur_network.network.Ssid.ssid_len,
312 			  pmlmepriv->assoc_ssid.ssid_len);
313 
314 		rtw_set_roaming(padapter, 1);
315 	}
316 	/* s2-2.  indicate disconnect to os */
317 	rtw_indicate_disconnect23a(padapter);
318 	/* s2-3. */
319 	rtw_free_assoc_resources23a(padapter, 1);
320 	/* s2-4. */
321 	rtw_free_network_queue23a(padapter);
322 
323 	rtw_dev_unload(padapter);
324 	up(&pwrpriv->lock);
325 
326 	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
327 		rtw_cfg80211_indicate_scan_done(
328 			wdev_to_priv(padapter->rtw_wdev), true);
329 
330 	if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING))
331 		rtw_indicate_disconnect23a(padapter);
332 
333 exit:
334 	DBG_8723A("<===  %s return %d.............. in %dms\n", __func__,
335 		  ret, jiffies_to_msecs(jiffies - start_time));
336 
337 	return ret;
338 }
339 
rtw_resume(struct usb_interface * pusb_intf)340 static int rtw_resume(struct usb_interface *pusb_intf)
341 {
342 	struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
343 	struct rtw_adapter *padapter = dvobj->if1;
344 	struct net_device *pnetdev;
345 	struct pwrctrl_priv *pwrpriv = NULL;
346 	int ret = -1;
347 	unsigned long start_time = jiffies;
348 
349 	DBG_8723A("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
350 
351 	if (!padapter)
352 		goto exit;
353 	pnetdev = padapter->pnetdev;
354 	pwrpriv = &padapter->pwrctrlpriv;
355 
356 	down(&pwrpriv->lock);
357 	rtw_reset_drv_sw23a(padapter);
358 	pwrpriv->bkeepfwalive = false;
359 
360 	DBG_8723A("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive);
361 	if (pm_netdev_open23a(pnetdev, true) != 0) {
362 		up(&pwrpriv->lock);
363 		goto exit;
364 	}
365 
366 	netif_device_attach(pnetdev);
367 	netif_carrier_on(pnetdev);
368 
369 	up(&pwrpriv->lock);
370 
371 	if (padapter->pid[1] != 0) {
372 		DBG_8723A("pid[1]:%d\n", padapter->pid[1]);
373 		kill_pid(find_vpid(padapter->pid[1]), SIGUSR2, 1);
374 	}
375 
376 	rtw23a_roaming(padapter, NULL);
377 
378 	ret = 0;
379 exit:
380 	if (pwrpriv)
381 		pwrpriv->bInSuspend = false;
382 	DBG_8723A("<===  %s return %d.............. in %dms\n", __func__,
383 		  ret, jiffies_to_msecs(jiffies - start_time));
384 
385 	return ret;
386 }
387 
388 /*
389  * drv_init() - a device potentially for us
390  *
391  * notes: drv_init() is called when the bus driver has located a card
392  * for us to support.
393  *        We accept the new device by returning 0.
394  */
rtw_usb_if1_init(struct dvobj_priv * dvobj,struct usb_interface * pusb_intf,const struct usb_device_id * pdid)395 static struct rtw_adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
396 					    struct usb_interface *pusb_intf,
397 					    const struct usb_device_id *pdid)
398 {
399 	struct rtw_adapter *padapter = NULL;
400 	struct net_device *pnetdev = NULL;
401 	int status = _FAIL;
402 
403 	pnetdev = rtw_init_netdev23a(padapter);
404 	if (!pnetdev)
405 		goto free_adapter;
406 	padapter = netdev_priv(pnetdev);
407 
408 	padapter->dvobj = dvobj;
409 	padapter->bDriverStopped = true;
410 	dvobj->if1 = padapter;
411 	dvobj->padapters[dvobj->iface_nums++] = padapter;
412 	padapter->iface_id = IFACE_ID0;
413 
414 	rtl8723au_set_hw_type(padapter);
415 
416 	SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj));
417 
418 	if (rtw_wdev_alloc(padapter, dvobj_to_dev(dvobj)))
419 		goto free_adapter;
420 
421 	/* step 2. allocate HalData */
422 	padapter->HalData = kzalloc(sizeof(struct hal_data_8723a), GFP_KERNEL);
423 	if (!padapter->HalData)
424 		goto free_wdev;
425 
426 	/* step read_chip_version */
427 	rtl8723a_read_chip_version(padapter);
428 
429 	/* step usb endpoint mapping */
430 	if (!rtl8723au_chip_configure(padapter))
431 		goto free_hal_data;
432 
433 	/* step read efuse/eeprom data and get mac_addr */
434 	rtl8723a_read_adapter_info(padapter);
435 
436 	/* step 5. */
437 	if (rtw_init_drv_sw23a(padapter) == _FAIL) {
438 		RT_TRACE(_module_hci_intfs_c_, _drv_err_,
439 			 "Initialize driver software resource Failed!\n");
440 		goto free_hal_data;
441 	}
442 
443 #ifdef CONFIG_PM
444 	if (padapter->pwrctrlpriv.bSupportRemoteWakeup) {
445 		dvobj->pusbdev->do_remote_wakeup = 1;
446 		pusb_intf->needs_remote_wakeup = 1;
447 		device_init_wakeup(&pusb_intf->dev, 1);
448 		DBG_8723A("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n");
449 		DBG_8723A("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",
450 			  device_may_wakeup(&pusb_intf->dev));
451 	}
452 #endif
453 	/* 2012-07-11 Move here to prevent the 8723AS-VAU BT
454 	 * auto suspend influence
455 	 */
456 	if (usb_autopm_get_interface(pusb_intf) < 0)
457 		DBG_8723A("can't get autopm:\n");
458 #ifdef	CONFIG_8723AU_BT_COEXIST
459 	padapter->pwrctrlpriv.autopm_cnt = 1;
460 #endif
461 
462 	/* If the eeprom mac address is corrupted, assign a random address */
463 	if (is_broadcast_ether_addr(padapter->eeprompriv.mac_addr) ||
464 	    is_zero_ether_addr(padapter->eeprompriv.mac_addr))
465 		eth_random_addr(padapter->eeprompriv.mac_addr);
466 
467 	DBG_8723A("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n",
468 		  padapter->bDriverStopped, padapter->bSurpriseRemoved,
469 		  padapter->bup, padapter->hw_init_completed
470 	);
471 	status = _SUCCESS;
472 
473 free_hal_data:
474 	if (status != _SUCCESS)
475 		kfree(padapter->HalData);
476 free_wdev:
477 	if (status != _SUCCESS) {
478 		rtw_wdev_unregister(padapter->rtw_wdev);
479 		rtw_wdev_free(padapter->rtw_wdev);
480 	}
481 free_adapter:
482 	if (status != _SUCCESS) {
483 		if (pnetdev)
484 			free_netdev(pnetdev);
485 		padapter = NULL;
486 	}
487 	return padapter;
488 }
489 
rtw_usb_if1_deinit(struct rtw_adapter * if1)490 static void rtw_usb_if1_deinit(struct rtw_adapter *if1)
491 {
492 	struct net_device *pnetdev = if1->pnetdev;
493 	struct mlme_priv *pmlmepriv = &if1->mlmepriv;
494 
495 	if (check_fwstate(pmlmepriv, _FW_LINKED))
496 		rtw_disassoc_cmd23a(if1, 0, false);
497 
498 #ifdef CONFIG_8723AU_AP_MODE
499 	free_mlme_ap_info23a(if1);
500 #endif
501 
502 	if (pnetdev)
503 		unregister_netdev(pnetdev); /* will call netdev_close() */
504 
505 	rtw_cancel_all_timer23a(if1);
506 
507 	rtw_dev_unload(if1);
508 
509 	DBG_8723A("+r871xu_dev_remove, hw_init_completed =%d\n",
510 		  if1->hw_init_completed);
511 
512 	if (if1->rtw_wdev) {
513 		rtw_wdev_unregister(if1->rtw_wdev);
514 		rtw_wdev_free(if1->rtw_wdev);
515 	}
516 
517 #ifdef CONFIG_8723AU_BT_COEXIST
518 	if (1 == if1->pwrctrlpriv.autopm_cnt) {
519 		usb_autopm_put_interface(adapter_to_dvobj(if1)->pusbintf);
520 		if1->pwrctrlpriv.autopm_cnt--;
521 	}
522 #endif
523 
524 	rtw_free_drv_sw23a(if1);
525 
526 	if (pnetdev)
527 		free_netdev(pnetdev);
528 }
529 
rtw_drv_init(struct usb_interface * pusb_intf,const struct usb_device_id * pdid)530 static int rtw_drv_init(struct usb_interface *pusb_intf,
531 			const struct usb_device_id *pdid)
532 {
533 	struct rtw_adapter *if1 = NULL;
534 	struct dvobj_priv *dvobj;
535 	int status = _FAIL;
536 
537 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_init\n");
538 
539 	/* Initialize dvobj_priv */
540 	dvobj = usb_dvobj_init(pusb_intf);
541 	if (!dvobj) {
542 		RT_TRACE(_module_hci_intfs_c_, _drv_err_,
543 			 "initialize device object priv Failed!\n");
544 		goto exit;
545 	}
546 
547 	if1 = rtw_usb_if1_init(dvobj, pusb_intf, pdid);
548 	if (!if1) {
549 		DBG_8723A("rtw_init_primary_adapter Failed!\n");
550 		goto free_dvobj;
551 	}
552 
553 	/* dev_alloc_name && register_netdev */
554 	status = rtw_drv_register_netdev(if1);
555 	if (status != _SUCCESS)
556 		goto free_if1;
557 	RT_TRACE(_module_hci_intfs_c_, _drv_err_,
558 		 "-871x_drv - drv_init, success!\n");
559 
560 	status = _SUCCESS;
561 
562 free_if1:
563 	if (status != _SUCCESS && if1)
564 		rtw_usb_if1_deinit(if1);
565 free_dvobj:
566 	if (status != _SUCCESS)
567 		usb_dvobj_deinit(pusb_intf);
568 exit:
569 	return status == _SUCCESS ? 0 : -ENODEV;
570 }
571 
572 /* dev_remove() - our device is being removed */
rtw_disconnect(struct usb_interface * pusb_intf)573 static void rtw_disconnect(struct usb_interface *pusb_intf)
574 {
575 	struct dvobj_priv *dvobj;
576 	struct rtw_adapter *padapter;
577 	struct net_device *pnetdev;
578 	struct mlme_priv *pmlmepriv;
579 
580 	dvobj = usb_get_intfdata(pusb_intf);
581 	if (!dvobj)
582 		return;
583 
584 	padapter = dvobj->if1;
585 	pnetdev = padapter->pnetdev;
586 	pmlmepriv = &padapter->mlmepriv;
587 
588 	usb_set_intfdata(pusb_intf, NULL);
589 
590 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+dev_remove()\n");
591 
592 	rtw_pm_set_ips23a(padapter, IPS_NONE);
593 	rtw_pm_set_lps23a(padapter, PS_MODE_ACTIVE);
594 
595 	LeaveAllPowerSaveMode23a(padapter);
596 
597 	rtw_usb_if1_deinit(padapter);
598 
599 	usb_dvobj_deinit(pusb_intf);
600 
601 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-dev_remove()\n");
602 	DBG_8723A("-r871xu_dev_remove, done\n");
603 }
604 
rtw_drv_entry(void)605 static int __init rtw_drv_entry(void)
606 {
607 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_entry\n");
608 	return usb_register(usb_drv);
609 }
610 
rtw_drv_halt(void)611 static void __exit rtw_drv_halt(void)
612 {
613 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_halt\n");
614 	DBG_8723A("+rtw_drv_halt\n");
615 
616 	usb_deregister(usb_drv);
617 
618 	DBG_8723A("-rtw_drv_halt\n");
619 }
620 
621 module_init(rtw_drv_entry);
622 module_exit(rtw_drv_halt);
623