idereadsector.c

来自「在51下的外挂硬盘和FLASH的MP3方案程序以及原理图」· C语言 代码 · 共 30 行

#ifndef _IDEIO_DEFINE
 #include "IDEIO.c"
#endif

BYTE IDEReadSector(DWORD Sector,BYTE *Buffer) small;

BYTE IDEReadSector(DWORD Sector,BYTE *Buffer) small
{
	register WORD i;

	if (!IDEStatus(IDE_STATUS_BSY,IDE_WAIT,FALSE,255))  return(IDE_ERROR_BSY);
	if (!IDEStatus(IDE_STATUS_DRDY,IDE_WAIT,TRUE,255)) return(IDE_ERROR_DRDY);
	IDE_WRITE_LSB(IDE_ADDR_CMD_LBA0,(BYTE)(Sector&0x000000ff));
	Sector=Sector>>8;
	IDE_WRITE_LSB(IDE_ADDR_CMD_LBA1,(BYTE)(Sector&0x000000ff));
	Sector=Sector>>8;
	IDE_WRITE_LSB(IDE_ADDR_CMD_LBA2,(BYTE)(Sector&0x000000ff));
	Sector=Sector>>8;
	IDE_WRITE_LSB(IDE_ADDR_CMD_LBA3,0xe0|(IDE.Devices&0x10)|(BYTE)(Sector&0x0f));
	IDE_WRITE_LSB(IDE_ADDR_CMD_SECCNT,0x01);
	IDE_WRITE_LSB(IDE_ADDR_CMD_COMMAND,IDE_CMD_READ);
	if (!IDEStatus(IDE_STATUS_BSY,IDE_WAIT,FALSE,255))  return(IDE_ERROR_BSY);
	if (!IDEStatus(IDE_STATUS_DRQ,IDE_WAIT,TRUE,255)) return(IDE_ERROR_DRQ);
	for(i=0;i<512;)
	{
		IDE_READ_WORD(IDE_ADDR_CMD_DATA,Buffer[i++],Buffer[i++]);
	}
	return(IDE_SUCCESSFUL);
}