VOID RTMP_CFG80211_VirtualIF_Init(
IN VOID *pAdSrc,
IN CHAR *pDevName,
IN UINT32 DevType)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
RTMP_OS_NETDEV_OP_HOOK netDevHook, *pNetDevOps;
PNET_DEV new_dev_p;
#ifdef RT_CFG80211_P2P_SUPPORT
APCLI_STRUCT *pApCliEntry;
#endif /* RT_CFG80211_P2P_SUPPORT */
struct wifi_dev *wdev;
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);
//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;
}
switch (DevType)
{
case RT_CMD_80211_IFTYPE_MONITOR:
DBGPRINT(RT_DEBUG_ERROR, ("CFG80211 I/F Monitor Type\n"));
//RTMP_OS_NETDEV_SET_TYPE_MONITOR(new_dev_p);
break;
#ifdef RT_CFG80211_P2P_SUPPORT
case RT_CMD_80211_IFTYPE_P2P_CLIENT:
pApCliEntry = &pAd->ApCfg.ApCliTab[MAIN_MBSSID];
wdev = &pApCliEntry->wdev;
wdev->wdev_type = WDEV_TYPE_STA;
wdev->func_dev = pApCliEntry;
wdev->sys_handle = (void *)pAd;
wdev->if_dev = new_dev_p;
wdev->tx_pkt_allowed = ApCliAllowToSendPacket;
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;
case RT_CMD_80211_IFTYPE_P2P_GO:
pNetDevOps->priv_flags = INT_P2P;
pAd->ApCfg.MBSSID[MAIN_MBSSID].MSSIDDev = NULL;
/* The Behivaor in SetBeacon Ops */
//pAd->ApCfg.MBSSID[MAIN_MBSSID].MSSIDDev = new_dev_p;
pAd->cfg80211_ctrl.isCfgInApMode = RT_CMD_80211_IFTYPE_AP;
COPY_MAC_ADDR(pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.if_addr, pNetDevOps->devAddr);
COPY_MAC_ADDR(pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.bssid, pNetDevOps->devAddr);
break;
#endif /* RT_CFG80211_P2P_SUPPORT */
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;
RtmpOSNetDevAttach(pAd->OpMode, new_dev_p, pNetDevOps);
AsicSetBssid(pAd, pAd->CurrentAddress);
/* Record the pNetDevice to Cfg80211VifDevList */
RTMP_CFG80211_AddVifEntry(pAd, new_dev_p, DevType);
DBGPRINT(RT_DEBUG_TRACE, ("%s <---\n", __FUNCTION__));
}
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__));
}
VOID RTMP_CFG80211_VirtualIF_Init(
IN struct rtmp_adapter *pAd,
IN CHAR *pDevName,
IN uint32_t DevType)
{
struct RTMP_OS_NETDEV_OP_HOOK netDevHook, *pNetDevOps;
struct net_device *new_dev_p;
struct rtmp_wifi_dev *wdev;
CHAR preIfName[12];
UINT devNameLen = strlen(pDevName);
UINT preIfIndex = pDevName[devNameLen-1] - 48;
struct mt7612u_cfg80211_cb *p80211CB = pAd->pCfg80211_CB;
struct wireless_dev *pWdev;
uint32_t MC_RowID = 0, IoctlIF = 0, Inf = INT_P2P;
memset(preIfName, 0, sizeof(preIfName));
memcpy(preIfName, pDevName, devNameLen-1);
pNetDevOps=&netDevHook;
DBGPRINT(RT_DEBUG_TRACE, ("%s ---> (%s, %s, %d)\n", __FUNCTION__, pDevName, preIfName, preIfIndex));
/* init operation functions and flags */
memset(&netDevHook, 0, 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(struct rtmp_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)));
}
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4,11,9))
new_dev_p->needs_free_netdev = true;
#else
new_dev_p->destructor = free_netdev;
#endif
RTMP_OS_NETDEV_SET_PRIV(new_dev_p, pAd);
pNetDevOps->needProtcted = true;
memmove(&pNetDevOps->devAddr[0], &pAd->CurrentAddress[0], MAC_ADDR_LEN);
//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;
}
switch (DevType)
{
case RT_CMD_80211_IFTYPE_MONITOR:
DBGPRINT(RT_DEBUG_ERROR, ("CFG80211 I/F Monitor Type\n"));
//RTMP_OS_NETDEV_SET_TYPE_MONITOR(new_dev_p);
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;
RtmpOSNetDevAttach(pAd->OpMode, new_dev_p, pNetDevOps);
AsicSetBssid(pAd, pAd->CurrentAddress);
/* Record the pNetDevice to Cfg80211VifDevList */
RTMP_CFG80211_AddVifEntry(pAd, new_dev_p, DevType);
DBGPRINT(RT_DEBUG_TRACE, ("%s <---\n", __FUNCTION__));
}
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;
}