| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567 |
- /* FAT12: BPB parse, root list, read/write files by following FAT chain. */
- #include "disk.h"
- #include "fat.h"
- #include "io.h"
- #define SECTOR_SIZE 512
- #define ROOT_ENTRY_SIZE 32
- #define FAT12_EOC_MIN 0xFF8
- /* BPB offsets (same for FAT12 1.44MB floppy) */
- #define BPB_BYTES_PER_SEC 0x0B
- #define BPB_SEC_PER_CLUSTER 0x0D
- #define BPB_RESERVED 0x0E
- #define BPB_NUM_FATS 0x10
- #define BPB_ROOT_ENTRIES 0x11
- #define BPB_SEC_PER_FAT 0x16
- #define BPB_TOTAL_SEC16 0x13 /* total sectors (16-bit) */
- #define BPB_TOTAL_SEC32 0x20 /* total sectors (32-bit) */
- #define BPB_SIGNATURE 0x1FE /* 0x55 0xAA at end of boot sector */
- static unsigned int fat_reserved;
- static unsigned int fat_root_start;
- static unsigned int fat_root_sectors;
- static unsigned int fat_data_start;
- static unsigned int fat_sec_per_cluster;
- static unsigned int fat_num_fats;
- static unsigned int fat_sec_per_fat;
- static unsigned int fat_total_sectors;
- static unsigned int fat_max_cluster; /* 2 + number of data clusters */
- static int fat_ready;
- static unsigned char sector_buf[SECTOR_SIZE];
- static int fat_read_sector(unsigned int lba)
- {
- if (disk_read_sectors(lba, sector_buf, 1) != 0)
- return -1;
- return 0;
- }
- /* Get 12-bit FAT entry at cluster index. FAT is in sector_buf (one sector). */
- static unsigned int fat_get_entry(unsigned int cluster_idx)
- {
- unsigned int byte_off = (cluster_idx * 3) / 2;
- unsigned int word_val;
- if (byte_off + 2 > SECTOR_SIZE)
- return 0xFFFF;
- word_val = (unsigned int)sector_buf[byte_off] | ((unsigned int)sector_buf[byte_off + 1] << 8);
- if (cluster_idx & 1)
- return word_val >> 4;
- return word_val & 0xFFF;
- }
- int fat_init(void)
- {
- unsigned int root_entries;
- if (fat_read_sector(0) != 0) {
- io_putstr("run: disk read error (boot sector LBA=0)\n");
- return -2; /* disk I/O error */
- }
- if (sector_buf[BPB_SIGNATURE] != 0x55 || sector_buf[BPB_SIGNATURE + 1] != 0xAA)
- return -1; /* no valid FAT filesystem */
- fat_reserved = (unsigned int)sector_buf[BPB_RESERVED] | ((unsigned int)sector_buf[BPB_RESERVED + 1] << 8);
- fat_num_fats = sector_buf[BPB_NUM_FATS];
- root_entries = (unsigned int)sector_buf[BPB_ROOT_ENTRIES] | ((unsigned int)sector_buf[BPB_ROOT_ENTRIES + 1] << 8);
- fat_sec_per_fat = (unsigned int)sector_buf[BPB_SEC_PER_FAT] | ((unsigned int)sector_buf[BPB_SEC_PER_FAT + 1] << 8);
- fat_sec_per_cluster = sector_buf[BPB_SEC_PER_CLUSTER];
- fat_total_sectors = (unsigned int)sector_buf[BPB_TOTAL_SEC16] | ((unsigned int)sector_buf[BPB_TOTAL_SEC16 + 1] << 8);
- if (fat_total_sectors == 0)
- fat_total_sectors = (unsigned int)sector_buf[BPB_TOTAL_SEC32]
- | ((unsigned int)sector_buf[BPB_TOTAL_SEC32 + 1] << 8)
- | ((unsigned int)sector_buf[BPB_TOTAL_SEC32 + 2] << 16)
- | ((unsigned int)sector_buf[BPB_TOTAL_SEC32 + 3] << 24);
- fat_root_start = fat_reserved + fat_num_fats * fat_sec_per_fat;
- fat_root_sectors = (root_entries * ROOT_ENTRY_SIZE + SECTOR_SIZE - 1) / SECTOR_SIZE;
- fat_data_start = fat_root_start + fat_root_sectors;
- if (fat_total_sectors > fat_data_start && fat_sec_per_cluster > 0)
- fat_max_cluster = 2 + (fat_total_sectors - fat_data_start) / fat_sec_per_cluster;
- else
- fat_max_cluster = 2;
- fat_ready = 1;
- return 0;
- }
- static void trim_name_8_3(const char *in, char *out)
- {
- unsigned int i;
- for (i = 0; i < 8 && in[i] && in[i] != ' '; i++)
- out[i] = (char)(in[i] >= 'a' && in[i] <= 'z' ? in[i] - 32 : in[i]);
- for (; i < 8; i++)
- out[i] = ' ';
- for (i = 0; i < 3 && in[8 + i] && in[8 + i] != ' '; i++)
- out[8 + i] = (char)(in[8 + i] >= 'a' && in[8 + i] <= 'z' ? in[8 + i] - 32 : in[8 + i]);
- for (; i < 3; i++)
- out[8 + i] = ' ';
- out[11] = '\0';
- }
- int fat_list_root(fat_root_callback_t callback)
- {
- unsigned int sec, off;
- char name_buf[12];
- if (!fat_ready || !callback)
- return -1;
- for (sec = 0; sec < fat_root_sectors; sec++) {
- if (fat_read_sector(fat_root_start + sec) != 0) {
- io_putstr("run: disk read error (root dir sec=");
- io_puthex(sec);
- io_putstr(" LBA=");
- io_puthex(fat_root_start + sec);
- io_putstr(")\n");
- return -2;
- }
- for (off = 0; off < SECTOR_SIZE; off += ROOT_ENTRY_SIZE) {
- unsigned char *e = sector_buf + off;
- if (e[0] == 0x00)
- return 0;
- if (e[0] == 0xE5)
- continue;
- if ((e[11] & 0x18) == 0x08)
- continue;
- trim_name_8_3((const char *)e, name_buf);
- {
- unsigned int size = (unsigned int)e[28] | ((unsigned int)e[29] << 8) |
- ((unsigned int)e[30] << 16) | ((unsigned int)e[31] << 24);
- (*callback)(name_buf, (e[11] & 0x10) ? 1 : 0, size);
- }
- }
- }
- return 0;
- }
- /* Find root entry by 8.3 name; return first cluster and size, or -1. */
- static int fat_find_root(const char *name_8_3, unsigned int *out_cluster, unsigned int *out_size)
- {
- unsigned int sec, off;
- char want[12];
- unsigned int i;
- for (i = 0; i < 11; i++)
- want[i] = (char)(name_8_3[i] >= 'a' && name_8_3[i] <= 'z' ? name_8_3[i] - 32 : name_8_3[i]);
- want[11] = '\0';
- for (sec = 0; sec < fat_root_sectors; sec++) {
- if (fat_read_sector(fat_root_start + sec) != 0) {
- io_putstr("run: disk read error (find root sec=");
- io_puthex(sec);
- io_putstr(" LBA=");
- io_puthex(fat_root_start + sec);
- io_putstr(")\n");
- return -2;
- }
- for (off = 0; off < SECTOR_SIZE; off += ROOT_ENTRY_SIZE) {
- unsigned char *e = sector_buf + off;
- if (e[0] == 0x00)
- return -1;
- if (e[0] == 0xE5 || (e[11] & 0x10))
- continue;
- for (i = 0; i < 11; i++)
- if ((e[i] >= 'a' ? e[i] - 32 : e[i]) != (unsigned char)want[i])
- break;
- if (i < 11)
- continue;
- *out_cluster = (unsigned int)e[26] | ((unsigned int)e[27] << 8);
- *out_size = (unsigned int)e[28] | ((unsigned int)e[29] << 8) |
- ((unsigned int)e[30] << 16) | ((unsigned int)e[31] << 24);
- return 0;
- }
- }
- return -1;
- }
- int fat_read_file(const char *name_8_3, void *buf, unsigned int max_len)
- {
- unsigned int cluster, size;
- unsigned int fat_start = fat_reserved;
- unsigned int copied = 0;
- unsigned char *dst = (unsigned char *)buf;
- unsigned int loaded_fat_sec;
- if (!fat_ready || !buf)
- return -1;
- {
- int fr = fat_find_root(name_8_3, &cluster, &size);
- if (fr == -2)
- return -2;
- if (fr != 0)
- return -1;
- }
- if (size > max_len)
- size = max_len;
- /* Pre-load the FAT sector covering the first cluster so we can follow
- * the chain without re-reading the FAT between every data cluster.
- * Data reads use DMA + memcpy to dst and never touch sector_buf,
- * so the cached FAT data stays valid throughout. */
- loaded_fat_sec = fat_start + (cluster * 3) / (2 * SECTOR_SIZE);
- if (fat_read_sector(loaded_fat_sec) != 0) {
- io_putstr("run: disk read error (FAT preload LBA=");
- io_puthex(loaded_fat_sec);
- io_putstr(")\n");
- return -2;
- }
- while (cluster >= 2 && cluster < 0xFF8 && copied < size) {
- unsigned int sector = fat_data_start + (cluster - 2) * fat_sec_per_cluster;
- unsigned int chunk = fat_sec_per_cluster * SECTOR_SIZE;
- unsigned int n_sec;
- if (chunk > size - copied)
- chunk = size - copied;
- n_sec = (chunk + SECTOR_SIZE - 1) / SECTOR_SIZE;
- if (disk_read_sectors(sector, dst + copied, n_sec) != 0) {
- io_putstr("run: disk read error (file data cluster=");
- io_puthex(cluster);
- io_putstr(" LBA=");
- io_puthex(sector);
- io_putstr(" n_sec=");
- io_puthex(n_sec);
- io_putstr(")\n");
- return -2;
- }
- copied += chunk;
- if (copied >= size)
- break;
- /* Only re-read FAT if the chain crosses into a different FAT sector. */
- {
- unsigned int need_fat_sec = fat_start + (cluster * 3) / (2 * SECTOR_SIZE);
- if (need_fat_sec != loaded_fat_sec) {
- if (fat_read_sector(need_fat_sec) != 0) {
- io_putstr("run: disk read error (FAT cluster=");
- io_puthex(cluster);
- io_putstr(" LBA=");
- io_puthex(need_fat_sec);
- io_putstr(")\n");
- return -2;
- }
- loaded_fat_sec = need_fat_sec;
- }
- }
- cluster = fat_get_entry(cluster);
- }
- return (int)copied;
- }
- /* ---- write support ---- */
- /* Read a 12-bit FAT entry for `cluster`, handling the case where the two
- * bytes straddle a FAT sector boundary. Returns 0, or -2 on disk error. */
- static int fat_entry_read(unsigned int cluster, unsigned int *value)
- {
- unsigned int byte_off = (cluster * 3) / 2;
- unsigned int sec = fat_reserved + byte_off / SECTOR_SIZE;
- unsigned int within = byte_off % SECTOR_SIZE;
- unsigned char b0, b1;
- if (within == SECTOR_SIZE - 1) {
- if (fat_read_sector(sec) != 0)
- return -2;
- b0 = sector_buf[within];
- if (fat_read_sector(sec + 1) != 0)
- return -2;
- b1 = sector_buf[0];
- } else {
- if (fat_read_sector(sec) != 0)
- return -2;
- b0 = sector_buf[within];
- b1 = sector_buf[within + 1];
- }
- if (cluster & 1)
- *value = ((unsigned int)b0 >> 4) | ((unsigned int)b1 << 4);
- else
- *value = (unsigned int)b0 | (((unsigned int)b1 & 0x0F) << 8);
- return 0;
- }
- /* Write a 12-bit FAT entry for `cluster` (read-modify-write), handling the
- * sector-boundary case. Returns 0, or -2 on disk error. */
- static int fat_entry_write(unsigned int cluster, unsigned int value)
- {
- unsigned int byte_off = (cluster * 3) / 2;
- unsigned int sec = fat_reserved + byte_off / SECTOR_SIZE;
- unsigned int within = byte_off % SECTOR_SIZE;
- value &= 0xFFF;
- if (within == SECTOR_SIZE - 1) {
- /* Entry straddles into the next FAT sector. */
- if (cluster & 1) {
- if (fat_read_sector(sec) != 0) return -2;
- sector_buf[within] = (sector_buf[within] & 0x0F) | (unsigned char)((value << 4) & 0xF0);
- if (disk_write_sectors(sec, sector_buf, 1) != 0) return -2;
- if (fat_read_sector(sec + 1) != 0) return -2;
- sector_buf[0] = (unsigned char)((value >> 4) & 0xFF);
- if (disk_write_sectors(sec + 1, sector_buf, 1) != 0) return -2;
- } else {
- if (fat_read_sector(sec) != 0) return -2;
- sector_buf[within] = (unsigned char)(value & 0xFF);
- if (disk_write_sectors(sec, sector_buf, 1) != 0) return -2;
- if (fat_read_sector(sec + 1) != 0) return -2;
- sector_buf[0] = (sector_buf[0] & 0xF0) | (unsigned char)((value >> 8) & 0x0F);
- if (disk_write_sectors(sec + 1, sector_buf, 1) != 0) return -2;
- }
- } else {
- if (fat_read_sector(sec) != 0) return -2;
- if (cluster & 1) {
- sector_buf[within] = (sector_buf[within] & 0x0F) | (unsigned char)((value << 4) & 0xF0);
- sector_buf[within + 1] = (unsigned char)((value >> 4) & 0xFF);
- } else {
- sector_buf[within] = (unsigned char)(value & 0xFF);
- sector_buf[within + 1] = (sector_buf[within + 1] & 0xF0) | (unsigned char)((value >> 8) & 0x0F);
- }
- if (disk_write_sectors(sec, sector_buf, 1) != 0) return -2;
- }
- return 0;
- }
- /* Find a free data cluster (FAT entry == 0x000). Returns cluster >= 2, -1 if
- * the disk is full, -2 on disk error. */
- static int fat_find_free_cluster(void)
- {
- unsigned int cluster;
- for (cluster = 2; cluster < fat_max_cluster; cluster++) {
- unsigned int val;
- if (fat_entry_read(cluster, &val) != 0)
- return -2;
- if (val == 0x000)
- return (int)cluster;
- }
- return -1;
- }
- /* Mark every cluster in a chain as free (0x000). */
- static int fat_free_chain(unsigned int cluster)
- {
- while (cluster >= 2 && cluster < fat_max_cluster) {
- unsigned int next;
- if (fat_entry_read(cluster, &next) != 0)
- return -2;
- if (fat_entry_write(cluster, 0x000) != 0)
- return -2;
- if (next < 2 || next >= FAT12_EOC_MIN)
- break;
- cluster = next;
- }
- return 0;
- }
- /* Read cluster/size from a 32-byte directory entry at absolute byte offset. */
- static int fat_dir_entry_read(unsigned int byte_off, unsigned int *cluster, unsigned int *size)
- {
- unsigned int lba = byte_off / SECTOR_SIZE;
- unsigned int within = byte_off % SECTOR_SIZE;
- if (fat_read_sector(lba) != 0)
- return -2;
- if (cluster)
- *cluster = (unsigned int)sector_buf[within + 26] | ((unsigned int)sector_buf[within + 27] << 8);
- if (size)
- *size = (unsigned int)sector_buf[within + 28] | ((unsigned int)sector_buf[within + 29] << 8)
- | ((unsigned int)sector_buf[within + 30] << 16) | ((unsigned int)sector_buf[within + 31] << 24);
- return 0;
- }
- /* Write a 32-byte directory entry at absolute byte offset. */
- static int fat_dir_entry_write(unsigned int byte_off, const unsigned char name[11],
- unsigned char attr, unsigned int cluster, unsigned int size)
- {
- unsigned int lba = byte_off / SECTOR_SIZE;
- unsigned int within = byte_off % SECTOR_SIZE;
- unsigned int i;
- if (fat_read_sector(lba) != 0)
- return -2;
- for (i = 0; i < 11; i++)
- sector_buf[within + i] = name[i];
- sector_buf[within + 11] = attr;
- for (i = 12; i < 26; i++)
- sector_buf[within + i] = 0;
- sector_buf[within + 26] = (unsigned char)(cluster & 0xFF);
- sector_buf[within + 27] = (unsigned char)((cluster >> 8) & 0xFF);
- sector_buf[within + 28] = (unsigned char)(size & 0xFF);
- sector_buf[within + 29] = (unsigned char)((size >> 8) & 0xFF);
- sector_buf[within + 30] = (unsigned char)((size >> 16) & 0xFF);
- sector_buf[within + 31] = (unsigned char)((size >> 24) & 0xFF);
- return (disk_write_sectors(lba, sector_buf, 1) != 0) ? -2 : 0;
- }
- /* Find the byte offset of a root entry matching `name`, or -1 / -2. */
- static int fat_find_root_entry_off(const unsigned char name[11])
- {
- unsigned int sec, off;
- for (sec = 0; sec < fat_root_sectors; sec++) {
- if (fat_read_sector(fat_root_start + sec) != 0)
- return -2;
- for (off = 0; off < SECTOR_SIZE; off += ROOT_ENTRY_SIZE) {
- unsigned char *e = sector_buf + off;
- unsigned int i;
- if (e[0] == 0x00)
- return -1;
- if (e[0] == 0xE5 || (e[11] & 0x10))
- continue;
- for (i = 0; i < 11; i++)
- if ((e[i] >= 'a' ? e[i] - 32 : e[i]) != name[i])
- break;
- if (i == 11)
- return (int)((fat_root_start + sec) * SECTOR_SIZE + off);
- }
- }
- return -1;
- }
- /* Find a free (0x00 or 0xE5) root entry; return its byte offset, -1, or -2. */
- static int fat_find_free_root_entry(void)
- {
- unsigned int sec, off;
- for (sec = 0; sec < fat_root_sectors; sec++) {
- if (fat_read_sector(fat_root_start + sec) != 0)
- return -2;
- for (off = 0; off < SECTOR_SIZE; off += ROOT_ENTRY_SIZE) {
- if (sector_buf[off] == 0x00 || sector_buf[off] == 0xE5)
- return (int)((fat_root_start + sec) * SECTOR_SIZE + off);
- }
- }
- return -1;
- }
- int fat_write_file(const char *name_8_3, const void *buf, unsigned int size)
- {
- unsigned char name[11];
- unsigned int i;
- int byte_off;
- unsigned int first_cluster = 0, prev = 0, cluster;
- unsigned int remaining = size;
- const unsigned char *src = (const unsigned char *)buf;
- if (!fat_ready || !name_8_3)
- return -1;
- for (i = 0; i < 11; i++)
- name[i] = (unsigned char)(name_8_3[i] >= 'a' && name_8_3[i] <= 'z'
- ? name_8_3[i] - 32 : name_8_3[i]);
- byte_off = fat_find_root_entry_off(name);
- if (byte_off == -2)
- return -2;
- if (byte_off >= 0) {
- /* Overwrite: free the existing chain first. */
- unsigned int old_cluster = 0;
- if (fat_dir_entry_read((unsigned int)byte_off, &old_cluster, 0) != 0)
- return -2;
- if (old_cluster >= 2)
- fat_free_chain(old_cluster);
- } else {
- byte_off = fat_find_free_root_entry();
- if (byte_off == -2)
- return -2;
- if (byte_off < 0) {
- io_putstr("write: root directory full\n");
- return -1;
- }
- }
- /* Allocate clusters, link the chain, and write the data. */
- if (remaining > 0) {
- unsigned int cluster_size = fat_sec_per_cluster * SECTOR_SIZE;
- while (remaining > 0) {
- int c = fat_find_free_cluster();
- if (c == -2)
- return -2;
- if (c < 0) {
- if (first_cluster)
- fat_free_chain(first_cluster);
- io_putstr("write: disk full\n");
- return -1;
- }
- cluster = (unsigned int)c;
- if (first_cluster == 0)
- first_cluster = cluster;
- else if (fat_entry_write(prev, cluster) != 0)
- return -2;
- {
- unsigned int chunk = (remaining < cluster_size) ? remaining : cluster_size;
- unsigned int lba = fat_data_start + (cluster - 2) * fat_sec_per_cluster;
- unsigned int full_secs = chunk / SECTOR_SIZE;
- unsigned int rem_bytes = chunk % SECTOR_SIZE;
- if (full_secs > 0) {
- if (disk_write_sectors(lba, src, full_secs) != 0)
- return -2;
- src += full_secs * SECTOR_SIZE;
- lba += full_secs;
- }
- if (rem_bytes > 0) {
- unsigned int j;
- for (j = 0; j < rem_bytes; j++)
- sector_buf[j] = src[j];
- for (j = rem_bytes; j < SECTOR_SIZE; j++)
- sector_buf[j] = 0;
- if (disk_write_sectors(lba, sector_buf, 1) != 0)
- return -2;
- src += rem_bytes;
- }
- remaining -= chunk;
- }
- prev = cluster;
- }
- if (fat_entry_write(prev, 0xFFF) != 0)
- return -2;
- }
- if (fat_dir_entry_write((unsigned int)byte_off, name, 0x20, first_cluster, size) != 0)
- return -2;
- return 0;
- }
- int fat_delete_file(const char *name_8_3)
- {
- unsigned char name[11];
- unsigned int i, cluster = 0;
- int byte_off;
- if (!fat_ready || !name_8_3)
- return -1;
- for (i = 0; i < 11; i++)
- name[i] = (unsigned char)(name_8_3[i] >= 'a' && name_8_3[i] <= 'z'
- ? name_8_3[i] - 32 : name_8_3[i]);
- byte_off = fat_find_root_entry_off(name);
- if (byte_off == -2)
- return -2;
- if (byte_off < 0)
- return -1;
- if (fat_dir_entry_read((unsigned int)byte_off, &cluster, 0) != 0)
- return -2;
- if (cluster >= 2)
- fat_free_chain(cluster);
- {
- unsigned int lba = (unsigned int)byte_off / SECTOR_SIZE;
- unsigned int within = (unsigned int)byte_off % SECTOR_SIZE;
- if (fat_read_sector(lba) != 0)
- return -2;
- sector_buf[within] = 0xE5;
- if (disk_write_sectors(lba, sector_buf, 1) != 0)
- return -2;
- }
- return 0;
- }
|