xv6-cs450/ide.c

191 lines
3.6 KiB
C
Raw Normal View History

2006-06-16 22:29:25 +02:00
/*
* Minimal PIO-based (non-interrupt-driven) IDE driver code.
* For information about what all this IDE/ATA magic means,
* see the materials available on the class references page.
*/
#include "types.h"
#include "param.h"
#include "mmu.h"
#include "proc.h"
#include "defs.h"
#include "x86.h"
2006-07-17 07:00:25 +02:00
#include "spinlock.h"
2006-06-16 22:29:25 +02:00
#define IDE_BSY 0x80
#define IDE_DRDY 0x40
#define IDE_DF 0x20
#define IDE_ERR 0x01
2006-07-10 21:06:48 +02:00
struct ide_request {
2006-07-20 11:07:53 +02:00
int diskno;
uint secno;
void *addr;
uint nsecs;
uint read;
2006-07-10 21:06:48 +02:00
};
struct ide_request request[NREQUEST];
int head, tail;
struct spinlock ide_lock;
2006-07-10 21:06:48 +02:00
2006-07-10 15:08:37 +02:00
int disk_channel;
2006-06-16 22:29:25 +02:00
static int
ide_wait_ready(int check_error)
{
int r;
2006-06-16 22:29:25 +02:00
while (((r = inb(0x1F7)) & (IDE_BSY|IDE_DRDY)) != IDE_DRDY)
/* do nothing */;
2006-06-16 22:29:25 +02:00
if (check_error && (r & (IDE_DF|IDE_ERR)) != 0)
return -1;
return 0;
2006-06-16 22:29:25 +02:00
}
void
ide_init(void)
{
initlock(&ide_lock, "ide");
if (ncpu < 2) {
panic ("ide_init: disk interrupt is going to the second cpu\n");
}
ioapic_enable (IRQ_IDE, 1);
ide_wait_ready(0);
cprintf ("cpu%d: ide_init:done\n", cpu());
}
void
ide_intr(void)
{
2006-07-29 03:20:15 +02:00
acquire(&ide_lock);
// cprintf("cpu%d: ide_intr\n", cpu());
2006-07-10 21:06:48 +02:00
wakeup(&request[tail]);
2006-07-29 03:20:15 +02:00
release(&ide_lock);
}
2006-06-16 22:29:25 +02:00
int
ide_probe_disk1(void)
{
int r, x;
2006-06-16 22:29:25 +02:00
// wait for Device 0 to be ready
ide_wait_ready(0);
2006-06-16 22:29:25 +02:00
// switch to Device 1
outb(0x1F6, 0xE0 | (1<<4));
2006-06-16 22:29:25 +02:00
// check for Device 1 to be ready for a while
for (x = 0; x < 1000 && (r = inb(0x1F7)) == 0; x++)
/* do nothing */;
2006-06-16 22:29:25 +02:00
// switch back to Device 0
outb(0x1F6, 0xE0 | (0<<4));
2006-06-16 22:29:25 +02:00
cprintf("Device 1 presence: %d\n", (x < 1000));
return (x < 1000);
2006-06-16 22:29:25 +02:00
}
2006-07-10 21:06:48 +02:00
void
ide_start_request (void)
{
struct ide_request *r;
if (head != tail) {
2006-07-10 21:06:48 +02:00
r = &request[tail];
ide_wait_ready(0);
outb(0x3f6, 0); // generate interrupt
2006-07-10 21:06:48 +02:00
outb(0x1F2, r->nsecs);
outb(0x1F3, r->secno & 0xFF);
outb(0x1F4, (r->secno >> 8) & 0xFF);
outb(0x1F5, (r->secno >> 16) & 0xFF);
2006-07-20 11:07:53 +02:00
outb(0x1F6, 0xE0 | ((r->diskno&1)<<4) | ((r->secno>>24)&0x0F));
if (r->read) outb(0x1F7, 0x20); // read
2006-08-07 03:38:46 +02:00
else {
outb(0x1F7, 0x30); // write
outsl(0x1F0, r->addr, 512/4);
}
2006-07-10 21:06:48 +02:00
}
}
void *
ide_start_rw(int diskno, uint secno, void *addr, uint nsecs, int read)
2006-06-16 22:29:25 +02:00
{
2006-07-10 21:06:48 +02:00
struct ide_request *r;
2006-07-17 07:00:25 +02:00
if(!holding(&ide_lock))
panic("ide_start_read: not holding ide_lock");
2006-07-10 21:06:48 +02:00
2006-08-07 03:38:46 +02:00
if(nsecs > 1)
2006-07-10 15:08:37 +02:00
panic("ide_start_read: nsecs too large");
2006-07-10 21:06:48 +02:00
while ((head + 1) % NREQUEST == tail)
2006-07-17 07:00:25 +02:00
sleep (&disk_channel, &ide_lock);
2006-07-10 21:06:48 +02:00
r = &request[head];
r->secno = secno;
r->addr = addr;
2006-07-10 21:06:48 +02:00
r->nsecs = nsecs;
r->diskno = diskno;
r->read = read;
2006-07-10 21:06:48 +02:00
head = (head + 1) % NREQUEST;
ide_start_request();
2006-07-10 21:06:48 +02:00
return r;
2006-07-10 15:08:37 +02:00
}
int
ide_finish(void *c)
2006-07-10 15:08:37 +02:00
{
2006-08-07 03:38:46 +02:00
int r;
2006-07-10 21:06:48 +02:00
struct ide_request *req = (struct ide_request *) c;
2006-07-10 15:08:37 +02:00
if(c != &request[tail])
panic("ide_finish_read");
2006-07-17 07:00:25 +02:00
if(!holding(&ide_lock))
panic("ide_start_read: not holding ide_lock");
2006-08-07 03:38:46 +02:00
if (req->read) {
if ((r = ide_wait_ready(1)) >= 0)
insl(0x1F0, req->addr, 512/4);
}
2006-07-10 21:06:48 +02:00
if ((head + 1) % NREQUEST == tail) {
wakeup(&disk_channel);
}
tail = (tail + 1) % NREQUEST;
ide_start_request();
return 0;
2006-06-16 22:29:25 +02:00
}
int
ide_write(int diskno, uint secno, const void *src, uint nsecs)
2006-06-16 22:29:25 +02:00
{
int r;
2006-06-16 22:29:25 +02:00
if(nsecs > 256)
panic("ide_write");
2006-06-16 22:29:25 +02:00
ide_wait_ready(0);
2006-06-16 22:29:25 +02:00
outb(0x1F2, nsecs);
outb(0x1F3, secno & 0xFF);
outb(0x1F4, (secno >> 8) & 0xFF);
outb(0x1F5, (secno >> 16) & 0xFF);
outb(0x1F6, 0xE0 | ((diskno&1)<<4) | ((secno>>24)&0x0F));
outb(0x1F7, 0x30); // CMD 0x30 means write sector
2006-06-16 22:29:25 +02:00
for (; nsecs > 0; nsecs--, src += 512) {
if ((r = ide_wait_ready(1)) < 0)
return r;
outsl(0x1F0, src, 512/4);
}
2006-06-16 22:29:25 +02:00
return 0;
2006-06-16 22:29:25 +02:00
}