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
16 if (!CONFIG_COREBOOT || !CONFIG_COREBOOT_FLASH || !CONFIG_FLASH_FLOPPY)
20 struct cbfs_file *file = cbfs_findprefix("floppyimg/", NULL);
23 u32 size = cbfs_datasize(file);
24 dprintf(3, "Found floppy file %s of size %d\n", cbfs_filename(file), size);
25 int ftype = find_floppy_type(size);
27 dprintf(3, "No floppy type found for ramdisk size\n");
31 // Allocate ram for image.
32 void *pos = memalign_tmphigh(PAGE_SIZE, size);
37 add_e820((u32)pos, size, E820_RESERVED);
39 // Copy image into ram.
40 cbfs_copyfile(file, pos, size);
43 dprintf(1, "Mapping CBFS floppy %s to addr %p\n", cbfs_filename(file), pos);
44 struct drive_s *drive_g = addFloppy((u32)pos, ftype, DTYPE_RAMDISK);
46 strtcpy(drive_g->desc, cbfs_filename(file), MAXDESCSIZE);
50 ramdisk_copy(struct disk_op_s *op, int iswrite)
52 u32 offset = GET_GLOBAL(op->drive_g->cntl_id);
53 offset += (u32)op->lba * DISK_SECTOR_SIZE;
54 u64 opd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE((u32)op->buf_fl);
55 u64 ramd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE(offset);
66 // Call int 1587 to copy data.
68 memset(&br, 0, sizeof(br));
73 br.cx = op->count * DISK_SECTOR_SIZE / 2;
74 call16_int(0x15, &br);
77 return DISK_RET_EBADTRACK;
78 return DISK_RET_SUCCESS;
82 process_ramdisk_op(struct disk_op_s *op)
84 if (!CONFIG_COREBOOT || !CONFIG_COREBOOT_FLASH || !CONFIG_FLASH_FLOPPY)
87 switch (op->command) {
89 return ramdisk_copy(op, 0);
91 return ramdisk_copy(op, 1);
95 return DISK_RET_SUCCESS;
98 return DISK_RET_EPARAM;