Subversion Repositories 10_100m_ethernet-fifo_convertor

#include <stdio.h>

#include <errno.h>

#include <sys/ioctl.h>

#include <net/if.h>

#include <netpacket/packet.h>

#include <net/ethernet.h>

#include <netinet/in.h>

#include <string.h>

#include <stdlib.h>

#include <sys/time.h>

#define MAC_ADD_FPGA 0x00,0x00,0x00,0x00,0x00,0x01

#define MAC_ADD_PC   0x00,0x00,0x00,0x00,0x00,0x02

#define num 8

const unsigned char sndhead[]={MAC_ADD_FPGA, MAC_ADD_PC, 0x00, 0x00};

const unsigned char mac_fpga[]={MAC_ADD_FPGA};

void printdata(char* str, unsigned char* buf1, int size);

int main(){

        int error_cnt=0;

        int frame_cnt=1000;

        long int frame_number, fn1=0, fn2=0, fn3=0;

        unsigned int sndlen=14+3+((unsigned int)(148*num/8));

        unsigned int rcvlen=14+3+((unsigned int)(156.25*num/8))+1;

        unsigned char sndbuf[sndlen];   //6+6+2+3+8*148

        unsigned char rcvbuf[rcvlen];   //actually is 96 = 6+6+2+3+[4*156.25]+1

        unsigned char* sndlentype = sndbuf + 12;

        unsigned char* sndframenumber = sndbuf + 14;

        unsigned char* snddata = sndbuf + 17;

        unsigned char* rcvlentype = rcvbuf + 12;

        unsigned char* rcvframenumber = rcvbuf + 14;

        unsigned char* rcvdata = rcvbuf + 17;

        unsigned char* temppoint;

        int mSocketFD;

        struct ifreq ifstruct;

        struct sockaddr_ll sll;

        int retval = 0;

        struct timeval testtime;

        long int usec2, usec1;

        memcpy(sndbuf, sndhead, 14);

        // create

        mSocketFD = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL));

        if (mSocketFD < 0){

                perror("socket()");

        }

        //struct ifreq ifstruct;

        strcpy(ifstruct.ifr_name, "eth2");

        retval = ioctl(mSocketFD, SIOCGIFINDEX, &ifstruct);

        if(retval == -1){

                perror("RAWSocket::open(): ioctl()");

        }

        //struct sockaddr_ll sll;

        memset(&sll, 0, sizeof(sll));

        sll.sll_family = AF_PACKET;

        sll.sll_protocol = htons(ETH_P_ALL);

        sll.sll_ifindex = ifstruct.ifr_ifindex;

        // bind

        retval = bind(mSocketFD, (struct sockaddr *)&sll, sizeof(sll));

        if(retval == -1)

        {

                perror("RAWSocket::open(): bind()");

        }

        // set recive buffer size

        //int rcvbuflen = BUFFER_SIZE;

        int rcvbuflen = 4000;//442;//221;

        retval = setsockopt(mSocketFD, SOL_SOCKET, SO_RCVBUF, (char *)&rcvbuflen, sizeof(int));

        if (retval == -1)

        {

                perror("RAWSocket::read(): setsockopt()");

        }

        // set send buffer size

        //int sndbuflen = BUFFER_SIZE;

        int sndbuflen = 15000;

        retval = setsockopt(mSocketFD, SOL_SOCKET, SO_SNDBUF, (char *)&sndbuflen, sizeof(int));

        if (retval == -1)

        {

                perror("RAWSocket::read(): setsockopt()");

        }

        frame_number = 0;

        sndframenumber[0] = frame_number;

        sndframenumber[1] = frame_number >> 8;

        sndframenumber[2] = frame_number >> 16;

        temppoint=snddata;

        for(int i=0; i< sndlen-17; i++){

                if(frame_number%2==0)

                        *temppoint=0;//((((unsigned char)frame_number)&0x07)<<4)|(((unsigned char)frame_number)&0x07);

                else

                        *temppoint= 0xff;

                temppoint++;

        }

        retval = send(mSocketFD, sndbuf, sndlen, 0);

        if (retval < 0)

        {

                perror("sendto()");

        }

        while( (frame_cnt>=0)&&( (retval = recv(mSocketFD, (void*)rcvbuf, rcvlen, 0)) >=0) ) {

                //printf("received data length: %d\n", retval);

                if (retval < 42){

                        perror("recvfrom():");

                        break;

                }

                fn3 = fn2;      fn2 = fn1;

                fn1 = (long int)(rcvbuf[16]<<16) + (rcvbuf[15]<<8) + rcvbuf[14];

                long int temp;

                frame_number ++;  frame_cnt--;

                        sndframenumber[0] = frame_number;

                        sndframenumber[1] = frame_number >> 8;

                        sndframenumber[2] = frame_number >> 16;

                if (memcmp(mac_fpga, rcvbuf+6, 6) == 0)

                {

                        gettimeofday(&testtime, NULL);

                        usec2=usec1;

                        usec1=testtime.tv_usec;

                        temp=(usec1+1000000-usec2)%1000000;

                        printf("%5ld\t%5ld\t%5ld\t%x", temp, fn2, fn1, fn1&0x07);

                        if( fn2+1 != fn1){

                                printf("\t%5ld\t*\n",frame_number);

                                error_cnt++;

                        }else printf("\t%5ld\n", frame_number);

                        printdata(NULL, rcvbuf,rcvlen);

                        temppoint=snddata;

                        for(int i=0; i< sndlen-17; i++){

                                if(frame_number%2==0)

                                        *temppoint=0;//((((unsigned char)frame_number)&0x07)<<4)|(((unsigned char)frame_number)&0x07);

                                else

                                        *temppoint= 0xff;

                                temppoint++;

                        }

                        retval = send(mSocketFD, sndbuf, sndlen, 0);

                        if (retval < 0) perror("sendto()");

                }

        }

        printf("the total number of wrong frames is:%d\n", error_cnt);

}

void printdata(char* str, unsigned char* buf1, int size)

{

        unsigned char temp=0;

        unsigned int i;

        unsigned char* buf=buf1;

        i=0;

        printf("%s:\n",str);

        if(size==0){

                printf("\t\tNot data!\n");

        }else{

                printf("\t\t");

                while((size>0)&&(i<512))

                {

                        printf(" %02x",*buf);

                        temp++; size--; buf++; i++;

                        if(!(temp & 3))

                        {

                                if(temp==16)

                                {

                                        temp=0;

                                        printf("\n\t\t");

                                }else

                                        printf(" ");

                        }

                }

                printf("\n");

        }

}