60 lines
1.6 KiB
C
60 lines
1.6 KiB
C
#include "../include/disk.h"
|
||
#include "../include/io.h"
|
||
|
||
void wait_disk_ready() {
|
||
while (1) {
|
||
int data = io_in8(0x1f7);
|
||
if ((data & 0x88) == 0x08) // 第3位为1表示硬盘控制器已准备好数据传输，第7位为1表示硬盘忙。
|
||
{
|
||
return;
|
||
}
|
||
}
|
||
}
|
||
|
||
void select_sector(int lba) {
|
||
io_out8(0x1f2, 1);
|
||
io_out8(0x1f3, lba);
|
||
io_out8(0x1f4, lba >> 8);
|
||
io_out8(0x1f5, lba >> 16);
|
||
io_out8(0x1f6, (((lba >> 24) & 0x0f) | 0xe0));
|
||
}
|
||
|
||
void read_disk_one_sector(int lba, unsigned int memory_addrress) {
|
||
while (io_in8(0x1f7) & 0x80);
|
||
select_sector(lba);
|
||
io_out8(0x1f7, 0x20);
|
||
wait_disk_ready();
|
||
for (int i = 0; i < 256; i++) {
|
||
short data = (short) io_in16(0x1f0);
|
||
*((short *) memory_addrress) = data;
|
||
memory_addrress += 2;
|
||
}
|
||
}
|
||
|
||
void write_disk_one_sertor(int lba, unsigned int memory_addrress) {
|
||
while (io_in8(0x1f7) & 0x80);
|
||
select_sector(lba);
|
||
io_out8(0x1f7, 0x30);
|
||
wait_disk_ready();
|
||
for (int i = 0; i < 256; i++) {
|
||
short data = *((short *) memory_addrress);
|
||
io_out16(0x1f0, data);
|
||
memory_addrress += 2;
|
||
}
|
||
}
|
||
|
||
void read_disk(int lba, int sector_count, unsigned int memory_addrress) {
|
||
for (int i = 0; i < sector_count; i++) {
|
||
read_disk_one_sector(lba, memory_addrress);
|
||
lba++;
|
||
memory_addrress += 512;
|
||
}
|
||
}
|
||
|
||
void write_disk(int lba, int sector_count, unsigned int memory_addrress) {
|
||
for (int i = 0; i < sector_count; i++) {
|
||
write_disk_one_sertor(lba, memory_addrress);
|
||
lba++;
|
||
memory_addrress += 512;
|
||
}
|
||
} |