idewritesector.c

外挂硬盘和FLASH的MP3播放器解决方案

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

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

BYTE IDEWriteSector(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_WRITE);
	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_WRITE_WORD(IDE_ADDR_CMD_DATA,Buffer[i++],Buffer[i++]);
	}
	return(IDE_SUCCESSFUL);
}