ethernetudp.c

Go to the documentation of this file.

/******************************************************
* Function: etherent udp protocol handler
*
* File:   etherentudp.c
* Author: Book Chen
* Date:   2008.07.18
*******************************************************
*/
#include "includes.h"

#if(DEBUG_ETHERNET_UDP==1)
 #define ETHERNET_UDP_INFO 1
#else
 #define ETHERNET_UDP_INFO 0
#endif

#define EthernetUdpIdleState 0

UDP_CONTROL UdpCtrl;

void F_EthernetUdpInit(void){
    UdpCtrl.InUse=FALSE;
    UdpCtrl.Id=ID_ETHERNET_UDP;
    UdpCtrl.State=EthernetUdpIdleState;
}
INT8U F_EthernetUdpPacketReceive(ETHBUFFER *pBuffer){
    UDP_HEAD *pUdpHead;
    
    
    #if(DEBUG_ETHERNET_UDP==1)
        printf("\n UDP receive");
    #endif
    pUdpHead=(UDP_HEAD *)(pBuffer->pData);
    pBuffer->Length=F_EthernetUnsignedShortN2H(pUdpHead->Length);
    F_EthernetBufferPull(pBuffer,sizeof(UDP_HEAD)); // point to pBuffer.Data[0+EHTHERNET_HEAD+IP_HEAD+UDP_HEAD]
    if(F_EthernetUnsignedShortN2H(pUdpHead->Destination)==TFTP) // 0x0045=69
        F_EthernetTftpPacketReceive(pBuffer);
    //else if(F_EthernetUnsignedShortN2H(pUdpHead->Destination)==SNMP){
    //
    //}        
    return TRUE;
}
INT8U F_EthernetUdpPacketSend(ETHBUFFER *pBuffer,
                              INT8U *pIpAddress,
                              INT16U SourcePort,
                              INT16U DestinationPort){
    UDP_HEAD *pUdpHead;
    
    #if(DEBUG_ETHERNET_UDP==1)
        printf("\n UDP send ");
    #endif
    pUdpHead=(UDP_HEAD *)F_EthernetBufferPush(pBuffer,sizeof(UDP_HEAD));                         
    pUdpHead->Source=F_EthernetUnsignedShortH2N(SourcePort);
    pUdpHead->Destination=F_EthernetUnsignedShortH2N(DestinationPort);         
    pUdpHead->Length=F_EthernetUnsignedShortH2N(12); // 12 byte packet length??
    pUdpHead->Check=0;
    F_EthernetIpSend(pBuffer,pIpAddress,UDP);
    return TRUE;
}
INT8U F_EthernetUdpBufferReserve(ETHBUFFER *pBuffer){
    F_EthernetBufferReserve(pBuffer,sizeof(ETHERNET_HEAD));
    F_EthernetBufferReserve(pBuffer,sizeof(IP_HEAD)); 
    F_EthernetBufferReserve(pBuffer,sizeof(UDP_HEAD));
    return TRUE;
}
INT16U F_EthernetUdpSourcePortGet(ETHBUFFER *pBuffer){
    UDP_HEAD *pUdpHead;
   
    pUdpHead=(UDP_HEAD *)((INT8U *)pBuffer->Data+ETHERNET_HEAD_LENGTH+IP_HEAD_LENGTH);
    #if(ETHERNET_UDP_INFO==1)    
        printf("\n pUdpHead->Source %4x",pUdpHead->Source);    
        printf("\n pUdpHead->Destination %4x",pUdpHead->Destination);    
        printf("\n pUdpHead->Length %4x",pUdpHead->Length);    
        printf("\n pUdpHead->Check %4x",pUdpHead->Check);
    #endif
    return F_EthernetUnsignedShortN2H(pUdpHead->Source);
}