| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190 |
- /* Block device registry: floppy (via FDC) + IDE (via ATA PIO) + SATA (AHCI). */
- #include "blkdev.h"
- #include "ahci.h"
- #include "ata.h"
- #include "disk.h"
- #include "serial.h"
- #include "timer.h"
- blk_dev_t blk_devs[BLKDEV_MAX];
- unsigned int blk_dev_count;
- /* Names for SATA disks, built from the AHCI port number ("sata0".."sata31"). */
- static char sata_names[AHCI_MAX_DISKS][8];
- static const char *sata_name(unsigned int idx, unsigned int port)
- {
- char *b = sata_names[idx];
- unsigned int i = 4;
- b[0] = 's'; b[1] = 'a'; b[2] = 't'; b[3] = 'a';
- if (port >= 10)
- b[i++] = (char)('0' + (port / 10) % 10);
- b[i++] = (char)('0' + port % 10);
- b[i] = '\0';
- return b;
- }
- static blk_dev_t *add(const char *name, blk_kind_t kind,
- unsigned int bus, unsigned int unit)
- {
- blk_dev_t *d;
- if (blk_dev_count >= BLKDEV_MAX)
- return 0;
- d = &blk_devs[blk_dev_count++];
- d->name = name;
- d->kind = kind;
- d->bus = bus;
- d->unit = unit;
- d->present = 0;
- d->total_sectors = 0;
- d->model[0] = '\0';
- return d;
- }
- static void blk_trace(const char *name, int present, unsigned int ms)
- {
- serial_puts(SERIAL_COM1, "blk: ");
- serial_puts(SERIAL_COM1, name);
- serial_puts(SERIAL_COM1, present ? " present " : " absent ");
- serial_putdec(SERIAL_COM1, ms);
- serial_puts(SERIAL_COM1, " ms\n");
- }
- void blk_scan(void)
- {
- blk_dev_t *d;
- unsigned int t0;
- blk_dev_count = 0;
- /* Floppy drives 0 and 1. Probe for media instead of assuming both
- * drives exist: an empty drive would otherwise go through the full
- * ten-retry recovery loop at every mount. */
- t0 = get_ticks_ms();
- d = add("floppy0", BLK_FLOPPY, 0, 0);
- if (d) {
- d->present = disk_probe(0);
- d->total_sectors = 2880;
- }
- blk_trace("floppy0", d ? d->present : 0, get_ticks_ms() - t0);
- t0 = get_ticks_ms();
- d = add("floppy1", BLK_FLOPPY, 1, 0);
- if (d) {
- d->present = disk_probe(1);
- d->total_sectors = 2880;
- }
- blk_trace("floppy1", d ? d->present : 0, get_ticks_ms() - t0);
- /* IDE: primary + secondary, master + slave. The channel port bases
- * come from the PCI IDE interface (native mode) or the legacy default. */
- ata_init_ports();
- {
- static const char *names[4] = { "ide0", "ide1", "ide2", "ide3" };
- unsigned int i;
- for (i = 0; i < 4; i++) {
- unsigned int sectors = 0;
- char model[41];
- int ok;
- d = add(names[i], BLK_IDE, i / 2, i % 2);
- if (!d)
- continue;
- t0 = get_ticks_ms();
- ok = ata_probe(i / 2, i % 2, §ors, model) == 0;
- blk_trace(names[i], ok, get_ticks_ms() - t0);
- if (ok) {
- unsigned int j;
- d->present = 1;
- d->total_sectors = sectors;
- for (j = 0; j < 40; j++)
- d->model[j] = model[j];
- d->model[40] = '\0';
- }
- }
- }
- /* SATA/AHCI: only present disks are registered, named by port index. */
- {
- struct ahci_disk disks[AHCI_MAX_DISKS];
- unsigned int n, i;
- t0 = get_ticks_ms();
- n = ahci_scan(disks, AHCI_MAX_DISKS);
- serial_puts(SERIAL_COM1, "blk: ahci ");
- serial_putdec(SERIAL_COM1, n);
- serial_puts(SERIAL_COM1, " disk(s) ");
- serial_putdec(SERIAL_COM1, get_ticks_ms() - t0);
- serial_puts(SERIAL_COM1, " ms\n");
- for (i = 0; i < n; i++) {
- unsigned int j;
- d = add(sata_name(i, disks[i].port), BLK_SATA, 0, disks[i].port);
- if (!d)
- break;
- d->present = 1;
- d->total_sectors = disks[i].sectors;
- for (j = 0; j < 40; j++)
- d->model[j] = disks[i].model[j];
- d->model[40] = '\0';
- }
- }
- }
- static int name_eq(const char *a, const char *b)
- {
- while (*a && *b) {
- if (*a != *b)
- return 0;
- a++;
- b++;
- }
- return (*a == *b);
- }
- blk_dev_t *blk_find(const char *name)
- {
- unsigned int i;
- for (i = 0; i < blk_dev_count; i++)
- if (name_eq(blk_devs[i].name, name))
- return &blk_devs[i];
- return 0;
- }
- int blk_read(blk_dev_t *d, unsigned int lba, void *buf, unsigned int count)
- {
- if (!d || count == 0)
- return -1;
- if (d->kind == BLK_FLOPPY) {
- disk_set_drive(d->bus);
- return disk_read_sectors(lba, buf, count);
- }
- if (d->kind == BLK_SATA)
- return ahci_read_sectors(d->unit, lba, buf, count);
- return ata_read_sectors(d->bus, d->unit, lba, buf, count);
- }
- int blk_write(blk_dev_t *d, unsigned int lba, const void *buf, unsigned int count)
- {
- if (!d || count == 0)
- return -1;
- if (d->kind == BLK_FLOPPY) {
- disk_set_drive(d->bus);
- return disk_write_sectors(lba, buf, count);
- }
- if (d->kind == BLK_SATA)
- return ahci_write_sectors(d->unit, lba, buf, count);
- return ata_write_sectors(d->bus, d->unit, lba, buf, count);
- }
- int blk_flush(blk_dev_t *d)
- {
- if (!d)
- return -1;
- if (d->kind == BLK_FLOPPY)
- return 0;
- if (d->kind == BLK_SATA)
- return ahci_flush(d->unit);
- return ata_flush(d->bus, d->unit);
- }
|