zlg_socket.c

在2210上运行的一个嵌入式web

			TcpStatus[s->queue[i]].My_Ip[0]=s->My_Ip[0];
			TcpStatus[s->queue[i]].My_Ip[1]=s->My_Ip[1];
			TcpStatus[s->queue[i]].My_Ip[2]=s->My_Ip[2];
			TcpStatus[s->queue[i]].My_Ip[3]=s->My_Ip[3];
			TcpStatus[s->queue[i]].My_Port=s->My_Port;
			TcpStatus[s->queue[i]].StaSem=0x82;
		}
	}
	OS_EXIT_CRITICAL();
	return (s->Max_Queue);
} 
uint8 accept( SOCKET * s, struct sockaddr *addr, int *addrlen )
{
uint16 i;
uint8  err;
	if(s->protocol!=0)
		return (0XFF);
	if(s->Max_Queue==0)
		return (0XFF);
	for(i=0;i<s->Max_Queue;i++)
	{
		if(OSSemAccept(AppSemCon[s->queue[i]]))
		{
			break;
		}
	}
	if(i>=s->Max_Queue)
	{
		for(i=0;i<s->Max_Queue;i++)
		{
			if(TcpStatus[s->queue[i]].State==TCP_STATE_LISTEN)
			{
				//OSSemPend(AppSemCon[s->queue[i]],0,&err);
				OSSemPend(AppSemCon[s->queue[i]],400,&err);
				if(err==OS_NO_ERR||err==OS_TIMEOUT)//等
					break;
				else 
					return (0XFF);
			}
		}
		if(err==OS_TIMEOUT)
		{
			for(i=0;i<s->Max_Queue;i++)
			{
				if(TcpStatus[s->queue[i]].State==TCP_STATE_ESTABLISHED)
					break;//连接中有已经建立连接的了
			}
			if(i>=s->Max_Queue)
			{
				return (0XFF);//连接已经满了
			}
		}
		
	}
	addr->sin_addr[0]=TcpStatus[s->queue[i]].Dest_Ip[0];
	addr->sin_addr[1]=TcpStatus[s->queue[i]].Dest_Ip[0];
	addr->sin_addr[2]=TcpStatus[s->queue[i]].Dest_Ip[0];
	addr->sin_addr[3]=TcpStatus[s->queue[i]].Dest_Ip[0];
	addr->sin_port=TcpStatus[s->queue[i]].Dest_Port;
	*addrlen=sizeof(*addr);
	return (s->queue[i]);
}

uint16 recv( uint8 num, uint8 *buf, uint16 len, int flags )
{
uint16	i,temp,sum,tempwindow;
struct _pkst TxdData;
	flags=flags;
	tempwindow=TcpStatus[num].Snd_Window;
	if((TcpStatus[num].TcpDataQWrPtr==TcpStatus[num].TcpDataQRdPtr)&&(TcpStatus[num].Snd_Window!=0))
		return (0);
	else 	if(TcpStatus[num].TcpDataQRdPtr>=TcpStatus[num].TcpDataQWrPtr)//队列已经翻转
	{
		temp=MAX_TCP_DATA-TcpStatus[num].TcpDataQRdPtr;
		if(temp>=len)//len没有翻转
		{
			for(i=0;i<len;i++)
			{
				*buf=TcpStatus[num].TcpDataQ[TcpStatus[num].TcpDataQRdPtr];
				buf++;
				TcpStatus[num].TcpDataQRdPtr++;
			}
			TcpStatus[num].Snd_Window=TcpStatus[num].Snd_Window+len;
			temp=len;
		}
		else	////len翻转
		{
			for(i=0;i<temp;i++)
			{
				*buf=TcpStatus[num].TcpDataQ[TcpStatus[num].TcpDataQRdPtr];
				buf++;
				TcpStatus[num].TcpDataQRdPtr++;
			}
			TcpStatus[num].TcpDataQRdPtr=0;
			sum=temp;
			temp=TcpStatus[num].TcpDataQWrPtr;
			if(temp>=(len-sum))//数据足够
				temp=len-sum;
			for(i=0;i<temp;i++)
			{
				*buf=TcpStatus[num].TcpDataQ[i];
				buf++;
				TcpStatus[num].TcpDataQRdPtr++;
			}
			sum=sum+temp;
			TcpStatus[num].Snd_Window=TcpStatus[num].Snd_Window+sum;
			temp=sum;
		}
	}
	else	//队列未翻转
	{
		temp=TcpStatus[num].TcpDataQWrPtr-TcpStatus[num].TcpDataQRdPtr;
		if(temp>=len)//数据足够
			temp=len;
		for(i=0;i<temp;i++)
		{
			*buf=TcpStatus[num].TcpDataQ[TcpStatus[num].TcpDataQRdPtr];
			buf++;
			TcpStatus[num].TcpDataQRdPtr++;
		}
		TcpStatus[num].Snd_Window=TcpStatus[num].Snd_Window+temp;
	}
	TcpHeadHandle(num ,0x5000+TCP_ACK);//headlength 0x20,
	TcpStatus[num].TcpDHeadUint8[2]=0;
	TcpStatus[num].TcpDHeadUint8[3]=20;
	sum=CheckSumTcp1(num,32);//12+28
	TcpStatus[num].TcpHeadUint8[16]=(sum&0xff00)>>8;;
	TcpStatus[num].TcpHeadUint8[17]=sum&0x00ff;
	TxdData.STPTR=NULL;
	TxdData.length=20;
	TxdData.DAPTR=TcpStatus[num].TcpHeadUint8;
	Send_Ip_Frame	
		(
			&TxdData,
			TcpStatus[num].Dest_Ip,
			TcpStatus[num].My_Ip,
			6
		);
	return (temp);
}

uint16 send( uint8 num, uint8 *buf, uint16 len, int flags )
{
struct _pkst TxdData;
uint16 temp;
uint8 err,i;
	flags=flags;
	if((TcpStatus[num].Dest_Max_Seg_Size>=len)&&(TcpStatus[num].State==TCP_STATE_ESTABLISHED))
	{
		TcpStatus[num].SenPassSeq=TcpStatus[num].SenFutureSeq;
		TcpStatus[num].SenPassAck=TcpStatus[num].SenPassAck;
		TcpStatus[num].SenFutureSeq=TcpStatus[num].SenPassSeq+len;
		TcpStatus[num].RecFutureAck=TcpStatus[num].SenPassSeq+len;
		TcpHeadHandle(num ,0x5000+TCP_PSH+TCP_ACK);//headlength 0x20,
		TcpStatus[num].TcpDHeadUint8[2]=((len+20)&0XFF00)>>8;
		TcpStatus[num].TcpDHeadUint8[3]=(len+20)&0X00FF;
		OS_ENTER_CRITICAL();
		memcpy (&(TcpStatus[num].TcpHeadUint8[20]), buf, len);
		temp=len+32;
		TxdData.length=CheckSumTcp1(num,temp);//12+20
		OS_EXIT_CRITICAL();
		TcpStatus[num].TcpHeadUint8[16]=(TxdData.length&0xff00)>>8;
		TcpStatus[num].TcpHeadUint8[17]=TxdData.length&0x00ff;
		TxdData.STPTR=NULL;
		TxdData.length=20+len;
		TxdData.DAPTR=TcpStatus[num].TcpHeadUint8;
		i=0;
		do
		{
			i++;
			if(Send_Ip_Frame	
				(
					&TxdData,
					TcpStatus[num].Dest_Ip,
					TcpStatus[num].My_Ip,
					6
				))
			{
				TcpStatus[num].StaSem=TcpStatus[num].StaSem|0x01;
				OSSemPend(AppSemSend[num],400,&err);
				if((err==OS_NO_ERR))//等
					return(len);
				if(TcpStatus[num].State!=TCP_STATE_ESTABLISHED)
					return 0;
			}
		}while(i<2);
		//Delete_Socket(num);
		return 0;
	}
	else
	{
		return (0);
	}	
} 
uint16 sendto( SOCKET s, uint8 *buf, uint16 len, int flags, struct sockaddr *to, uint16 tolen )
{
//uint16 temp;
udp_send UdpPacked;
struct _pkst TxdData;
	if(len>1478)
		return 0;
	UdpPacked.UdpDHead.rev=0;
	UdpPacked.UdpDHead.NextProtocal=17;

	UdpPacked.UdpDHead.TotalLen=8+len;
#ifdef Little_End
	UdpPacked.UdpDHead.TotalLen=swap_int16(UdpPacked.UdpDHead.TotalLen);
#endif
	UdpPacked.UdpDHead.SourceIp[0]=s.My_Ip[0];
	UdpPacked.UdpDHead.SourceIp[1]=s.My_Ip[1];
	UdpPacked.UdpDHead.SourceIp[2]=s.My_Ip[2];
	UdpPacked.UdpDHead.SourceIp[3]=s.My_Ip[3];
	UdpPacked.UdpDHead.DestId[0]=((struct sockaddr *)to)->sin_addr[0];
	UdpPacked.UdpDHead.DestId[1]=((struct sockaddr *)to)->sin_addr[1];
	UdpPacked.UdpDHead.DestId[2]=((struct sockaddr *)to)->sin_addr[2];
	UdpPacked.UdpDHead.DestId[3]=((struct sockaddr *)to)->sin_addr[3];
	UdpPacked.Udp.SourcePort=s.My_Port;
	UdpPacked.Udp.DestPort=((struct sockaddr *)to)->sin_port;
	UdpPacked.Udp.length=8+len;
#ifdef Little_End
	UdpPacked.Udp.SourcePort=swap_int16(UdpPacked.Udp.SourcePort);
	UdpPacked.Udp.DestPort=swap_int16(UdpPacked.Udp.DestPort);
	UdpPacked.Udp.length=swap_int16(UdpPacked.Udp.length);
#endif
OS_ENTER_CRITICAL();
	memcpy (&(UdpPacked.Udp.udpdata), buf, len);
OS_EXIT_CRITICAL();
	UdpPacked.Udp.Crc=0;
	UdpPacked.Udp.Crc=CheckSumUdp((uint8 *)(&UdpPacked),len+20);
#ifdef Little_End
	UdpPacked.Udp.Crc=swap_int16(UdpPacked.Udp.Crc);
#endif
	TxdData.STPTR=NULL;
	TxdData.length=8+len;
	TxdData.DAPTR=(uint8 *)(&(UdpPacked.Udp));
	if(Send_Ip_Frame	
		(
			&TxdData,
			UdpPacked.UdpDHead.DestId,
			UdpPacked.UdpDHead.SourceIp,
			17
		))
	{
		return(len);
	}
	else
		return(0);	
}

uint16 recvfrom( SOCKET s, uint8 *buf, uint16 len, int flags, struct sockaddr *from, uint16 *fromlen )
{
uint16 temp;
uint8 j,err;
	if(s.Udp_Queue>=MAX_UDP_LINKS)
		return 0;
	if(s.My_Port!=UdpStatus[s.Udp_Queue].My_Port)
		return 0;
	OSSemPend(UdpStatus[s.Udp_Queue].UdpSemRec,40,&err);
	if(err==OS_TIMEOUT)
		return 0;
	else if(err==OS_NO_ERR)
	{
		j=0;
		do
		{
			if(UdpStatus[s.Udp_Queue].info[j].num!=UdpMaxRec)
				break;
			j++;
		}
		while(j<UdpMaxRec);
		if(j>=UdpMaxRec)
		{
			return (0);
		}
		from->sin_addr[0]=UdpStatus[s.Udp_Queue].info[j].De_Ip[0];
		from->sin_addr[1]=UdpStatus[s.Udp_Queue].info[j].De_Ip[1];
		from->sin_addr[2]=UdpStatus[s.Udp_Queue].info[j].De_Ip[2];
		from->sin_addr[3]=UdpStatus[s.Udp_Queue].info[j].De_Ip[3];
		from->sin_port=UdpStatus[s.Udp_Queue].info[j].De_Port;
		OS_ENTER_CRITICAL();
		UdpStatus[s.Udp_Queue].info[j].len=UdpStatus[s.Udp_Queue].info[j].len-8;
		if(UdpStatus[s.Udp_Queue].info[j].len>=len)	
		{
			memcpy (buf, (uint8 *)&(UdpRecBuff[UdpStatus[s.Udp_Queue].info[j].num])+8, len);			
			temp=len;
		}
		else
		{
			memcpy (buf, (uint8 *)&(UdpRecBuff[UdpStatus[s.Udp_Queue].info[j].num])+8, UdpStatus[s.Udp_Queue].info[j].len);
			temp=UdpStatus[s.Udp_Queue].info[j].len;
		}
		UdpStatus[s.Udp_Queue].info[j].num=UdpMaxRec;
		UdpStatus[s.Udp_Queue].info[j].len=0;
		OS_EXIT_CRITICAL();
		*fromlen=sizeof(*from);
		return (temp);
	
			
	}
	else
		return 0;
}
int closesocket( SOCKET s )
{
uint8 i;
	if(s.protocol==TCP_PROTOCOL)
	{
		s.Max_Queue=0;
		for(i=0;i<MAX_TCP_LINKS;i++)
			s.queue[i]=0xff;
	}
	else if(s.protocol==UDP_PROTOCOL)
	{
		OS_ENTER_CRITICAL();
		UdpStatus[s.Udp_Queue].My_Port=0;
		UdpStatus[s.Udp_Queue].My_Ip[0]=0xff;
		UdpStatus[s.Udp_Queue].My_Ip[1]=0xff;
		UdpStatus[s.Udp_Queue].My_Ip[2]=0xff;
		UdpStatus[s.Udp_Queue].My_Ip[3]=0xff;
		for(i=0;i<UdpMaxRec;i++)
		{
			UdpStatus[s.Udp_Queue].info[i].num=UdpMaxRec;
			UdpStatus[s.Udp_Queue].info[i].De_Port=0;
			UdpStatus[s.Udp_Queue].info[i].len=0;
		}
		OS_EXIT_CRITICAL();
		do
		{
			i=OSSemAccept(UdpStatus[s.Udp_Queue].UdpSemRec);
		}while(i!=0);
	}
	s.State=0;
	s.protocol=0xff;
	s.af=0xff;
	s.type=0xff;
	s.My_Ip[0]=0xff;
	s.My_Ip[1]=0xff;
	s.My_Ip[2]=0xff;
	s.My_Ip[3]=0xff;
	s.My_Port=0;
	s.Udp_Queue=MAX_UDP_LINKS;
	return 1;
}