1. Changed device detect method to use ATA/ATAPI device signature;
2. Enhancements to better support SATA CDROM; 3. Fixed UDMA operation for buffer above 4G memory issue; 4. Fixed maximal block setting for ATAPI read sector operation to comply with spec; 5. Some minor fixes. git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@1739 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
@@ -12,8 +12,11 @@
|
||||
|
||||
#include "idebus.h"
|
||||
|
||||
BOOLEAN SlaveDeviceExist = FALSE;
|
||||
BOOLEAN MasterDeviceExist = FALSE;
|
||||
BOOLEAN ChannelDeviceDetected = FALSE;
|
||||
BOOLEAN SlaveDeviceExist = FALSE;
|
||||
UINT8 SlaveDeviceType = INVALID_DEVICE_TYPE;
|
||||
BOOLEAN MasterDeviceExist = FALSE;
|
||||
UINT8 MasterDeviceType = INVALID_DEVICE_TYPE;
|
||||
|
||||
/**
|
||||
TODO: Add function description
|
||||
@@ -464,57 +467,6 @@ ReassignIdeResources (
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
Read SATA registers to detect SATA disks
|
||||
|
||||
@param IdeDev The BLK_IO private data which specifies the IDE device
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
CheckPowerMode (
|
||||
IDE_BLK_IO_DEV *IdeDev
|
||||
)
|
||||
// TODO: EFI_NOT_FOUND - add return value to function comment
|
||||
// TODO: EFI_SUCCESS - add return value to function comment
|
||||
// TODO: EFI_NOT_FOUND - add return value to function comment
|
||||
{
|
||||
UINT8 ErrorRegister;
|
||||
EFI_STATUS Status;
|
||||
|
||||
IDEWritePortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->Head,
|
||||
(UINT8) ((IdeDev->Device << 4) | 0xe0)
|
||||
);
|
||||
|
||||
//
|
||||
// Wait 31 seconds for BSY clear. BSY should be in clear state if there exists
|
||||
// a device (initial state). Normally, BSY is also in clear state if there is
|
||||
// no device
|
||||
//
|
||||
Status = WaitForBSYClear (IdeDev, 31000);
|
||||
if (EFI_ERROR (Status)) {
|
||||
return EFI_NOT_FOUND;
|
||||
}
|
||||
|
||||
//
|
||||
// select device, read error register
|
||||
//
|
||||
IDEWritePortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->Head,
|
||||
(UINT8) ((IdeDev->Device << 4) | 0xe0)
|
||||
);
|
||||
Status = DRDYReady (IdeDev, 200);
|
||||
|
||||
ErrorRegister = IDEReadPortB (IdeDev->PciIo, IdeDev->IoPort->Reg1.Error);
|
||||
if ((ErrorRegister == 0x01) || (ErrorRegister == 0x81)) {
|
||||
return EFI_SUCCESS;
|
||||
} else {
|
||||
return EFI_NOT_FOUND;
|
||||
}
|
||||
}
|
||||
|
||||
//
|
||||
// DiscoverIdeDevice
|
||||
//
|
||||
@@ -533,44 +485,67 @@ DiscoverIdeDevice (
|
||||
// TODO: EFI_SUCCESS - add return value to function comment
|
||||
{
|
||||
EFI_STATUS Status;
|
||||
BOOLEAN SataFlag;
|
||||
|
||||
SataFlag = FALSE;
|
||||
//
|
||||
// This extra detection is for SATA disks
|
||||
//
|
||||
Status = CheckPowerMode (IdeDev);
|
||||
if (Status == EFI_SUCCESS) {
|
||||
SataFlag = TRUE;
|
||||
}
|
||||
|
||||
//
|
||||
// If a channel has not been checked, check it now. Then set it to "checked" state
|
||||
// After this step, all devices in this channel have been checked.
|
||||
//
|
||||
Status = DetectIDEController (IdeDev);
|
||||
|
||||
if ((EFI_ERROR (Status)) && !SataFlag) {
|
||||
return EFI_NOT_FOUND;
|
||||
}
|
||||
|
||||
//
|
||||
// Device exists. test if it is an ATA device
|
||||
//
|
||||
Status = ATAIdentify (IdeDev);
|
||||
if (EFI_ERROR (Status)) {
|
||||
//
|
||||
// if not ATA device, test if it is an ATAPI device
|
||||
//
|
||||
Status = ATAPIIdentify (IdeDev);
|
||||
if (ChannelDeviceDetected == FALSE) {
|
||||
Status = DetectIDEController (IdeDev);
|
||||
if (EFI_ERROR (Status)) {
|
||||
//
|
||||
// if not ATAPI device either, return error.
|
||||
//
|
||||
return EFI_NOT_FOUND;
|
||||
}
|
||||
}
|
||||
|
||||
Status = EFI_NOT_FOUND;
|
||||
|
||||
//
|
||||
// Device exists. test if it is an ATA device.
|
||||
// Prefer the result from DetectIDEController,
|
||||
// if failed, try another device type to handle
|
||||
// devices that not follow the spec.
|
||||
//
|
||||
if ((IdeDev->Device == IdeMaster) && (MasterDeviceExist)) {
|
||||
if (MasterDeviceType == ATA_DEVICE_TYPE) {
|
||||
Status = ATAIdentify (IdeDev);
|
||||
if (EFI_ERROR (Status)) {
|
||||
Status = ATAPIIdentify (IdeDev);
|
||||
if (!EFI_ERROR (Status)) {
|
||||
MasterDeviceType = ATAPI_DEVICE_TYPE;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
Status = ATAPIIdentify (IdeDev);
|
||||
if (EFI_ERROR (Status)) {
|
||||
Status = ATAIdentify (IdeDev);
|
||||
if (!EFI_ERROR (Status)) {
|
||||
MasterDeviceType = ATA_DEVICE_TYPE;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
if ((IdeDev->Device == IdeSlave) && (SlaveDeviceExist)) {
|
||||
if (SlaveDeviceType == ATA_DEVICE_TYPE) {
|
||||
Status = ATAIdentify (IdeDev);
|
||||
if (EFI_ERROR (Status)) {
|
||||
Status = ATAPIIdentify (IdeDev);
|
||||
if (!EFI_ERROR (Status)) {
|
||||
SlaveDeviceType = ATAPI_DEVICE_TYPE;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
Status = ATAPIIdentify (IdeDev);
|
||||
if (EFI_ERROR (Status)) {
|
||||
Status = ATAIdentify (IdeDev);
|
||||
if (!EFI_ERROR (Status)) {
|
||||
SlaveDeviceType = ATA_DEVICE_TYPE;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
if (EFI_ERROR (Status)) {
|
||||
return EFI_NOT_FOUND;
|
||||
}
|
||||
//
|
||||
// Init Block I/O interface
|
||||
//
|
||||
@@ -595,6 +570,26 @@ DiscoverIdeDevice (
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
This interface is used to initialize all state data related to the detection of one
|
||||
channel.
|
||||
|
||||
@retval EFI_SUCCESS Completed Successfully.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
InitializeIDEChannelData (
|
||||
VOID
|
||||
)
|
||||
{
|
||||
ChannelDeviceDetected = FALSE;
|
||||
MasterDeviceExist = FALSE;
|
||||
MasterDeviceType = 0xff;
|
||||
SlaveDeviceExist = FALSE;
|
||||
SlaveDeviceType = 0xff;
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
This function is called by DiscoverIdeDevice(). It is used for detect
|
||||
whether the IDE device exists in the specified Channel as the specified
|
||||
@@ -633,31 +628,12 @@ DetectIDEController (
|
||||
)
|
||||
{
|
||||
EFI_STATUS Status;
|
||||
UINT8 ErrorReg;
|
||||
UINT8 StatusReg;
|
||||
UINT8 SectorCountReg;
|
||||
UINT8 LBALowReg;
|
||||
UINT8 LBAMidReg;
|
||||
UINT8 LBAHighReg;
|
||||
UINT8 InitStatusReg;
|
||||
EFI_STATUS DeviceStatus;
|
||||
|
||||
//
|
||||
// Slave device has been detected with master device.
|
||||
//
|
||||
if ((IdeDev->Device) == 1) {
|
||||
if (SlaveDeviceExist) {
|
||||
//
|
||||
// If master not exists but slave exists, slave have to wait a while
|
||||
//
|
||||
if (!MasterDeviceExist) {
|
||||
//
|
||||
// if single slave can't be detected, add delay 4s here.
|
||||
//
|
||||
gBS->Stall (4000000);
|
||||
}
|
||||
|
||||
return EFI_SUCCESS;
|
||||
} else {
|
||||
return EFI_NOT_FOUND;
|
||||
}
|
||||
}
|
||||
UINT8 StatusReg;
|
||||
|
||||
//
|
||||
// Select slave device
|
||||
@@ -675,7 +651,7 @@ DetectIDEController (
|
||||
InitStatusReg = IDEReadPortB (IdeDev->PciIo, IdeDev->IoPort->Reg.Status);
|
||||
|
||||
//
|
||||
// Select master back
|
||||
// Select Master back
|
||||
//
|
||||
IDEWritePortB (
|
||||
IdeDev->PciIo,
|
||||
@@ -683,6 +659,7 @@ DetectIDEController (
|
||||
(UINT8) ((0 << 4) | 0xe0)
|
||||
);
|
||||
gBS->Stall (100);
|
||||
|
||||
//
|
||||
// Send ATA Device Execut Diagnostic command.
|
||||
// This command should work no matter DRDY is ready or not
|
||||
@@ -690,88 +667,124 @@ DetectIDEController (
|
||||
IDEWritePortB (IdeDev->PciIo, IdeDev->IoPort->Reg.Command, 0x90);
|
||||
|
||||
Status = WaitForBSYClear (IdeDev, 3500);
|
||||
|
||||
ErrorReg = IDEReadPortB (IdeDev->PciIo, IdeDev->IoPort->Reg1.Error);
|
||||
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG((EFI_D_ERROR, "New detecting method: Send Execute Diagnostic Command: WaitForBSYClear: Status: %d\n", Status));
|
||||
return Status;
|
||||
}
|
||||
//
|
||||
// Master Error register is 0x01. D0 passed, D1 passed or not present.
|
||||
// Master Error register is 0x81. D0 passed, D1 failed. Return.
|
||||
// Master Error register is other value. D0 failed, D1 passed or not present..
|
||||
// Read device signature
|
||||
//
|
||||
if (ErrorReg == 0x01) {
|
||||
//
|
||||
// Select Master
|
||||
//
|
||||
IDEWritePortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->Head,
|
||||
(UINT8) ((0 << 4) | 0xe0)
|
||||
);
|
||||
gBS->Stall (100);
|
||||
SectorCountReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->SectorCount
|
||||
);
|
||||
LBALowReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->SectorNumber
|
||||
);
|
||||
LBAMidReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->CylinderLsb
|
||||
);
|
||||
LBAHighReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->CylinderMsb
|
||||
);
|
||||
if ((SectorCountReg == 0x1) &&
|
||||
(LBALowReg == 0x1) &&
|
||||
(LBAMidReg == 0x0) &&
|
||||
(LBAHighReg == 0x0)) {
|
||||
MasterDeviceExist = TRUE;
|
||||
DeviceStatus = EFI_SUCCESS;
|
||||
} else if (ErrorReg == 0x81) {
|
||||
|
||||
MasterDeviceExist = TRUE;
|
||||
DeviceStatus = EFI_SUCCESS;
|
||||
SlaveDeviceExist = FALSE;
|
||||
|
||||
return DeviceStatus;
|
||||
MasterDeviceType = ATA_DEVICE_TYPE;
|
||||
} else {
|
||||
MasterDeviceExist = FALSE;
|
||||
DeviceStatus = EFI_NOT_FOUND;
|
||||
if ((LBAMidReg == 0x14) &&
|
||||
(LBAHighReg == 0xeb)) {
|
||||
MasterDeviceExist = TRUE;
|
||||
MasterDeviceType = ATAPI_DEVICE_TYPE;
|
||||
}
|
||||
}
|
||||
|
||||
//
|
||||
// Master Error register is not 0x81, Go on check Slave
|
||||
//
|
||||
|
||||
//
|
||||
// Stall 20ms to wait for slave device ready if master device not exists
|
||||
// For some Hard Drive, it takes some time to get
|
||||
// the right signature when operating in single slave mode.
|
||||
// We stall 20ms to work around this.
|
||||
//
|
||||
if (!MasterDeviceExist) {
|
||||
gBS->Stall (20000);
|
||||
}
|
||||
|
||||
//
|
||||
// select slave
|
||||
// Select Slave
|
||||
//
|
||||
IDEWritePortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->Head,
|
||||
(UINT8) ((1 << 4) | 0xe0)
|
||||
);
|
||||
|
||||
gBS->Stall (300);
|
||||
ErrorReg = IDEReadPortB (IdeDev->PciIo, IdeDev->IoPort->Reg1.Error);
|
||||
|
||||
//
|
||||
// Slave Error register is not 0x01, D1 failed. Return.
|
||||
//
|
||||
if (ErrorReg != 0x01) {
|
||||
SlaveDeviceExist = FALSE;
|
||||
return DeviceStatus;
|
||||
}
|
||||
|
||||
StatusReg = IDEReadPortB (IdeDev->PciIo, IdeDev->IoPort->Reg.Status);
|
||||
|
||||
//
|
||||
// Most ATAPI devices don't set DRDY bit, so test with a slow but accurate
|
||||
// "ATAPI TEST UNIT READY" command
|
||||
//
|
||||
if (((StatusReg & DRDY) == 0) && ((InitStatusReg & DRDY) == 0)) {
|
||||
Status = AtapiTestUnitReady (IdeDev);
|
||||
|
||||
//
|
||||
// Still fail, Slave doesn't exist.
|
||||
//
|
||||
if (EFI_ERROR (Status)) {
|
||||
SlaveDeviceExist = FALSE;
|
||||
return DeviceStatus;
|
||||
gBS->Stall (100);
|
||||
SectorCountReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->SectorCount
|
||||
);
|
||||
LBALowReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->SectorNumber
|
||||
);
|
||||
LBAMidReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->CylinderLsb
|
||||
);
|
||||
LBAHighReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->CylinderMsb
|
||||
);
|
||||
StatusReg = IDEReadPortB (
|
||||
IdeDev->PciIo,
|
||||
IdeDev->IoPort->Reg.Status
|
||||
);
|
||||
if ((SectorCountReg == 0x1) &&
|
||||
(LBALowReg == 0x1) &&
|
||||
(LBAMidReg == 0x0) &&
|
||||
(LBAHighReg == 0x0)) {
|
||||
SlaveDeviceExist = TRUE;
|
||||
SlaveDeviceType = ATA_DEVICE_TYPE;
|
||||
} else {
|
||||
if ((LBAMidReg == 0x14) &&
|
||||
(LBAHighReg == 0xeb)) {
|
||||
SlaveDeviceExist = TRUE;
|
||||
SlaveDeviceType = ATAPI_DEVICE_TYPE;
|
||||
}
|
||||
}
|
||||
|
||||
//
|
||||
// Error reg is 0x01 and DRDY is ready,
|
||||
// or ATAPI test unit ready success,
|
||||
// or init Slave status DRDY is ready
|
||||
// Slave exists.
|
||||
// When single master is plugged, slave device
|
||||
// will be wrongly detected. Here's the workaround
|
||||
// for ATA devices by detecting DRY bit in status
|
||||
// register.
|
||||
// NOTE: This workaround doesn't apply to ATAPI.
|
||||
//
|
||||
SlaveDeviceExist = TRUE;
|
||||
|
||||
return DeviceStatus;
|
||||
if (MasterDeviceExist && SlaveDeviceExist &&
|
||||
(StatusReg & DRDY) == 0 &&
|
||||
(InitStatusReg & DRDY) == 0 &&
|
||||
MasterDeviceType == SlaveDeviceType &&
|
||||
SlaveDeviceType != ATAPI_DEVICE_TYPE) {
|
||||
SlaveDeviceExist = FALSE;
|
||||
}
|
||||
|
||||
//
|
||||
// Indicate this channel has been detected
|
||||
//
|
||||
ChannelDeviceDetected = TRUE;
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
@@ -1251,7 +1264,7 @@ DRDYReady (
|
||||
}
|
||||
}
|
||||
|
||||
gBS->Stall (15);
|
||||
gBS->Stall (30);
|
||||
|
||||
Delay--;
|
||||
} while (Delay);
|
||||
@@ -1432,6 +1445,11 @@ ReleaseIdeResources (
|
||||
gBS->FreePool (IdeBlkIoDevice->DevicePath);
|
||||
}
|
||||
|
||||
if (IdeBlkIoDevice->ExitBootServiceEvent != NULL) {
|
||||
gBS->CloseEvent (IdeBlkIoDevice->ExitBootServiceEvent);
|
||||
IdeBlkIoDevice->ExitBootServiceEvent = NULL;
|
||||
}
|
||||
|
||||
gBS->FreePool (IdeBlkIoDevice);
|
||||
IdeBlkIoDevice = NULL;
|
||||
|
||||
@@ -1553,8 +1571,14 @@ AtaNonDataCommandIn (
|
||||
|
||||
//
|
||||
// Wait for command completion
|
||||
// For ATA_SMART_CMD, we may need more timeout to let device
|
||||
// adjust internal states.
|
||||
//
|
||||
Status = WaitForBSYClear (IdeDev, ATATIMEOUT);
|
||||
if (AtaCommand == ATA_SMART_CMD) {
|
||||
Status = WaitForBSYClear (IdeDev, ATASMARTTIMEOUT);
|
||||
} else {
|
||||
Status = WaitForBSYClear (IdeDev, ATATIMEOUT);
|
||||
}
|
||||
if (EFI_ERROR (Status)) {
|
||||
return EFI_DEVICE_ERROR;
|
||||
}
|
||||
@@ -1716,12 +1740,11 @@ SetDriveParameters (
|
||||
//
|
||||
// Send Init drive parameters
|
||||
//
|
||||
Status = AtaPioDataIn (
|
||||
Status = AtaNonDataCommandIn (
|
||||
IdeDev,
|
||||
NULL,
|
||||
0,
|
||||
INIT_DRIVE_PARAM_CMD,
|
||||
(UINT8) (DeviceSelect + DriveParameters->Heads),
|
||||
0,
|
||||
DriveParameters->Sector,
|
||||
0,
|
||||
0,
|
||||
@@ -1731,18 +1754,16 @@ SetDriveParameters (
|
||||
//
|
||||
// Send Set Multiple parameters
|
||||
//
|
||||
Status = AtaPioDataIn (
|
||||
Status = AtaNonDataCommandIn (
|
||||
IdeDev,
|
||||
NULL,
|
||||
0,
|
||||
SET_MULTIPLE_MODE_CMD,
|
||||
DeviceSelect,
|
||||
0,
|
||||
DriveParameters->MultipleSector,
|
||||
0,
|
||||
0,
|
||||
0
|
||||
);
|
||||
|
||||
return Status;
|
||||
}
|
||||
|
||||
@@ -1769,13 +1790,13 @@ EnableInterrupt (
|
||||
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
Clear pending IDE interrupt before OS loader/kernel take control of the IDE device.
|
||||
|
||||
@param[in] Event Pointer to this event
|
||||
@param[in] Context Event hanlder private data
|
||||
|
||||
|
||||
**/
|
||||
VOID
|
||||
EFIAPI
|
||||
|
Reference in New Issue
Block a user