BOOLEAN CFG80211DRV_OpsBeaconAdd(VOID *pAdOrg, VOID *pData)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdOrg;
CMD_RTPRIV_IOCTL_80211_BEACON *pBeacon;
// BOOLEAN Cancelled;
UINT i = 0;
#ifdef RT_CFG80211_P2P_SUPPORT
UINT apidx = CFG_GO_BSSID_IDX;
#else
UINT apidx = MAIN_MBSSID;
#endif /*RT_CFG80211_P2P_SUPPORT*/
BSS_STRUCT *pMbss = &pAd->ApCfg.MBSSID[apidx];
struct wifi_dev *wdev = &pMbss->wdev;
CHAR tr_tb_idx = MAX_LEN_OF_MAC_TABLE + apidx;
/* for Concurrent, AP/P2P GO use HW_BSSID 1 */
//wdev->hw_bssid_idx = CFG_GO_BSSID_IDX;
wdev->hw_bssid_idx = apidx;
#ifdef RT_CFG80211_SUPPORT
#ifdef RT_CFG80211_P2P_SUPPORT
if (!RTMP_CFG80211_VIF_P2P_GO_ON(pAd))
#endif /* RT_CFG80211_P2P_SUPPORT */
wdev->Hostapd=Hostapd_CFG;
#endif /* RT_CFG80211_SUPPORT */
CFG80211DBG(RT_DEBUG_TRACE, ("80211> %s ==>\n", __FUNCTION__));
#ifdef CONFIG_AP_SUPPORT
#endif /* CONFIG_AP_SUPPORT */
pBeacon = (CMD_RTPRIV_IOCTL_80211_BEACON *)pData;
#ifdef UAPSD_SUPPORT
wdev->UapsdInfo.bAPSDCapable = TRUE;
pMbss->CapabilityInfo |= 0x0800;
#endif /* UAPSD_SUPPORT */
CFG80211DRV_UpdateApSettingFromBeacon(pAd, apidx, pBeacon);
AsicSetRxFilter(pAd);
/* Start from 0 & MT_MAC using HW_BSSID 1, TODO */
#ifdef RT_CFG80211_P2P_SUPPORT
pAd->ApCfg.BssidNum = (CFG_GO_BSSID_IDX + 1);
#else
pAd->ApCfg.BssidNum = (MAIN_MBSSID + 1);
#endif /*RT_CFG80211_P2P_SUPPORT*/
pAd->MacTab.MsduLifeTime = 20; /* pEntry's UAPSD Q Idle Threshold */
/* CFG_TODO */
pAd->ApCfg.MBSSID[apidx].bcn_buf.BcnBufIdx = 0 ;
for(i = 0; i < WLAN_MAX_NUM_OF_TIM; i++)
pAd->ApCfg.MBSSID[apidx].TimBitmaps[i] = 0;
pMbss->bcn_buf.bBcnSntReq = TRUE;
/* For GO Timeout */
#ifdef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
pAd->ApCfg.StaIdleTimeout = 300;
pMbss->StationKeepAliveTime = 60;
#else
pAd->ApCfg.StaIdleTimeout = 300;
pMbss->StationKeepAliveTime = 0;
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
AsicDisableSync(pAd);
if (pAd->CommonCfg.Channel > 14)
pAd->CommonCfg.PhyMode = (WMODE_A | WMODE_AN);
else
pAd->CommonCfg.PhyMode = (WMODE_B | WMODE_G |WMODE_GN);
/* cfg_todo */
wdev->bWmmCapable = TRUE;
wdev->wdev_type = WDEV_TYPE_AP;
wdev->func_dev = (void *)&pAd->ApCfg.MBSSID[apidx];
wdev->sys_handle = (void *)pAd;
wdev->func_idx = apidx; //NEW
#ifdef RT_CFG80211_P2P_CONCURRENT_DEVICE
/* Using netDev ptr from VifList if VifDevList Exist */
PNET_DEV pNetDev = NULL;
if ((pAd->cfg80211_ctrl.Cfg80211VifDevSet.vifDevList.size > 0) &&
((pNetDev = RTMP_CFG80211_FindVifEntry_ByType(pAd, RT_CMD_80211_IFTYPE_P2P_GO)) != NULL))
{
wdev->if_dev = pNetDev;
COPY_MAC_ADDR(wdev->bssid, pNetDev->dev_addr);
COPY_MAC_ADDR(wdev->if_addr, pNetDev->dev_addr);
RTMP_OS_NETDEV_SET_WDEV(pNetDev, wdev);
RTMP_OS_NETDEV_SET_PRIV(pNetDev, pAd);
}
else
#endif /* RT_CFG80211_P2P_CONCURRENT_DEVICE */
{
wdev->if_dev = pAd->net_dev;
COPY_MAC_ADDR(wdev->bssid, pAd->CurrentAddress);
COPY_MAC_ADDR(wdev->if_addr, pAd->CurrentAddress);
/* assoc to MBSSID's wdev */
RTMP_OS_NETDEV_SET_WDEV(pAd->net_dev, wdev);
RTMP_OS_NETDEV_SET_PRIV(pAd->net_dev, pAd);
//reset to INT_MAIN , because SET_PRIV would clear priv_flag
RT_DEV_PRIV_FLAGS_SET(pAd->net_dev,INT_MAIN);
}
/* BC/MC Handling */
wdev->tr_tb_idx = tr_tb_idx;
tr_tb_set_mcast_entry(pAd, tr_tb_idx, wdev);
/* 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;
wdev_bcn_buf_init(pAd, &pAd->ApCfg.MBSSID[apidx].bcn_buf);
if (rtmp_wdev_idx_reg(pAd, wdev) < 0)
{
DBGPRINT(RT_DEBUG_TRACE, ("%s(): register wdev fail\n", __FUNCTION__));
}
wdev->allow_data_tx = TRUE;
AsicSetBssid(pAd, wdev->if_addr, 0x1);
AsicSetDevMac(pAd, wdev->if_addr, 0x1);
DBGPRINT(RT_DEBUG_TRACE, ("New AP BSSID %02x:%02x:%02x:%02x:%02x:%02x (%d)\n",
PRINT_MAC(wdev->bssid), pAd->CommonCfg.PhyMode));
RTMPSetPhyMode(pAd, pAd->CommonCfg.PhyMode);
#ifdef DOT11_N_SUPPORT
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode) && (pAd->Antenna.field.TxPath == 2))
bbp_set_txdac(pAd, 2);
else
#endif /* DOT11_N_SUPPORT */
bbp_set_txdac(pAd, 0);
/* Receiver Antenna selection */
bbp_set_rxpath(pAd, pAd->Antenna.field.RxPath);
if(!OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_MEDIA_STATE_CONNECTED))
{
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode) || wdev->bWmmCapable)
{
/* EDCA parameters used for AP's own transmission */
if (pAd->CommonCfg.APEdcaParm.bValid == FALSE)
set_default_ap_edca_param(pAd);
/* EDCA parameters to be annouced in outgoing BEACON, used by WMM STA */
if (pAd->ApCfg.BssEdcaParm.bValid == FALSE)
set_default_sta_edca_param(pAd);
AsicSetEdcaParm(pAd, &pAd->CommonCfg.APEdcaParm);
}
else
AsicSetEdcaParm(pAd, NULL);
}
#ifdef DOT11_N_SUPPORT
#ifndef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode))
pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth = BW_20; /* Patch UI */
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
AsicSetRDG(pAd, pAd->CommonCfg.bRdg);
AsicSetRalinkBurstMode(pAd, pAd->CommonCfg.bRalinkBurstMode);
#endif /* DOT11_N_SUPPORT */
//AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("%s():Reset WCID Table\n", __FUNCTION__));
AsicDelWcidTab(pAd, WCID_ALL);
pAd->MacTab.Content[0].Addr[0] = 0x01;
pAd->MacTab.Content[0].HTPhyMode.field.MODE = MODE_OFDM;
pAd->MacTab.Content[0].HTPhyMode.field.MCS = 3;
#ifdef DOT11_N_SUPPORT
SetCommonHT(pAd);
#endif /* DOT11_N_SUPPORT */
/*In MCC & p2p GO not support VHT now, */
/*change here for support P2P GO 40 BW*/
/* pAd->CommonCfg.vht_bw = 0;*/
if(pAd->CommonCfg.RegTransmitSetting.field.EXTCHA == EXTCHA_BELOW)
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel - 2;
else if (pAd->CommonCfg.RegTransmitSetting.field.EXTCHA == EXTCHA_ABOVE)
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel + 2;
else
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
AsicSwitchChannel(pAd, pAd->CommonCfg.CentralChannel,FALSE);
AsicLockChannel(pAd, pAd->CommonCfg.CentralChannel);
#ifdef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
bbp_set_bw(pAd, wdev->bw);
#else
bbp_set_bw(pAd, pAd->CommonCfg.RegTransmitSetting.field.BW);
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
AsicBBPAdjust(pAd);
//MlmeSetTxPreamble(pAd, (USHORT)pAd->CommonCfg.TxPreamble);
//MlmeUpdateTxRates(pAd, FALSE, MIN_NET_DEVICE_FOR_MBSSID);
#ifdef RT_CFG80211_P2P_SUPPORT
MlmeUpdateTxRates(pAd, FALSE, MIN_NET_DEVICE_FOR_CFG80211_VIF_P2P_GO + apidx);
#else
MlmeUpdateTxRates(pAd, FALSE, apidx);
#endif /*RT_CFG80211_P2P_SUPPORT*/
#ifdef DOT11_N_SUPPORT
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode))
MlmeUpdateHtTxRates(pAd, MIN_NET_DEVICE_FOR_MBSSID);
#endif /* DOT11_N_SUPPORT */
/* Disable Protection first. */
if (!INFRA_ON(pAd))
AsicUpdateProtect(pAd, 0, (ALLN_SETPROTECT|CCKSETPROTECT|OFDMSETPROTECT), TRUE, FALSE);
APUpdateCapabilityAndErpIe(pAd);
#ifdef DOT11_N_SUPPORT
APUpdateOperationMode(pAd);
#endif /* DOT11_N_SUPPORT */
CFG80211_UpdateBeacon(pAd, pBeacon->beacon_head, pBeacon->beacon_head_len,
pBeacon->beacon_tail, pBeacon->beacon_tail_len, TRUE);
#ifdef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
if (INFRA_ON(pAd))
{
ULONG BPtoJiffies;
LONG timeDiff;
INT starttime= pAd->Mlme.channel_1st_staytime;
NdisGetSystemUpTime(&pAd->Mlme.BeaconNow32);
timeDiff = (pAd->Mlme.BeaconNow32 - pAd->StaCfg.LastBeaconRxTime) % (pAd->CommonCfg.BeaconPeriod);
DBGPRINT(RT_DEBUG_TRACE, ("#####pAd->Mlme.Now32 %d pAd->StaCfg.LastBeaconRxTime %d \n",pAd->Mlme.BeaconNow32,pAd->StaCfg.LastBeaconRxTime));
DBGPRINT(RT_DEBUG_TRACE, ("#### timeDiff %d \n",timeDiff));
if (starttime > timeDiff)
{
OS_WAIT((starttime - timeDiff));
}
else{
OS_WAIT((starttime + (pAd->CommonCfg.BeaconPeriod - timeDiff)));
}
}
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
/* Enable BSS Sync*/
#ifdef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
if (INFRA_ON(pAd))
{
ULONG BPtoJiffies;
LONG timeDiff;
INT starttime= pAd->Mlme.channel_1st_staytime;
NdisGetSystemUpTime(&pAd->Mlme.BeaconNow32);
timeDiff = (pAd->Mlme.BeaconNow32 - pAd->StaCfg.LastBeaconRxTime) % (pAd->CommonCfg.BeaconPeriod);
DBGPRINT(RT_DEBUG_TRACE, ("#####pAd->Mlme.Now32 %d pAd->StaCfg.LastBeaconRxTime %d \n",pAd->Mlme.BeaconNow32,pAd->StaCfg.LastBeaconRxTime));
DBGPRINT(RT_DEBUG_TRACE, ("#### timeDiff %d \n",timeDiff));
if (starttime > timeDiff)
{
OS_WAIT((starttime - timeDiff));
}
else{
OS_WAIT((starttime + (pAd->CommonCfg.BeaconPeriod - timeDiff)));
}
}
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
AsicEnableApBssSync(pAd, pAd->CommonCfg.BeaconPeriod);
//pAd->P2pCfg.bSentProbeRSP = TRUE;
AsicSetPreTbtt(pAd, TRUE);
OPSTATUS_SET_FLAG(pAd, fOP_AP_STATUS_MEDIA_STATE_CONNECTED);
RTMP_IndicateMediaState(pAd, NdisMediaStateConnected);
return TRUE;
}
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;
}
VOID RTMP_CFG80211_VirtualIF_Init(
IN VOID *pAdSrc,
IN CHAR *pDevName,
IN UINT32 DevType)
{
#ifdef RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE
return;
#endif /* RT_CFG80211_P2P_STATIC_CONCURRENT_DEVICE */
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
RTMP_OS_NETDEV_OP_HOOK netDevHook, *pNetDevOps;
PNET_DEV new_dev_p;
APCLI_STRUCT *pApCliEntry;
struct wifi_dev *wdev;
#ifdef RT_CFG80211_P2P_SUPPORT
UINT apidx = CFG_GO_BSSID_IDX;
#else
UINT apidx = MAIN_MBSSID;
#endif /*RT_CFG80211_P2P_SUPPORT*/
CHAR tr_tb_idx = MAX_LEN_OF_MAC_TABLE + apidx;
CHAR preIfName[12];
UINT devNameLen = strlen(pDevName);
UINT preIfIndex = pDevName[devNameLen-1] - 48;
CFG80211_CB *p80211CB = pAd->pCfg80211_CB;
struct wireless_dev *pWdev;
UINT32 MC_RowID = 0, IoctlIF = 0, Inf = INT_P2P;
memset(preIfName, 0, sizeof(preIfName));
NdisCopyMemory(preIfName, pDevName, devNameLen-1);
pNetDevOps=&netDevHook;
DBGPRINT(RT_DEBUG_TRACE, ("%s ---> (%s, %s, %d)\n", __FUNCTION__, pDevName, preIfName, preIfIndex));
/* init operation functions and flags */
NdisZeroMemory(&netDevHook, sizeof(netDevHook));
netDevHook.open = CFG80211_VirtualIF_Open; /* device opem hook point */
netDevHook.stop = CFG80211_VirtualIF_Close; /* device close hook point */
netDevHook.xmit = CFG80211_VirtualIF_PacketSend; /* hard transmit hook point */
netDevHook.ioctl = CFG80211_VirtualIF_Ioctl; /* ioctl hook point */
#if WIRELESS_EXT >= 12
//netDevHook.iw_handler = (void *)&rt28xx_ap_iw_handler_def;
#endif /* WIRELESS_EXT >= 12 */
new_dev_p = RtmpOSNetDevCreate(MC_RowID, &IoctlIF, Inf, preIfIndex, sizeof(PRTMP_ADAPTER), preIfName);
if (new_dev_p == NULL)
{
/* allocation fail, exit */
DBGPRINT(RT_DEBUG_ERROR, ("Allocate network device fail (CFG80211)...\n"));
return;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("Register CFG80211 I/F (%s)\n", RTMP_OS_NETDEV_GET_DEVNAME(new_dev_p)));
}
new_dev_p->destructor = free_netdev;
RTMP_OS_NETDEV_SET_PRIV(new_dev_p, pAd);
pNetDevOps->needProtcted = TRUE;
NdisMoveMemory(&pNetDevOps->devAddr[0], &pAd->CurrentAddress[0], MAC_ADDR_LEN);
#ifdef MT_MAC
INT32 Value;
UCHAR MacByte = 0;
//TODO: shall we make choosing which byte to be selectable???
Value = 0x00000000L;
RTMP_IO_READ32(pAd, LPON_BTEIR, &Value);//read BTEIR bit[31:29] for determine to choose which byte to extend BSSID mac address.
Value = Value | (0x2 << 29);//Note: Carter, make default will use byte4 bit[31:28] to extend Mac Address
RTMP_IO_WRITE32(pAd, LPON_BTEIR, Value);
MacByte = Value >> 29;
pNetDevOps->devAddr[0] |= 0x2;
switch (MacByte) {
case 0x1: /* choose bit[23:20]*/
pNetDevOps->devAddr[2] = (pNetDevOps->devAddr[2] = pNetDevOps->devAddr[2] & 0x0f);
break;
case 0x2: /* choose bit[31:28]*/
pNetDevOps->devAddr[3] = (pNetDevOps->devAddr[3] = pNetDevOps->devAddr[3] & 0x0f);
break;
case 0x3: /* choose bit[39:36]*/
pNetDevOps->devAddr[4] = (pNetDevOps->devAddr[4] = pNetDevOps->devAddr[4] & 0x0f);
break;
case 0x4: /* choose bit [47:44]*/
pNetDevOps->devAddr[5] = (pNetDevOps->devAddr[5] = pNetDevOps->devAddr[5] & 0x0f);
break;
default: /* choose bit[15:12]*/
pNetDevOps->devAddr[1] = (pNetDevOps->devAddr[1] = pNetDevOps->devAddr[1] & 0x0f);
break;
}
AsicSetDevMac(pAd, pNetDevOps->devAddr, 0x1);//set own_mac to HWBSSID1
#else
//CFG_TODO
/*
Bit1 of MAC address Byte0 is local administration bit
and should be set to 1 in extended multiple BSSIDs'
Bit3~ of MAC address Byte0 is extended multiple BSSID index.
*/
if (pAd->chipCap.MBSSIDMode == MBSSID_MODE1)
pNetDevOps->devAddr[0] += 2; /* NEW BSSID */
else
{
#ifdef P2P_ODD_MAC_ADJUST
if (pNetDevOps->devAddr[5] & 0x01 == 0x01)
pNetDevOps->devAddr[5] -= 1;
else
#endif /* P2P_ODD_MAC_ADJUST */
pNetDevOps->devAddr[5] += FIRST_MBSSID;
}
#endif /* MT_MAC */
switch (DevType)
{
#ifdef CONFIG_STA_SUPPORT
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_P2P_CLIENT:
case RT_CMD_80211_IFTYPE_STATION:
pApCliEntry = &pAd->ApCfg.ApCliTab[MAIN_MBSSID];
wdev = &pApCliEntry->wdev;
wdev->wdev_type = WDEV_TYPE_STA;
wdev->func_dev = pApCliEntry;
wdev->func_idx = MAIN_MBSSID;
wdev->sys_handle = (void *)pAd;
wdev->if_dev = new_dev_p;
/* TX */
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(new_dev_p, pAd);
RTMP_OS_NETDEV_SET_WDEV(new_dev_p, 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(new_dev_p)));
RtmpOSNetDevFree(new_dev_p);
break;
}
/* init MAC address of virtual network interface */
COPY_MAC_ADDR(wdev->if_addr, pNetDevOps->devAddr);
break;
#endif /*CONFIG_STA_SUPPORT*/
case RT_CMD_80211_IFTYPE_P2P_GO:
/* Only ForceGO init from here,
Nego as GO init on AddBeacon Ops.
*/
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 = new_dev_p;
/* BC/MC Handling */
wdev->tr_tb_idx = tr_tb_idx;
tr_tb_set_mcast_entry(pAd, tr_tb_idx, wdev);
/* 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;
/* for concurrent purpose */
wdev->hw_bssid_idx = CFG_GO_BSSID_IDX;
wdev_bcn_buf_init(pAd, &pAd->ApCfg.MBSSID[apidx].bcn_buf);
RTMP_OS_NETDEV_SET_PRIV(new_dev_p, pAd);
RTMP_OS_NETDEV_SET_WDEV(new_dev_p, 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(new_dev_p)));
RtmpOSNetDevFree(new_dev_p);
break;
}
COPY_MAC_ADDR(pAd->ApCfg.MBSSID[apidx].wdev.if_addr, pNetDevOps->devAddr);
COPY_MAC_ADDR(pAd->ApCfg.MBSSID[apidx].wdev.bssid, pNetDevOps->devAddr);
break;
default:
DBGPRINT(RT_DEBUG_ERROR, ("Unknown CFG80211 I/F Type (%d)\n", DevType));
}
//CFG_TODO : should be move to VIF_CHG
if ((DevType == RT_CMD_80211_IFTYPE_P2P_CLIENT) ||
(DevType == RT_CMD_80211_IFTYPE_P2P_GO))
{
COPY_MAC_ADDR(pAd->cfg80211_ctrl.P2PCurrentAddress, pNetDevOps->devAddr);
}
pWdev = kzalloc(sizeof(*pWdev), GFP_KERNEL);
new_dev_p->ieee80211_ptr = pWdev;
pWdev->wiphy = p80211CB->pCfg80211_Wdev->wiphy;
SET_NETDEV_DEV(new_dev_p, wiphy_dev(pWdev->wiphy));
pWdev->netdev = new_dev_p;
pWdev->iftype = DevType;
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,0))
COPY_MAC_ADDR(pWdev->address, pNetDevOps->devAddr);
#endif /* LINUX_VERSION_CODE: 3.7.0 */
RtmpOSNetDevAttach(pAd->OpMode, new_dev_p, pNetDevOps);
//AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
//AsicSetBssid(pAd, wdev->if_addr, 0x1);
/* Record the pNetDevice to Cfg80211VifDevList */
RTMP_CFG80211_AddVifEntry(pAd, new_dev_p, DevType);
DBGPRINT(RT_DEBUG_TRACE, ("%s <---\n", __FUNCTION__));
}
/*
========================================================================
Routine Description:
Initialize Multi-BSS function.
Arguments:
pAd points to our adapter
pDevMain points to the main BSS network interface
Return Value:
None
Note:
1. Only create and initialize virtual network interfaces.
2. No main network interface here.
3. If you down ra0 and modify the BssNum of RT2860AP.dat/RT2870AP.dat,
it will not work! You must rmmod rt2860ap.ko and lsmod rt2860ap.ko again.
========================================================================
*/
VOID MBSS_Init(RTMP_ADAPTER *pAd, RTMP_OS_NETDEV_OP_HOOK *pNetDevOps)
{
#define MBSS_MAX_DEV_NUM 32
PNET_DEV pDevNew;
INT32 IdBss, MaxNumBss;
INT status;
RTMP_OS_NETDEV_OP_HOOK netDevHook;
/* sanity check to avoid redundant virtual interfaces are created */
if (pAd->FlgMbssInit != FALSE)
return;
MaxNumBss = pAd->ApCfg.BssidNum;
if (MaxNumBss > MAX_MBSSID_NUM(pAd))
MaxNumBss = MAX_MBSSID_NUM(pAd);
/* first IdBss must not be 0 (BSS0), must be 1 (BSS1) */
for(IdBss=FIRST_MBSSID; IdBss<MAX_MBSSID_NUM(pAd); IdBss++)
pAd->ApCfg.MBSSID[IdBss].wdev.if_dev = NULL;
/* create virtual network interface */
for(IdBss=FIRST_MBSSID; IdBss<MaxNumBss; IdBss++)
{
struct wifi_dev *wdev;
UINT32 MC_RowID = 0, IoctlIF = 0;
char *dev_name;
#ifdef MULTIPLE_CARD_SUPPORT
MC_RowID = pAd->MC_RowID;
#endif /* MULTIPLE_CARD_SUPPORT */
#ifdef HOSTAPD_SUPPORT
IoctlIF = pAd->IoctlIF;
#endif /* HOSTAPD_SUPPORT */
BSS_STRUCT *pMbss;
dev_name = get_dev_name_prefix(pAd, INT_MBSSID);
pDevNew = RtmpOSNetDevCreate(MC_RowID, &IoctlIF, INT_MBSSID, IdBss, sizeof(struct mt_dev_priv), dev_name);
#ifdef HOSTAPD_SUPPORT
pAd->IoctlIF = IoctlIF;
#endif /* HOSTAPD_SUPPORT */
if (pDevNew == NULL)
{
pAd->ApCfg.BssidNum = IdBss; /* re-assign new MBSS number */
break;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("Register MBSSID IF (%s)\n", RTMP_OS_NETDEV_GET_DEVNAME(pDevNew)));
}
pMbss = &pAd->ApCfg.MBSSID[IdBss];
wdev = &pAd->ApCfg.MBSSID[IdBss].wdev;
wdev->wdev_type = WDEV_TYPE_AP;
wdev->func_dev = &pAd->ApCfg.MBSSID[IdBss];
wdev->func_idx = IdBss;
wdev->sys_handle = (void *)pAd;
wdev->if_dev = pDevNew;
if (rtmp_wdev_idx_reg(pAd, wdev) < 0) {
DBGPRINT(RT_DEBUG_ERROR, ("Assign wdev idx for %s failed, free net device!\n",
RTMP_OS_NETDEV_GET_DEVNAME(pDevNew)));
RtmpOSNetDevFree(pDevNew);
break;
}
wdev->tx_pkt_allowed = ApAllowToSendPacket;
wdev->tx_pkt_handle = APSendPacket;
wdev->wdev_hard_tx = APHardTransmit;
wdev->rx_pkt_allowed = ap_rx_pkt_allow;
wdev->rx_ps_handle = ap_rx_ps_handle;
wdev->rx_pkt_foward = ap_rx_foward_handle;
RTMP_OS_NETDEV_SET_PRIV(pDevNew, pAd);
RTMP_OS_NETDEV_SET_WDEV(pDevNew, wdev);
/* init operation functions and flags */
NdisCopyMemory(&netDevHook, pNetDevOps, sizeof(netDevHook));
netDevHook.priv_flags = INT_MBSSID;
netDevHook.needProtcted = TRUE;
netDevHook.wdev = wdev;
/* Init MAC address of virtual network interface */
NdisMoveMemory(&netDevHook.devAddr[0], &wdev->bssid[0], MAC_ADDR_LEN);
/* register this device to OS */
status = RtmpOSNetDevAttach(pAd->OpMode, pDevNew, &netDevHook);
ASSERT(pMbss);
if (pMbss) {
wdev_bcn_buf_init(pAd, &pMbss->bcn_buf);
} else {
DBGPRINT(RT_DEBUG_ERROR, ("%s():func_dev is NULL!\n", __FUNCTION__));
return;
}
}
pAd->FlgMbssInit = TRUE;
}
