nkeynes@248: /**
nkeynes@561:  * $Id$
nkeynes@248:  *
nkeynes@248:  * IDE interface test cases. Covers all (known) IDE registers in the 
nkeynes@248:  * 5F7000 - 5F74FF range including DMA, but does not cover any GD-Rom
nkeynes@248:  * device behaviour (ie packet comands).
nkeynes@248:  *
nkeynes@248:  * These tests should be run with the drive empty.
nkeynes@248:  *
nkeynes@248:  * Copyright (c) 2006 Nathan Keynes.
nkeynes@248:  *
nkeynes@248:  * This program is free software; you can redistribute it and/or modify
nkeynes@248:  * it under the terms of the GNU General Public License as published by
nkeynes@248:  * the Free Software Foundation; either version 2 of the License, or
nkeynes@248:  * (at your option) any later version.
nkeynes@248:  *
nkeynes@248:  * This program is distributed in the hope that it will be useful,
nkeynes@248:  * but WITHOUT ANY WARRANTY; without even the implied warranty of
nkeynes@248:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
nkeynes@248:  * GNU General Public License for more details.
nkeynes@248:  */
nkeynes@248: 
nkeynes@248: #include <stdlib.h>
nkeynes@248: #include <stdio.h>
nkeynes@263: #include "testdata.h"
nkeynes@248: #include "lib.h"
nkeynes@185: #include "ide.h"
nkeynes@248: #include "asic.h"
nkeynes@248: 
nkeynes@248: unsigned int test_count = 0, test_failures = 0;
nkeynes@248: 
nkeynes@248: #define IDE_BASE 0xA05F7000
nkeynes@248: 
nkeynes@248: #define IDE_ALTSTATUS IDE_BASE+0x018
nkeynes@248: #define IDE_UNKNOWN   IDE_BASE+0x01C
nkeynes@248: #define IDE_DATA      IDE_BASE+0x080 /* 16 bits */
nkeynes@248: #define IDE_FEATURE   IDE_BASE+0x084
nkeynes@248: #define IDE_COUNT     IDE_BASE+0x088
nkeynes@248: #define IDE_LBA0      IDE_BASE+0x08C
nkeynes@248: #define IDE_LBA1      IDE_BASE+0x090
nkeynes@248: #define IDE_LBA2      IDE_BASE+0x094
nkeynes@248: #define IDE_DEVICE    IDE_BASE+0x098
nkeynes@248: #define IDE_COMMAND   IDE_BASE+0x09C
nkeynes@248: #define IDE_ACTIVATE  IDE_BASE+0x4E4
nkeynes@248: 
nkeynes@252: #define IDE_DISC       IDE_LBA0
nkeynes@248: #define IDE_DEVCONTROL IDE_ALTSTATUS
nkeynes@248: #define IDE_ERROR      IDE_FEATURE
nkeynes@248: #define IDE_STATUS     IDE_COMMAND
nkeynes@248: 
nkeynes@248: #define IDE_DMA_ADDR   IDE_BASE+0x404
nkeynes@248: #define IDE_DMA_SIZE   IDE_BASE+0x408
nkeynes@248: #define IDE_DMA_DIR    IDE_BASE+0x40C
nkeynes@248: #define IDE_DMA_CTL1   IDE_BASE+0x414
nkeynes@248: #define IDE_DMA_CTL2   IDE_BASE+0x418
nkeynes@248: #define IDE_DMA_MAGIC  IDE_BASE+0x4B8
nkeynes@248: #define IDE_DMA_STATUS IDE_BASE+0x4F8
nkeynes@248: 
nkeynes@248: #define CHECK_REG_EQUALS( a, b, c ) if( b != c ) { fprintf(stderr, "Assertion failed at %s:%d %s(): expected %08X from register %08X, but was %08X\n", __FILE__, __LINE__, __func__, b, a, c ); return -1; }
nkeynes@248: 
nkeynes@248: /* Wait for the standard timeout for an INTRQ. If none is received, print an
nkeynes@248:  * error and return -1
nkeynes@248:  */
nkeynes@248: #define EXPECT_INTRQ() if( ide_wait_irq() != 0 ) { fprintf(stderr, "Timeout at %s:%d %s(): waiting for INTRQ\n", __FILE__, __LINE__, __func__ ); return -1; }
nkeynes@248: 
nkeynes@248: /* Check if the INTRQ line is currently cleared (ie inactive) */
nkeynes@248: #define CHECK_INTRQ_CLEAR() if ( (long_read( ASIC_STATUS1 ) & 1) != 0 ) { fprintf(stderr, "Assertion failed at %s:%d %s(): expected INTRQ to be cleared, but was raised.\n", __FILE__, __LINE__, __func__ ); return -1; }
nkeynes@248: 
nkeynes@248: #define EXPECT_READY() if( ide_wait_ready() != 0 ) { fprintf(stderr, "Timeout at %s:%d %s(): waiting for BSY flag to clear\n", __FILE__, __LINE__, __func__ ); return -1; }
nkeynes@248: 
nkeynes@248: int check_regs( uint32_t *regs,const char *file, int line, const char *fn ) 
nkeynes@185: {
nkeynes@248:     int i;
nkeynes@248:     int rv = 0;
nkeynes@248:     for( i=0; regs[i] != 0; i+=2 ) {
nkeynes@248: 	uint32_t addr = regs[i];
nkeynes@248: 	uint32_t val = regs[i+1];
nkeynes@248: 	uint32_t actual;
nkeynes@248: 	if( addr == IDE_DATA ) {
nkeynes@248: 	    actual = (uint32_t)word_read(addr);
nkeynes@248: 	    if( val != actual ) { 
nkeynes@248: 		fprintf(stderr, "Assertion failed at %s:%d %s(): expected %04X from register %08X, but was %04X\n", file, line, fn, val, addr, actual ); 
nkeynes@248: 		rv = -1;
nkeynes@248: 	    }
nkeynes@248: 	} else if( addr <= IDE_COMMAND ) {
nkeynes@248: 	    actual = (uint32_t)byte_read(addr);
nkeynes@248: 	    if( val != actual ) { 
nkeynes@248: 		fprintf(stderr, "Assertion failed at %s:%d %s(): expected %02X from register %08X, but was %02X\n", file, line, fn, val, addr, actual ); 
nkeynes@248: 		rv = -1;
nkeynes@248: 	    }
nkeynes@248: 	} else {
nkeynes@248: 	    actual = long_read(addr);
nkeynes@248: 	    if( val != actual ) { 
nkeynes@248: 		fprintf(stderr, "Assertion failed at %s:%d %s(): expected %08X from register %08X, but was %08X\n", file, line, fn, val, addr, actual ); 
nkeynes@248: 		rv = -1;
nkeynes@248: 	    }
nkeynes@185: 	}
nkeynes@185:     }
nkeynes@248:     return rv;
nkeynes@185: }
nkeynes@185: 
nkeynes@248: #define CHECK_REGS( r ) if( check_regs(r, __FILE__, __LINE__, __func__) != 0 ) { return -1; }
nkeynes@248: 
nkeynes@251: 
nkeynes@251: uint32_t post_packet_ready_regs[] = 
nkeynes@251:     { IDE_ALTSTATUS, 0x58,
nkeynes@251:       IDE_COUNT, 0x01,
nkeynes@251:       IDE_LBA1, 8,
nkeynes@251:       IDE_LBA2, 0,
nkeynes@251:       IDE_DEVICE, 0,
nkeynes@251:       IDE_STATUS, 0x58, 0, 0 };
nkeynes@251: 
nkeynes@251: uint32_t post_packet_cmd_regs[] = 
nkeynes@251:     { IDE_ALTSTATUS, 0xD0,
nkeynes@251:       IDE_ERROR, 0x00,
nkeynes@251:       IDE_COUNT, 0x01,
nkeynes@251:       IDE_LBA1, 8,
nkeynes@251:       IDE_LBA2, 0,
nkeynes@251:       IDE_DEVICE, 0,
nkeynes@251:       IDE_STATUS, 0xD0, 0, 0 };
nkeynes@251: 
nkeynes@251: uint32_t packet_cmd_error6_regs[] = 
nkeynes@251:     { IDE_ALTSTATUS, 0x51,
nkeynes@251:       IDE_ERROR, 0x60,
nkeynes@251:       IDE_COUNT, 0x03,
nkeynes@251:       IDE_LBA1, 8,
nkeynes@251:       IDE_LBA2, 0,
nkeynes@251:       IDE_DEVICE, 0,
nkeynes@251:       IDE_STATUS, 0x51, 0, 0 };
nkeynes@251: 
nkeynes@251: uint32_t packet_data_ready_regs[] = 
nkeynes@251:     { IDE_ALTSTATUS, 0x58,
nkeynes@251:       IDE_ERROR, 0x00,
nkeynes@251:       IDE_COUNT, 0x02,
nkeynes@251:       IDE_LBA1, 0x0C,
nkeynes@251:       IDE_LBA2, 0,
nkeynes@251:       IDE_DEVICE, 0,
nkeynes@251:       IDE_STATUS, 0x58, 0, 0 };
nkeynes@251: 
nkeynes@251: 
nkeynes@251: uint32_t post_packet_data_regs[] = 
nkeynes@251:     { IDE_ALTSTATUS, 0xD0,
nkeynes@251:       IDE_ERROR, 0x00,
nkeynes@251:       IDE_COUNT, 0x02,
nkeynes@251:       IDE_LBA1, 0x0C,
nkeynes@251:       IDE_LBA2, 0,
nkeynes@251:       IDE_DEVICE, 0,
nkeynes@251:       IDE_STATUS, 0xD0, 0, 0 };
nkeynes@251: 
nkeynes@251: uint32_t packet_complete_regs[] = 
nkeynes@251:     { IDE_ALTSTATUS, 0x50,
nkeynes@251:       IDE_ERROR, 0x00,
nkeynes@251:       IDE_COUNT, 0x03,
nkeynes@251:       IDE_LBA1, 0x0C,
nkeynes@251:       IDE_LBA2, 0,
nkeynes@251:       IDE_DEVICE, 0,
nkeynes@251:       IDE_STATUS, 0x50, 0, 0 };
nkeynes@251: 
nkeynes@252: int send_packet_command( const char *cmd )
nkeynes@251: {
nkeynes@251:     unsigned short *spkt = (unsigned short *)cmd;
nkeynes@251:     int i;
nkeynes@251: 
nkeynes@251:     EXPECT_READY();
nkeynes@251:     byte_write( IDE_FEATURE, 0 );
nkeynes@251:     byte_write( IDE_COUNT, 0 );
nkeynes@251:     byte_write( IDE_LBA0, 0 );
nkeynes@251:     byte_write( IDE_LBA1, 8 );
nkeynes@251:     byte_write( IDE_LBA2, 0 );
nkeynes@251:     byte_write( IDE_DEVICE, 0 );
nkeynes@251:     byte_write( IDE_COMMAND, 0xA0 );
nkeynes@251:     byte_read(IDE_ALTSTATUS); /* delay 1 PIO cycle */
nkeynes@251:     EXPECT_READY(); /* Wait until device is ready to accept command (usually immediate) */
nkeynes@251:     CHECK_INTRQ_CLEAR();
nkeynes@251:     CHECK_REGS( post_packet_ready_regs );
nkeynes@251:     
nkeynes@251:     /* Write the command */
nkeynes@251:     for( i=0; i<6; i++ ) {
nkeynes@251:         word_write( IDE_DATA, spkt[i] );
nkeynes@251:     }
nkeynes@251: 
nkeynes@251:     byte_read(IDE_ALTSTATUS); 
nkeynes@251: 
nkeynes@251:     // CHECK_REGS( post_packet_cmd_regs );
nkeynes@251:     EXPECT_INTRQ();
nkeynes@251:     EXPECT_READY();
nkeynes@251:     return 0;
nkeynes@251: }
nkeynes@251: 
nkeynes@252: int read_pio( char *buf, int expected_length ) {
nkeynes@252:     uint32_t ready_regs[] = {
nkeynes@252: 	IDE_ALTSTATUS, 0x58,
nkeynes@252: 	IDE_ERROR, 0x00,
nkeynes@252: 	IDE_COUNT, 0x02,
nkeynes@252: 	IDE_LBA1, expected_length & 0xFF,
nkeynes@252: 	IDE_LBA2, (expected_length >> 8),
nkeynes@252: 	IDE_DEVICE, 0,
nkeynes@252: 	IDE_STATUS, 0x58, 
nkeynes@252: 	0, 0 };    
nkeynes@252: 
nkeynes@252:     int i;
nkeynes@252:     unsigned short *bufptr = (unsigned short *)buf;
nkeynes@252:     unsigned int length = 0, avail;
nkeynes@252:     int status;
nkeynes@252:     
nkeynes@252:     CHECK_REGS( ready_regs );
nkeynes@252:     for( i=0; i<expected_length; i+=2 ) {
nkeynes@252: 	*bufptr++ = word_read(IDE_DATA);
nkeynes@252:     }
nkeynes@252: 
nkeynes@252:     EXPECT_INTRQ();
nkeynes@252:     EXPECT_READY();
nkeynes@252:     ready_regs[1] = 0x50;
nkeynes@252:     ready_regs[5] = 0x03;
nkeynes@252:     ready_regs[13] = 0x50;
nkeynes@252:     CHECK_REGS( ready_regs );
nkeynes@252:     return 0;
nkeynes@252: }
nkeynes@252: 
nkeynes@252: #define IDE_TEST_PACKET_OK( c,e,l ) if( ide_test_packet_ok( __FILE__, __LINE__, __func__, c, e, l ) != 0 ) { return -1; }
nkeynes@252: int ide_test_packet_ok( const char *file, int line, const char *func, 
nkeynes@252: 			const char *cmd, char *expect, int expect_len ) 
nkeynes@252: {
nkeynes@252:     char buf[expect_len];
nkeynes@252:     int status = send_packet_command(cmd);
nkeynes@252:     if( status != 0 ) {
nkeynes@252: 	return status;
nkeynes@252:     }
nkeynes@252:     status = byte_read( IDE_ALTSTATUS );
nkeynes@252:     if( status & 1 ) { /* Error */
nkeynes@252: 	status = ide_get_sense_code();
nkeynes@252: 	fprintf( stderr, "Assertion failed at %s:%d %s(): Unexpected error %04X\n",
nkeynes@252: 		 file, line, func, status );
nkeynes@252: 	return -1;
nkeynes@252:     }
nkeynes@252: 
nkeynes@252:     status = read_pio( buf, expect_len );
nkeynes@252:     if( status != 0 ) {
nkeynes@252: 	return status;
nkeynes@252:     }
nkeynes@252:     if( expect != NULL && memcmp( expect, buf, expect_len ) != 0 ) {
nkeynes@252: 	fprintf(stderr, "Assertion failed at %s:%d %s(): Results differ from expected:\n",file,line,func );
nkeynes@252: 	fwrite_diff( stderr, expect, expect_len, buf, expect_len );
nkeynes@252: 	return -1;
nkeynes@252:     }
nkeynes@252:     return 0;
nkeynes@252: }
nkeynes@252: 
nkeynes@252: #define IDE_TEST_PACKET_ERROR( c,e ) if( ide_test_packet_error( __FILE__, __LINE__, __func__, c, e ) != 0 ) { return -1; }
nkeynes@252: int ide_test_packet_error( char *file, int line, char *func,
nkeynes@252: 			   char *cmd, int expect_error )
nkeynes@252: {
nkeynes@252:     uint32_t error_regs[] = 
nkeynes@252:     { IDE_ALTSTATUS, 0x51,
nkeynes@252:       IDE_ERROR, (expect_error & 0x0F)<<4,
nkeynes@252:       IDE_COUNT, 0x03,
nkeynes@252:       IDE_DEVICE, 0,
nkeynes@252:       IDE_STATUS, 0x51, 0, 0 };
nkeynes@252:     uint32_t error_code;
nkeynes@252:     int status = send_packet_command(cmd);
nkeynes@252:     if( status != 0 ) {
nkeynes@252: 	return status;
nkeynes@252:     }
nkeynes@252:     CHECK_REGS(error_regs);
nkeynes@252:     error_code = ide_get_sense_code();
nkeynes@252:     CHECK_IEQUALS( expect_error, error_code );
nkeynes@252: 
nkeynes@252:     return 0;
nkeynes@252: }
nkeynes@252:     
nkeynes@251: 
nkeynes@248: uint32_t abort_regs[] = {
nkeynes@248:     IDE_ALTSTATUS, 0x51,
nkeynes@248:     IDE_ERROR, 0x04,
nkeynes@248:     IDE_COUNT, 0x02,
nkeynes@248:     IDE_LBA1, 0x00,
nkeynes@248:     IDE_LBA2, 0x50,
nkeynes@248:     IDE_DEVICE, 0,
nkeynes@248:     IDE_DATA, 0x0000,
nkeynes@248:     IDE_STATUS, 0x51, 
nkeynes@248:     0, 0 };
nkeynes@248: 
nkeynes@248: uint32_t post_reset_regs[] = {
nkeynes@248:     IDE_ALTSTATUS, 0x00,
nkeynes@248:     IDE_ERROR, 0x01,
nkeynes@248:     IDE_COUNT, 0x01,
nkeynes@248:     IDE_LBA1, 0x14,
nkeynes@248:     IDE_LBA2, 0xEB,
nkeynes@248:     IDE_DEVICE, 0,
nkeynes@248:     IDE_DATA, 0xFFFF,
nkeynes@248:     IDE_STATUS, 0x00, 
nkeynes@248:     0, 0 };
nkeynes@248: 
nkeynes@248: uint32_t post_set_feature_regs[] = {
nkeynes@248:     IDE_ALTSTATUS, 0x50,
nkeynes@248:     IDE_ERROR, 0x00,
nkeynes@248:     IDE_COUNT, 0x0B,
nkeynes@248:     IDE_LBA1, 0x00,
nkeynes@248:     IDE_LBA2, 0x00,
nkeynes@248:     IDE_DEVICE, 0,
nkeynes@248:     IDE_DATA, 0xFFFF,
nkeynes@248:     IDE_STATUS, 0x50, 
nkeynes@248:     0, 0 };    
nkeynes@248: 
nkeynes@248: uint32_t post_set_feature2_regs[] = {
nkeynes@248:     IDE_ALTSTATUS, 0x50,
nkeynes@248:     IDE_ERROR, 0x00,
nkeynes@248:     IDE_COUNT, 0x22,
nkeynes@248:     IDE_LBA1, 0x00,
nkeynes@248:     IDE_LBA2, 0x00,
nkeynes@248:     IDE_DEVICE, 0,
nkeynes@248:     IDE_DATA, 0xFFFF,
nkeynes@248:     IDE_STATUS, 0x50, 
nkeynes@248:     0, 0 };    
nkeynes@248: 
nkeynes@252: /************************** Interface Tests *******************************/
nkeynes@252: 
nkeynes@248: /**
nkeynes@248:  * Test enable/disable of the IDE interface via port
nkeynes@248:  * 0x4E4. 
nkeynes@248:  */
nkeynes@248: int test_enable()
nkeynes@185: {
nkeynes@248:     int i;
nkeynes@248:     int failed = 0;
nkeynes@248:     /* ensure deactivated */
nkeynes@248:     long_write( IDE_ACTIVATE, 0x00042FE );
nkeynes@185: 
nkeynes@248:     /* test registers to ensure all return 0xFF (need to wait a few cycles?) */
nkeynes@248:     for( i= IDE_BASE; i< IDE_BASE+0x400; i+= 4 ) {
nkeynes@248: 	CHECK_REG_EQUALS( i, 0xFFFFFFFF, long_read( i ) );
nkeynes@185:     }
nkeynes@185: 
nkeynes@248:     /* enable interface */
nkeynes@248:     ide_activate();
nkeynes@248: 
nkeynes@248:     /* test registers have default settings */
nkeynes@248:     //    CHECK_REGS( post_reset_regs );
nkeynes@248:     
nkeynes@248: 
nkeynes@248:     /* disable interface and re-test */
nkeynes@248:     long_write( IDE_ACTIVATE, 0x00042FE );
nkeynes@248: 
nkeynes@248:     /* Test registers all 0xFF */
nkeynes@248:     for( i= IDE_BASE; i< IDE_BASE+0x400; i+= 4 ) {
nkeynes@248: 	CHECK_REG_EQUALS( i, 0xFFFFFFFF, long_read( i ) );
nkeynes@185:     }
nkeynes@185: 
nkeynes@248:     /* Finally leave the interface in an enabled state */
nkeynes@248:     ide_activate();
nkeynes@185:     return 0;
nkeynes@185: }
nkeynes@185: 
nkeynes@251: 
nkeynes@251: uint32_t drive_ready_regs[] = {
nkeynes@251:     IDE_ALTSTATUS, 0x50,
nkeynes@251:     IDE_ERROR, 0x00,
nkeynes@251:     IDE_COUNT, 0x03,
nkeynes@251:     IDE_LBA1, 0x08,
nkeynes@251:     IDE_LBA2, 0x00,
nkeynes@251:     IDE_DEVICE, 0,
nkeynes@251:     IDE_DATA, 0xFFFF,
nkeynes@251:     IDE_STATUS, 0x50, 
nkeynes@251:     0, 0 };    
nkeynes@251: 
nkeynes@248: /**
nkeynes@248:  * Test the reset command
nkeynes@248:  */
nkeynes@248: int test_reset()
nkeynes@248: {
nkeynes@248:     byte_write( IDE_COMMAND, 0x08 );
nkeynes@248:     EXPECT_READY();
nkeynes@248:     CHECK_INTRQ_CLEAR();
nkeynes@248:     CHECK_REGS( post_reset_regs );
nkeynes@248:     
nkeynes@248:     /** Set Default PIO mode */
nkeynes@248:     byte_write( IDE_FEATURE, 0x03 );
nkeynes@248:     byte_write( IDE_COUNT, 0x0B );
nkeynes@248:     byte_write( IDE_COMMAND, 0xEF );
nkeynes@248:     EXPECT_READY();
nkeynes@248:     CHECK_REGS( post_set_feature_regs );
nkeynes@248:     
nkeynes@248:     /** Set Multi-word DMA mode 2 */
nkeynes@248:     long_write( 0xA05F7490, 0x222 );
nkeynes@248:     long_write( 0xA05F7494, 0x222 );
nkeynes@248:     byte_write( IDE_FEATURE, 0x03 );
nkeynes@248:     byte_write( IDE_COUNT, 0x22 );
nkeynes@248:     byte_write( IDE_COMMAND, 0xEF );
nkeynes@248:     EXPECT_READY();
nkeynes@248:     CHECK_INTRQ_CLEAR();
nkeynes@248:     CHECK_REGS( post_set_feature2_regs );
nkeynes@185: 
nkeynes@251:     char test_ready_cmd[12] = { 0,0,0,0, 0,0,0,0, 0,0,0,0 };
nkeynes@251:     if( send_packet_command(test_ready_cmd) != 0 ) {
nkeynes@251: 	return -1;
nkeynes@251:     }
nkeynes@251: 
nkeynes@251:     CHECK_REGS( packet_cmd_error6_regs );
nkeynes@251:     int sense = ide_get_sense_code();
nkeynes@251:     CHECK_IEQUALS( 0x2906, sense );
nkeynes@251: 
nkeynes@251:     if( send_packet_command(test_ready_cmd) != 0 ) {
nkeynes@251: 	return -1;
nkeynes@251:     }
nkeynes@251:     CHECK_REGS( drive_ready_regs );
nkeynes@248:     return 0;
nkeynes@248: }
nkeynes@248: 
nkeynes@248: char expect_ident[] = { 0x00, 0xb4, 0x19, 0x00,
nkeynes@248: 			0x00, 0x08, 0x53, 0x45, 0x20, 0x20, 0x20, 0x20 };
nkeynes@251: 
nkeynes@248: /**
nkeynes@248:  * Test the PACKET command (using the Inquiry command)
nkeynes@248:  */
nkeynes@248: int test_packet()
nkeynes@185: {
nkeynes@248:     int i;
nkeynes@248:     char cmd[12] = { 0x11, 0, 4, 0,  12, 0, 0, 0,  0, 0, 0, 0 };
nkeynes@248:     // char cmd[12] = { 0x00,0,0,0, 0,0,0,0, 0,0,0,0 };
nkeynes@251:     unsigned short *spkt;
nkeynes@248:     char result[12];
nkeynes@248: 
nkeynes@251:     send_packet_command( cmd );
nkeynes@248:     CHECK_REGS( packet_data_ready_regs );
nkeynes@248:     spkt = (unsigned short *)result;
nkeynes@248:     *spkt++ = word_read(IDE_DATA);
nkeynes@248:     *spkt++ = word_read(IDE_DATA);
nkeynes@248:     *spkt++ = word_read(IDE_DATA);
nkeynes@248:     *spkt++ = word_read(IDE_DATA);
nkeynes@248:     CHECK_REGS( packet_data_ready_regs );
nkeynes@248:     *spkt++ = word_read(IDE_DATA);
nkeynes@248:     *spkt++ = word_read(IDE_DATA);
nkeynes@252: //    CHECK_REGS( post_packet_data_regs );
nkeynes@248:     EXPECT_READY();
nkeynes@251:     EXPECT_INTRQ();
nkeynes@248:     CHECK_REGS( packet_complete_regs );
nkeynes@251: 
nkeynes@248:     if( memcmp( result, expect_ident, 12 ) != 0 ) {
nkeynes@248: 	fwrite_diff( stderr, expect_ident, 12, result, 12 );
nkeynes@252: 	return -1;
nkeynes@248:     }
nkeynes@248:     return 0;
nkeynes@185: }
nkeynes@248: 
nkeynes@248: /**
nkeynes@248:  * Test the SET FEATURE command
nkeynes@248:  */
nkeynes@248: int test_set_feature()
nkeynes@248: {
nkeynes@248:     return 0;
nkeynes@248: }
nkeynes@248: 
nkeynes@258: 
nkeynes@258: 
nkeynes@248: /**
nkeynes@248:  * Test DMA transfer (using the Inquiry packet comand)
nkeynes@248:  */
nkeynes@248: int test_dma()
nkeynes@248: {
nkeynes@248:     return 0;
nkeynes@248: }
nkeynes@248: 
nkeynes@248: /**
nkeynes@248:  * Test DMA abort
nkeynes@248:  */
nkeynes@248: int test_dma_abort()
nkeynes@248: {
nkeynes@248:     return 0;
nkeynes@248: }
nkeynes@248: 
nkeynes@252: /***************************** GD-Rom Tests **********************************/
nkeynes@252: 
nkeynes@252: int test_read_toc()
nkeynes@252: {
nkeynes@252:     char cmd[12] = { 0x14,0,0,0x00, 0x0C,0,0,0, 0,0,0,0 };
nkeynes@252:     char expect[12] = { 0x41, 0,0, 0x96, 0x41, 0, 0x2E, 0x4C, 0xFF, 0xFF, 0xFF, 0xFF };
nkeynes@252:     
nkeynes@252:     IDE_TEST_PACKET_OK( cmd, expect, 12 );
nkeynes@252:     return 0;
nkeynes@252: }
nkeynes@252: 
nkeynes@258: int test_read_pio()
nkeynes@258: {
nkeynes@258:     int i,j;
nkeynes@258:     char cmd[12] = {0x30, 0x28, 0, 0x2E,  0x4C, 0, 0, 0,  0, 0, 7, 0 };
nkeynes@258:     uint32_t read_pio_ready_regs[] = 
nkeynes@258: 	{ IDE_ALTSTATUS, 0x58,
nkeynes@258: 	  IDE_ERROR, 0x00,
nkeynes@258: 	  IDE_COUNT, 0x02,
nkeynes@258: 	  IDE_LBA1, 0x00,
nkeynes@258: 	  IDE_LBA2, 0x08,
nkeynes@258: 	  IDE_DEVICE, 0,
nkeynes@258: 	  IDE_STATUS, 0x58, 0, 0 };
nkeynes@258: 
nkeynes@258:     if( send_packet_command(cmd) != 0 ) {
nkeynes@258: 	return -1;
nkeynes@258:     }
nkeynes@258: 
nkeynes@258:     for( j=0; j<7; j++ ) {
nkeynes@258: 	CHECK_REGS(read_pio_ready_regs);
nkeynes@258: 	CHECK_INTRQ_CLEAR();
nkeynes@258: 	for( i=0; i<0x0800; i+=2 ) {
nkeynes@258: 	    word_read(IDE_DATA); // throw away for now.
nkeynes@258: 	}
nkeynes@258: 	
nkeynes@258: 	EXPECT_INTRQ();
nkeynes@258: 	EXPECT_READY();
nkeynes@258:     }
nkeynes@258: 
nkeynes@258:     read_pio_ready_regs[1] = 0x50;
nkeynes@258:     read_pio_ready_regs[5] = 0x03;
nkeynes@258:     read_pio_ready_regs[13] = 0x50;
nkeynes@258:     CHECK_REGS( read_pio_ready_regs );
nkeynes@258:     return 0;
nkeynes@258: }
nkeynes@258: 
nkeynes@252: /**
nkeynes@252:  * Test interaction of Read CD (0x30) with Status (0x40,1)
nkeynes@252:  */
nkeynes@252: int test_status1() 
nkeynes@252: {
nkeynes@252:     char cmd[12] = { 0x40, 0x01, 0, 0, 16,0,0,0, 0,0,0,0 };
nkeynes@252:     char read1cmd[12] = { 0x30, 0x28, 0, 0x2E, 0x4C, 0, 0, 0, 0, 0,1,0 };
nkeynes@252:     char expect1[16] = { 0,0x15,0,0x0E, 0x41,2,1,0, 0,1,0,0, 0x2E,0x4D,0,0 };
nkeynes@252:     char read2cmd[12] = { 0x30, 0x28, 0, 0x2E, 0x4D, 0, 0, 0, 0, 0,1,0 };
nkeynes@252:     char expect2[16] = { 0,0x15,0,0x0E, 0x41,2,1,0, 0,4,0,0, 0x2E,0x50,0,0 };
nkeynes@252:     char read3cmd[12] = { 0x30, 0x28, 0, 0x2E, 0x4E, 0, 0, 0, 0, 0,1,0 };
nkeynes@252:     char expect3[16] = { 0,0x15,0,0x0E, 0x41,2,1,0, 0,5,0,0, 0x2E,0x51,0,0 };
nkeynes@252:     char expect4[16] = { 0,0x15,0,0x0E, 0x41,2,1,0, 0,2,0,0, 0x2E,0x4E,0,0 };
nkeynes@252:     char read5cmd[12] = { 0x30, 0x28, 0, 0x2F, 0x01, 0, 0, 0, 0, 0,1,0 };
nkeynes@252:     char expect5[16] = { 0,0x15,0,0x0E, 0x41,2,1,0, 0,0xB6,0,0, 0x2F,0x02,0,0 };
nkeynes@252:     char read6cmd[12] = { 0x30, 0x28, 0, 0x2F, 0x50, 0, 0, 0, 0, 0,1,0 };
nkeynes@252:     char expect6[16] = { 0,0x15,0,0x0E, 0x41,2,1,0, 0x01,0x05,0,0, 0x2F,0x51,0,0 };
nkeynes@252:     char read7cmd[12] = { 0x30, 0x28, 0, 0x2F, 0x51, 0, 0, 0, 0, 0,1,0 };
nkeynes@252:     char expect7[16] = { 0,0x15,0,0x0E, 0x41,2,1,0, 0x01,0x06,0,0, 0x2F,0x52,0,0 };
nkeynes@252:     
nkeynes@252: 
nkeynes@252:     IDE_TEST_PACKET_OK(read1cmd, NULL, 2048);
nkeynes@252:     IDE_TEST_PACKET_OK(cmd, expect1, 14 );
nkeynes@252:     IDE_TEST_PACKET_OK(read2cmd, NULL, 2048);
nkeynes@252:     IDE_TEST_PACKET_OK(cmd, expect2, 14 );
nkeynes@252:     IDE_TEST_PACKET_OK(read3cmd, NULL, 2048);
nkeynes@252:     IDE_TEST_PACKET_OK(cmd, expect3, 14 );
nkeynes@252:     IDE_TEST_PACKET_OK(read2cmd, NULL, 2048);
nkeynes@252:     IDE_TEST_PACKET_OK(cmd, expect4, 14 );
nkeynes@252:     IDE_TEST_PACKET_OK(read5cmd, NULL, 2048);
nkeynes@252:     IDE_TEST_PACKET_OK(cmd, expect5, 14 );
nkeynes@252:     IDE_TEST_PACKET_OK(read6cmd, NULL, 2048);
nkeynes@252:     IDE_TEST_PACKET_OK(cmd, expect6, 14 );
nkeynes@252: 
nkeynes@252:     return 0;
nkeynes@252: }
nkeynes@252: 
nkeynes@252: /********************************* Main **************************************/
nkeynes@252: 
nkeynes@251: test_func_t test_fns[] = { test_enable, test_reset, test_packet,
nkeynes@258: 			   test_dma, test_dma_abort, test_read_pio,
nkeynes@252: 			   test_read_toc,
nkeynes@252: 			   test_status1, NULL };
nkeynes@248: 
nkeynes@248: int main() 
nkeynes@248: {
nkeynes@248:     int i;
nkeynes@248:     ide_init();
nkeynes@263:     return run_tests( test_fns );
nkeynes@248: }