#include <phal_sw_api.h>
#include <swapi_utils.h>

//Compare_data: Compare the received data with the original one.
//When length of data received is equal to the file length outputs the BER

int compare_data0(unsigned char *data_in,\
                    unsigned char *file,\
                    int numchars, int file_length, int NumErrorsMax){

    static int p=0, onlyone=0, firsterror=0;
    static int numbitserror=0;
    unsigned char byte;
    int i, n, length;


  	//Read data from file

	for (i=0; i<numchars; i++){
		if(p<file_length){		//Check the file length
			//if(p<500)xprintf("SINK: p=%d bytereceived=%d bytesent=%d\n", p, *(data_in+i), *(file+p));
			byte=*(data_in+i)^*(file+p);
			if(byte!=0){
                                if(firsterror==0){
					xprintf("%s.compare_data0(): p=%d bytereceived=%d != bytesent=%d\n", GetObjectName(), p, *(data_in+i), *(file+p));
					firsterror=1;
					}

				for(n=0; n<8; n++){
					numbitserror=numbitserror+(byte&0x01);
					byte=byte>>1;
				}
			}

		p++;
		}
	}
    	if((p>=file_length) || (numbitserror>NumErrorsMax)){
                if(onlyone==0){
                    xprintf("%s.compare_data0() bits_sent=%d filelength=%d bits numbitserror=%d\n",\
                            GetObjectName(), p*8, file_length*8, numbitserror);
                    xprintf("FILE RECEIVED: BER=%f\n",\
                            (float)numbitserror/(float)(p*8));
                    p++;
                    onlyone=1;
                }
                return(-1);
	}
    
    //xprintf("p=%d,file_length=%d \n",p, file_length);
    return(1);
}

int compare_data1(unsigned char *data_in,\
                    unsigned char *file,\
                    int numchars, int file_length, int NumErrorsMax){

    static int p=0, onlyone=0, firsterror=0;
    static int numbitserror=0;
    unsigned char byte;
    int i, n, length;

  	//Read data from file
	for (i=0; i<numchars; i++){
		if(p<file_length){		//Check the file length
			//if(p<500)xprintf("SINK: p=%d bytereceived=%d bytesent=%d\n", p, *(data_in+i), *(file+p));
			byte=*(data_in+i)^*(file+p);
			if(byte!=0){
                                if(firsterror==0){
					xprintf("%s.compare_data1(): p=%d bytereceived=%d != bytesent=%d\n", GetObjectName(), p, *(data_in+i), *(file+p));
					firsterror=1;
					}

				for(n=0; n<8; n++){
					numbitserror=numbitserror+(byte&0x01);
					byte=byte>>1;
				}
			}

		p++;
		}
	}
    	if((p>=file_length) || (numbitserror>NumErrorsMax)){
                if(onlyone==0){
                    xprintf("%s.compare_data1() bits_sent=%d filelength=%d bits numbitserror=%d\n",\
                            GetObjectName(), p*8, file_length*8, numbitserror);
                    xprintf("FILE RECEIVED: BER=%f\n",\
                            (float)numbitserror/(float)(p*8));
                    p++;
                    onlyone=1;
                }
                return(-1);
	}
    
    //xprintf("p=%d,file_length=%d \n",p, file_length);
    return(1);
}