2eb953f1f1
* Works with different block sizes * Works with different inode sizes * Tested on a real EXT2 file system made with mkfs.ext2 * MBR reading is available * You can specify a partition with hdd=0 or hdd=1 etc. * If you make a "real" disk image, you can get GRUB installed in its MBR, toss in a suitable config file, and boot right off the disk rather than having to use QEMU to boot the kernel or using some silly CDROM ramdisk nonsense.
88 lines
2.3 KiB
C
88 lines
2.3 KiB
C
/* vim: tabstop=4 shiftwidth=4 noexpandtab
|
|
*
|
|
* ToAruOS PCI Initialization
|
|
*/
|
|
|
|
#include <system.h>
|
|
#include <ata.h>
|
|
#include <logging.h>
|
|
|
|
ide_channel_regs_t ide_channels[2];
|
|
ide_device_t ide_devices[4];
|
|
uint8_t ide_buf[2048] = {0};
|
|
uint8_t ide_irq_invoked = 0;
|
|
uint8_t atapi_packet[12] = {0xA8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
|
|
|
|
void ide_detect() {
|
|
|
|
}
|
|
|
|
void ata_wait(uint16_t bus) {
|
|
uint8_t status = 0;
|
|
while ((status = inportb(bus + 0x07)) & 0x80);
|
|
if (!(status & 0x08)) {
|
|
while (!((status = inportb(bus + 0x07)) & 0x41)) {
|
|
if (!status) break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void ata_wait_ready(uint16_t bus) {
|
|
uint8_t status = 0;
|
|
while (!(status = inportb(bus + 0x07)) & 0x40);
|
|
}
|
|
|
|
void ide_read_sector(uint16_t bus, uint8_t slave, uint32_t lba, uint8_t * buf) {
|
|
ata_wait(bus);
|
|
outportb(bus + ATA_REG_FEATURES, 0x00);
|
|
outportb(bus + ATA_REG_SECCOUNT0, 1);
|
|
outportb(bus + ATA_REG_HDDEVSEL, 0xe0 | slave << 4 |
|
|
(lba & 0x0f000000) >> 24);
|
|
outportb(bus + ATA_REG_LBA0, (lba & 0x000000ff) >> 0);
|
|
outportb(bus + ATA_REG_LBA1, (lba & 0x0000ff00) >> 8);
|
|
outportb(bus + ATA_REG_LBA2, (lba & 0x00ff0000) >> 16);
|
|
outportb(bus + ATA_REG_COMMAND, ATA_CMD_READ_PIO);
|
|
ata_wait_ready(bus);
|
|
int size = 256;
|
|
inportsm(bus,buf,size);
|
|
}
|
|
|
|
void ide_write_sector(uint16_t bus, uint8_t slave, uint32_t lba, uint8_t * buf) {
|
|
ata_wait_ready(bus);
|
|
outportb(bus + ATA_REG_FEATURES, 0x00);
|
|
outportb(bus + ATA_REG_SECCOUNT0, 0x01);
|
|
outportb(bus + ATA_REG_HDDEVSEL, 0xe0 | slave << 4 |
|
|
(lba & 0x0f000000) >> 24);
|
|
outportb(bus + ATA_REG_LBA0, (lba & 0x000000ff) >> 0);
|
|
outportb(bus + ATA_REG_LBA1, (lba & 0x0000ff00) >> 8);
|
|
outportb(bus + ATA_REG_LBA2, (lba & 0x00ff0000) >> 16);
|
|
outportb(bus + ATA_REG_COMMAND, ATA_CMD_WRITE_PIO);
|
|
ata_wait(bus);
|
|
int size = 256;
|
|
outportsm(bus,buf,size);
|
|
ata_wait_ready(bus);
|
|
outportb(bus + 0x07, ATA_CMD_CACHE_FLUSH);
|
|
}
|
|
|
|
int ide_cmp(uint32_t * ptr1, uint32_t * ptr2, size_t size) {
|
|
assert(!(size % 4));
|
|
uint32_t i = 0;
|
|
while (i < size) {
|
|
if (*ptr1 != *ptr2) return 1;
|
|
ptr1++;
|
|
ptr2++;
|
|
i += 4;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void ide_write_sector_retry(uint16_t bus, uint8_t slave, uint32_t lba, uint8_t * buf) {
|
|
uint8_t * read_buf = malloc(512);
|
|
IRQ_OFF;
|
|
do {
|
|
ide_write_sector(bus,slave,lba,buf);
|
|
ide_read_sector(bus,slave,lba,read_buf);
|
|
} while (ide_cmp((uint32_t*)buf,(uint32_t*)read_buf,512));
|
|
IRQ_RES;
|
|
}
|