blob: 6e730bfe0d5ed06d302077c4459ece7d7952d996 [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
Kevin O'Connorca2bc1c2010-12-29 21:41:19 -050012#include "boot.h" // boot_add_floppy
Kevin O'Connorfa9c66a2013-09-14 19:10:40 -040013#include "string.h" // memset
Kevin O'Connora3855ad2009-08-16 21:59:40 -040014
Kevin O'Connora3855ad2009-08-16 21:59:40 -040015void
Kevin O'Connor1ca05b02010-01-03 17:43:37 -050016ramdisk_setup(void)
Kevin O'Connora3855ad2009-08-16 21:59:40 -040017{
Kevin O'Connor59d6ca52012-05-31 00:20:55 -040018 if (!CONFIG_FLASH_FLOPPY)
Kevin O'Connora3855ad2009-08-16 21:59:40 -040019 return;
20
21 // Find image.
Kevin O'Connor59d6ca52012-05-31 00:20:55 -040022 struct romfile_s *file = romfile_findprefix("floppyimg/", NULL);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040023 if (!file)
24 return;
Kevin O'Connor59d6ca52012-05-31 00:20:55 -040025 const char *filename = file->name;
26 u32 size = file->size;
Kevin O'Connorc4bd3b92010-12-29 21:59:44 -050027 dprintf(3, "Found floppy file %s of size %d\n", filename, size);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040028 int ftype = find_floppy_type(size);
29 if (ftype < 0) {
30 dprintf(3, "No floppy type found for ramdisk size\n");
31 return;
32 }
33
34 // Allocate ram for image.
Kevin O'Connor907a41c2009-08-30 19:31:22 -040035 void *pos = memalign_tmphigh(PAGE_SIZE, size);
36 if (!pos) {
Kevin O'Connorcfdc13f2010-02-14 13:07:54 -050037 warn_noalloc();
Kevin O'Connora3855ad2009-08-16 21:59:40 -040038 return;
39 }
Kevin O'Connor907a41c2009-08-30 19:31:22 -040040 add_e820((u32)pos, size, E820_RESERVED);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040041
42 // Copy image into ram.
Kevin O'Connor59d6ca52012-05-31 00:20:55 -040043 int ret = file->copy(file, pos, size);
44 if (ret < 0)
45 return;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040046
47 // Setup driver.
Kevin O'Connorca2bc1c2010-12-29 21:41:19 -050048 struct drive_s *drive_g = init_floppy((u32)pos, ftype);
Kevin O'Connor575ffc82010-02-21 23:20:10 -050049 if (!drive_g)
Kevin O'Connorca2bc1c2010-12-29 21:41:19 -050050 return;
51 drive_g->type = DTYPE_RAMDISK;
Kevin O'Connorc4bd3b92010-12-29 21:59:44 -050052 dprintf(1, "Mapping CBFS floppy %s to addr %p\n", filename, pos);
53 char *desc = znprintf(MAXDESCSIZE, "Ramdisk [%s]", &filename[10]);
54 boot_add_floppy(drive_g, desc, bootprio_find_named_rom(filename, 0));
Kevin O'Connora3855ad2009-08-16 21:59:40 -040055}
56
57static int
Kevin O'Connor907a41c2009-08-30 19:31:22 -040058ramdisk_copy(struct disk_op_s *op, int iswrite)
Kevin O'Connora3855ad2009-08-16 21:59:40 -040059{
Kevin O'Connor77d227b2009-10-22 21:48:39 -040060 u32 offset = GET_GLOBAL(op->drive_g->cntl_id);
Kevin O'Connor36c93a52009-09-12 19:35:04 -040061 offset += (u32)op->lba * DISK_SECTOR_SIZE;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040062 u64 opd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE((u32)op->buf_fl);
63 u64 ramd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE(offset);
64
65 u64 gdt[6];
66 if (iswrite) {
67 gdt[2] = opd;
68 gdt[3] = ramd;
69 } else {
70 gdt[2] = ramd;
71 gdt[3] = opd;
72 }
73
Kevin O'Connor907a41c2009-08-30 19:31:22 -040074 // Call int 1587 to copy data.
Kevin O'Connora3855ad2009-08-16 21:59:40 -040075 struct bregs br;
76 memset(&br, 0, sizeof(br));
Kevin O'Connorf8e800d2009-09-24 21:01:16 -040077 br.flags = F_CF|F_IF;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040078 br.ah = 0x87;
79 br.es = GET_SEG(SS);
80 br.si = (u32)gdt;
Kevin O'Connor36c93a52009-09-12 19:35:04 -040081 br.cx = op->count * DISK_SECTOR_SIZE / 2;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040082 call16_int(0x15, &br);
83
Kevin O'Connor907a41c2009-08-30 19:31:22 -040084 if (br.flags & F_CF)
85 return DISK_RET_EBADTRACK;
Kevin O'Connora3855ad2009-08-16 21:59:40 -040086 return DISK_RET_SUCCESS;
87}
88
89int
90process_ramdisk_op(struct disk_op_s *op)
91{
Kevin O'Connor897fb112013-02-07 23:32:48 -050092 if (!CONFIG_FLASH_FLOPPY)
Kevin O'Connora3855ad2009-08-16 21:59:40 -040093 return 0;
94
95 switch (op->command) {
96 case CMD_READ:
Kevin O'Connor907a41c2009-08-30 19:31:22 -040097 return ramdisk_copy(op, 0);
Kevin O'Connora3855ad2009-08-16 21:59:40 -040098 case CMD_WRITE:
Kevin O'Connor907a41c2009-08-30 19:31:22 -040099 return ramdisk_copy(op, 1);
Kevin O'Connora3855ad2009-08-16 21:59:40 -0400100 case CMD_VERIFY:
101 case CMD_FORMAT:
102 case CMD_RESET:
103 return DISK_RET_SUCCESS;
104 default:
105 op->count = 0;
106 return DISK_RET_EPARAM;
107 }
108}