1 // SPDX-License-Identifier: GPL-2.0
2 /******************************************************************************
4 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
6 ******************************************************************************/
10 #include <rtw_debug.h>
11 #include <linux/jiffies.h>
13 #ifndef dev_to_sdio_func
14 #define dev_to_sdio_func(d) container_of(d, struct sdio_func, dev)
17 static const struct sdio_device_id sdio_ids[] =
19 { SDIO_DEVICE(0x024c, 0x0523), },
20 { SDIO_DEVICE(0x024c, 0x0525), },
21 { SDIO_DEVICE(0x024c, 0x0623), },
22 { SDIO_DEVICE(0x024c, 0x0626), },
23 { SDIO_DEVICE(0x024c, 0x0627), },
24 { SDIO_DEVICE(0x024c, 0xb723), },
25 { /* end: all zeroes */ },
27 MODULE_DEVICE_TABLE(sdio, sdio_ids);
29 static int rtw_drv_init(struct sdio_func *func, const struct sdio_device_id *id);
30 static void rtw_dev_remove(struct sdio_func *func);
31 static int rtw_sdio_resume(struct device *dev);
32 static int rtw_sdio_suspend(struct device *dev);
34 static const struct dev_pm_ops rtw_sdio_pm_ops = {
35 .suspend = rtw_sdio_suspend,
36 .resume = rtw_sdio_resume,
39 struct sdio_drv_priv {
40 struct sdio_driver r871xs_drv;
44 static struct sdio_drv_priv sdio_drvpriv = {
45 .r871xs_drv.probe = rtw_drv_init,
46 .r871xs_drv.remove = rtw_dev_remove,
47 .r871xs_drv.name = "rtl8723bs",
48 .r871xs_drv.id_table = sdio_ids,
50 .pm = &rtw_sdio_pm_ops,
54 static void sd_sync_int_hdl(struct sdio_func *func)
56 struct dvobj_priv *psdpriv;
59 psdpriv = sdio_get_drvdata(func);
62 DBG_871X("%s if1 == NULL\n", __func__);
66 rtw_sdio_set_irq_thd(psdpriv, current);
67 sd_int_hdl(psdpriv->if1);
68 rtw_sdio_set_irq_thd(psdpriv, NULL);
71 static int sdio_alloc_irq(struct dvobj_priv *dvobj)
73 PSDIO_DATA psdio_data;
74 struct sdio_func *func;
77 psdio_data = &dvobj->intf_data;
78 func = psdio_data->func;
80 sdio_claim_host(func);
82 err = sdio_claim_irq(func, &sd_sync_int_hdl);
85 dvobj->drv_dbg.dbg_sdio_alloc_irq_error_cnt++;
86 printk(KERN_CRIT "%s: sdio_claim_irq FAIL(%d)!\n", __func__, err);
90 dvobj->drv_dbg.dbg_sdio_alloc_irq_cnt++;
94 sdio_release_host(func);
96 return err?_FAIL:_SUCCESS;
99 static void sdio_free_irq(struct dvobj_priv *dvobj)
101 PSDIO_DATA psdio_data;
102 struct sdio_func *func;
105 if (dvobj->irq_alloc) {
106 psdio_data = &dvobj->intf_data;
107 func = psdio_data->func;
110 sdio_claim_host(func);
111 err = sdio_release_irq(func);
114 dvobj->drv_dbg.dbg_sdio_free_irq_error_cnt++;
115 DBG_871X_LEVEL(_drv_err_,"%s: sdio_release_irq FAIL(%d)!\n", __func__, err);
118 dvobj->drv_dbg.dbg_sdio_free_irq_cnt++;
119 sdio_release_host(func);
121 dvobj->irq_alloc = 0;
125 #ifdef CONFIG_GPIO_WAKEUP
126 extern unsigned int oob_irq;
127 static irqreturn_t gpio_hostwakeup_irq_thread(int irq, void *data)
129 struct adapter *padapter = data;
130 DBG_871X_LEVEL(_drv_always_, "gpio_hostwakeup_irq_thread\n");
131 /* Disable interrupt before calling handler */
132 /* disable_irq_nosync(oob_irq); */
133 rtw_lock_suspend_timeout(HZ/2);
137 static u8 gpio_hostwakeup_alloc_irq(struct adapter *padapter)
141 DBG_871X("oob_irq ZERO!\n");
144 /* dont set it IRQF_TRIGGER_LOW, or wowlan */
145 /* power is high after suspend */
146 /* and failing can prevent can not sleep issue if */
147 /* wifi gpio12 pin is not linked with CPU */
148 err = request_threaded_irq(oob_irq, gpio_hostwakeup_irq_thread, NULL,
149 /* IRQF_TRIGGER_LOW | IRQF_ONESHOT, */
150 IRQF_TRIGGER_FALLING,
151 "rtw_wifi_gpio_wakeup", padapter);
153 DBG_871X("Oops: can't allocate gpio irq %d err:%d\n", oob_irq, err);
156 DBG_871X("allocate gpio irq %d ok\n", oob_irq);
159 enable_irq_wake(oob_irq);
163 static void gpio_hostwakeup_free_irq(struct adapter *padapter)
168 disable_irq_wake(oob_irq);
169 free_irq(oob_irq, padapter);
173 static u32 sdio_init(struct dvobj_priv *dvobj)
175 PSDIO_DATA psdio_data;
176 struct sdio_func *func;
179 psdio_data = &dvobj->intf_data;
180 func = psdio_data->func;
182 /* 3 1. init SDIO bus */
183 sdio_claim_host(func);
185 err = sdio_enable_func(func);
187 dvobj->drv_dbg.dbg_sdio_init_error_cnt++;
188 DBG_8192C(KERN_CRIT "%s: sdio_enable_func FAIL(%d)!\n", __func__, err);
192 err = sdio_set_block_size(func, 512);
194 dvobj->drv_dbg.dbg_sdio_init_error_cnt++;
195 DBG_8192C(KERN_CRIT "%s: sdio_set_block_size FAIL(%d)!\n", __func__, err);
198 psdio_data->block_transfer_len = 512;
199 psdio_data->tx_block_mode = 1;
200 psdio_data->rx_block_mode = 1;
203 sdio_release_host(func);
210 static void sdio_deinit(struct dvobj_priv *dvobj)
212 struct sdio_func *func;
216 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("+sdio_deinit\n"));
218 func = dvobj->intf_data.func;
221 sdio_claim_host(func);
222 err = sdio_disable_func(func);
225 dvobj->drv_dbg.dbg_sdio_deinit_error_cnt++;
226 DBG_8192C(KERN_ERR "%s: sdio_disable_func(%d)\n", __func__, err);
229 if (dvobj->irq_alloc) {
230 err = sdio_release_irq(func);
233 dvobj->drv_dbg.dbg_sdio_free_irq_error_cnt++;
234 DBG_8192C(KERN_ERR "%s: sdio_release_irq(%d)\n", __func__, err);
237 dvobj->drv_dbg.dbg_sdio_free_irq_cnt++;
240 sdio_release_host(func);
243 static struct dvobj_priv *sdio_dvobj_init(struct sdio_func *func)
246 struct dvobj_priv *dvobj = NULL;
249 dvobj = devobj_init();
254 sdio_set_drvdata(func, dvobj);
256 psdio = &dvobj->intf_data;
259 if (sdio_init(dvobj) != _SUCCESS) {
260 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: initialize SDIO Failed!\n", __func__));
263 rtw_reset_continual_io_error(dvobj);
267 if (status != _SUCCESS && dvobj) {
268 sdio_set_drvdata(func, NULL);
270 devobj_deinit(dvobj);
278 static void sdio_dvobj_deinit(struct sdio_func *func)
280 struct dvobj_priv *dvobj = sdio_get_drvdata(func);
282 sdio_set_drvdata(func, NULL);
285 devobj_deinit(dvobj);
290 void rtw_set_hal_ops(struct adapter *padapter)
292 /* alloc memory for HAL DATA */
293 rtw_hal_data_init(padapter);
295 rtl8723bs_set_hal_ops(padapter);
298 static void sd_intf_start(struct adapter *padapter)
300 if (padapter == NULL) {
301 DBG_8192C(KERN_ERR "%s: padapter is NULL!\n", __func__);
306 rtw_hal_enable_interrupt(padapter);
309 static void sd_intf_stop(struct adapter *padapter)
311 if (padapter == NULL) {
312 DBG_8192C(KERN_ERR "%s: padapter is NULL!\n", __func__);
317 rtw_hal_disable_interrupt(padapter);
321 static struct adapter *rtw_sdio_if1_init(struct dvobj_priv *dvobj, const struct sdio_device_id *pdid)
324 struct net_device *pnetdev;
325 struct adapter *padapter = NULL;
326 PSDIO_DATA psdio = &dvobj->intf_data;
328 padapter = vzalloc(sizeof(*padapter));
329 if (padapter == NULL) {
333 padapter->dvobj = dvobj;
334 dvobj->if1 = padapter;
336 padapter->bDriverStopped =true;
338 dvobj->padapters = padapter;
339 padapter->iface_id = 0;
341 /* 3 1. init network device data */
342 pnetdev = rtw_init_netdev(padapter);
346 SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj));
348 padapter = rtw_netdev_priv(pnetdev);
350 rtw_wdev_alloc(padapter, dvobj_to_dev(dvobj));
352 /* 3 3. init driver special setting, interface, OS and hardware relative */
354 /* 4 3.1 set hardware operation functions */
355 rtw_set_hal_ops(padapter);
358 /* 3 5. initialize Chip version */
359 padapter->intf_start = &sd_intf_start;
360 padapter->intf_stop = &sd_intf_stop;
362 padapter->intf_init = &sdio_init;
363 padapter->intf_deinit = &sdio_deinit;
364 padapter->intf_alloc_irq = &sdio_alloc_irq;
365 padapter->intf_free_irq = &sdio_free_irq;
367 if (rtw_init_io_priv(padapter, sdio_set_intf_ops) == _FAIL)
369 RT_TRACE(_module_hci_intfs_c_, _drv_err_,
370 ("rtw_drv_init: Can't init io_priv\n"));
374 rtw_hal_read_chip_version(padapter);
376 rtw_hal_chip_configure(padapter);
378 rtw_btcoex_Initialize(padapter);
380 /* 3 6. read efuse/eeprom data */
381 rtw_hal_read_chip_info(padapter);
383 /* 3 7. init driver common data */
384 if (rtw_init_drv_sw(padapter) == _FAIL) {
385 RT_TRACE(_module_hci_intfs_c_, _drv_err_,
386 ("rtw_drv_init: Initialize driver software resource Failed!\n"));
390 /* 3 8. get WLan MAC address */
392 rtw_macaddr_cfg(&psdio->func->dev, padapter->eeprompriv.mac_addr);
394 rtw_hal_disable_interrupt(padapter);
396 DBG_871X("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n"
397 , padapter->bDriverStopped
398 , padapter->bSurpriseRemoved
400 , padapter->hw_init_completed
406 if (status != _SUCCESS && padapter->HalData)
407 kfree(padapter->HalData);
409 if (status != _SUCCESS) {
410 rtw_wdev_unregister(padapter->rtw_wdev);
411 rtw_wdev_free(padapter->rtw_wdev);
415 if (status != _SUCCESS) {
417 rtw_free_netdev(pnetdev);
419 vfree((u8 *)padapter);
426 static void rtw_sdio_if1_deinit(struct adapter *if1)
428 struct net_device *pnetdev = if1->pnetdev;
429 struct mlme_priv *pmlmepriv = &if1->mlmepriv;
431 if (check_fwstate(pmlmepriv, _FW_LINKED))
432 rtw_disassoc_cmd(if1, 0, false);
434 free_mlme_ap_info(if1);
436 #ifdef CONFIG_GPIO_WAKEUP
437 gpio_hostwakeup_free_irq(if1);
440 rtw_cancel_all_timer(if1);
443 adapter_to_pwrctl(if1)->wowlan_mode =false;
444 DBG_871X_LEVEL(_drv_always_, "%s wowlan_mode:%d\n", __func__, adapter_to_pwrctl(if1)->wowlan_mode);
445 #endif /* CONFIG_WOWLAN */
448 DBG_871X("+r871xu_dev_remove, hw_init_completed =%d\n", if1->hw_init_completed);
451 rtw_wdev_free(if1->rtw_wdev);
454 rtw_free_drv_sw(if1);
457 rtw_free_netdev(pnetdev);
461 * drv_init() - a device potentially for us
463 * notes: drv_init() is called when the bus driver has located a card for us to support.
464 * We accept the new device by returning 0.
466 static int rtw_drv_init(
467 struct sdio_func *func,
468 const struct sdio_device_id *id)
471 struct adapter *if1 = NULL, *if2 = NULL;
472 struct dvobj_priv *dvobj;
474 dvobj = sdio_dvobj_init(func);
476 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("initialize device object priv Failed!\n"));
480 if1 = rtw_sdio_if1_init(dvobj, id);
482 DBG_871X("rtw_init_primarystruct adapter Failed!\n");
486 /* dev_alloc_name && register_netdev */
487 status = rtw_drv_register_netdev(if1);
488 if (status != _SUCCESS) {
492 if (sdio_alloc_irq(dvobj) != _SUCCESS)
495 #ifdef CONFIG_GPIO_WAKEUP
496 gpio_hostwakeup_alloc_irq(if1);
499 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-871x_drv - drv_init, success!\n"));
501 rtw_ndev_notifier_register();
505 if (status != _SUCCESS && if2) {
507 if (status != _SUCCESS && if1) {
508 rtw_sdio_if1_deinit(if1);
511 if (status != _SUCCESS)
512 sdio_dvobj_deinit(func);
514 return status == _SUCCESS?0:-ENODEV;
517 static void rtw_dev_remove(struct sdio_func *func)
519 struct dvobj_priv *dvobj = sdio_get_drvdata(func);
520 struct adapter *padapter = dvobj->if1;
522 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("+rtw_dev_remove\n"));
524 dvobj->processing_dev_remove = true;
526 rtw_unregister_netdevs(dvobj);
528 if (padapter->bSurpriseRemoved == false) {
531 /* test surprise remove */
532 sdio_claim_host(func);
533 sdio_readb(func, 0, &err);
534 sdio_release_host(func);
535 if (err == -ENOMEDIUM) {
536 padapter->bSurpriseRemoved = true;
537 DBG_871X(KERN_NOTICE "%s: device had been removed!\n", __func__);
541 rtw_ps_deny(padapter, PS_DENY_DRV_REMOVE);
543 rtw_pm_set_ips(padapter, IPS_NONE);
544 rtw_pm_set_lps(padapter, PS_MODE_ACTIVE);
546 LeaveAllPowerSaveMode(padapter);
548 rtw_btcoex_HaltNotify(padapter);
550 rtw_sdio_if1_deinit(padapter);
552 sdio_dvobj_deinit(func);
554 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("-rtw_dev_remove\n"));
557 extern int pm_netdev_open(struct net_device *pnetdev, u8 bnormal);
558 extern int pm_netdev_close(struct net_device *pnetdev, u8 bnormal);
560 static int rtw_sdio_suspend(struct device *dev)
562 struct sdio_func *func =dev_to_sdio_func(dev);
563 struct dvobj_priv *psdpriv = sdio_get_drvdata(func);
564 struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv);
565 struct adapter *padapter = psdpriv->if1;
566 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
568 if (padapter->bDriverStopped == true)
570 DBG_871X("%s bDriverStopped = %d\n", __func__, padapter->bDriverStopped);
574 if (pwrpriv->bInSuspend == true)
576 DBG_871X("%s bInSuspend = %d\n", __func__, pwrpriv->bInSuspend);
577 pdbgpriv->dbg_suspend_error_cnt++;
581 return rtw_suspend_common(padapter);
584 static int rtw_resume_process(struct adapter *padapter)
586 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
587 struct dvobj_priv *psdpriv = padapter->dvobj;
588 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
590 if (pwrpriv->bInSuspend == false)
592 pdbgpriv->dbg_resume_error_cnt++;
593 DBG_871X("%s bInSuspend = %d\n", __func__, pwrpriv->bInSuspend);
597 return rtw_resume_common(padapter);
600 static int rtw_sdio_resume(struct device *dev)
602 struct sdio_func *func =dev_to_sdio_func(dev);
603 struct dvobj_priv *psdpriv = sdio_get_drvdata(func);
604 struct adapter *padapter = psdpriv->if1;
605 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
607 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
609 DBG_871X("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
611 pdbgpriv->dbg_resume_cnt++;
613 ret = rtw_resume_process(padapter);
615 pmlmeext->last_scan_time = jiffies;
616 DBG_871X("<======== %s return %d\n", __func__, ret);
620 static int __init rtw_drv_entry(void)
624 DBG_871X_LEVEL(_drv_always_, "module init start\n");
625 dump_drv_version(RTW_DBGDUMP);
627 DBG_871X_LEVEL(_drv_always_, "rtl8723bs BT-Coex version = %s\n", BTCOEXVERSION);
628 #endif /* BTCOEXVERSION */
630 sdio_drvpriv.drv_registered = true;
633 ret = sdio_register_driver(&sdio_drvpriv.r871xs_drv);
636 sdio_drvpriv.drv_registered = false;
637 rtw_drv_proc_deinit();
638 rtw_ndev_notifier_unregister();
639 DBG_871X("%s: register driver failed!!(%d)\n", __func__, ret);
646 DBG_871X_LEVEL(_drv_always_, "module init ret =%d\n", ret);
650 static void __exit rtw_drv_halt(void)
652 DBG_871X_LEVEL(_drv_always_, "module exit start\n");
654 sdio_drvpriv.drv_registered = false;
656 sdio_unregister_driver(&sdio_drvpriv.r871xs_drv);
658 rtw_drv_proc_deinit();
659 rtw_ndev_notifier_unregister();
661 DBG_871X_LEVEL(_drv_always_, "module exit success\n");
663 rtw_mstat_dump(RTW_DBGDUMP);
667 module_init(rtw_drv_entry);
668 module_exit(rtw_drv_halt);