Initial commit of OpenSPARC T2 design and verification files.

[OpenSPARC-T2-DV] / verif / env / common / vera / niu_ippktgen / C / wrapper / pgUtils.c

#include <stdio.h>
#include "vera_directc.h"
#include "include/pg.h"
// CRC GEN Function 
//
//
//

extern void setpgSeed( unsigned int seed );
extern unsigned int pgrand();


#if 0
// global name crc32 collides with one in the denali library
unsigned int crc32(unsigned char *pktbuf,unsigned int pktlen )
{
  
  unsigned int crc;
  unsigned int c;
  unsigned int byte;
  int bit;
  
  crc = (unsigned int) 0xffffffff;
  for (byte = 0; byte < pktlen; byte++) {
    c = (unsigned int) pktbuf[byte];
    printf("index - %d CRC Byte - %x  CRC So far - %x \n",byte,c,crc);
    for (bit = 0; bit < 8; bit++) {
      if ((c & 0x1) ^ (crc & 0x1))
	crc = (crc >> 1)^0xedb88320;
      else
	crc = (crc >> 1);
      c >>= 1;
    }
  }
  printf("CRC - %x \n",~crc);
  return ((~crc) );
  
}
#endif

unsigned char getNextByte(unsigned char in, int data_type) {
  
  // data_type = DATA_SEQ;
  if(data_type== DATA_SEQ) {
    return(in +1);
  } else if(data_type == DATA_FIXED) {
    return(in);
  } else if(data_type== DATA_RAND) {
    return(pgrand()&0xff);
  } else if(data_type == DATA_ALL0) {
    return(0);
  } else if(data_type == DATA_ALL1) {
    return(0xff);
  } else {
	  // default to DATA_SEQ
    return(in +1);
  }
			
}

unsigned char * genPayload ( int data_type, unsigned int seed, int data_length) {
/* defined data types are
*  DATA_RANDOM - Random data
*  DATA_SEQ - In Sequence
*  More to be defined later
*/

  unsigned char *payload;
  int index,i;
  if(data_length==0) {
    return(NULL); 
  }
  payload = (unsigned char *) malloc(data_length* sizeof(unsigned char));
  index =0;

  if(data_type== DATA_RAND) {
    setpgSeed(seed ) ;  
  } else if(data_type == DATA_ALL0) {
     seed =0;	
  } else if(data_type== DATA_ALL1) {
     seed =0xffffffff;	
  } else if(data_type == DATA_FC_PAUSE) {
    // maintain seed for first 4 bytes and then all0s
    data_type = DATA_ALL0;
  }

  for(i=0;i<data_length;i++) {
     if(i<4) {
      // Start with Seed
      payload[index]= ((seed & (0xff << (8*i)))>>(8*i));
     } else {
     payload[index] = getNextByte(payload[index-1],data_type);
     // printf(" Index - %d data -0 %x \n",index, payload[index] );
     }
     index++;
  }
  return(payload);

}
unsigned char *  addL2Pad(unsigned char * pktbuf,int pktlen,int l2_pad_length) {
        unsigned char *payload;
	int i; 
	if(l2_pad_length==0) {
         return(pktbuf);	
	} else {
         payload = (unsigned char *) malloc((pktlen + l2_pad_length)* sizeof(unsigned char));
         for(i=0;i<pktlen;i++){
          payload[i] = pktbuf[i];
         } 
         for(i=pktlen;i<pktlen + l2_pad_length ;i++){
          payload[i] = (i%2) ? 0xa5:0x5a ;
         } 
         return(payload);
       }
}

unsigned char * addCrc ( unsigned char * p1, int l1, unsigned int crc) {
        unsigned char *payload;
        int i;
        payload = (unsigned char *) malloc((l1+4)* sizeof(unsigned char));
        for(i=0;i<l1;i++){
         payload[i] = p1[i];
        } 
        for(i=0;i<4;i++) {
         payload[l1+ i]= ((crc & (0xff << (8*i)))>>(8*i));
        }
        return(payload);
}
unsigned char * addPayload ( unsigned char * p1, int l1, unsigned char * p2, int l2) {
        unsigned char *payload;
        int i;
        if( (l1+l2) == 0) return(NULL);
        payload = (unsigned char *) malloc((l1+l2)* sizeof(unsigned char));
        for(i=0;i<l1;i++) {
                payload[i] = p1[i];
        }
        for(i=l1;i<l1 + l2;i++) {
                payload[i] = p2[i];
        }
        return(payload);
}