|
@@ -27,11 +27,12 @@
|
|
|
#include <AK/ByteBuffer.h>
|
|
|
#include <AK/Singleton.h>
|
|
|
#include <AK/StringView.h>
|
|
|
-#include <Kernel/Devices/PATAChannel.h>
|
|
|
-#include <Kernel/Devices/PATADiskDevice.h>
|
|
|
#include <Kernel/FileSystem/ProcFS.h>
|
|
|
#include <Kernel/IO.h>
|
|
|
#include <Kernel/Process.h>
|
|
|
+#include <Kernel/Storage/IDEChannel.h>
|
|
|
+#include <Kernel/Storage/IDEController.h>
|
|
|
+#include <Kernel/Storage/PATADiskDevice.h>
|
|
|
#include <Kernel/VM/MemoryManager.h>
|
|
|
|
|
|
namespace Kernel {
|
|
@@ -108,24 +109,25 @@ namespace Kernel {
|
|
|
#define PCI_Mass_Storage_Class 0x1
|
|
|
#define PCI_IDE_Controller_Subclass 0x1
|
|
|
|
|
|
-OwnPtr<PATAChannel> PATAChannel::create(ChannelType type, bool force_pio)
|
|
|
+NonnullOwnPtr<IDEChannel> IDEChannel::create(const IDEController& controller, IOAddressGroup io_group, ChannelType type, bool force_pio)
|
|
|
{
|
|
|
- PCI::Address pci_address;
|
|
|
- PCI::enumerate([&](const PCI::Address& address, PCI::ID id) {
|
|
|
- if (PCI::get_class(address) == PCI_Mass_Storage_Class && PCI::get_subclass(address) == PCI_IDE_Controller_Subclass) {
|
|
|
- pci_address = address;
|
|
|
- klog() << "PATAChannel: PATA Controller found, ID " << id;
|
|
|
- }
|
|
|
- });
|
|
|
- return make<PATAChannel>(pci_address, type, force_pio);
|
|
|
+ return make<IDEChannel>(controller, io_group, type, force_pio);
|
|
|
}
|
|
|
|
|
|
-PATAChannel::PATAChannel(PCI::Address address, ChannelType type, bool force_pio)
|
|
|
- : PCI::Device(address, (type == ChannelType::Primary ? PATA_PRIMARY_IRQ : PATA_SECONDARY_IRQ))
|
|
|
+RefPtr<StorageDevice> IDEChannel::master_device()
|
|
|
+{
|
|
|
+ return m_master;
|
|
|
+}
|
|
|
+RefPtr<StorageDevice> IDEChannel::slave_device()
|
|
|
+{
|
|
|
+ return m_slave;
|
|
|
+}
|
|
|
+
|
|
|
+IDEChannel::IDEChannel(const IDEController& controller, IOAddressGroup io_group, ChannelType type, bool force_pio)
|
|
|
+ : IRQHandler(type == ChannelType::Primary ? PATA_PRIMARY_IRQ : PATA_SECONDARY_IRQ)
|
|
|
, m_channel_number((type == ChannelType::Primary ? 0 : 1))
|
|
|
- , m_io_base((type == ChannelType::Primary ? 0x1F0 : 0x170))
|
|
|
- , m_control_base((type == ChannelType::Primary ? 0x3f6 : 0x376))
|
|
|
- , m_bus_master_base(PCI::get_BAR4(pci_address()) & 0xfffc)
|
|
|
+ , m_io_group(io_group)
|
|
|
+ , m_parent_controller(controller)
|
|
|
{
|
|
|
disable_irq();
|
|
|
|
|
@@ -137,15 +139,15 @@ PATAChannel::PATAChannel(PCI::Address address, ChannelType type, bool force_pio)
|
|
|
enable_irq();
|
|
|
}
|
|
|
|
|
|
-PATAChannel::~PATAChannel()
|
|
|
+IDEChannel::~IDEChannel()
|
|
|
{
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::start_request(AsyncBlockDeviceRequest& request, bool use_dma, bool is_slave)
|
|
|
+void IDEChannel::start_request(AsyncBlockDeviceRequest& request, bool use_dma, bool is_slave)
|
|
|
{
|
|
|
ScopedSpinLock lock(m_request_lock);
|
|
|
#ifdef PATA_DEBUG
|
|
|
- dbg() << "PATAChannel::start_request";
|
|
|
+ dbg() << "IDEChannel::start_request";
|
|
|
#endif
|
|
|
m_current_request = &request;
|
|
|
m_current_request_block_index = 0;
|
|
@@ -165,7 +167,7 @@ void PATAChannel::start_request(AsyncBlockDeviceRequest& request, bool use_dma,
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::complete_current_request(AsyncDeviceRequest::RequestResult result)
|
|
|
+void IDEChannel::complete_current_request(AsyncDeviceRequest::RequestResult result)
|
|
|
{
|
|
|
// NOTE: this may be called from the interrupt handler!
|
|
|
ASSERT(m_current_request);
|
|
@@ -177,7 +179,7 @@ void PATAChannel::complete_current_request(AsyncDeviceRequest::RequestResult res
|
|
|
// before Processor::deferred_call_queue returns!
|
|
|
Processor::deferred_call_queue([this, result]() {
|
|
|
#ifdef PATA_DEBUG
|
|
|
- dbg() << "PATAChannel::complete_current_request result: " << result;
|
|
|
+ dbg() << "IDEChannel::complete_current_request result: " << result;
|
|
|
#endif
|
|
|
ASSERT(m_current_request);
|
|
|
auto& request = *m_current_request;
|
|
@@ -193,7 +195,7 @@ void PATAChannel::complete_current_request(AsyncDeviceRequest::RequestResult res
|
|
|
}
|
|
|
|
|
|
// I read somewhere that this may trigger a cache flush so let's do it.
|
|
|
- m_bus_master_base.offset(2).out<u8>(m_bus_master_base.offset(2).in<u8>() | 0x6);
|
|
|
+ m_io_group.bus_master_base().offset(2).out<u8>(m_io_group.bus_master_base().offset(2).in<u8>() | 0x6);
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -201,50 +203,50 @@ void PATAChannel::complete_current_request(AsyncDeviceRequest::RequestResult res
|
|
|
});
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::initialize(bool force_pio)
|
|
|
+void IDEChannel::initialize(bool force_pio)
|
|
|
{
|
|
|
- PCI::enable_interrupt_line(pci_address());
|
|
|
+ m_parent_controller->enable_pin_based_interrupts();
|
|
|
if (force_pio) {
|
|
|
- klog() << "PATAChannel: Requested to force PIO mode; not setting up DMA";
|
|
|
+ klog() << "IDEChannel: Requested to force PIO mode; not setting up DMA";
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
// Let's try to set up DMA transfers.
|
|
|
- PCI::enable_bus_mastering(pci_address());
|
|
|
+ PCI::enable_bus_mastering(m_parent_controller->pci_address());
|
|
|
m_prdt_page = MM.allocate_supervisor_physical_page();
|
|
|
prdt().end_of_table = 0x8000;
|
|
|
m_dma_buffer_page = MM.allocate_supervisor_physical_page();
|
|
|
- klog() << "PATAChannel: Bus master IDE: " << m_bus_master_base;
|
|
|
+ klog() << "IDEChannel: Bus master IDE: " << m_io_group.bus_master_base();
|
|
|
}
|
|
|
|
|
|
static void print_ide_status(u8 status)
|
|
|
{
|
|
|
- klog() << "PATAChannel: print_ide_status: DRQ=" << ((status & ATA_SR_DRQ) != 0) << " BSY=" << ((status & ATA_SR_BSY) != 0) << " DRDY=" << ((status & ATA_SR_DRDY) != 0) << " DSC=" << ((status & ATA_SR_DSC) != 0) << " DF=" << ((status & ATA_SR_DF) != 0) << " CORR=" << ((status & ATA_SR_CORR) != 0) << " IDX=" << ((status & ATA_SR_IDX) != 0) << " ERR=" << ((status & ATA_SR_ERR) != 0);
|
|
|
+ klog() << "IDEChannel: print_ide_status: DRQ=" << ((status & ATA_SR_DRQ) != 0) << " BSY=" << ((status & ATA_SR_BSY) != 0) << " DRDY=" << ((status & ATA_SR_DRDY) != 0) << " DSC=" << ((status & ATA_SR_DSC) != 0) << " DF=" << ((status & ATA_SR_DF) != 0) << " CORR=" << ((status & ATA_SR_CORR) != 0) << " IDX=" << ((status & ATA_SR_IDX) != 0) << " ERR=" << ((status & ATA_SR_ERR) != 0);
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::handle_irq(const RegisterState&)
|
|
|
+void IDEChannel::handle_irq(const RegisterState&)
|
|
|
{
|
|
|
- u8 status = m_io_base.offset(ATA_REG_STATUS).in<u8>();
|
|
|
+ u8 status = m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>();
|
|
|
|
|
|
m_entropy_source.add_random_event(status);
|
|
|
|
|
|
- u8 bstatus = m_bus_master_base.offset(2).in<u8>();
|
|
|
+ u8 bstatus = m_io_group.bus_master_base().offset(2).in<u8>();
|
|
|
if (!(bstatus & 0x4)) {
|
|
|
// interrupt not from this device, ignore
|
|
|
#ifdef PATA_DEBUG
|
|
|
- klog() << "PATAChannel: ignore interrupt";
|
|
|
+ klog() << "IDEChannel: ignore interrupt";
|
|
|
#endif
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
ScopedSpinLock lock(m_request_lock);
|
|
|
#ifdef PATA_DEBUG
|
|
|
- klog() << "PATAChannel: interrupt: DRQ=" << ((status & ATA_SR_DRQ) != 0) << " BSY=" << ((status & ATA_SR_BSY) != 0) << " DRDY=" << ((status & ATA_SR_DRDY) != 0);
|
|
|
+ klog() << "IDEChannel: interrupt: DRQ=" << ((status & ATA_SR_DRQ) != 0) << " BSY=" << ((status & ATA_SR_BSY) != 0) << " DRDY=" << ((status & ATA_SR_DRDY) != 0);
|
|
|
#endif
|
|
|
|
|
|
if (!m_current_request) {
|
|
|
#ifdef PATA_DEBUG
|
|
|
- dbg() << "PATAChannel: IRQ but no pending request!";
|
|
|
+ dbg() << "IDEChannel: IRQ but no pending request!";
|
|
|
#endif
|
|
|
return;
|
|
|
}
|
|
@@ -253,8 +255,8 @@ void PATAChannel::handle_irq(const RegisterState&)
|
|
|
|
|
|
if (status & ATA_SR_ERR) {
|
|
|
print_ide_status(status);
|
|
|
- m_device_error = m_io_base.offset(ATA_REG_ERROR).in<u8>();
|
|
|
- klog() << "PATAChannel: Error " << String::format("%b", m_device_error) << "!";
|
|
|
+ m_device_error = m_io_group.io_base().offset(ATA_REG_ERROR).in<u8>();
|
|
|
+ klog() << "IDEChannel: Error " << String::format("%b", m_device_error) << "!";
|
|
|
complete_current_request(AsyncDeviceRequest::Failure);
|
|
|
return;
|
|
|
}
|
|
@@ -270,7 +272,7 @@ void PATAChannel::handle_irq(const RegisterState&)
|
|
|
// trigger page faults
|
|
|
Processor::deferred_call_queue([this]() {
|
|
|
if (m_current_request->request_type() == AsyncBlockDeviceRequest::Read) {
|
|
|
- dbg() << "PATAChannel: Read block " << m_current_request_block_index << "/" << m_current_request->block_count();
|
|
|
+ dbg() << "IDEChannel: Read block " << m_current_request_block_index << "/" << m_current_request->block_count();
|
|
|
if (ata_do_read_sector()) {
|
|
|
if (++m_current_request_block_index >= m_current_request->block_count()) {
|
|
|
complete_current_request(AsyncDeviceRequest::Success);
|
|
@@ -281,12 +283,12 @@ void PATAChannel::handle_irq(const RegisterState&)
|
|
|
}
|
|
|
} else {
|
|
|
if (!m_current_request_flushing_cache) {
|
|
|
- dbg() << "PATAChannel: Wrote block " << m_current_request_block_index << "/" << m_current_request->block_count();
|
|
|
+ dbg() << "IDEChannel: Wrote block " << m_current_request_block_index << "/" << m_current_request->block_count();
|
|
|
if (++m_current_request_block_index >= m_current_request->block_count()) {
|
|
|
// We read the last block, flush cache
|
|
|
ASSERT(!m_current_request_flushing_cache);
|
|
|
m_current_request_flushing_cache = true;
|
|
|
- m_io_base.offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_CACHE_FLUSH);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_CACHE_FLUSH);
|
|
|
} else {
|
|
|
// Read next block
|
|
|
ata_do_write_sector();
|
|
@@ -305,27 +307,27 @@ static void io_delay()
|
|
|
IO::in8(0x3f6);
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::detect_disks()
|
|
|
+void IDEChannel::detect_disks()
|
|
|
{
|
|
|
// There are only two possible disks connected to a channel
|
|
|
for (auto i = 0; i < 2; i++) {
|
|
|
- m_io_base.offset(ATA_REG_HDDEVSEL).out<u8>(0xA0 | (i << 4)); // First, we need to select the drive itself
|
|
|
+ m_io_group.io_base().offset(ATA_REG_HDDEVSEL).out<u8>(0xA0 | (i << 4)); // First, we need to select the drive itself
|
|
|
|
|
|
// Apparently these need to be 0 before sending IDENTIFY?!
|
|
|
- m_io_base.offset(ATA_REG_SECCOUNT0).out<u8>(0x00);
|
|
|
- m_io_base.offset(ATA_REG_LBA0).out<u8>(0x00);
|
|
|
- m_io_base.offset(ATA_REG_LBA1).out<u8>(0x00);
|
|
|
- m_io_base.offset(ATA_REG_LBA2).out<u8>(0x00);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_SECCOUNT0).out<u8>(0x00);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA0).out<u8>(0x00);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA1).out<u8>(0x00);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA2).out<u8>(0x00);
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_IDENTIFY); // Send the ATA_IDENTIFY command
|
|
|
+ m_io_group.io_base().offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_IDENTIFY); // Send the ATA_IDENTIFY command
|
|
|
|
|
|
// Wait for the BSY flag to be reset
|
|
|
- while (m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
+ while (m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
;
|
|
|
|
|
|
- if (m_io_base.offset(ATA_REG_STATUS).in<u8>() == 0x00) {
|
|
|
+ if (m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() == 0x00) {
|
|
|
#ifdef PATA_DEBUG
|
|
|
- klog() << "PATAChannel: No " << (i == 0 ? "master" : "slave") << " disk detected!";
|
|
|
+ klog() << "IDEChannel: No " << (i == 0 ? "master" : "slave") << " disk detected!";
|
|
|
#endif
|
|
|
continue;
|
|
|
}
|
|
@@ -337,7 +339,7 @@ void PATAChannel::detect_disks()
|
|
|
const u16* wbufbase = (u16*)wbuf.data();
|
|
|
|
|
|
for (u32 i = 0; i < 256; ++i) {
|
|
|
- u16 data = m_io_base.offset(ATA_REG_DATA).in<u16>();
|
|
|
+ u16 data = m_io_group.io_base().offset(ATA_REG_DATA).in<u16>();
|
|
|
*(w++) = data;
|
|
|
*(b++) = MSB(data);
|
|
|
*(b++) = LSB(data);
|
|
@@ -350,26 +352,25 @@ void PATAChannel::detect_disks()
|
|
|
u8 cyls = wbufbase[1];
|
|
|
u8 heads = wbufbase[3];
|
|
|
u8 spt = wbufbase[6];
|
|
|
-
|
|
|
- klog() << "PATAChannel: Name=" << ((char*)bbuf.data() + 54) << ", C/H/Spt=" << cyls << "/" << heads << "/" << spt;
|
|
|
+ if (cyls == 0 || heads == 0 || spt == 0)
|
|
|
+ continue;
|
|
|
+ klog() << "IDEChannel: Name=" << ((char*)bbuf.data() + 54) << ", C/H/Spt=" << cyls << "/" << heads << "/" << spt;
|
|
|
|
|
|
int major = (m_channel_number == 0) ? 3 : 4;
|
|
|
if (i == 0) {
|
|
|
- m_master = PATADiskDevice::create(*this, PATADiskDevice::DriveType::Master, major, 0);
|
|
|
- m_master->set_drive_geometry(cyls, heads, spt);
|
|
|
+ m_master = PATADiskDevice::create(m_parent_controller, *this, PATADiskDevice::DriveType::Master, cyls, heads, spt, major, 0);
|
|
|
} else {
|
|
|
- m_slave = PATADiskDevice::create(*this, PATADiskDevice::DriveType::Slave, major, 1);
|
|
|
- m_slave->set_drive_geometry(cyls, heads, spt);
|
|
|
+ m_slave = PATADiskDevice::create(m_parent_controller, *this, PATADiskDevice::DriveType::Slave, cyls, heads, spt, major, 1);
|
|
|
}
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::ata_read_sectors_with_dma(bool slave_request)
|
|
|
+void IDEChannel::ata_read_sectors_with_dma(bool slave_request)
|
|
|
{
|
|
|
auto& request = *m_current_request;
|
|
|
u32 lba = request.block_index();
|
|
|
#ifdef PATA_DEBUG
|
|
|
- dbg() << "PATAChannel::ata_read_sectors_with_dma (" << lba << " x" << request.block_count() << ")";
|
|
|
+ dbg() << "IDEChannel::ata_read_sectors_with_dma (" << lba << " x" << request.block_count() << ")";
|
|
|
#endif
|
|
|
|
|
|
prdt().offset = m_dma_buffer_page->paddr();
|
|
@@ -378,57 +379,57 @@ void PATAChannel::ata_read_sectors_with_dma(bool slave_request)
|
|
|
ASSERT(prdt().size <= PAGE_SIZE);
|
|
|
|
|
|
// Stop bus master
|
|
|
- m_bus_master_base.out<u8>(0);
|
|
|
+ m_io_group.bus_master_base().out<u8>(0);
|
|
|
|
|
|
// Write the PRDT location
|
|
|
- m_bus_master_base.offset(4).out(m_prdt_page->paddr().get());
|
|
|
+ m_io_group.bus_master_base().offset(4).out(m_prdt_page->paddr().get());
|
|
|
|
|
|
// Turn on "Interrupt" and "Error" flag. The error flag should be cleared by hardware.
|
|
|
- m_bus_master_base.offset(2).out<u8>(m_bus_master_base.offset(2).in<u8>() | 0x6);
|
|
|
+ m_io_group.bus_master_base().offset(2).out<u8>(m_io_group.bus_master_base().offset(2).in<u8>() | 0x6);
|
|
|
|
|
|
// Set transfer direction
|
|
|
- m_bus_master_base.out<u8>(0x8);
|
|
|
+ m_io_group.bus_master_base().out<u8>(0x8);
|
|
|
|
|
|
- while (m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
+ while (m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
;
|
|
|
|
|
|
- m_control_base.offset(ATA_CTL_CONTROL).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_HDDEVSEL).out<u8>(0x40 | (static_cast<u8>(slave_request) << 4));
|
|
|
+ m_io_group.control_base().offset(ATA_CTL_CONTROL).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_HDDEVSEL).out<u8>(0x40 | (static_cast<u8>(slave_request) << 4));
|
|
|
io_delay();
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_FEATURES).out<u16>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_FEATURES).out<u16>(0);
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_SECCOUNT0).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA0).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA1).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA2).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_SECCOUNT0).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA0).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA1).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA2).out<u8>(0);
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_SECCOUNT0).out<u8>(request.block_count());
|
|
|
- m_io_base.offset(ATA_REG_LBA0).out<u8>((lba & 0x000000ff) >> 0);
|
|
|
- m_io_base.offset(ATA_REG_LBA1).out<u8>((lba & 0x0000ff00) >> 8);
|
|
|
- m_io_base.offset(ATA_REG_LBA2).out<u8>((lba & 0x00ff0000) >> 16);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_SECCOUNT0).out<u8>(request.block_count());
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA0).out<u8>((lba & 0x000000ff) >> 0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA1).out<u8>((lba & 0x0000ff00) >> 8);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA2).out<u8>((lba & 0x00ff0000) >> 16);
|
|
|
|
|
|
for (;;) {
|
|
|
- auto status = m_io_base.offset(ATA_REG_STATUS).in<u8>();
|
|
|
+ auto status = m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>();
|
|
|
if (!(status & ATA_SR_BSY) && (status & ATA_SR_DRDY))
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_READ_DMA_EXT);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_READ_DMA_EXT);
|
|
|
io_delay();
|
|
|
|
|
|
enable_irq();
|
|
|
// Start bus master
|
|
|
- m_bus_master_base.out<u8>(0x9);
|
|
|
+ m_io_group.bus_master_base().out<u8>(0x9);
|
|
|
}
|
|
|
|
|
|
-bool PATAChannel::ata_do_read_sector()
|
|
|
+bool IDEChannel::ata_do_read_sector()
|
|
|
{
|
|
|
auto& request = *m_current_request;
|
|
|
auto out_buffer = request.buffer().offset(m_current_request_block_index * 512);
|
|
|
ssize_t nwritten = request.write_to_buffer_buffered<512>(out_buffer, 512, [&](u8* buffer, size_t buffer_bytes) {
|
|
|
for (size_t i = 0; i < buffer_bytes; i += sizeof(u16))
|
|
|
- *(u16*)&buffer[i] = IO::in16(m_io_base.offset(ATA_REG_DATA).get());
|
|
|
+ *(u16*)&buffer[i] = IO::in16(m_io_group.io_base().offset(ATA_REG_DATA).get());
|
|
|
return (ssize_t)buffer_bytes;
|
|
|
});
|
|
|
if (nwritten < 0) {
|
|
@@ -439,58 +440,58 @@ bool PATAChannel::ata_do_read_sector()
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::ata_read_sectors(bool slave_request)
|
|
|
+void IDEChannel::ata_read_sectors(bool slave_request)
|
|
|
{
|
|
|
auto& request = *m_current_request;
|
|
|
ASSERT(request.block_count() <= 256);
|
|
|
#ifdef PATA_DEBUG
|
|
|
- dbg() << "PATAChannel::ata_read_sectors";
|
|
|
+ dbg() << "IDEChannel::ata_read_sectors";
|
|
|
#endif
|
|
|
|
|
|
- while (m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
+ while (m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
;
|
|
|
|
|
|
auto lba = request.block_index();
|
|
|
#ifdef PATA_DEBUG
|
|
|
- klog() << "PATAChannel: Reading " << request.block_count() << " sector(s) @ LBA " << lba;
|
|
|
+ klog() << "IDEChannel: Reading " << request.block_count() << " sector(s) @ LBA " << lba;
|
|
|
#endif
|
|
|
|
|
|
u8 devsel = 0xe0;
|
|
|
if (slave_request)
|
|
|
devsel |= 0x10;
|
|
|
|
|
|
- m_control_base.offset(ATA_CTL_CONTROL).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_HDDEVSEL).out<u8>(devsel | (static_cast<u8>(slave_request) << 4) | 0x40);
|
|
|
+ m_io_group.control_base().offset(ATA_CTL_CONTROL).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_HDDEVSEL).out<u8>(devsel | (static_cast<u8>(slave_request) << 4) | 0x40);
|
|
|
io_delay();
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_FEATURES).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_FEATURES).out<u8>(0);
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_SECCOUNT0).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA0).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA1).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA2).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_SECCOUNT0).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA0).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA1).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA2).out<u8>(0);
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_SECCOUNT0).out<u8>(request.block_count());
|
|
|
- m_io_base.offset(ATA_REG_LBA0).out<u8>((lba & 0x000000ff) >> 0);
|
|
|
- m_io_base.offset(ATA_REG_LBA1).out<u8>((lba & 0x0000ff00) >> 8);
|
|
|
- m_io_base.offset(ATA_REG_LBA2).out<u8>((lba & 0x00ff0000) >> 16);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_SECCOUNT0).out<u8>(request.block_count());
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA0).out<u8>((lba & 0x000000ff) >> 0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA1).out<u8>((lba & 0x0000ff00) >> 8);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA2).out<u8>((lba & 0x00ff0000) >> 16);
|
|
|
|
|
|
for (;;) {
|
|
|
- auto status = m_io_base.offset(ATA_REG_STATUS).in<u8>();
|
|
|
+ auto status = m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>();
|
|
|
if (!(status & ATA_SR_BSY) && (status & ATA_SR_DRDY))
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
enable_irq();
|
|
|
- m_io_base.offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_READ_PIO);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_READ_PIO);
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::ata_write_sectors_with_dma(bool slave_request)
|
|
|
+void IDEChannel::ata_write_sectors_with_dma(bool slave_request)
|
|
|
{
|
|
|
auto& request = *m_current_request;
|
|
|
u32 lba = request.block_index();
|
|
|
#ifdef PATA_DEBUG
|
|
|
- dbg() << "PATAChannel::ata_write_sectors_with_dma (" << lba << " x" << request.block_count() << ")";
|
|
|
+ dbg() << "IDEChannel::ata_write_sectors_with_dma (" << lba << " x" << request.block_count() << ")";
|
|
|
#endif
|
|
|
|
|
|
prdt().offset = m_dma_buffer_page->paddr();
|
|
@@ -504,72 +505,72 @@ void PATAChannel::ata_write_sectors_with_dma(bool slave_request)
|
|
|
ASSERT(prdt().size <= PAGE_SIZE);
|
|
|
|
|
|
// Stop bus master
|
|
|
- m_bus_master_base.out<u8>(0);
|
|
|
+ m_io_group.bus_master_base().out<u8>(0);
|
|
|
|
|
|
// Write the PRDT location
|
|
|
- m_bus_master_base.offset(4).out<u32>(m_prdt_page->paddr().get());
|
|
|
+ m_io_group.bus_master_base().offset(4).out<u32>(m_prdt_page->paddr().get());
|
|
|
|
|
|
// Turn on "Interrupt" and "Error" flag. The error flag should be cleared by hardware.
|
|
|
- m_bus_master_base.offset(2).out<u8>(m_bus_master_base.offset(2).in<u8>() | 0x6);
|
|
|
+ m_io_group.bus_master_base().offset(2).out<u8>(m_io_group.bus_master_base().offset(2).in<u8>() | 0x6);
|
|
|
|
|
|
- while (m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
+ while (m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
;
|
|
|
|
|
|
- m_control_base.offset(ATA_CTL_CONTROL).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_HDDEVSEL).out<u8>(0x40 | (static_cast<u8>(slave_request) << 4));
|
|
|
+ m_io_group.control_base().offset(ATA_CTL_CONTROL).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_HDDEVSEL).out<u8>(0x40 | (static_cast<u8>(slave_request) << 4));
|
|
|
io_delay();
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_FEATURES).out<u16>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_FEATURES).out<u16>(0);
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_SECCOUNT0).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA0).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA1).out<u8>(0);
|
|
|
- m_io_base.offset(ATA_REG_LBA2).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_SECCOUNT0).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA0).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA1).out<u8>(0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA2).out<u8>(0);
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_SECCOUNT0).out<u8>(request.block_count());
|
|
|
- m_io_base.offset(ATA_REG_LBA0).out<u8>((lba & 0x000000ff) >> 0);
|
|
|
- m_io_base.offset(ATA_REG_LBA1).out<u8>((lba & 0x0000ff00) >> 8);
|
|
|
- m_io_base.offset(ATA_REG_LBA2).out<u8>((lba & 0x00ff0000) >> 16);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_SECCOUNT0).out<u8>(request.block_count());
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA0).out<u8>((lba & 0x000000ff) >> 0);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA1).out<u8>((lba & 0x0000ff00) >> 8);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA2).out<u8>((lba & 0x00ff0000) >> 16);
|
|
|
|
|
|
for (;;) {
|
|
|
- auto status = m_io_base.offset(ATA_REG_STATUS).in<u8>();
|
|
|
+ auto status = m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>();
|
|
|
if (!(status & ATA_SR_BSY) && (status & ATA_SR_DRDY))
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_WRITE_DMA_EXT);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_WRITE_DMA_EXT);
|
|
|
io_delay();
|
|
|
|
|
|
enable_irq();
|
|
|
// Start bus master
|
|
|
- m_bus_master_base.out<u8>(0x1);
|
|
|
+ m_io_group.bus_master_base().out<u8>(0x1);
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::ata_do_write_sector()
|
|
|
+void IDEChannel::ata_do_write_sector()
|
|
|
{
|
|
|
auto& request = *m_current_request;
|
|
|
|
|
|
io_delay();
|
|
|
- while ((m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY) || !(m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_DRQ))
|
|
|
+ while ((m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY) || !(m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_DRQ))
|
|
|
;
|
|
|
|
|
|
- u8 status = m_io_base.offset(ATA_REG_STATUS).in<u8>();
|
|
|
+ u8 status = m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>();
|
|
|
ASSERT(status & ATA_SR_DRQ);
|
|
|
|
|
|
auto in_buffer = request.buffer().offset(m_current_request_block_index * 512);
|
|
|
#ifdef PATA_DEBUG
|
|
|
- dbg() << "PATAChannel: Writing 512 bytes (part " << m_current_request_block_index << ") (status=" << String::format("%b", status) << ")...";
|
|
|
+ dbg() << "IDEChannel: Writing 512 bytes (part " << m_current_request_block_index << ") (status=" << String::format("%b", status) << ")...";
|
|
|
#endif
|
|
|
ssize_t nread = request.read_from_buffer_buffered<512>(in_buffer, 512, [&](const u8* buffer, size_t buffer_bytes) {
|
|
|
for (size_t i = 0; i < buffer_bytes; i += sizeof(u16))
|
|
|
- IO::out16(m_io_base.offset(ATA_REG_DATA).get(), *(const u16*)&buffer[i]);
|
|
|
+ IO::out16(m_io_group.io_base().offset(ATA_REG_DATA).get(), *(const u16*)&buffer[i]);
|
|
|
return (ssize_t)buffer_bytes;
|
|
|
});
|
|
|
if (nread < 0)
|
|
|
complete_current_request(AsyncDeviceRequest::MemoryFault);
|
|
|
}
|
|
|
|
|
|
-void PATAChannel::ata_write_sectors(bool slave_request)
|
|
|
+void IDEChannel::ata_write_sectors(bool slave_request)
|
|
|
{
|
|
|
auto& request = *m_current_request;
|
|
|
|
|
@@ -577,34 +578,34 @@ void PATAChannel::ata_write_sectors(bool slave_request)
|
|
|
u32 start_sector = request.block_index();
|
|
|
u32 count = request.block_count();
|
|
|
#ifdef PATA_DEBUG
|
|
|
- klog() << "PATAChannel::ata_write_sectors request (" << count << " sector(s) @ " << start_sector << ")";
|
|
|
+ klog() << "IDEChannel::ata_write_sectors request (" << count << " sector(s) @ " << start_sector << ")";
|
|
|
#endif
|
|
|
|
|
|
- while (m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
+ while (m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY)
|
|
|
;
|
|
|
|
|
|
#ifdef PATA_DEBUG
|
|
|
- klog() << "PATAChannel: Writing " << count << " sector(s) @ LBA " << start_sector;
|
|
|
+ klog() << "IDEChannel: Writing " << count << " sector(s) @ LBA " << start_sector;
|
|
|
#endif
|
|
|
|
|
|
u8 devsel = 0xe0;
|
|
|
if (slave_request)
|
|
|
devsel |= 0x10;
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_SECCOUNT0).out<u8>(count == 256 ? 0 : LSB(count));
|
|
|
- m_io_base.offset(ATA_REG_LBA0).out<u8>(start_sector & 0xff);
|
|
|
- m_io_base.offset(ATA_REG_LBA1).out<u8>((start_sector >> 8) & 0xff);
|
|
|
- m_io_base.offset(ATA_REG_LBA2).out<u8>((start_sector >> 16) & 0xff);
|
|
|
- m_io_base.offset(ATA_REG_HDDEVSEL).out<u8>(devsel | ((start_sector >> 24) & 0xf));
|
|
|
+ m_io_group.io_base().offset(ATA_REG_SECCOUNT0).out<u8>(count == 256 ? 0 : LSB(count));
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA0).out<u8>(start_sector & 0xff);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA1).out<u8>((start_sector >> 8) & 0xff);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_LBA2).out<u8>((start_sector >> 16) & 0xff);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_HDDEVSEL).out<u8>(devsel | ((start_sector >> 24) & 0xf));
|
|
|
|
|
|
IO::out8(0x3F6, 0x08);
|
|
|
- while (!(m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_DRDY))
|
|
|
+ while (!(m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_DRDY))
|
|
|
;
|
|
|
|
|
|
- m_io_base.offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_WRITE_PIO);
|
|
|
+ m_io_group.io_base().offset(ATA_REG_COMMAND).out<u8>(ATA_CMD_WRITE_PIO);
|
|
|
|
|
|
io_delay();
|
|
|
- while ((m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY) || !(m_io_base.offset(ATA_REG_STATUS).in<u8>() & ATA_SR_DRQ))
|
|
|
+ while ((m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_BSY) || !(m_io_group.io_base().offset(ATA_REG_STATUS).in<u8>() & ATA_SR_DRQ))
|
|
|
;
|
|
|
|
|
|
enable_irq();
|