esp32emu / firmware /dosvga32 /diskpart.cpp
HelloSun's picture
ESP32 emulator update
d8afd6f verified
Raw History Blame Contribute Delete
3.55 kB
// Floppy image on raw flash partition "dosdisk"; writes are kept in a RAM overlay (lost at reset).
#ifndef _GNU_SOURCE
#define _GNU_SOURCE
#endif
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include "esp_partition.h"
#include "diskpart.h"
namespace {
struct Disk {
const esp_partition_t * part;
uint32_t size;
uint32_t pos;
uint8_t * pool;
uint16_t poolSlots, used;
uint16_t * map; // sector -> slot+1 (0 = not overlaid)
uint32_t reads;
};
ssize_t dread(void * c, char * buf, size_t n)
{
Disk * d = (Disk*)c;
if (d->pos >= d->size) return 0;
if (n > d->size - d->pos) n = d->size - d->pos;
size_t done = 0;
while (done < n) {
uint32_t sec = (d->pos + done) / 512, off = (d->pos + done) % 512;
size_t chunk = 512 - off; if (chunk > n - done) chunk = n - done;
if (d->map[sec]) {
memcpy(buf + done, d->pool + (uint32_t)(d->map[sec] - 1) * 512 + off, chunk);
} else {
// coalesce following non-overlaid sectors into one flash read
size_t span = chunk;
uint32_t s2 = sec + 1;
while (done + span < n && !d->map[s2]) { size_t add = n - done - span; if (add > 512) add = 512; span += add; ++s2; }
if (esp_partition_read(d->part, d->pos + done, buf + done, span) != ESP_OK) return -1;
chunk = span;
}
done += chunk;
}
if (d->reads < 12) { printf("[disk] read off=%u len=%u\n", (unsigned)d->pos, (unsigned)n); }
++d->reads;
d->pos += n;
return n;
}
ssize_t dwrite(void * c, const char * buf, size_t n)
{
Disk * d = (Disk*)c;
if (d->pos >= d->size) return 0;
if (n > d->size - d->pos) n = d->size - d->pos;
size_t done = 0;
while (done < n) {
uint32_t sec = (d->pos + done) / 512, off = (d->pos + done) % 512;
size_t chunk = 512 - off; if (chunk > n - done) chunk = n - done;
if (!d->map[sec]) {
if (d->used >= d->poolSlots) return done ? (d->pos += done, done) : -1; // overlay full
uint8_t * slot = d->pool + (uint32_t)d->used * 512;
if (esp_partition_read(d->part, sec * 512, slot, 512) != ESP_OK) return -1;
d->map[sec] = ++d->used;
}
memcpy(d->pool + (uint32_t)(d->map[sec] - 1) * 512 + off, buf + done, chunk);
done += chunk;
}
d->pos += n;
return n;
}
int dseek(void * c, off_t * off, int whence)
{
Disk * d = (Disk*)c;
int64_t p = *off;
if (whence == SEEK_CUR) p += d->pos; else if (whence == SEEK_END) p += d->size;
if (p < 0) return -1;
d->pos = (uint32_t)p; *off = p;
return 0;
}
int dclose(void * c) { Disk * d = (Disk*)c; free(d->map); free(d); return 0; }
}
FILE * openPartitionDisk(uint8_t * overlayMem, uint32_t overlaySize, uint64_t * diskSize)
{
const esp_partition_t * p = esp_partition_find_first(ESP_PARTITION_TYPE_DATA, ESP_PARTITION_SUBTYPE_ANY, "dosdisk");
if (!p) { printf("[disk] partition 'dosdisk' NOT FOUND\n"); return nullptr; }
Disk * d = (Disk*)calloc(1, sizeof(Disk));
d->part = p;
d->size = p->size > 1474560 ? 1474560 : p->size; // 1.44MB floppy
d->pool = overlayMem;
d->poolSlots = overlaySize / 512;
d->map = (uint16_t*)calloc(d->size / 512, sizeof(uint16_t));
uint8_t bs[512];
esp_partition_read(p, 0, bs, 512);
printf("[disk] partition dosdisk @0x%x size=0x%x, boot sector: %02X %02X %02X ... sig=%02X%02X\n",
(unsigned)p->address, (unsigned)p->size, bs[0], bs[1], bs[2], bs[510], bs[511]);
cookie_io_functions_t f = { dread, dwrite, dseek, dclose };
FILE * fp = fopencookie(d, "r+", f);
if (fp) setvbuf(fp, (char*)malloc(512), _IOFBF, 512);
*diskSize = d->size;
return fp;
}