static struct adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
struct usb_interface *pusb_intf, const struct usb_device_id *pdid)
{
struct adapter *padapter = NULL;
struct net_device *pnetdev = NULL;
int status = _FAIL;
padapter = (struct adapter *)vzalloc(sizeof(*padapter));
if (padapter == NULL)
goto exit;
padapter->dvobj = dvobj;
dvobj->if1 = padapter;
padapter->bDriverStopped = true;
mutex_init(&padapter->hw_init_mutex);
padapter->chip_type = RTL8188E;
pnetdev = rtw_init_netdev(padapter);
if (pnetdev == NULL)
goto free_adapter;
SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj));
padapter = rtw_netdev_priv(pnetdev);
/* step 2. hook HalFunc, allocate HalData */
hal_set_hal_ops(padapter);
padapter->intf_start = &usb_intf_start;
padapter->intf_stop = &usb_intf_stop;
/* step read_chip_version */
rtw_hal_read_chip_version(padapter);
/* step usb endpoint mapping */
rtw_hal_chip_configure(padapter);
/* step read efuse/eeprom data and get mac_addr */
rtw_hal_read_chip_info(padapter);
/* step 5. */
if (rtw_init_drv_sw(padapter) == _FAIL) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("Initialize driver software resource Failed!\n"));
goto free_hal_data;
}
#ifdef CONFIG_PM
if (padapter->pwrctrlpriv.bSupportRemoteWakeup) {
dvobj->pusbdev->do_remote_wakeup = 1;
pusb_intf->needs_remote_wakeup = 1;
device_init_wakeup(&pusb_intf->dev, 1);
DBG_88E("\n padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n");
DBG_88E("\n padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",
device_may_wakeup(&pusb_intf->dev));
}
#endif
/* 2012-07-11 Move here to prevent the 8723AS-VAU BT auto
* suspend influence */
if (usb_autopm_get_interface(pusb_intf) < 0)
DBG_88E("can't get autopm:\n");
/* alloc dev name after read efuse. */
rtw_init_netdev_name(pnetdev, padapter->registrypriv.ifname);
rtw_macaddr_cfg(padapter->eeprompriv.mac_addr);
memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN);
DBG_88E("MAC Address from pnetdev->dev_addr = %pM\n",
pnetdev->dev_addr);
/* step 6. Tell the network stack we exist */
if (register_netdev(pnetdev) != 0) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("register_netdev() failed\n"));
goto free_hal_data;
}
DBG_88E("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n"
, padapter->bDriverStopped
, padapter->bSurpriseRemoved
, padapter->bup
, padapter->hw_init_completed
);
status = _SUCCESS;
free_hal_data:
if (status != _SUCCESS)
kfree(padapter->HalData);
free_adapter:
if (status != _SUCCESS) {
if (pnetdev)
rtw_free_netdev(pnetdev);
else if (padapter)
vfree(padapter);
padapter = NULL;
}
exit:
return padapter;
}
static PADAPTER rtw_gspi_if1_init(struct dvobj_priv *dvobj)
{
int status = _FAIL;
struct net_device *pnetdev;
PADAPTER padapter = NULL;
padapter = (PADAPTER)rtw_zvmalloc(sizeof(*padapter));
if (NULL == padapter) {
goto exit;
}
padapter->dvobj = dvobj;
dvobj->if1 = padapter;
padapter->bDriverStopped = _TRUE;
#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_DUALMAC_CONCURRENT)
//set adapter_type/iface type for primary padapter
padapter->isprimary = _TRUE;
padapter->adapter_type = PRIMARY_ADAPTER;
#ifndef CONFIG_HWPORT_SWAP
padapter->iface_type = IFACE_PORT0;
#else
padapter->iface_type = IFACE_PORT1;
#endif
#endif
padapter->hw_init_mutex = &drvpriv.hw_init_mutex;
#ifdef CONFIG_CONCURRENT_MODE
//set global variable to primary adapter
padapter->ph2c_fwcmd_mutex = &drvpriv.h2c_fwcmd_mutex;
padapter->psetch_mutex = &drvpriv.setch_mutex;
padapter->psetbw_mutex = &drvpriv.setbw_mutex;
#endif
padapter->interface_type = RTW_GSPI;
decide_chip_type_by_device_id(padapter);
//3 1. init network device data
pnetdev = rtw_init_netdev(padapter);
if (!pnetdev)
goto free_adapter;
SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj));
#ifdef CONFIG_IOCTL_CFG80211
rtw_wdev_alloc(padapter, dvobj_to_dev(dvobj));
#endif
//3 3. init driver special setting, interface, OS and hardware relative
//4 3.1 set hardware operation functions
hal_set_hal_ops(padapter);
//3 5. initialize Chip version
padapter->intf_start = &gspi_intf_start;
padapter->intf_stop = &gspi_intf_stop;
if (rtw_init_io_priv(padapter, spi_set_intf_ops) == _FAIL)
{
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: Can't init io_priv\n"));
goto free_hal_data;
}
{
u32 ret = 0;
DBG_8192C("read start:\n");
//spi_write8_endian(padapter, SPI_LOCAL_OFFSET | 0xF0, 0x01, 1);
rtw_write8(padapter, SPI_LOCAL_OFFSET | 0xF0, 0x03);
ret = rtw_read32(padapter, SPI_LOCAL_OFFSET | 0xF0);
DBG_8192C("read end 0xF0 read32:%x:\n", ret);
DBG_8192C("read end 0xF0 read8:%x:\n", rtw_read8(padapter, SPI_LOCAL_OFFSET | 0xF0));
}
rtw_hal_read_chip_version(padapter);
rtw_hal_chip_configure(padapter);
//3 6. read efuse/eeprom data
rtw_hal_read_chip_info(padapter);
//3 7. init driver common data
if (rtw_init_drv_sw(padapter) == _FAIL) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: Initialize driver software resource Failed!\n"));
goto free_hal_data;
}
//3 8. get WLan MAC address
// alloc dev name after read efuse.
rtw_init_netdev_name(pnetdev, padapter->registrypriv.ifname);
rtw_macaddr_cfg(padapter->eeprompriv.mac_addr);
_rtw_memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN);
rtw_hal_disable_interrupt(padapter);
//3 9. Tell the network stack we exist
if (register_netdev(pnetdev) != 0) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: register_netdev() failed\n"));
goto free_hal_data;
}
DBG_871X("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n"
,padapter->bDriverStopped
,padapter->bSurpriseRemoved
,padapter->bup
,padapter->hw_init_completed
);
#ifdef CONFIG_HOSTAPD_MLME
hostapd_mode_init(padapter);
#endif
status = _SUCCESS;
free_hal_data:
if (status != _SUCCESS && padapter->HalData)
rtw_mfree(padapter->HalData, sizeof(*(padapter->HalData)));
free_wdev:
if (status != _SUCCESS) {
#ifdef CONFIG_IOCTL_CFG80211
rtw_wdev_free(padapter->rtw_wdev);
#endif
}
free_adapter:
if (status != _SUCCESS) {
if (pnetdev)
rtw_free_netdev(pnetdev);
else if (padapter)
rtw_vmfree((u8*)padapter, sizeof(*padapter));
padapter = NULL;
}
exit:
return padapter;
}
_adapter *rtw_sdio_if1_init(struct dvobj_priv *dvobj, const struct sdio_device_id *pdid){
int status = _FAIL;
struct net_device *pnetdev;
PADAPTER padapter = NULL;
u8 mac_addr[ETH_ALEN];
u16 fw_ready;
u32 i;
_func_enter_;
if ((padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter))) == NULL) {
DBG_871X("%s: vmalloc for padapter failed!\n", __FUNCTION__);
goto exit;
}
padapter->dvobj = dvobj;
dvobj->if1 = padapter;
padapter->interface_type = RTW_SDIO;
// 1. init network device data
pnetdev = rtw_init_netdev(padapter);
if (!pnetdev)
goto free_adapter;
SET_NETDEV_DEV(pnetdev, &dvobj->intf_data.func->dev);
padapter = rtw_netdev_priv(pnetdev);
// 2. init driver special setting, interface, OS and hardware relative
rtw_set_hal_ops(padapter);
// 3. initialize Chip version
padapter->intf_start = &sd_intf_start;
padapter->intf_stop = &sd_intf_stop;
padapter->intf_init = &sdio_init;
padapter->intf_deinit = &sdio_deinit;
padapter->intf_alloc_irq = &sdio_alloc_irq;
padapter->intf_free_irq = &sdio_free_irq;
sdio_set_intf_ops(padapter, &padapter->io_ops);
// 4. init driver common data
if (rtw_init_drv_sw(padapter) == _FAIL) {
goto free_adapter;
}
// 5. get MAC address
mac_addr[0] = 0x00;
mac_addr[1] = 0xe0;
mac_addr[2] = 0x4c;
mac_addr[3] = 0xB7;
mac_addr[4] = 0x23;
mac_addr[5] = 0x00;
_rtw_memcpy(pnetdev->dev_addr, mac_addr, ETH_ALEN);
#ifdef CONFIG_FWDL
// wait for the device boot code ready
for (i=0;i<100;i++) {
fw_ready = rtw_read16(padapter, SDIO_REG_HCPWM2);
if (fw_ready & SDIO_INIT_DONE) {
break;
}
rtw_msleep_os(10);
}
if (i==100) {
DBG_871X("%s: Wait Device Firmware Ready Timeout!!SDIO_REG_HCPWM2 @ 0x%04x\n", __FUNCTION__, fw_ready);
goto free_adapter;
}
#else
// wait for the device firmware ready
for (i=0;i<100;i++) {
fw_ready = rtw_read8(padapter, SDIO_REG_CPU_IND);
if (fw_ready & SDIO_SYSTEM_TRX_RDY_IND) {
break;
}
rtw_msleep_os(10);
}
if (i==100) {
DBG_871X("%s: Wait Device Firmware Ready Timeout!!SDIO_REG_CPU_IND @ 0x%04x\n", __FUNCTION__, fw_ready);
goto free_adapter;
}
#endif
rtw_hal_disable_interrupt(padapter);
DBG_871X("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d\n"
,padapter->bDriverStopped
,padapter->bSurpriseRemoved
,padapter->bup
);
status = _SUCCESS;
free_adapter:
if (status != _SUCCESS) {
if (pnetdev)
rtw_free_netdev(pnetdev);
else
rtw_vmfree((u8*)padapter, sizeof(*padapter));
padapter = NULL;
}
exit:
_func_exit_;
return padapter;
}
static int r871xs_drv_init(struct sdio_func *func, const struct sdio_device_id *id)
{
_adapter *padapter = NULL;
struct dvobj_priv *pdvobjpriv;
struct net_device *pnetdev;
RT_TRACE(_module_hci_intfs_c_,_drv_alert_,("+871x - drv_init:id=0x%p func->vendor=0x%x func->device=0x%x\n",id,func->vendor,func->device));
//step 1.
pnetdev = rtw_init_netdev();
if (!pnetdev)
goto error;
padapter = netdev_priv(pnetdev);
pdvobjpriv = &padapter->dvobjpriv;
pdvobjpriv->padapter = padapter;
pdvobjpriv->func = func;
sdio_set_drvdata(func, pdvobjpriv);
SET_NETDEV_DEV(pnetdev, &func->dev);
//step 2.
if (alloc_io_queue(padapter) == _FAIL) {
RT_TRACE(_module_hci_intfs_c_,_drv_err_,("Can't init io_reqs\n"));
goto error;
}
#if 0 //temp remove
//step 3.
if (loadparam(padapter, pnetdev) == _FAIL) {
RT_TRACE(_module_hci_intfs_c_,_drv_err_,("Read Parameter Failed!\n"));
goto error;
}
#endif
//step 4.
//dvobj_init(padapter);
padapter->dvobj_init = &sd_dvobj_init;
padapter->dvobj_deinit = &sd_dvobj_deinit;
padapter->halpriv.hal_bus_init = &sd_hal_bus_init;
padapter->halpriv.hal_bus_deinit = &sd_hal_bus_deinit;
if (padapter->dvobj_init == NULL) {
RT_TRACE(_module_hci_intfs_c_,_drv_err_,("\n Initialize dvobjpriv.dvobj_init error!!!\n"));
goto error;
}
if (padapter->dvobj_init(padapter) == _FAIL) {
RT_TRACE(_module_hci_intfs_c_,_drv_err_,("\n initialize device object priv Failed!\n"));
goto error;
}
//step 6.
if (rtw_init_drv_sw(padapter) == _FAIL) {
RT_TRACE(_module_hci_intfs_c_,_drv_err_,("Initialize driver software resource Failed!\n"));
goto error;
}
#if 1
{
//step 7.
u8 mac[6];
mac[0]=0x00;
mac[1]=0xe0;
mac[2]=0x4c;
mac[3]=0x87;
mac[4]=0x66;
mac[5]=0x55;
_rtw_memcpy(pnetdev->dev_addr, mac/*padapter->eeprompriv.mac_addr*/, ETH_ALEN);
RT_TRACE(_module_hci_intfs_c_,_drv_info_,("pnetdev->dev_addr=0x%x:0x%x:0x%x:0x%x:0x%x:0x%x\n",pnetdev->dev_addr[0],pnetdev->dev_addr[1],pnetdev->dev_addr[2],pnetdev->dev_addr[3],pnetdev->dev_addr[4],pnetdev->dev_addr[5]));
}
#endif
//step 8.
/* Tell the network stack we exist */
if (register_netdev(pnetdev) != 0) {
RT_TRACE(_module_hci_intfs_c_,_drv_err_,("register_netdev() failed\n"));
goto error;
}
RT_TRACE(_module_hci_intfs_c_,_drv_info_,("register_netdev() success\n"));
RT_TRACE(_module_hci_intfs_c_,_drv_notice_,("-drv_init - Adapter->bDriverStopped=%d, Adapter->bSurpriseRemoved=%d\n",padapter->bDriverStopped, padapter->bSurpriseRemoved));
RT_TRACE(_module_hci_intfs_c_,_drv_info_,("-871xs_drv - drv_init, success!\n"));
return 0;
error:
if (padapter->dvobj_deinit == NULL) {
RT_TRACE(_module_hci_intfs_c_,_drv_err_,("\n Initialize dvobjpriv.dvobj_deinit error!!!\n"));
} else {
padapter->dvobj_deinit(padapter);
}
if (pnetdev) {
unregister_netdev(pnetdev);
free_netdev(pnetdev);
}
RT_TRACE(_module_hci_intfs_c_, _drv_emerg_, ("-871x_sdio - drv_init, fail!\n"));
return -1;
}
/*
* drv_init() - a device potentially for us
*
* notes: drv_init() is called when the bus driver has located a card for us to support.
* We accept the new device by returning 0.
*/
static int rtw_drv_init(
struct sdio_func *func,
const struct sdio_device_id *id)
{
struct net_device *pnetdev;
PADAPTER padapter;
struct dvobj_priv *pdvobjpriv;
PSDIO_DATA psdio;
RT_TRACE(_module_hci_intfs_c_, _drv_info_,
("+rtw_drv_init: vendor=0x%04x device=0x%04x class=0x%02x\n",
func->vendor, func->device, func->class));
//3 1. init network device data
pnetdev = rtw_init_netdev(NULL);
if (!pnetdev) goto error;
SET_NETDEV_DEV(pnetdev, &func->dev);
padapter = rtw_netdev_priv(pnetdev);
pdvobjpriv = &padapter->dvobjpriv;
pdvobjpriv->padapter = padapter;
psdio = &pdvobjpriv->intf_data;
psdio->func = func;
#ifdef CONFIG_IOCTL_CFG80211
rtw_wdev_alloc(padapter, &func->dev);
#endif
//3 2. set interface private data
sdio_set_drvdata(func, pdvobjpriv);
//3 3. init driver special setting, interface, OS and hardware relative
// set interface_type to sdio
padapter->interface_type = RTW_SDIO;
decide_chip_type_by_device_id(padapter, (u32)func->device);
//4 3.1 set hardware operation functions
padapter->HalData = rtw_zmalloc(sizeof(HAL_DATA_TYPE));
if (padapter->HalData == NULL) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: can't alloc memory for HAL DATA\n"));
goto error;
}
padapter->hal_data_sz = sizeof(HAL_DATA_TYPE);
set_hal_ops(padapter);
//3 4. interface init
if (sdio_init(padapter) != _SUCCESS) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: initialize device object priv Failed!\n"));
goto error;
}
padapter->intf_start = &sd_intf_start;
padapter->intf_stop = &sd_intf_stop;
//3 5. register I/O operations
if (rtw_init_io_priv(padapter) == _FAIL)
{
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: Can't init io_priv\n"));
goto deinit;
}
//3 6.
intf_read_chip_version(padapter);
//3 7.
intf_chip_configure(padapter);
//3 8. read efuse/eeprom data
intf_read_chip_info(padapter);
//3 9. init driver common data
if (rtw_init_drv_sw(padapter) == _FAIL) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: Initialize driver software resource Failed!\n"));
goto deinit;
}
//3 10. get WLan MAC address
// alloc dev name after read efuse.
rtw_init_netdev_name(pnetdev, ifname);
rtw_macaddr_cfg(padapter->eeprompriv.mac_addr);
_rtw_memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN);
#ifdef CONFIG_PROC_DEBUG
#ifdef RTK_DMP_PLATFORM
rtw_proc_init_one(pnetdev);
#endif
#endif
#ifdef CONFIG_HOSTAPD_MLME
hostapd_mode_init(padapter);
#endif
#ifdef CONFIG_CONCURRENT_MODE
//set global variable to primary adapter
padapter->ph2c_fwcmd_mutex = &drvpriv.h2c_fwcmd_mutex;
padapter->psetch_mutex = &drvpriv.setch_mutex;
padapter->psetbw_mutex = &drvpriv.setbw_mutex;
padapter->hw_init_mutex = &drvpriv.hw_init_mutex;
#endif
#ifdef CONFIG_PLATFORM_RTD2880B
DBG_871X("wlan link up\n");
rtd2885_wlan_netlink_sendMsg("linkup", "8712");
#endif
#ifdef CONFIG_GLOBAL_UI_PID
if(ui_pid[1]!=0) {
DBG_871X("ui_pid[1]:%d\n",ui_pid[1]);
rtw_signal_process(ui_pid[1], SIGUSR2);
}
#endif
DBG_871X("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n"
,padapter->bDriverStopped
,padapter->bSurpriseRemoved
,padapter->bup
,padapter->hw_init_completed
);
//3 8. Tell the network stack we exist
if (register_netdev(pnetdev) != 0) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: register_netdev() failed\n"));
goto deinit;
}
#ifdef CONFIG_CONCURRENT_MODE
if(rtw_drv_if2_init(padapter)==_FAIL)
{
goto deinit;
}
#endif
RT_TRACE(_module_hci_intfs_c_, _drv_info_,
("-rtw_drv_init: Success. bDriverStopped=%d bSurpriseRemoved=%d\n",
padapter->bDriverStopped, padapter->bSurpriseRemoved));
return 0;
deinit:
sdio_deinit(padapter);
error:
if (padapter)
{
if (padapter->HalData && padapter->hal_data_sz>0) {
rtw_mfree(padapter->HalData, padapter->hal_data_sz);
padapter->HalData = NULL;
}
}
if (pnetdev)
rtw_free_netdev(pnetdev);
RT_TRACE(_module_hci_intfs_c_, _drv_crit_, ("-rtw_drv_init: FAIL!\n"));
return -1;
}
