igmp_router.cpp~

igmp for switch in vxworks

		TimeOut =
			(TimerEntity *) StopTimer (IgmpGroup->
			tGroupPortLastMemberQueryTimer[usPort]);
	}
	else
	{
		TimeOut = (TimerEntity *) CustomMalloc (sizeof (TimerEntity));
		if (TimeOut == NULL)
		{
			if (bIgmpDebug)
			{
				printf ("Malloc Timer ERROR!\n");
			}
			return;
		}
		usCurrentTimer++;
	}
	TimeOut->TimerType = GroupPortLastMemberQueryTimeOutEvent;
	TimeOut->IgmpGroup = IgmpGroup;
	TimeOut->usPort = usPort;
	IgmpGroup->tGroupPortLastMemberQueryTimer[usPort] =
		StartTimer ((UINT) usLastMemberQueryInterval * 1000,
		(TIMERFUNC) ProcessIgmpTimerEvent, (ULONG) TimeOut, TIMERONESHOT);
	#endif

}

/***************************************************
函数名称:StopGroupPortLastMemberQueryTimer
函数功能:停止GroupPortLastMemberQuery定时器
输入参数:unTimerID 定时器ID号
返回值:	 无
***************************************************/
void StopGroupPortLastMemberQueryTimer (GroupEntity * IgmpGroup, USHORT usPort)
{
	IgmpGroup->tGroupPortLastMemberQueryTimer[usPort] = 0;
	
	#if 0
	TimerEntity *TimeOut;

	if (unTimerID != 0)
	{
		TimeOut = (TimerEntity *) StopTimer (unTimerID);
		CustomFree ((void *) TimeOut);
		usCurrentTimer--;
	}
	#endif
}

void RouterSendGroupSpecificQuery (UINT unGroupAddress, UCHAR MaxResponseTime,
	USHORT usPort)
{
	SendIgmpPkt (IGMPMembershipQuery, unGroupAddress, usPort, MaxResponseTime);
}

void RouterSendGenernalQueryToAllPort (void)
{
     SendIgmpPkt(IGMPMembershipQuery, 0, 1, 100);
}


/***************************************************
函数名称:TransformPVCToPort
函数功能:将PVC转换成端口号
输入参数:unPVC PVC的值
返回值:	 转换后的端口号
***************************************************/
static USHORT TransformPVCToPort (UINT unPVC)
{
	if(unPVC == 0)
	{
		return 0;
	}
	return ((USHORT) ((unPVC >> 4) & 0xFFFF) - 31);
}


/***************************************************
函数名称:PPPoENotifyIGMPUserOffline
函数功能:PPPoE用户下线后通知IGMP
输入参数:UINT unPVC    用户PVC
返回值:	 无
***************************************************/

void PPPoENotifyIGMPUserOffline(UINT unPVC)
{
	GroupEntity *pTemp;
	pTemp = pGroupEntityList;
	USHORT usPort = TransformPVCToPort(unPVC);
	while(pTemp)
	{
		if(FindPortInSpecificGroup(pTemp, usPort))
		{
			/*DeletePortFromSpecificGroup(pTemp,usPort);*/
		}
		pTemp = pTemp->pNext;
	}
}

void AddPortToSearchGroup(GroupEntity * IgmpGroup,USHORT usPort)
{
	/*SearchGroup * pSearchGroup;*/
	SearchNode * pSearchNode;
	
	pSearchNode = (SearchNode *) malloc (sizeof(struct search_node));
	if (NULL == pSearchNode)
	return;
	pSearchNode->pNext = IgmpGroup->pNode;
	pSearchNode->usPort = usPort;
	IgmpGroup->pNode = pSearchNode;
}


void DelPortFromSearchGroup(GroupEntity * IgmpGroup,USHORT usPort)
{
	SearchNode *pSearchNode;
	SearchNode *pSearchNodeTemp;
	
	if(IgmpGroup->pNode == NULL)
	{
		return;
	}
	if(IgmpGroup->pNode->usPort  == usPort)
	{
		pSearchNode = IgmpGroup->pNode;
		IgmpGroup->pNode = pSearchNode->pNext;
		free(pSearchNode);
		return;
	}
	pSearchNodeTemp = IgmpGroup->pNode;
	pSearchNode = IgmpGroup->pNode->pNext;
	while(pSearchNode)
	{
		if(pSearchNode->usPort == usPort)
		{
			pSearchNodeTemp->pNext = pSearchNode->pNext;
			free(pSearchNode);
			return;
		}
		pSearchNodeTemp = pSearchNodeTemp->pNext;
		pSearchNode = pSearchNode->pNext;
	}

}


/************************************************************************************
  函数名称: IpToMultimac
  功能描述: 把组播IP地址映射为组播MAC地址
  输入参数: ipaddr
  输出参数: ether_addr
  返回值:       N/A
************************************************************************************/
void IpToMutimac1 (struct in_addr ipaddr, u_char * ether_addr)
{
	u_char *p_ip;

	p_ip = (u_char *) & (ipaddr.s_addr);
	ether_addr[0] = 0x01;
	ether_addr[1] = 0x00;
	ether_addr[2] = 0x5e;
	ether_addr[3] = p_ip[1] & 0x7f;	/* modified by zhangxinhui */
	ether_addr[4] = p_ip[2];
	ether_addr[5] = p_ip[3];
}
/*extern void bcm_mcast_addr_t_init (bcm_mcast_addr_t *mcaddr,mac_addr_t mac, bcm_vlan_t vid);
extern void bcmk_mcast_addr_init(bcm_mcast_addr_t *mcaddr,mac_addr_t mac, bcm_vlan_t vid);
extern int  bcmk_mcast_addr_add(bcm_mcast_addr_t mcxaddr);
extern int  bcmj_mcast_addr_add(bcm_mcast_addr_t  *mcxaddr);
extern void bcm_mcast_addr_init(bcm_mcast_addr_t *mcaddr,mac_addr_t mac, bcm_vlan_t vid);
extern int  bcmk_mcast_join(mac_addr_t mcMacAddr, bcm_vlan_t vlanId,int srcPort);
extern int  bcmj_mcast_join(int dev, mac_addr_t mcMacAddr, bcm_vlan_t vlanId,int srcPort);
extern int  bcmk_mcast_addr_remove(mac_addr_t mac, bcm_vlan_t vid);
extern int  bcmj_mcast_addr_remove(mac_addr_t mac, bcm_vlan_t vid);
extern int  bcmk_mcast_leave(mac_addr_t mcMacAddr, bcm_vlan_t vlanId,int srcPort);
extern int  bcmj_mcast_leave(int dev, mac_addr_t mcMacAddr, bcm_vlan_t vlanId,int srcPort);	*/


/*函数功能：设置某VLAN中的unknown mcast的转发方式.
输入参数:unit,,设备号,永远为0;vlanid,组播组对应的VLAN ID;mode1,Multicast的转发方式,0表示所有组播组在VLAN中广播,1表示已知组播组在VLAN中按组播方式转发,未知组播组在VLAN中广播,2表示已知组播在组播组中转发,未知组播丢弃.
输出参数:无. 
返回值： 0 ,成功;<0,失败.
备注： 注意与bcm5690/bcm5695的区别.一般在组播功能打开时,转发应该设置为模式2,组播功能关闭时转发应该设置为模式0.*/
/*int bcm_vlan_mcast_flood_set(int unit, short vlanid, int mode);*/
/************************************************************************************
  函数名称: AddGroup
  功能描述: 写硬件组播表
  输入参数: unGroupAddress
  输出参数: 正确返回OK,失败返回ERROR
  返回值:       N/A
  作者           : aibin 2005-01-24
************************************************************************************/
int AddGroup(UINT unGroupAddress)
{
	/*struct IS_GROUP_MAC *p_groupmac = NULL;*/
	/*int group_vid = -1, find, i;*/
	struct in_addr gip;
	gip.s_addr = unGroupAddress;
	u_char gmac[6];
	int i;
	

	bcm_mcast_addr_t mcaddr[2];
	mac_addr_t mac_address;
	bcm_vlan_t vlanId;
	bcm_pbmp_t pbmp;
      	bcm_pbmp_t ubmp;

      	unsigned char dev;
      	unsigned char portOffSet;
      	int temp_dev, temp_portOffSet;

	IpToMutimac1 (gip, gmac);
	
	/*1.b.1   创建一个组播条目，以router_port[].vid为该组的vid */
	memcpy (mac_address,0, 8);
	memcpy (mac_address,gmac, 6);
	
	vlanId = GetGroupVlan (unGroupAddress);

	if (bIgmpDebug)
	{
		printf ("\r\ncreate  group %s, vid= %d\r\n", inet_ntoa (gip), vlanId);
	}
	memset(&pbmp,0,sizeof(bcm_pbmp_t));  
       memset(&ubmp,0,sizeof(bcm_pbmp_t));  

#ifdef _AN5116_06A_
     	bcm_mcast_addr_t_init(&mcaddr[0], mac_address, vlanId);      
#else
	bcm_mcast_addr_init(&mcaddr[0], mac_address, vlanId);      
      	bcm_mcast_addr_init(&mcaddr[1], mac_address, vlanId);      
#endif


      	mcaddr[0].pbmp=pbmp;
      	mcaddr[0].ubmp=ubmp;
      	mcaddr[1].pbmp=pbmp;
      	mcaddr[1].ubmp=ubmp;

#ifdef _AN5116_06A_
	/*if (bcm_vlan_mcast_flood_set(0, vlanId, 2) < 0)
	{
		return ERROR;
	}*/
	if (bcmk_mcast_addr_add(mcaddr[0])<0)
	{
	    /* bcm_vlan_mcast_flood_set(0, vlanId, 0);*/
	     return ERROR;
	}
#else
	if (bcmj_mcast_addr_add(mcaddr)<0)
	{
	     return ERROR;
	}
#endif
	
	return OK;
}

int chip5695 = 0;
/************************************************************************************
  函数名称: AddPortToGroup
  功能描述: 增加表项到硬件组播表
  输入参数: unGroupAddress 组播ip地址
                          usPort 接收到的包的端口号(槽位号)
    输出参数: 正确返回OK,失败返回ERROR
  返回值:       N/A
  作者           : aibin 2005-01-24
************************************************************************************/
int AddPortToGroup (UINT unGroupAddress, USHORT usPort)
{
	struct in_addr gip;
	gip.s_addr = unGroupAddress;
	mac_addr_t mac_address;
	unsigned char dev, dev1;
      	unsigned char portOffSet, portOffSet1; 
	int vlan;
	short vlanid;

	if(igmp_get_510port(usPort,&dev,&portOffSet)<0)
       	return ERROR;
	IpToMutimac1 (gip, mac_address);

	/*get vlan from online group, aibin 20080320*/
	vlanid = GetOnlineGroupVlan(unGroupAddress);
	if (-1 == vlanid)
	{
		printf ("not online group %x\r\n", unGroupAddress);
		return -1;
	}
	/*vlanid = GetGroupVlan (unGroupAddress);*/

	/*in cross vlan mode, add slot untag to group vlan, and add uplink port tag to group vlan*/
	if(0)         /*epon全部以tag流下发到线卡2007-03-11 aibin (gEnableCrossVlan)*/   
	{
		if (usPort >(usMaxPort-8))
		{
			debug_setslotvlan_no_pvid(usPort, 1, 0x1ffffff, 1, vlanid);
		}
		else
		{
			debug_setslotvlan_no_pvid(usPort, 0, 0x1ffffff, 1, vlanid);
		}
	}

	if (bIgmpDebug)
	{
		printf ("\r\nadd  slot %d to %s, vid= %d\r\n", usPort, inet_ntoa (gip), vlanid);
	}
	
#ifdef _AN5116_06A_
	if (ERROR == bcmk_mcast_join(mac_address, vlanid, portOffSet))
	{
		return ERROR;
	}
#else 
	if (ERROR == bcmj_mcast_join(dev, mac_address, vlanid, portOffSet))
	{
		return ERROR;
	}
#endif
	return OK;
}

int GetOnlineGroupVlan (UINT groupaddress)
{
	GroupEntity *pTemp;

	pTemp = FindIgmpGroupByAddress(groupaddress);
	if (NULL == pTemp)
	return -1;
	
	return pTemp->OutVlanTag;
}


	
/************************************************************************************
  函数名称: DelGroup
  功能描述: 在底层删除 相应组的组播转发表
  输入参数: unGroupAddress 组播ip地址
                          
    输出参数: 正确返回OK,失败返回ERROR
  返回值:       N/A
  作者           : aibin 2005-01-25
************************************************************************************/
int DelGroup (UINT unGroupAddress)
{
     	struct in_addr gip;
	gip.s_addr = unGroupAddress;
       mac_addr_t mac_address;
       IpToMutimac1 (gip, mac_address);
	short vlanid;

	/*get vlan from online group, aibin 20080320*/
	vlanid = GetOnlineGroupVlan(unGroupAddress);
	if (-1 == vlanid)
	{
		printf ("not online group %x\r\n", unGroupAddress);
		return -1;
	}
	/*vlanid = GetGroupVlan (unGroupAddress);*/
	   
	if (bIgmpDebug)
	{
		printf ("\r\nremoved  group %s, vid= %d\r\n", inet_ntoa (gip), vlanid);
		printf("mac_address is %x:%x:%x:%x:%x:%x, vlan: %d\r\n", mac_address[0],mac_address[1],mac_address[2],mac_address[3],mac_address[4],mac_address[5], vlanid);
	}	
#ifdef _AN5116_06A_
       if (ERROR == bcmk_mcast_addr_remove(mac_address, vlanid))
	{
		/*bcm_vlan_mcast_flood_set(0, vlanid, 1);*/
		return ERROR;
	}
	/*bcm_vlan_mcast_flood_set(0, vlanid, 0);*/
	return OK;
#else

 if (ERROR == bcmj_mcast_addr_remove(mac_address, vlanid))
	{
            
		return ERROR;
	}
	return OK;
#endif
}

/************************************************************************************
  函数名称: DelPortFromGroup1
  功能描述: 在硬件表中删除端口 (线卡的曹位 )
  输入参数: unGroupAddress 组播ip地址
                          usPort 接收到的包的端口号(槽位号)
    输出参数: 正确返回OK,失败返回ERROR
  返回值:       N/A
  作者           : aibin 2005-01-25
************************************************************************************/
int DelPortFromGroup1 (UINT unGroupAddress, USHORT usPort)
{
	struct in_addr gip;
	gip.s_addr = unGroupAddress;
	mac_addr_t mac_address;
	unsigned char dev;
	short vlanid;
      	unsigned char portOffSet; 

	/*get vlan from online group, aibin 20080320*/
	vlanid = GetOnlineGroupVlan(unGroupAddress);
	if (-1 == vlanid)
	{
		printf ("not online group %x\r\n", unGroupAddress);
		return -1;
	}
	/*vlanid = GetGroupVlan (unGroupAddress);*/

       if(igmp_get_510port(usPort,&dev,&portOffSet)<0)
       	return ERROR;
	
	IpToMutimac1 (gip, mac_address);

	if (bIgmpDebug)
	{
		printf ("\r\ndel  slot %d from %s, vid= %d\r\n", usPort, inet_ntoa (gip), vlanid);
		printf("mac_address is %x:%x:%x:%x:%x:%x, vlan: %d, dev = %d, portoff= %d \r\n", mac_address[0],mac_address[1],mac_address[2],mac_address[3],mac_address[4],mac_address[5], vlanid, dev, portOffSet);
	}

#ifdef _AN5116_06A_
	if (ERROR == bcmk_mcast_leave(mac_address, vlanid, portOffSet))
	{
		return ERROR;
	}
   	return OK;
#else
	if (ERROR == bcmj_mcast_leave(dev, mac_address, vlanid, portOffSet))
	{
		
		return ERROR;
	}
   	return OK;
#endif

}