src/ramdisk.c

   1 // Code for emulating a drive via high-memory accesses.
   2 //
   3 // Copyright (C) 2009  Kevin O'Connor <kevin@koconnor.net>
   4 //
   5 // This file may be distributed under the terms of the GNU LGPLv3 license.
   6
   7 #include "disk.h" // process_ramdisk_op
   8 #include "util.h" // dprintf
   9 #include "memmap.h" // add_e820
  10 #include "biosvar.h" // GET_GLOBAL
  11 #include "bregs.h" // struct bregs
  12
  13 #define RAMDISK_SECTOR_SIZE 512
  14
  15 void
  16 ramdisk_setup()
  17 {
  18     if (!CONFIG_COREBOOT_FLASH || !CONFIG_FLASH_FLOPPY)
  19         return;
  20
  21     // Find image.
  22     struct cbfs_file *file = cbfs_findprefix("floppyimg/", NULL);
  23     if (!file)
  24         return;
  25     u32 size = cbfs_datasize(file);
  26     dprintf(3, "Found floppy file %s of size %d\n", cbfs_filename(file), size);
  27     int ftype = find_floppy_type(size);
  28     if (ftype < 0) {
  29         dprintf(3, "No floppy type found for ramdisk size\n");
  30         return;
  31     }
  32
  33     // Allocate ram for image.
  34     struct e820entry *e = find_high_area(size);
  35     if (!e) {
  36         dprintf(3, "No ram for ramdisk\n");
  37         return;
  38     }
  39     u32 loc = e->start + e->size - size;
  40     add_e820(loc, size, E820_RESERVED);
  41
  42     // Copy image into ram.
  43     cbfs_copyfile(file, (void*)loc, size);
  44
  45     // Setup driver.
  46     dprintf(1, "Mapping CBFS floppy %s to addr %x\n", cbfs_filename(file), loc);
  47     addFloppy(loc, ftype, DTYPE_RAMDISK);
  48 }
  49
  50 static int
  51 ramdisk_op(struct disk_op_s *op, int iswrite)
  52 {
  53     u32 offset = GET_GLOBAL(Drives.drives[op->driveid].cntl_id);
  54     offset += (u32)op->lba * RAMDISK_SECTOR_SIZE;
  55     u64 opd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE((u32)op->buf_fl);
  56     u64 ramd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE(offset);
  57
  58     u64 gdt[6];
  59     if (iswrite) {
  60         gdt[2] = opd;
  61         gdt[3] = ramd;
  62     } else {
  63         gdt[2] = ramd;
  64         gdt[3] = opd;
  65     }
  66
  67     // Call 0x1587 to copy data.
  68     struct bregs br;
  69     memset(&br, 0, sizeof(br));
  70     br.ah = 0x87;
  71     br.es = GET_SEG(SS);
  72     br.si = (u32)gdt;
  73     br.cx = op->count * RAMDISK_SECTOR_SIZE / 2;
  74     call16_int(0x15, &br);
  75
  76     return DISK_RET_SUCCESS;
  77 }
  78
  79 int
  80 process_ramdisk_op(struct disk_op_s *op)
  81 {
  82     if (!CONFIG_COREBOOT_FLASH || !CONFIG_FLASH_FLOPPY)
  83         return 0;
  84
  85     switch (op->command) {
  86     case CMD_READ:
  87         return ramdisk_op(op, 0);
  88     case CMD_WRITE:
  89         return ramdisk_op(op, 1);
  90     case CMD_VERIFY:
  91     case CMD_FORMAT:
  92     case CMD_RESET:
  93         return DISK_RET_SUCCESS;
  94     default:
  95         op->count = 0;
  96         return DISK_RET_EPARAM;
  97     }
  98 }