blob: 641d87e7022ec898b1bb4fd11d3743e0421b03c4 [file] [log] [blame]
Kevin O'Connora3855ad2009-08-16 21:59:40 -04001// 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
Kevin O'Connora3855ad2009-08-16 21:59:40 -040013void
Kevin O'Connor77d227b2009-10-22 21:48:39 -040014describe_ramdisk(struct drive_s *drive_g)
Kevin O'Connor51fd0a12009-09-12 13:20:14 -040015{
Kevin O'Connor77d227b2009-10-22 21:48:39 -040016 printf("%s", drive_g->model);
Kevin O'Connor51fd0a12009-09-12 13:20:14 -040017}
18
19void
Kevin O'Connor1ca05b02010-01-03 17:43:37 -050020ramdisk_setup(void)
Kevin O'Connora3855ad2009-08-16 21:59:40 -040021{
22 if (!CONFIG_COREBOOT_FLASH || !CONFIG_FLASH_FLOPPY)
23 return;
24
25 // Find image.
Kevin O'Connor00882592009-08-18 22:21:10 -040026 struct cbfs_file *file = cbfs_findprefix("floppyimg/", NULL);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040027 if (!file)
28 return;
Kevin O'Connor00882592009-08-18 22:21:10 -040029 u32 size = cbfs_datasize(file);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040030 dprintf(3, "Found floppy file %s of size %d\n", cbfs_filename(file), size);
31 int ftype = find_floppy_type(size);
32 if (ftype < 0) {
33 dprintf(3, "No floppy type found for ramdisk size\n");
34 return;
35 }
36
37 // Allocate ram for image.
Kevin O'Connor907a41c2009-08-30 19:31:22 -040038 void *pos = memalign_tmphigh(PAGE_SIZE, size);
39 if (!pos) {
Kevin O'Connorcfdc13f2010-02-14 13:07:54 -050040 warn_noalloc();
Kevin O'Connora3855ad2009-08-16 21:59:40 -040041 return;
42 }
Kevin O'Connor907a41c2009-08-30 19:31:22 -040043 add_e820((u32)pos, size, E820_RESERVED);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040044
45 // Copy image into ram.
Kevin O'Connor907a41c2009-08-30 19:31:22 -040046 cbfs_copyfile(file, pos, size);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040047
48 // Setup driver.
Kevin O'Connor907a41c2009-08-30 19:31:22 -040049 dprintf(1, "Mapping CBFS floppy %s to addr %p\n", cbfs_filename(file), pos);
Kevin O'Connor77d227b2009-10-22 21:48:39 -040050 struct drive_s *drive_g = addFloppy((u32)pos, ftype, DTYPE_RAMDISK);
51 if (drive_g)
52 strtcpy(drive_g->model, cbfs_filename(file), ARRAY_SIZE(drive_g->model));
Kevin O'Connora3855ad2009-08-16 21:59:40 -040053}
54
55static int
Kevin O'Connor907a41c2009-08-30 19:31:22 -040056ramdisk_copy(struct disk_op_s *op, int iswrite)
Kevin O'Connora3855ad2009-08-16 21:59:40 -040057{
Kevin O'Connor77d227b2009-10-22 21:48:39 -040058 u32 offset = GET_GLOBAL(op->drive_g->cntl_id);
Kevin O'Connor36c93a52009-09-12 19:35:04 -040059 offset += (u32)op->lba * DISK_SECTOR_SIZE;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040060 u64 opd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE((u32)op->buf_fl);
61 u64 ramd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE(offset);
62
63 u64 gdt[6];
64 if (iswrite) {
65 gdt[2] = opd;
66 gdt[3] = ramd;
67 } else {
68 gdt[2] = ramd;
69 gdt[3] = opd;
70 }
71
Kevin O'Connor907a41c2009-08-30 19:31:22 -040072 // Call int 1587 to copy data.
Kevin O'Connora3855ad2009-08-16 21:59:40 -040073 struct bregs br;
74 memset(&br, 0, sizeof(br));
Kevin O'Connorf8e800d2009-09-24 21:01:16 -040075 br.flags = F_CF|F_IF;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040076 br.ah = 0x87;
77 br.es = GET_SEG(SS);
78 br.si = (u32)gdt;
Kevin O'Connor36c93a52009-09-12 19:35:04 -040079 br.cx = op->count * DISK_SECTOR_SIZE / 2;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040080 call16_int(0x15, &br);
81
Kevin O'Connor907a41c2009-08-30 19:31:22 -040082 if (br.flags & F_CF)
83 return DISK_RET_EBADTRACK;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040084 return DISK_RET_SUCCESS;
85}
86
87int
88process_ramdisk_op(struct disk_op_s *op)
89{
90 if (!CONFIG_COREBOOT_FLASH || !CONFIG_FLASH_FLOPPY)
91 return 0;
92
93 switch (op->command) {
94 case CMD_READ:
Kevin O'Connor907a41c2009-08-30 19:31:22 -040095 return ramdisk_copy(op, 0);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040096 case CMD_WRITE:
Kevin O'Connor907a41c2009-08-30 19:31:22 -040097 return ramdisk_copy(op, 1);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040098 case CMD_VERIFY:
99 case CMD_FORMAT:
100 case CMD_RESET:
101 return DISK_RET_SUCCESS;
102 default:
103 op->count = 0;
104 return DISK_RET_EPARAM;
105 }
106}