NDIS_STATUS IgmpPktInfoQuery(
IN PRTMP_ADAPTER pAd,
IN PUCHAR pSrcBufVA,
IN PNDIS_PACKET pPacket,
IN UCHAR FromWhichBSSID,
OUT INT *pInIgmpGroup,
OUT PMULTICAST_FILTER_TABLE_ENTRY *ppGroupEntry)
{
if(IS_MULTICAST_MAC_ADDR(pSrcBufVA))
{
INT32 ExcludedGroupType = -1;
UINT16 EtherType = ntohs(*((UINT16 *)(pSrcBufVA + 12)));
if (EtherType == ETH_P_IPV6)
{
ExcludedGroupType = IPv6MulticastFilterExcluded(pSrcBufVA);
}
else if(EtherType == ETH_P_IP)
{
ExcludedGroupType = IPv4MulticastFilterExcluded(pSrcBufVA);
}
if (ExcludedGroupType)
{
*ppGroupEntry = NULL;
if (ExcludedGroupType == 1)
*pInIgmpGroup = IGMP_PKT;
}
else if ((*ppGroupEntry = MulticastFilterTableLookup(pAd->pMulticastFilterTable, pSrcBufVA,
get_netdev_from_bssid(pAd, FromWhichBSSID))) == NULL)
{
RELEASE_NDIS_PACKET(pAd, pPacket, NDIS_STATUS_FAILURE);
return NDIS_STATUS_FAILURE;
}
else
*pInIgmpGroup = IGMP_IN_GROUP;
}
else if (IS_BROADCAST_MAC_ADDR(pSrcBufVA))
{
PUCHAR pDstIpAddr = pSrcBufVA + 30; /* point to Destination of Ip address of IP header. */
UCHAR GroupMacAddr[6];
PUCHAR pGroupMacAddr = (PUCHAR)&GroupMacAddr;
ConvertMulticastIP2MAC(pDstIpAddr, (PUCHAR *)&pGroupMacAddr, ETH_P_IP);
if ((*ppGroupEntry = MulticastFilterTableLookup(pAd->pMulticastFilterTable, pGroupMacAddr,
get_netdev_from_bssid(pAd, FromWhichBSSID))) != NULL)
{
*pInIgmpGroup = IGMP_IN_GROUP;
}
}
return NDIS_STATUS_SUCCESS;
}
NDIS_STATUS IgmpPktInfoQuery(
IN PRTMP_ADAPTER pAd,
IN PUCHAR pSrcBufVA,
IN PNDIS_PACKET pPacket,
IN struct wifi_dev *wdev,
OUT INT *pInIgmpGroup,
OUT PMULTICAST_FILTER_TABLE_ENTRY *ppGroupEntry)
{
if(IS_MULTICAST_MAC_ADDR(pSrcBufVA))
{
BOOLEAN IgmpMldPkt = FALSE;
PUCHAR pIpHeader = pSrcBufVA + 12;
if(ntohs(*((UINT16 *)(pIpHeader))) == ETH_P_IPV6)
IgmpMldPkt = IPv6MulticastFilterExcluded(pSrcBufVA, pIpHeader);
else
IgmpMldPkt = isIgmpPkt(pSrcBufVA, pIpHeader);
if (IgmpMldPkt)
{
*ppGroupEntry = NULL;
*pInIgmpGroup = IGMP_PKT;
}
else if ((*ppGroupEntry = MulticastFilterTableLookup(pAd->pMulticastFilterTable, pSrcBufVA,
wdev->if_dev)) == NULL)
{
RELEASE_NDIS_PACKET(pAd, pPacket, NDIS_STATUS_FAILURE);
return NDIS_STATUS_FAILURE;
}
else
*pInIgmpGroup = IGMP_IN_GROUP;
}
else if (IS_BROADCAST_MAC_ADDR(pSrcBufVA))
{
PUCHAR pDstIpAddr = pSrcBufVA + 30; /* point to Destination of Ip address of IP header. */
UCHAR GroupMacAddr[6];
PUCHAR pGroupMacAddr = (PUCHAR)&GroupMacAddr;
ConvertMulticastIP2MAC(pDstIpAddr, (PUCHAR *)&pGroupMacAddr, ETH_P_IP);
if ((*ppGroupEntry = MulticastFilterTableLookup(pAd->pMulticastFilterTable, pGroupMacAddr,
wdev->if_dev)) != NULL)
{
*pInIgmpGroup = IGMP_IN_GROUP;
}
}
return NDIS_STATUS_SUCCESS;
}
