nkeynes@185: #include <assert.h>
nkeynes@185: #include <ctype.h>
nkeynes@185: #include "ide.h"
nkeynes@185: void debug_dump_buffer(char *buf, int length)
nkeynes@185: {
nkeynes@185:     int i,j;
nkeynes@185:     for( i=0; i<length; i+=16 ) {
nkeynes@185: 	printf( "%08X: ", i );
nkeynes@185:         for( j=0; j<16 && i+j < length; j+=4 ) {
nkeynes@185: 	    unsigned int val = *((volatile unsigned int *)(buf+i+j));
nkeynes@185: 	    printf( "%02X %02X %02X %02X  ", val&0xFF, (val>>8)&0xFF, (val>>16)&0xFF, (val>>24)&0xFF );
nkeynes@185:         }
nkeynes@185: 	for( j=0; j<16 && i+j < length; j++ ) {
nkeynes@185: 	    printf( "%c", isprint(buf[i+j]) ? buf[i+j] : '.' );
nkeynes@185: 	}
nkeynes@185: 	printf("\n");
nkeynes@185:     }
nkeynes@185: }
nkeynes@185: 
nkeynes@185: void debug_dump_int_buffer(volatile char *buf, int length)
nkeynes@185: {
nkeynes@185:     int i,j;
nkeynes@185:     for( i=0; i<length; i+=16 ) {
nkeynes@185: 	printf( "%08X:", i );
nkeynes@185:         for( j=0; j<16 && i+j < length; j+=4 ) {
nkeynes@185: 	    printf( " %08X", *((volatile unsigned int *)(buf+i+j)) );
nkeynes@185:         }
nkeynes@185: 	printf( "\n" );
nkeynes@185:     }
nkeynes@185: }
nkeynes@185: 
nkeynes@185: 
nkeynes@185: char buf[2048*7 + 32];
nkeynes@185: 
nkeynes@185: int test_ide_read_bootstrap()
nkeynes@185: {
nkeynes@185:     struct gdrom_session session;
nkeynes@185:     int length;
nkeynes@185:     char *p;
nkeynes@185: 
nkeynes@185:     ide_init();
nkeynes@185: 
nkeynes@185:     if( ide_test_ready() != 0 ) {
nkeynes@185: 	printf( "ERROR - Test ready failed\n" );
nkeynes@185: 	return -1;
nkeynes@185:     }
nkeynes@185: 
nkeynes@185:     if( ide_spinup() != 0 ) {
nkeynes@185: 	printf( "ERROR - Spinup failed\n" );
nkeynes@185: 	return -1;
nkeynes@185:     }
nkeynes@185: 
nkeynes@185:     /*
nkeynes@185:     length = ide_unknown71( buf, sizeof(buf) );
nkeynes@185:     if( length == -1 ) {
nkeynes@185: 	printf( "ERROR - 0x71 failed\n" );
nkeynes@185: 	ide_print_sense_error();
nkeynes@185: 	return -1;
nkeynes@185:     }
nkeynes@185:     debug_dump_buffer(buf,length);
nkeynes@185:     */
nkeynes@185:     if( ide_get_session( 0, &session ) == -1 ) {
nkeynes@185: 	printf( "ERROR - Get session(0) failed\n" );
nkeynes@185: 	return -1;
nkeynes@185:     }
nkeynes@185:     if( ide_get_session( session.track, &session ) == -1 ) {
nkeynes@185: 	printf( "ERROR - Get session(%d) failed\n", session.track );
nkeynes@185: 	return -1;
nkeynes@185:     }
nkeynes@185: 
nkeynes@185:     p = (char *)((((unsigned int)buf) & 0xFFFFFFE0) + 0x20);
nkeynes@185:     printf( "--- DMA buffer: %08X\n",  p );
nkeynes@185:     length = ide_read_sector_dma( session.lba, 2, 0x28, p, 2048*2 );
nkeynes@185:     if( length != 2048*2 ) {
nkeynes@185: 	printf( "ERROR - Got incorrect read length, expected %d but was %d\n", 2048, length );
nkeynes@185: 	return -1;
nkeynes@185:     }
nkeynes@185:     debug_dump_buffer( p, 2048*2 );
nkeynes@185:     
nkeynes@185:     return 0;
nkeynes@185: }
nkeynes@185: 
nkeynes@185: 
nkeynes@185: int main( int argc, char *argv[] )
nkeynes@185: {
nkeynes@185:     ide_dump_registers();
nkeynes@185:     ide_spinup();
nkeynes@185:     ide_read_something();
nkeynes@185: //    test_ide_read_bootstrap();
nkeynes@185: }