📄 ataioreg.c
字号:
// For interrupt mode, install interrupt handler.
int_save_int_vect();
}
// Start the command by setting the Command register. The drive
// should immediately set BUSY status.
pio_outbyte( CB_CMD, reg_cmd_info.cmd );
// Waste some time by reading the alternate status a few times.
// This gives the drive time to set BUSY in the status register on
// really fast systems. If we don't do this, a slow drive on a fast
// system may not set BUSY fast enough and we would think it had
// completed the command when it really had not even started the
// command yet.
DELAY400NS;
if ( reg_config_info[0] == REG_CONFIG_TYPE_ATAPI )
sub_atapi_delay( 0 );
if ( reg_config_info[1] == REG_CONFIG_TYPE_ATAPI )
sub_atapi_delay( 1 );
// IF
// This is an Exec Dev Diag command (cmd=0x90)
// and there is no device 0 then
// there will be no interrupt. So we must
// poll device 1 until it allows register
// access and then do normal polling of the Status
// register for BSY=0.
// ELSE
// IF
// This is a Dev Reset command (cmd=0x08) then
// there should be no interrupt. So we must
// poll for BSY=0.
// ELSE
// Do the normal wait for interrupt or polling for
// completion.
if ( ( reg_cmd_info.cmd == CMD_EXECUTE_DEVICE_DIAGNOSTIC )
&&
( reg_config_info[0] == REG_CONFIG_TYPE_NONE )
)
{
polled = 1;
trc_llt( 0, 0, TRC_LLT_PNBSY );
while ( 1 )
{
pio_outbyte( CB_DH, CB_DH_DEV1 );
DELAY400NS;
secCnt = pio_inbyte( CB_SC );
secNum = pio_inbyte( CB_SN );
if ( ( secCnt == 0x01 ) && ( secNum == 0x01 ) )
break;
if ( tmr_chk_timeout() )
{
trc_llt( 0, 0, TRC_LLT_TOUT );
reg_cmd_info.to = 1;
reg_cmd_info.ec = 24;
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
break;
}
}
}
else
{
if ( reg_cmd_info.cmd == CMD_DEVICE_RESET )
{
// Wait for not BUSY -or- wait for time out.
polled = 1;
reg_wait_poll( 0, 23 );
}
else
{
// Wait for interrupt -or- wait for not BUSY -or- wait for time out.
if ( ! int_use_intr_flag )
polled = 1;
reg_wait_poll( 22, 23 );
}
}
// If status was polled or if any error read the status register,
// otherwise get the status that was read by the interrupt handler.
if ( ( polled ) || ( reg_cmd_info.ec ) )
status = pio_inbyte( CB_STAT );
else
status = int_ata_status;
// Error if BUSY, DEVICE FAULT, DRQ or ERROR status now.
if ( reg_cmd_info.ec == 0 )
{
if ( status & ( CB_STAT_BSY | CB_STAT_DF | CB_STAT_DRQ | CB_STAT_ERR ) )
{
reg_cmd_info.ec = 21;
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
}
}
// read the output registers and trace the command.
sub_trace_command();
// BMCR/BMIDE Error=1?
if ( sub_readBusMstrStatus() & BM_SR_MASK_ERR )
{
reg_cmd_info.ec = 78; // yes
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
}
// NON_DATA_DONE:
// For interrupt mode, remove interrupt handler.
int_restore_int_vect();
// mark end of ND cmd in low level trace
trc_llt( 0, 0, TRC_LLT_E_ND );
// All done. The return values of this function are described in
// ATAIO.H.
if ( reg_cmd_info.ec )
return 1;
return 0;
}
//*************************************************************
//
// reg_non_data_chs() - Execute a non-data command.
//
// Note special handling for Execute Device Diagnostics
// command when there is no device 0.
//
// See ATA-2 Section 9.5, ATA-3 Section 9.5,
// ATA-4 Section 8.8 Figure 12. Also see Section 8.5.
//
//*************************************************************
int reg_non_data_chs( int dev, int cmd,
unsigned int fr, unsigned int sc,
unsigned int cyl, unsigned int head, unsigned int sect )
{
// Setup command parameters.
sub_zero_return_data();
reg_cmd_info.flg = TRC_FLAG_ATA;
reg_cmd_info.ct = TRC_TYPE_AND;
reg_cmd_info.cmd = cmd;
reg_cmd_info.fr1 = fr;
reg_cmd_info.sc1 = sc;
reg_cmd_info.sn1 = sect;
reg_cmd_info.cl1 = cyl & 0x00ff;
reg_cmd_info.ch1 = ( cyl & 0xff00 ) >> 8;
reg_cmd_info.dh1 = ( dev ? CB_DH_DEV1 : CB_DH_DEV0 ) | ( head & 0x0f );
reg_cmd_info.dc1 = int_use_intr_flag ? 0 : CB_DC_NIEN;
reg_cmd_info.ns = sc;
reg_cmd_info.lbaSize = LBACHS;
// Execute the command.
return exec_non_data_cmd( dev );
}
//*************************************************************
//
// reg_non_data_lba28() - Easy way to execute a non-data command
// using an LBA sector address.
//
//*************************************************************
int reg_non_data_lba28( int dev, int cmd,
unsigned int fr, unsigned int sc,
unsigned long lba )
{
// Setup current command information.
sub_zero_return_data();
reg_cmd_info.flg = TRC_FLAG_ATA;
reg_cmd_info.ct = TRC_TYPE_AND;
reg_cmd_info.cmd = cmd;
reg_cmd_info.fr1 = fr;
reg_cmd_info.sc1 = sc;
reg_cmd_info.dh1 = CB_DH_LBA | (dev ? CB_DH_DEV1 : CB_DH_DEV0 );
reg_cmd_info.dc1 = int_use_intr_flag ? 0 : CB_DC_NIEN;
reg_cmd_info.ns = sc;
reg_cmd_info.lbaSize = LBA28;
reg_cmd_info.lbaHigh1 = 0L;
reg_cmd_info.lbaLow1 = lba;
// Execute the command.
return exec_non_data_cmd( dev );
}
//*************************************************************
//
// reg_non_data_lba48() - Easy way to execute a non-data command
// using an LBA sector address.
//
//*************************************************************
int reg_non_data_lba48( int dev, int cmd,
unsigned int fr, unsigned int sc,
unsigned long lbahi, unsigned long lbalo )
{
// Setup current command infomation.
sub_zero_return_data();
reg_cmd_info.flg = TRC_FLAG_ATA;
reg_cmd_info.ct = TRC_TYPE_AND;
reg_cmd_info.cmd = cmd;
reg_cmd_info.fr1 = fr;
reg_cmd_info.sc1 = sc;
reg_cmd_info.dh1 = CB_DH_LBA | (dev ? CB_DH_DEV1 : CB_DH_DEV0 );
reg_cmd_info.dc1 = int_use_intr_flag ? 0 : CB_DC_NIEN;
reg_cmd_info.ns = sc;
reg_cmd_info.lbaSize = LBA48;
reg_cmd_info.lbaHigh1 = lbahi;
reg_cmd_info.lbaLow1 = lbalo;
// Execute the command.
return exec_non_data_cmd( dev );
}
//*************************************************************
//
// exec_pio_data_in_cmd() - Execute a PIO Data In command.
//
// See ATA-2 Section 9.3, ATA-3 Section 9.3,
// ATA-4 Section 8.6 Figure 10.
//
//*************************************************************
static int exec_pio_data_in_cmd( int dev,
unsigned int seg, unsigned int off,
long numSect, int multiCnt );
static int exec_pio_data_in_cmd( int dev,
unsigned int seg, unsigned int off,
long numSect, int multiCnt )
{
unsigned char status;
long wordCnt;
unsigned int saveSeg = seg;
unsigned int saveOff = off;
// mark start of PDI cmd in low level trace
trc_llt( 0, 0, TRC_LLT_S_PDI );
// reset Bus Master Error bit
sub_writeBusMstrStatus( BM_SR_MASK_ERR );
// Set command time out.
tmr_set_timeout();
// Select the drive - call the sub_select function.
// Quit now if this fails.
if ( sub_select( dev ) )
{
sub_trace_command();
trc_llt( 0, 0, TRC_LLT_E_PDI );
reg_drq_block_call_back = (void *) 0;
return 1;
}
// Set up all the registers except the command register.
sub_setup_command();
// For interrupt mode, install interrupt handler.
int_save_int_vect();
// Start the command by setting the Command register. The drive
// should immediately set BUSY status.
pio_outbyte( CB_CMD, reg_cmd_info.cmd );
// Waste some time by reading the alternate status a few times.
// This gives the drive time to set BUSY in the status register on
// really fast systems. If we don't do this, a slow drive on a fast
// system may not set BUSY fast enough and we would think it had
// completed the command when it really had not even started the
// command yet.
DELAY400NS;
// Loop to read each sector.
while ( 1 )
{
// READ_LOOP:
//
// NOTE NOTE NOTE ... The primary status register (1f7) MUST NOT be
// read more than ONCE for each sector transferred! When the
// primary status register is read, the drive resets IRQ 14. The
// alternate status register (3f6) can be read any number of times.
// After interrupt read the the primary status register ONCE
// and transfer the 256 words (REP INSW). AS SOON as BOTH the
// primary status register has been read AND the last of the 256
// words has been read, the drive is allowed to generate the next
// IRQ 14 (newer and faster drives could generate the next IRQ 14 in
// 50 microseconds or less). If the primary status register is read
// more than once, there is the possibility of a race between the
// drive and the software and the next IRQ 14 could be reset before
// the system interrupt controller sees it.
// Wait for interrupt -or- wait for not BUSY -or- wait for time out.
sub_atapi_delay( dev );
reg_wait_poll( 34, 35 );
// If polling or error read the status, otherwise
// get the status that was read by the interrupt handler.
if ( ( ! int_use_intr_flag ) || ( reg_cmd_info.ec ) )
status = pio_inbyte( CB_STAT );
else
status = int_ata_status;
// If there was a time out error, go to READ_DONE.
if ( reg_cmd_info.ec )
break; // go to READ_DONE
// If BSY=0 and DRQ=1, transfer the data,
// even if we find out there is an error later.
if ( ( status & ( CB_STAT_BSY | CB_STAT_DRQ ) ) == CB_STAT_DRQ )
{
// do the slow data transfer thing
if ( reg_slow_xfer_flag )
{
if ( numSect <= reg_slow_xfer_flag )
{
sub_xfer_delay();
reg_slow_xfer_flag = 0;
}
}
// increment number of DRQ packets
reg_cmd_info.drqPackets ++ ;
// determine the number of sectors to transfer
wordCnt = multiCnt ? multiCnt : 1;
if ( wordCnt > numSect )
wordCnt = numSect;
wordCnt = wordCnt * 256;
// Quit if buffer overrun.
// Adjust buffer address when DRQ block call back in use.
if ( reg_drq_block_call_back )
{
if ( ( wordCnt << 1 ) > reg_buffer_size )
{
reg_cmd_info.ec = 61;
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
break; // go to READ_DONE
}
seg = saveSeg;
off = saveOff;
}
else
{
if ( ( reg_cmd_info.totalBytesXfer + ( wordCnt << 1 ) )
> reg_buffer_size )
{
reg_cmd_info.ec = 61;
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
break; // go to READ_DONE
}
}
// Do the REP INSW to read the data for one DRQ block.
reg_cmd_info.totalBytesXfer += ( wordCnt << 1 );
pio_drq_block_in( CB_DATA, seg, off, wordCnt );
DELAY400NS; // delay so device can get the status updated
// Note: The drive should have dropped DATA REQUEST by now. If there
// are more sectors to transfer, BUSY should be active now (unless
// there is an error).
// Call DRQ block call back function.
if ( reg_drq_block_call_back )
{
reg_cmd_info.drqPacketSize = ( wordCnt << 1 );
(* reg_drq_block_call_back) ( & reg_cmd_info );
}
// Decrement the count of sectors to be transferred
// and increment buffer address.
numSect = numSect - ( multiCnt ? multiCnt : 1 );
seg = seg + ( 32 * ( multiCnt ? multiCnt : 1 ) );
}
// So was there any error condition?
if ( status & ( CB_STAT_BSY | CB_STAT_DF | CB_STAT_ERR ) )
{
reg_cmd_info.ec = 31;
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
break; // go to READ_DONE
}
// DRQ should have been set -- was it?
if ( ( status & CB_STAT_DRQ ) == 0 )
{
reg_cmd_info.ec = 32;
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
break; // go to READ_DONE
}
// If all of the requested sectors have been transferred, make a
// few more checks before we exit.
if ( numSect < 1 )
{
// Since the drive has transferred all of the requested sectors
// without error, the drive should not have BUSY, DEVICE FAULT,
// DATA REQUEST or ERROR active now.
sub_atapi_delay( dev );
status = pio_inbyte( CB_STAT );
if ( status & ( CB_STAT_BSY | CB_STAT_DF | CB_STAT_DRQ | CB_STAT_ERR ) )
{
reg_cmd_info.ec = 33;
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
break; // go to READ_DONE
}
// All sectors have been read without error, go to READ_DONE.
break; // go to READ_DONE
}
// This is the end of the read loop. If we get here, the loop is
// repeated to read the next sector. Go back to READ_LOOP.
}
// read the output registers and trace the command.
sub_trace_command();
// BMCR/BMIDE Error=1?
if ( sub_readBusMstrStatus() & BM_SR_MASK_ERR )
{
reg_cmd_info.ec = 78; // yes
trc_llt( 0, reg_cmd_info.ec, TRC_LLT_ERROR );
}
// READ_DONE:
// For interrupt mode, remove interrupt handler.
int_restore_int_vect();
// mark end of PDI cmd in low level trace
trc_llt( 0, 0, TRC_LLT_E_PDI );
// reset reg_drq_block_call_back to NULL (0)
reg_drq_block_call_back = (void *) 0;
// All done. The return values of this function are described in
// ATAIO.H.
if ( reg_cmd_info.ec )
return 1;
return 0;
}
//*************************************************************
//
// reg_pio_data_in_chs() - Execute a PIO Data In command.
//
// See ATA-2 Section 9.3, ATA-3 Section 9.3,
// ATA-4 Section 8.6 Figure 10.
//
//*************************************************************
int reg_pio_data_in_chs( int dev, int cmd,
unsigned int fr, unsigned int sc,
unsigned int cyl, unsigned int head, unsigned int sect,
unsigned int seg, unsigned int off,
long numSect, int multiCnt )
{
// Reset error return data.
sub_zero_return_data();
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -