#include "lib.h"

void fwrite_dump( FILE *f, char *buf, int length)
{
    int i,j;
    for( i=0; i<length; i+=16 ) {
	fprintf( f, "%08X: ", i );
        for( j=0; j<16 && i+j < length; j+=4 ) {
	    unsigned int val = *((volatile unsigned int *)(buf+i+j));
	    fprintf( f, "%02X %02X %02X %02X  ", val&0xFF, (val>>8)&0xFF, (val>>16)&0xFF, (val>>24)&0xFF );
        }
        for( ;j<16; j+= 4 ) {
            fprintf( f, "             " );
        }
	for( j=0; j<16 && i+j < length; j++ ) {
	    fprintf( f, "%c", isprint(buf[i+j]) ? buf[i+j] : '.' );
	}
	fprintf( f, "\n");
    }
}

void fwrite_diff( FILE *f,  char *a, int a_length, char *b, int b_length )
{
    int i;
    fprintf( f, "Expected %d bytes:\n", a_length );
    fwrite_dump( f, a, a_length );
    fprintf( f, "but was %d bytes =>\n", b_length );
    fwrite_dump( f, b, b_length );
}

void fwrite_diff32( FILE *f, char *a, int a_length, char *b, int b_length )
{
    int i,j, k;
    int length = a_length > b_length ? a_length : b_length;
    fprintf( f, "Expected %d bytes, was %d bytes =>\n", a_length, b_length );
    
    for( i=0; i<length; i+=16 ) {
	for( k=0; k<32 && i+k < length; k+=4 ) {
	    if( i+k >= a_length || i+k >= b_length ||
		*((volatile unsigned int *)(a+i+k)) != *((volatile unsigned int *)(b+i+k)) ) {
		break;
	    }
	}
	if( k != 32 && i+k != length ) {
	    fprintf( f, "%08X: ", i );
	    for( j=0; j<16 && i+j < a_length; j+=4 ) {
		fprintf( f, "%08X ", *((volatile unsigned int *)(a+i+j)) );
	    }
	    
	    for(; j<16; j+=4 ) {
		fprintf( f, "         " );
	    }
	    
	    fprintf( f, "| " );
	    for( j=0; j<16 && i+j < b_length; j+=4 ) {
		fprintf( f, "%08X ", *((volatile unsigned int *)(b+i+j)) );
	    }

	    fprintf( f, "\n");
	}
    }
}