1 // Code for emulating a drive via high-memory accesses.
3 // Copyright (C) 2009 Kevin O'Connor <kevin@koconnor.net>
5 // This file may be distributed under the terms of the GNU LGPLv3 license.
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 #include "boot.h" // boot_add_floppy
17 if (!CONFIG_COREBOOT || !CONFIG_COREBOOT_FLASH || !CONFIG_FLASH_FLOPPY)
21 struct cbfs_file *file = cbfs_findprefix("floppyimg/", NULL);
24 u32 size = cbfs_datasize(file);
25 dprintf(3, "Found floppy file %s of size %d\n", cbfs_filename(file), size);
26 int ftype = find_floppy_type(size);
28 dprintf(3, "No floppy type found for ramdisk size\n");
32 // Allocate ram for image.
33 void *pos = memalign_tmphigh(PAGE_SIZE, size);
38 add_e820((u32)pos, size, E820_RESERVED);
40 // Copy image into ram.
41 cbfs_copyfile(file, pos, size);
44 struct drive_s *drive_g = init_floppy((u32)pos, ftype);
47 drive_g->type = DTYPE_RAMDISK;
48 dprintf(1, "Mapping CBFS floppy %s to addr %p\n", cbfs_filename(file), pos);
49 char *desc = znprintf(MAXDESCSIZE, "Ramdisk [%s]", cbfs_filename(file));
50 boot_add_floppy(drive_g, desc, -1);
54 ramdisk_copy(struct disk_op_s *op, int iswrite)
56 u32 offset = GET_GLOBAL(op->drive_g->cntl_id);
57 offset += (u32)op->lba * DISK_SECTOR_SIZE;
58 u64 opd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE((u32)op->buf_fl);
59 u64 ramd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE(offset);
70 // Call int 1587 to copy data.
72 memset(&br, 0, sizeof(br));
77 br.cx = op->count * DISK_SECTOR_SIZE / 2;
78 call16_int(0x15, &br);
81 return DISK_RET_EBADTRACK;
82 return DISK_RET_SUCCESS;
86 process_ramdisk_op(struct disk_op_s *op)
88 if (!CONFIG_COREBOOT || !CONFIG_COREBOOT_FLASH || !CONFIG_FLASH_FLOPPY)
91 switch (op->command) {
93 return ramdisk_copy(op, 0);
95 return ramdisk_copy(op, 1);
99 return DISK_RET_SUCCESS;
102 return DISK_RET_EPARAM;