OSDev.org

Code: Select all

void AtaPI_SendPacket( unsigned char* pPacket, int pLength )
{
	// Sends an ATAPI packet command
	// Based on ATA-ATAPI-6, PACKET command (section 8.24) and PACKET Command Protocol (section 9.8)

	short lPortBase = 0x1F0;

	char lOverlap = 0;
	char lDMA = 0;
	char lTag = 0;
	unsigned short lByteCount = 0xFFFF;
	char lDevice = 1;

	unsigned char lCount;
	unsigned short lCommand;

	lOverlap &= 0x01;
	lDMA &= 0x01;
	lTag &= 0x1F;
	lDevice &= 0x01;

	// Initial status is 0x50 (DRDY set, bit 4 set)
	Ata_ShowStatus( lPortBase );

	// Set initial imput conditions
	Ports_OutB( lPortBase + ATA_ERROR_FEATURES, (lOverlap << 1) | lDMA     );		// Sets OVERLAP and DMA
	Ports_OutB( lPortBase + ATA_SECTORCOUNT,    lTag << 3                  );		// Sets TAG
	Ports_OutB( lPortBase + ATA_LBA_LOW,        0x00                       );		// Does nothing
	Ports_OutB( lPortBase + ATA_LBA_MID,        (lByteCount & 0xFF)        );		// Sets the Byte Count Low
	Ports_OutB( lPortBase + ATA_LBA_HIGH,       (lByteCount & 0xFF00) >> 8 );		// Sets the Byte Count High
	Ports_OutB( lPortBase + ATA_DEVICE,         lDevice << 4               );		// Set the Device

	mWaitingForInterrupt = 1;
	Ports_OutB( lPortBase + ATA_STATUS_COMMAND, 0xA0 );							// Send PACKET command
	Ata_WaitForInterrupt();

	// Now in "HP0: Check_Status_A" state

	// If BSY is set, continue to wait
	Timer_Delay( 10 );
	while ( Ports_InB( lPortBase + ATA_STATUS_COMMAND ) & 0x80 )
	{
		Timer_Delay( 10 );
	}

	// Status is now 0x58 (DRQ now set)
	Ata_ShowStatus( lPortBase );

	// If BSY is clear and DRQ is clear, return to Idle
	if ( Ports_InB( lPortBase + ATA_STATUS_COMMAND ) & 0x88 == 0x00 )
	{
		// Doesn't come in here
		return;
	}

	// Now in "HP1: Send_Packet" state

	// Send Command Packet to the Data port
	mWaitingForInterrupt = 1;
	for ( lCount = 0 ; lCount < pLength ; lCount += 2 )
	{
		lCommand = *((unsigned short*)&pPacket[lCount]);

		String_kprintf( "0x%04X\n", lCommand );
		Ports_OutS( lPortBase + ATA_DATA, lCommand );

	}
	Ata_WaitForInterrupt();

	// Status is now 0x51 (DRQ clear, CHK set)
	Ata_ShowStatus( lPortBase );

	// Error Register now contains 0x60
	Ata_ShowError( lPortBase );

}

Code: Select all

	unsigned char lEjectCd[12] = { 0x1B, 1, 0, 0, 2, 0, 0, 0, 0, 0, 0, 0 };
	AtaPI_SendPacket( lEjectCd, 12 );

Code: Select all

#define	ATA_Cmd_Reset			0x08
#define	ATA_Cmd_Read			0x20
#define	ATA_Cmd_Write 			0x30
#define	ATA_Cmd_Packet 			0xA0

#define	ATAPI_Cmd_Read12		0xA8
#define	ATAPI_Cmd_ReadTOC		0x43
#define	ATAPI_Cmd_Start			0x1B
#define	ATAPI_Cmd_Test			0x00

#define	ATA_Bit_Command_OBSBIT7		10000000b
#define	ATA_Bit_Command_LBAEnabled	01000000b
#define	ATA_Bit_Command_OBSBIT5		00100000b
#define	ATA_Bit_Command_Slave		00010000b

#define	ATA_Bit_Status_BSY			10000000b
#define	ATA_Bit_Status_DRDY			01000000b
#define	ATA_Bit_Status_DWF			00100000b
#define	ATA_Bit_Status_DSC			00010000b
#define	ATA_Bit_Status_DRQ			00001000b
#define	ATA_Bit_Status_CORR			00000100b
#define	ATA_Bit_Status_IDX			00000010b
#define	ATA_Bit_Status_ERR			00000001b

#define	ATA_Bit_Error_BBK			10000000b//BBK (Bad Block)
#define	ATA_Bit_Error_UNC			01000000b//UNC (Uncorrectable data error)
#define	ATA_Bit_Error_MC			00100000b//MC (Media Changed)
#define	ATA_Bit_Error_IDNF			00010000b//IDNF (ID mark Not Found)
#define	ATA_Bit_Error_MCR			00001000b//MCR (Media Change Requested)
#define	ATA_Bit_Error_ABRT			00000100b//ABRT (command aborted)
#define	ATA_Bit_Error_TKONF			00000010b//TK0NF (Track 0 Not Found)
#define	ATA_Bit_Error_AMNF			00000001b//AMNF (Address Mark Not Found)

#define	ATA_Bit_DevCtrl_Default		00001000b
#define	ATA_Bit_DevCtrl_SRST		00000100b
#define	ATA_Bit_DevCtrl_nIEN		00000010b

#define	ATA_Port_Primary_Data			0x1F0
#define	ATA_Port_Primary_Error			0x1F1
#define	ATA_Port_Primary_Feature		0x1F1
#define	ATA_Port_Primary_SectorCount	0x1F2
#define	ATA_Port_Primary_LBA			0x1F3
#define	ATA_Port_Primary_LBA8			0x1F4
#define	ATA_Port_Primary_LBA16			0x1F5
#define	ATA_Port_Primary_LBA24			0x1F6
#define	ATA_Port_Primary_Status			0x1F7
#define	ATA_Port_Primary_Command		0x1F7
#define	ATA_Port_Primary_AlterStatus	0x3F6
#define	ATA_Port_Primary_DeviceCtrl		0x3F6

#define	ATA_Port_Secondary_Data			0x170
#define	ATA_Port_Secondary_Error		0x171
#define	ATA_Port_Secondary_Feature		0x171
#define	ATA_Port_Secondary_SectorCount	0x172
#define	ATA_Port_Secondary_LBA			0x173
#define	ATA_Port_Secondary_LBA8			0x174
#define	ATA_Port_Secondary_LBA16		0x175
#define	ATA_Port_Secondary_LBA24		0x176
#define	ATA_Port_Secondary_Status		0x177
#define	ATA_Port_Secondary_Command		0x177
#define	ATA_Port_Secondary_AlterStatus	0x376
#define	ATA_Port_Secondary_DeviceCtrl	0x376


void	ATAPI_ReadSector(unsigned int LBA,unsigned int DEV,unsigned byte * M)
{
	ATA_Status=InPortB(ATA_Port_Secondary_Status);
	PutDecimal((unsigned int)ATA_Status);
	PutCRLF();

	unsigned dword LBAlo,LBAhi;

	Counter=0;
	ATA_interrupt=0;

	OutPortB(ATA_Port_Secondary_DeviceCtrl, ATA_Bit_DevCtrl_Default);
	OutPortB(ATA_Port_Secondary_LBA24, DEV);
	OutPortB(ATA_Port_Secondary_LBA16, 0);
	OutPortB(ATA_Port_Secondary_LBA8, 12);
	OutPortB(ATA_Port_Secondary_Command,ATA_Cmd_Packet);

	asm
		{
		push dword [LBA]
		pop ax
		pop dx
		xchg al,ah
		xchg dl,dh
		mov [LBAlo],ax
		mov [LBAhi],dx
		}

	ATA_Status=InPortB(ATA_Port_Secondary_Status);
	PutDecimal((unsigned int)ATA_Status);
	PutCRLF();

	OutPortW(ATA_Port_Secondary_Data,ATAPI_Cmd_Read12);
	OutPortW(ATA_Port_Secondary_Data,LBAhi);
	OutPortW(ATA_Port_Secondary_Data,LBAlo);
	OutPortW(ATA_Port_Secondary_Data,0);
	OutPortW(ATA_Port_Secondary_Data,1<<8);
	OutPortW(ATA_Port_Secondary_Data,0);

	while(ATA_interrupt==0);
        ATA_Status=InPortB(ATA_Port_Secondary_Status);
        PutDecimal((unsigned int)ATA_Status);
        PutCRLF();
        if(ATA_Status&1==1)
			{
			PutDecimal((unsigned int)InPortB(ATA_Port_Secondary_Error));
			return;
			}
	asm
	{
	cld
	mov ecx,2048/2
	mov edi,[M]
	mov dx,ATA_Port_Secondary_Data
	rep insw
	}

	return;
}