static INT CFG80211_VirtualIF_Close(PNET_DEV dev_p)
{
VOID *pAdSrc;
pAdSrc = RTMP_OS_NETDEV_GET_PRIV(dev_p);
ASSERT(pAdSrc);
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
#ifdef RT_CFG80211_P2P_SUPPORT
if (dev_p->ieee80211_ptr->iftype == RT_CMD_80211_IFTYPE_P2P_CLIENT)
{
DBGPRINT(RT_DEBUG_TRACE, ("CFG80211_VirtualIF_Close\n"));
CFG80211OS_ScanEnd(pAd->pCfg80211_CB, TRUE);
RT_MOD_DEC_USE_COUNT();
return ApCli_Close(pAd, dev_p);
}
#endif /* RT_CFG80211_P2P_SUPPORT */
DBGPRINT(RT_DEBUG_TRACE, ("%s: ===> %s\n", __FUNCTION__, RTMP_OS_NETDEV_GET_DEVNAME(dev_p)));
RTMP_OS_NETDEV_STOP_QUEUE(dev_p);
if (netif_carrier_ok(dev_p))
netif_carrier_off(dev_p);
else
AsicDisableSync(pAd);
//VIRTUAL_IF_DOWN(pAd);
RT_MOD_DEC_USE_COUNT();
return 0;
}
static INT CFG80211_VirtualIF_Close(PNET_DEV dev_p)
{
VOID *pAdSrc;
pAdSrc = RTMP_OS_NETDEV_GET_PRIV(dev_p);
ASSERT(pAdSrc);
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
#ifdef RT_CFG80211_P2P_SUPPORT
if (dev_p->ieee80211_ptr->iftype == RT_CMD_80211_IFTYPE_P2P_CLIENT)
{
DBGPRINT(RT_DEBUG_TRACE, ("CFG80211_VirtualIF_Close\n"));
CFG80211OS_ScanEnd(pAd->pCfg80211_CB, TRUE);
RT_MOD_DEC_USE_COUNT();
return ApCli_Close(pAd, dev_p);
}
#endif /* RT_CFG80211_P2P_SUPPORT */
#ifdef CONFIG_SNIFFER_SUPPORT
#ifdef CONFIG_AP_SUPPORT
if(dev_p->ieee80211_ptr->iftype == RT_CMD_80211_IFTYPE_MONITOR)
{
pAd->ApCfg.BssType = BSS_INFRA;
AsicSetRxFilter(pAd);
}
#endif /*CONFIG_AP_SUPPORT*/
#endif /*CONFIG_SNIFFER_SUPPORT*/
DBGPRINT(RT_DEBUG_TRACE, ("%s: ===> %s\n", __FUNCTION__, RTMP_OS_NETDEV_GET_DEVNAME(dev_p)));
RTMP_OS_NETDEV_STOP_QUEUE(dev_p);
if (netif_carrier_ok(dev_p))
netif_carrier_off(dev_p);
#ifdef CONFIG_STA_SUPPORT
if (INFRA_ON(pAd))
AsicEnableBssSync(pAd);
else if (ADHOC_ON(pAd))
AsicEnableIbssSync(pAd);
#else
else
AsicDisableSync(pAd);
#endif
//VIRTUAL_IF_DOWN(pAd);
RT_MOD_DEC_USE_COUNT();
return 0;
}
static INT CFG80211_VirtualIF_Close(PNET_DEV dev_p)
{
VOID *pAdSrc;
pAdSrc = RTMP_OS_NETDEV_GET_PRIV(dev_p);
ASSERT(pAdSrc);
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
if ((dev_p->ieee80211_ptr->iftype == RT_CMD_80211_IFTYPE_P2P_CLIENT)
#ifdef CFG80211_MULTI_STA
|| (dev_p->ieee80211_ptr->iftype == RT_CMD_80211_IFTYPE_STATION)
#endif /* CFG80211_MULTI_STA */
)
{
DBGPRINT(RT_DEBUG_TRACE, ("CFG80211_VirtualIF_Close\n"));
CFG80211OS_ScanEnd(pAd->pCfg80211_CB, TRUE);
if (pAd->cfg80211_ctrl.FlgCfg80211Scanning)
pAd->cfg80211_ctrl.FlgCfg80211Scanning = FALSE;
RT_MOD_DEC_USE_COUNT();
return ApCli_Close(pAd, dev_p);
}
DBGPRINT(RT_DEBUG_TRACE, ("%s: ===> %s\n", __FUNCTION__, RTMP_OS_NETDEV_GET_DEVNAME(dev_p)));
RTMP_OS_NETDEV_STOP_QUEUE(dev_p);
if (netif_carrier_ok(dev_p))
netif_carrier_off(dev_p);
if (INFRA_ON(pAd))
AsicEnableBssSync(pAd, pAd->CommonCfg.BeaconPeriod);
else if (ADHOC_ON(pAd))
AsicEnableIbssSync(pAd);
else
AsicDisableSync(pAd);
//VIRTUAL_IF_DOWN(pAd);
RT_MOD_DEC_USE_COUNT();
return 0;
}
BOOLEAN CFG80211DRV_OpsChgVirtualInf(RTMP_ADAPTER *pAd, VOID *pData)
{
PCFG80211_CTRL pCfg80211_ctrl = &pAd->cfg80211_ctrl;
UINT newType, oldType;
CMD_RTPRIV_IOCTL_80211_VIF_PARM *pVifParm;
pVifParm = (CMD_RTPRIV_IOCTL_80211_VIF_PARM *)pData;
newType = pVifParm->newIfType;
oldType = pVifParm->oldIfType;
#ifdef RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE
APCLI_STRUCT *pApCliEntry;
struct wifi_dev *wdev;
PCFG80211_CTRL cfg80211_ctrl = &pAd->cfg80211_ctrl;
UINT apidx = 1;
CHAR tr_tb_idx = MAX_LEN_OF_MAC_TABLE + apidx;
printk(" CFG80211DRV_OpsChgVirtualInf newType %d oldType %d \n",newType,oldType);
if (strcmp(pVifParm->net_dev->name, "p2p0") == 0)
{
switch (newType)
{
case RT_CMD_80211_IFTYPE_MONITOR:
DBGPRINT(RT_DEBUG_TRACE, ("CFG80211 I/F Monitor Type\n"));
//RTMP_OS_NETDEV_SET_TYPE_MONITOR(new_dev_p);
break;
case RT_CMD_80211_IFTYPE_STATION:
RTMP_CFG80211_RemoveVifEntry(pAd,cfg80211_ctrl->dummy_p2p_net_dev);
RTMP_CFG80211_AddVifEntry(pAd, cfg80211_ctrl->dummy_p2p_net_dev, newType);
AsicSetBssid(pAd, pAd->cfg80211_ctrl.P2PCurrentAddress, 0x1);
AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
break;
case RT_CMD_80211_IFTYPE_P2P_CLIENT:
pAd->ApCfg.ApCliTab[MAIN_MBSSID].wdev.if_dev = NULL;
pApCliEntry = &pAd->ApCfg.ApCliTab[MAIN_MBSSID];
pApCliEntry->wdev.if_dev= cfg80211_ctrl->dummy_p2p_net_dev;
wdev = &pApCliEntry->wdev;
wdev->wdev_type = WDEV_TYPE_STA;
wdev->func_dev = pApCliEntry;
wdev->sys_handle = (void *)pAd;
DBGPRINT(RT_DEBUG_TRACE, ("ApCli_Open\n"));
RTMP_CFG80211_RemoveVifEntry(pAd,cfg80211_ctrl->dummy_p2p_net_dev);
/* TX */
RTMP_CFG80211_AddVifEntry(pAd, cfg80211_ctrl->dummy_p2p_net_dev, newType);
wdev->tx_pkt_allowed = ApCliAllowToSendPacket;
wdev->wdev_hard_tx = APHardTransmit;
wdev->tx_pkt_handle = APSendPacket;
/* RX */
wdev->rx_pkt_allowed = sta_rx_pkt_allow;
wdev->rx_pkt_foward = sta_rx_fwd_hnd;
RTMP_OS_NETDEV_SET_PRIV(cfg80211_ctrl->dummy_p2p_net_dev, pAd);
RTMP_OS_NETDEV_SET_WDEV(cfg80211_ctrl->dummy_p2p_net_dev, wdev);
COPY_MAC_ADDR(wdev->if_addr,pAd->cfg80211_ctrl.P2PCurrentAddress);
if (rtmp_wdev_idx_reg(pAd, wdev) < 0)
{
DBGPRINT(RT_DEBUG_ERROR, ("%s: Assign wdev idx for %s failed, free net device!\n",
__FUNCTION__,RTMP_OS_NETDEV_GET_DEVNAME(cfg80211_ctrl->dummy_p2p_net_dev)));
RtmpOSNetDevFree(cfg80211_ctrl->dummy_p2p_net_dev);
break;
}
pAd->flg_apcli_init = TRUE;
ApCli_Open(pAd, cfg80211_ctrl->dummy_p2p_net_dev);
// COPY_MAC_ADDR(wdev->if_addr,pAd->cfg80211_ctrl.P2PCurrentAddress);
AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
break;
case RT_CMD_80211_IFTYPE_P2P_GO:
// pNetDevOps->priv_flags = INT_P2P;
/* The Behivaor in SetBeacon Ops */
pAd->cfg80211_ctrl.isCfgInApMode = RT_CMD_80211_IFTYPE_AP;
wdev = &pAd->ApCfg.MBSSID[apidx].wdev;
wdev->wdev_type = WDEV_TYPE_AP;
wdev->func_dev = &pAd->ApCfg.MBSSID[apidx];
wdev->func_idx = apidx;
wdev->sys_handle = (void *)pAd;
wdev->if_dev = cfg80211_ctrl->dummy_p2p_net_dev;
/* BC/MC Handling */
wdev->tr_tb_idx = tr_tb_idx;
tr_tb_set_mcast_entry(pAd, tr_tb_idx, wdev);
RTMP_CFG80211_RemoveVifEntry(pAd,cfg80211_ctrl->dummy_p2p_net_dev);
/* TX */
RTMP_CFG80211_AddVifEntry(pAd, cfg80211_ctrl->dummy_p2p_net_dev, newType);
// RT_MOD_INC_USE_COUNT();
/* TX */
wdev->tx_pkt_allowed = ApAllowToSendPacket;
wdev->wdev_hard_tx = APHardTransmit;
wdev->tx_pkt_handle = APSendPacket;
/* RX */
wdev->rx_pkt_allowed = ap_rx_pkt_allow;
wdev->rx_pkt_foward = ap_rx_foward_handle;
wdev->rx_ps_handle = ap_rx_ps_handle;
// RTMP_OS_NETDEV_START_QUEUE(cfg80211_ctrl->dummy_p2p_net_dev);
RTMP_OS_NETDEV_SET_PRIV(cfg80211_ctrl->dummy_p2p_net_dev, pAd);
RTMP_OS_NETDEV_SET_WDEV(cfg80211_ctrl->dummy_p2p_net_dev, wdev);
wdev_bcn_buf_init(pAd, &pAd->ApCfg.MBSSID[apidx].bcn_buf);
RTMP_OS_NETDEV_SET_PRIV(cfg80211_ctrl->dummy_p2p_net_dev, pAd);
RTMP_OS_NETDEV_SET_WDEV(cfg80211_ctrl->dummy_p2p_net_dev, wdev);
if (rtmp_wdev_idx_reg(pAd, wdev) < 0)
{
DBGPRINT(RT_DEBUG_ERROR, ("%s: Assign wdev idx for %s failed, free net device!\n",
__FUNCTION__,RTMP_OS_NETDEV_GET_DEVNAME(cfg80211_ctrl->dummy_p2p_net_dev)));
RtmpOSNetDevFree(cfg80211_ctrl->dummy_p2p_net_dev);
break;
}
COPY_MAC_ADDR(pAd->ApCfg.MBSSID[apidx].wdev.if_addr, pAd->cfg80211_ctrl.P2PCurrentAddress);
COPY_MAC_ADDR(pAd->ApCfg.MBSSID[apidx].wdev.bssid, pAd->cfg80211_ctrl.P2PCurrentAddress);
AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
break;
default:
DBGPRINT(RT_DEBUG_ERROR, ("Unknown CFG80211 I/F Type (%d)\n", newType));
}
}
if ((newType == RT_CMD_80211_IFTYPE_STATION) &&
(oldType == RT_CMD_80211_IFTYPE_P2P_CLIENT) && (pAd->flg_apcli_init == TRUE))
{
DBGPRINT(RT_DEBUG_TRACE, ("ApCli_Close\n"));
CFG80211OS_ScanEnd(pAd->pCfg80211_CB, TRUE);
// RT_MOD_DEC_USE_COUNT();
pAd->flg_apcli_init = FALSE;
RT_MOD_INC_USE_COUNT();
printk("iverson ApCli_Close \n");
AsicSetBssid(pAd, pAd->cfg80211_ctrl.P2PCurrentAddress, 0x1);
AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
pAd->cfg80211_ctrl.isCfgInApMode = RT_CMD_80211_IFTYPE_STATION;
return ApCli_Close(pAd, cfg80211_ctrl->dummy_p2p_net_dev);
}
else if ((newType == RT_CMD_80211_IFTYPE_STATION) &&
(oldType == RT_CMD_80211_IFTYPE_P2P_GO))
{
DBGPRINT(RT_DEBUG_TRACE, ("GOi_Close\n"));
wdev_bcn_buf_deinit(pAd, &pAd->ApCfg.MBSSID[apidx].bcn_buf);
AsicSetBssid(pAd, pAd->cfg80211_ctrl.P2PCurrentAddress, 0x1);
AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
// rtmp_wdev_idx_unreg(pAd, Wdev);
// Wdev->if_dev = NULL;
}
#endif /* RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE */
#ifdef RT_CFG80211_P2P_CONCURRENT_DEVICE
#ifndef RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE
/* After P2P NEGO phase, the device type may be change from GC to GO
or no change. We remove the GC in VIF list if nego as GO case.
*/
if ((newType == RT_CMD_80211_IFTYPE_P2P_GO) &&
(oldType == RT_CMD_80211_IFTYPE_P2P_CLIENT))
{
RTMP_CFG80211_VirtualIF_CancelP2pClient(pAd);
}
#endif /* RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE */
#endif /* RT_CFG80211_P2P_CONCURRENT_DEVICE */
#ifdef RT_CFG80211_P2P_SINGLE_DEVICE
CFG80211DBG(RT_DEBUG_TRACE, ("80211> @@@ Change from %u to %u Mode\n",oldType,newType));
pCfg80211_ctrl->P2POpStatusFlags = CFG_P2P_DISABLE;
if (newType == RT_CMD_80211_IFTYPE_P2P_CLIENT)
{
pCfg80211_ctrl->P2POpStatusFlags = CFG_P2P_CLI_UP;
}
else if (newType == RT_CMD_80211_IFTYPE_P2P_GO)
{
pCfg80211_ctrl->P2POpStatusFlags = CFG_P2P_GO_UP;
}
#endif /* RT_CFG80211_P2P_SINGLE_DEVICE */
/* Change Device Type */
#ifdef CONFIG_STA_SUPPORT
if (newType == RT_CMD_80211_IFTYPE_ADHOC)
{
#ifdef DOT11_N_SUPPORT
SetCommonHT(pAd);
#endif /* DOT11_N_SUPPORT */
pAd->StaCfg.BssType = BSS_ADHOC;
}
else
#endif /* CONFIG_STA_SUPPORT */
if ((newType == RT_CMD_80211_IFTYPE_STATION) ||
(newType == RT_CMD_80211_IFTYPE_P2P_CLIENT))
{
CFG80211DBG(RT_DEBUG_TRACE, ("80211> Change the Interface to STA Mode\n"));
#ifdef CONFIG_STA_SUPPORT
if ((oldType == RT_CMD_80211_IFTYPE_ADHOC) &&
(newType == RT_CMD_80211_IFTYPE_STATION))
{
/* DeviceType Change from adhoc to infra,
only in StaCfg.
CFG Todo: It should not bind by device.
*/
pAd->StaCfg.BssType = BSS_INFRA;
}
#endif /* CONFIG_STA_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
if (pAd->cfg80211_ctrl.isCfgInApMode == RT_CMD_80211_IFTYPE_AP)
CFG80211DRV_DisableApInterface(pAd);
#endif /* CONFIG_AP_SUPPORT */
pAd->cfg80211_ctrl.isCfgInApMode = RT_CMD_80211_IFTYPE_STATION;
}
else if ((newType == RT_CMD_80211_IFTYPE_AP) ||
(newType == RT_CMD_80211_IFTYPE_P2P_GO))
{
CFG80211DBG(RT_DEBUG_TRACE, ("80211> Change the Interface to AP Mode\n"));
pAd->cfg80211_ctrl.isCfgInApMode = RT_CMD_80211_IFTYPE_AP;
}
#ifdef CONFIG_STA_SUPPORT
else if (newType == RT_CMD_80211_IFTYPE_MONITOR)
{
/* set packet filter */
Set_NetworkType_Proc(pAd, "Monitor");
if (pVifParm->MonFilterFlag != 0)
{
UINT32 Filter = 0;
#ifndef MT_MAC
if (pAd->chipCap.hif_type != HIF_MT) {
RTMP_IO_READ32(pAd, RX_FILTR_CFG, &Filter);
if ((pVifParm->MonFilterFlag & RT_CMD_80211_FILTER_FCSFAIL) == RT_CMD_80211_FILTER_FCSFAIL)
{
Filter = Filter & (~0x01);
}
else
{
Filter = Filter | 0x01;
}
if ((pVifParm->MonFilterFlag & RT_CMD_80211_FILTER_PLCPFAIL) == RT_CMD_80211_FILTER_PLCPFAIL)
{
Filter = Filter & (~0x02);
}
else
{
Filter = Filter | 0x02;
}
if ((pVifParm->MonFilterFlag & RT_CMD_80211_FILTER_CONTROL) == RT_CMD_80211_FILTER_CONTROL)
{
Filter = Filter & (~0xFF00);
}
else
{
Filter = Filter | 0xFF00;
}
if ((pVifParm->MonFilterFlag & RT_CMD_80211_FILTER_OTHER_BSS) == RT_CMD_80211_FILTER_OTHER_BSS)
{
Filter = Filter & (~0x08);
}
else
{
Filter = Filter | 0x08;
}
RTMP_IO_WRITE32(pAd, RX_FILTR_CFG, Filter);
}
#endif /* MT_MAC */
pVifParm->MonFilterFlag = Filter;
}
}
#endif /*CONFIG_STA_SUPPORT*/
if ((newType == RT_CMD_80211_IFTYPE_P2P_CLIENT) ||
(newType == RT_CMD_80211_IFTYPE_P2P_GO))
{
COPY_MAC_ADDR(pAd->cfg80211_ctrl.P2PCurrentAddress, pVifParm->net_dev->dev_addr);
}
else
{
#ifdef RT_CFG80211_P2P_SUPPORT
pCfg80211_ctrl->bP2pCliPmEnable = FALSE;
pCfg80211_ctrl->bPreKeepSlient = FALSE;
pCfg80211_ctrl->bKeepSlient = FALSE;
pCfg80211_ctrl->NoAIndex = MAX_LEN_OF_MAC_TABLE;
pCfg80211_ctrl->MyGOwcid = MAX_LEN_OF_MAC_TABLE;
pCfg80211_ctrl->CTWindows= 0; /* CTWindows and OppPS parameter field */
#endif /* RT_CFG80211_P2P_SUPPORT */
}
if(pCfg80211_ctrl == NULL)
CFG80211DBG(RT_DEBUG_TRACE, ("(%s)pCfg80211_ctrl is null",__FUNCTION__));
return TRUE;
}
static INT CFG80211_DummyP2pIf_Close(
IN PNET_DEV dev_p)
{
struct wireless_dev *wdev = dev_p->ieee80211_ptr;
#ifdef RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE
VOID *pAdSrc;
pAdSrc = RTMP_OS_NETDEV_GET_PRIV(dev_p);
ASSERT(pAdSrc);
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
PCFG80211_CTRL cfg80211_ctrl = &pAd->cfg80211_ctrl;
BOOLEAN isGoOn = FALSE;
UINT apidx = 1;
struct wifi_dev *Wdev;
#endif /* RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE */
if (!wdev)
return -EINVAL;
#ifdef RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE
if (pAd->flg_apcli_init)
{
DBGPRINT(RT_DEBUG_TRACE, ("ApCli_Close\n"));
CFG80211OS_ScanEnd(pAd->pCfg80211_CB, TRUE);
// RT_MOD_DEC_USE_COUNT();
ApCli_Close(pAd, dev_p);
}
DBGPRINT(RT_DEBUG_TRACE, ("%s: ===> %s\n", __FUNCTION__, RTMP_OS_NETDEV_GET_DEVNAME(dev_p)));
RTMP_OS_NETDEV_STOP_QUEUE(dev_p);
if (INFRA_ON(pAd))
AsicEnableBssSync(pAd,100);
else if (ADHOC_ON(pAd))
AsicEnableIbssSync(pAd);
else
AsicDisableSync(pAd);
//VIRTUAL_IF_DOWN(pAd);
if (cfg80211_ctrl->dummy_p2p_net_dev)
{
//iverson
if (isGoOn)
{
Wdev = &pAd->ApCfg.MBSSID[apidx].wdev;
wdev_bcn_buf_deinit(pAd, &pAd->ApCfg.MBSSID[apidx].bcn_buf);
rtmp_wdev_idx_unreg(pAd, Wdev);
Wdev->if_dev = NULL;
}
else
if (pAd->flg_apcli_init)
{
Wdev = &pAd->ApCfg.ApCliTab[MAIN_MBSSID].wdev;
OPSTATUS_CLEAR_FLAG(pAd, fOP_AP_STATUS_MEDIA_STATE_CONNECTED);
cfg80211_disconnected(dev_p, 0, NULL, 0, GFP_KERNEL);
CFG80211OS_ScanEnd(pAd->pCfg80211_CB, TRUE);
NdisZeroMemory(pAd->ApCfg.ApCliTab[MAIN_MBSSID].CfgApCliBssid, MAC_ADDR_LEN);
// RtmpOSNetDevDetach(dev_p);
rtmp_wdev_idx_unreg(pAd, Wdev);
pAd->flg_apcli_init = FALSE;
// Wdev->if_dev = NULL;
}
}
AsicSetBssid(pAd, pAd->cfg80211_ctrl.P2PCurrentAddress, 0x1);
AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
#endif /* RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE */
wdev->wiphy->interface_modes = (wdev->wiphy->interface_modes)
& (~(BIT(NL80211_IFTYPE_P2P_CLIENT)
| BIT(NL80211_IFTYPE_P2P_GO)
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,0))
| BIT(RT_CMD_80211_IFTYPE_P2P_DEVICE)
#endif /* LINUX_VERSION_CODE: 3.7.0 */
));
#ifdef RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE
RT_MOD_DEC_USE_COUNT();
#endif /* RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE */
return 0;
}
