| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395 |
- /* Disk layer: read sectors via direct FDC + ISA DMA in protected mode. */
- #include "disk.h"
- #include "timer.h"
- #define SECTOR_SIZE 512
- #define SECTORS_PER_TRACK 18
- #define HEADS 2
- #define DMA_BUF_ADDR 0x10000
- /* FDC I/O ports */
- #define FDC_DOR 0x3F2
- #define FDC_MSR 0x3F4
- #define FDC_FIFO 0x3F5
- #define FDC_CCR 0x3F7
- /* ISA DMA channel 2 ports */
- #define DMA_CH2_ADDR 0x04
- #define DMA_CH2_COUNT 0x05
- #define DMA_CH2_PAGE 0x81
- #define DMA_SINGLEMASK 0x0A
- #define DMA_MODE 0x0B
- #define DMA_FLIPFLOP 0x0C
- /* MSR bits */
- #define MSR_RQM 0x80
- #define MSR_DIO 0x40
- #define MSR_CB 0x10
- /* FDC commands */
- #define CMD_SPECIFY 0x03
- #define CMD_RECALIBRATE 0x07
- #define CMD_SENSE_INT 0x08
- #define CMD_READ_DATA 0xE6 /* READ | MFM | SK */
- #define CMD_SEEK 0x0F
- #define MOTOR_DELAY_MS 300
- #define IRQ_TIMEOUT_MS 2000
- #define MAX_RETRIES 3
- /* PIC master mask port */
- #define PIC1_DATA 0x21
- static inline unsigned char inb(unsigned short port)
- {
- unsigned char v;
- __asm__ volatile ("inb %1, %0" : "=a"(v) : "Nd"(port));
- return v;
- }
- static inline void outb(unsigned short port, unsigned char v)
- {
- __asm__ volatile ("outb %0, %1" : : "a"(v), "Nd"(port));
- }
- volatile int fdc_irq_fired;
- void fdc_irq(void)
- {
- fdc_irq_fired = 1;
- outb(0x20, 0x20);
- }
- static int fdc_initialized;
- static int motor_on;
- static unsigned int cur_cylinder;
- static unsigned int current_drive;
- /* ---- low-level FDC helpers ---- */
- static int fdc_wait_rqm(void)
- {
- unsigned int t0 = get_ticks_ms();
- while ((get_ticks_ms() - t0) < 500) {
- if (inb(FDC_MSR) & MSR_RQM)
- return 0;
- }
- return -1;
- }
- static int fdc_send(unsigned char b)
- {
- if (fdc_wait_rqm() != 0)
- return -1;
- if (inb(FDC_MSR) & MSR_DIO)
- return -1;
- outb(FDC_FIFO, b);
- return 0;
- }
- static int fdc_recv(unsigned char *b)
- {
- if (fdc_wait_rqm() != 0)
- return -1;
- if (!(inb(FDC_MSR) & MSR_DIO))
- return -1;
- *b = inb(FDC_FIFO);
- return 0;
- }
- static int fdc_wait_irq(void)
- {
- unsigned int t0 = get_ticks_ms();
- while (!fdc_irq_fired) {
- if ((get_ticks_ms() - t0) >= IRQ_TIMEOUT_MS)
- return -1;
- __asm__ volatile ("hlt");
- }
- return 0;
- }
- static int fdc_sense_interrupt(unsigned char *st0, unsigned char *cyl)
- {
- if (fdc_send(CMD_SENSE_INT) != 0)
- return -1;
- if (fdc_recv(st0) != 0)
- return -1;
- if (fdc_recv(cyl) != 0)
- return -1;
- return 0;
- }
- /* ---- motor control ---- */
- static void fdc_motor_on(void)
- {
- if (motor_on)
- return;
- outb(FDC_DOR, (unsigned char)((1 << (4 + current_drive)) | 0x0C | current_drive));
- {
- unsigned int t0 = get_ticks_ms();
- while ((get_ticks_ms() - t0) < MOTOR_DELAY_MS)
- __asm__ volatile ("hlt");
- }
- motor_on = 1;
- }
- /* ---- reset ---- */
- static int fdc_reset(void)
- {
- unsigned char st0, cyl;
- int i;
- /* Pull reset line: DOR = 0 turns off controller + motor */
- outb(FDC_DOR, 0x00);
- motor_on = 0;
- {
- unsigned int t0 = get_ticks_ms();
- while ((get_ticks_ms() - t0) < 10)
- ;
- }
- /* Release reset: controller on, DMA/IRQ enabled, no motor.
- * The FDC fires IRQ 6 once the reset completes. */
- fdc_irq_fired = 0;
- outb(FDC_DOR, (unsigned char)(0x0C | current_drive));
- if (fdc_wait_irq() != 0)
- return -1;
- for (i = 0; i < 4; i++)
- fdc_sense_interrupt(&st0, &cyl);
- outb(FDC_CCR, 0x00); /* 500 kbps for 1.44 MB */
- /* SPECIFY: SRT=3ms, HUT=240ms, HLT=16ms, DMA mode */
- if (fdc_send(CMD_SPECIFY) != 0)
- return -1;
- if (fdc_send(0xDF) != 0)
- return -1;
- if (fdc_send(0x02) != 0)
- return -1;
- return 0;
- }
- static int fdc_recalibrate(void)
- {
- unsigned char st0, cyl;
- fdc_irq_fired = 0;
- if (fdc_send(CMD_RECALIBRATE) != 0)
- return -1;
- if (fdc_send((unsigned char)current_drive) != 0)
- return -1;
- if (fdc_wait_irq() != 0)
- return -1;
- if (fdc_sense_interrupt(&st0, &cyl) != 0)
- return -1;
- if (st0 & 0xC0)
- return -1;
- cur_cylinder = 0;
- return 0;
- }
- static int fdc_seek(unsigned int cylinder, unsigned int head)
- {
- unsigned char st0, cyl;
- fdc_irq_fired = 0;
- if (fdc_send(CMD_SEEK) != 0)
- return -1;
- if (fdc_send((unsigned char)((head << 2) | current_drive)) != 0)
- return -1;
- if (fdc_send((unsigned char)cylinder) != 0)
- return -1;
- if (fdc_wait_irq() != 0)
- return -1;
- if (fdc_sense_interrupt(&st0, &cyl) != 0)
- return -1;
- if ((st0 & 0xC0) || cyl != (unsigned char)cylinder)
- return -1;
- cur_cylinder = cylinder;
- return 0;
- }
- /* ---- DMA channel 2 setup ---- */
- static void dma_setup_read(unsigned int phys, unsigned int len)
- {
- unsigned int count = len - 1;
- outb(DMA_SINGLEMASK, 0x06); /* mask channel 2 */
- outb(DMA_FLIPFLOP, 0xFF); /* reset flip-flop */
- outb(DMA_CH2_ADDR, (unsigned char)(phys & 0xFF));
- outb(DMA_CH2_ADDR, (unsigned char)((phys >> 8) & 0xFF));
- outb(DMA_CH2_PAGE, (unsigned char)((phys >> 16) & 0xFF));
- outb(DMA_FLIPFLOP, 0xFF); /* reset flip-flop */
- outb(DMA_CH2_COUNT, (unsigned char)(count & 0xFF));
- outb(DMA_CH2_COUNT, (unsigned char)((count >> 8) & 0xFF));
- outb(DMA_MODE, 0x46); /* single, increment, write, ch2 */
- outb(DMA_SINGLEMASK, 0x02); /* unmask channel 2 */
- }
- /* ---- read one sector ---- */
- static void lba_to_chs(unsigned int lba,
- unsigned int *cyl, unsigned int *head, unsigned int *sec)
- {
- unsigned int tmp = lba / SECTORS_PER_TRACK;
- *sec = (lba % SECTORS_PER_TRACK) + 1;
- *head = tmp % HEADS;
- *cyl = tmp / HEADS;
- }
- static int fdc_do_read(unsigned int cyl, unsigned int head, unsigned int sec)
- {
- unsigned char results[7];
- int i;
- dma_setup_read(DMA_BUF_ADDR, SECTOR_SIZE);
- fdc_irq_fired = 0;
- if (fdc_send(CMD_READ_DATA) != 0) return -1;
- if (fdc_send((unsigned char)((head << 2) | current_drive)) != 0) return -1;
- if (fdc_send((unsigned char)cyl) != 0) return -1;
- if (fdc_send((unsigned char)head) != 0) return -1;
- if (fdc_send((unsigned char)sec) != 0) return -1;
- if (fdc_send(0x02) != 0) return -1; /* 512 bytes/sector */
- if (fdc_send((unsigned char)SECTORS_PER_TRACK) != 0) return -1;
- if (fdc_send(0x1B) != 0) return -1; /* gap3 */
- if (fdc_send(0xFF) != 0) return -1; /* data length */
- if (fdc_wait_irq() != 0)
- return -1;
- for (i = 0; i < 7; i++) {
- if (fdc_recv(&results[i]) != 0)
- return -1;
- }
- if (results[0] & 0xC0)
- return -1;
- return 0;
- }
- static int fdc_read_one(unsigned int lba)
- {
- unsigned int cyl, head, sec;
- lba_to_chs(lba, &cyl, &head, &sec);
- if (cyl != cur_cylinder) {
- if (fdc_seek(cyl, head) != 0)
- return -1;
- }
- return fdc_do_read(cyl, head, sec);
- }
- /* ---- public API ---- */
- static int fdc_init_once(void)
- {
- /* Mask IRQ 6 before reset so the completion interrupt doesn't
- * fire before we're ready (IRQ 6 may already be unmasked from
- * a previous init). Then clear the flag and release the reset. */
- outb(PIC1_DATA, inb(PIC1_DATA) | 0x40);
- outb(FDC_DOR, 0x00);
- motor_on = 0;
- {
- unsigned int t0 = get_ticks_ms();
- while ((get_ticks_ms() - t0) < 10)
- ;
- }
- fdc_irq_fired = 0;
- outb(FDC_DOR, (unsigned char)(0x0C | current_drive));
- /* Unmask IRQ 6 — the latched reset-completion interrupt fires now. */
- outb(PIC1_DATA, inb(PIC1_DATA) & ~0x40);
- if (fdc_wait_irq() != 0)
- return -1;
- {
- unsigned char st0, cyl;
- int i;
- for (i = 0; i < 4; i++)
- fdc_sense_interrupt(&st0, &cyl);
- outb(FDC_CCR, 0x00);
- if (fdc_send(CMD_SPECIFY) != 0)
- return -1;
- if (fdc_send(0xDF) != 0)
- return -1;
- if (fdc_send(0x02) != 0)
- return -1;
- }
- fdc_motor_on();
- if (fdc_recalibrate() != 0)
- return -1;
- fdc_initialized = 1;
- return 0;
- }
- void disk_set_drive(unsigned int drive)
- {
- if (drive > 1)
- return;
- if (drive == current_drive && fdc_initialized)
- return;
- current_drive = drive;
- motor_on = 0;
- fdc_initialized = 0;
- }
- unsigned int disk_get_drive(void)
- {
- return current_drive;
- }
- int disk_read_sectors(unsigned int lba, void *buf, unsigned int count)
- {
- unsigned int i;
- if (!fdc_initialized) {
- if (fdc_init_once() != 0)
- return -1;
- }
- for (i = 0; i < count; i++) {
- int attempt, ok = 0;
- for (attempt = 0; attempt < MAX_RETRIES; attempt++) {
- if (fdc_read_one(lba + i) == 0) {
- ok = 1;
- break;
- }
- fdc_reset();
- fdc_motor_on();
- fdc_recalibrate();
- }
- if (!ok)
- return -1;
- {
- unsigned int j;
- unsigned char *dst = (unsigned char *)buf + (i * SECTOR_SIZE);
- const unsigned char *src = (const unsigned char *)DMA_BUF_ADDR;
- for (j = 0; j < SECTOR_SIZE; j++)
- dst[j] = src[j];
- }
- }
- return 0;
- }
|