aaru-dps/Aaru
1
0
Fork 0
mirror of https://github.com/aaru-dps/Aaru.git synced 2025-12-16 19:24:25 +00:00
Code Issues Packages Projects Releases Wiki Activity

Add ATA commands for lock, unlock and eject.

Browse Source
This commit is contained in:
Natalia Portillo
2020-07-14 02:45:27 +01:00
parent 29e6d16b78
commit 75ec1d3d92
1 changed files with 67 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files

81
Aaru.Devices/Device/AtaCommands/AtaCHS.cs
View File

@@ -99,8 +99,7 @@ namespace Aaru.Devices
var registers = new AtaRegistersChs var registers = new AtaRegistersChs
{ {
SectorCount = count, CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100), SectorCount = count, CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100),
CylinderLow = (byte)((cylinder & 0xFF) / 0x1), DeviceHead = (byte)(head & 0x0F), CylinderLow = (byte)((cylinder & 0xFF) / 0x1), DeviceHead = (byte)(head & 0x0F), Sector = sector,
Sector = sector,
Command = retry ? (byte)AtaCommands.ReadDmaRetry : (byte)AtaCommands.ReadDma Command = retry ? (byte)AtaCommands.ReadDmaRetry : (byte)AtaCommands.ReadDma
}; };
@@ -149,8 +148,7 @@ namespace Aaru.Devices
var registers = new AtaRegistersChs var registers = new AtaRegistersChs
{ {
Command = retry ? (byte)AtaCommands.ReadRetry : (byte)AtaCommands.Read, SectorCount = count, Command = retry ? (byte)AtaCommands.ReadRetry : (byte)AtaCommands.Read, SectorCount = count,
CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100), CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100), CylinderLow = (byte)((cylinder & 0xFF) / 0x1),
CylinderLow = (byte)((cylinder & 0xFF) / 0x1),
DeviceHead = (byte)(head & 0x0F), Sector = sector DeviceHead = (byte)(head & 0x0F), Sector = sector
}; };
@@ -177,10 +175,8 @@ namespace Aaru.Devices
var registers = new AtaRegistersChs var registers = new AtaRegistersChs
{ {
Command = retry ? (byte)AtaCommands.ReadLongRetry : (byte)AtaCommands.ReadLong, SectorCount = 1, Command = retry ? (byte)AtaCommands.ReadLongRetry : (byte)AtaCommands.ReadLong, SectorCount = 1,
CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100), CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100), CylinderLow = (byte)((cylinder & 0xFF) / 0x1),
CylinderLow = (byte)((cylinder & 0xFF) / 0x1), DeviceHead = (byte)(head & 0x0F), Sector = sector
DeviceHead = (byte)(head & 0x0F),
Sector = sector
}; };
LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.PioIn, LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.PioIn,
@@ -202,8 +198,7 @@ namespace Aaru.Devices
var registers = new AtaRegistersChs var registers = new AtaRegistersChs
{ {
Command = (byte)AtaCommands.Seek, CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100), Command = (byte)AtaCommands.Seek, CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100),
CylinderLow = (byte)((cylinder & 0xFF) / 0x1), CylinderLow = (byte)((cylinder & 0xFF) / 0x1), DeviceHead = (byte)(head & 0x0F), Sector = sector
DeviceHead = (byte)(head & 0x0F), Sector = sector
}; };
LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.NonData, LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.NonData,
@@ -229,10 +224,8 @@ namespace Aaru.Devices
var registers = new AtaRegistersChs var registers = new AtaRegistersChs
{ {
Command = (byte)AtaCommands.SetFeatures, CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100), Command = (byte)AtaCommands.SetFeatures, CylinderHigh = (byte)((cylinder & 0xFF00) / 0x100),
CylinderLow = (byte)((cylinder & 0xFF) / 0x1), CylinderLow = (byte)((cylinder & 0xFF) / 0x1), DeviceHead = (byte)(head & 0x0F), Sector = sector,
DeviceHead = (byte)(head & 0x0F), Sector = sector, SectorCount = sectorCount, Feature = (byte)feature
SectorCount = sectorCount,
Feature = (byte)feature
}; };
LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.NonData, LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.NonData,
@@ -245,5 +238,65 @@ namespace Aaru.Devices
return sense; return sense;
} }
public bool DoorLock(out AtaErrorRegistersChs statusRegisters, uint timeout, out double duration)
{
byte[] buffer = new byte[0];
var registers = new AtaRegistersChs
{
Command = (byte)AtaCommands.DoorLock
};
LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.NonData,
AtaTransferRegister.NoTransfer, ref buffer, timeout, true, out duration,
out bool sense);
Error = LastError != 0;
AaruConsole.DebugWriteLine("ATA Device", "DOOR LOCK took {0} ms.", duration);
return sense;
}
public bool DoorUnlock(out AtaErrorRegistersChs statusRegisters, uint timeout, out double duration)
{
byte[] buffer = new byte[0];
var registers = new AtaRegistersChs
{
Command = (byte)AtaCommands.DoorUnLock
};
LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.NonData,
AtaTransferRegister.NoTransfer, ref buffer, timeout, true, out duration,
out bool sense);
Error = LastError != 0;
AaruConsole.DebugWriteLine("ATA Device", "DOOR UNLOCK took {0} ms.", duration);
return sense;
}
public bool MediaEject(out AtaErrorRegistersChs statusRegisters, uint timeout, out double duration)
{
byte[] buffer = new byte[0];
var registers = new AtaRegistersChs
{
Command = (byte)AtaCommands.MediaEject
};
LastError = SendAtaCommand(registers, out statusRegisters, AtaProtocol.NonData,
AtaTransferRegister.NoTransfer, ref buffer, timeout, true, out duration,
out bool sense);
Error = LastError != 0;
AaruConsole.DebugWriteLine("ATA Device", "MEDIA EJECT took {0} ms.", duration);
return sense;
}
} }
} }