#include "FATFS.class.h"
#include <VTManager/SimpleVT.class.h>
#include "FATFileNode.class.h"
#include "FATDirectoryNode.class.h"
#include <VFS/VFS.ns.h>
#include <ByteArray.class.h>
#define FIRSTCLUS(node) ((u32int&)(node->type() == NT_DIRECTORY ? \
((FATDirectoryNode*)(node))->m_firstCluster : \
((FATFileNode*)(node))->m_firstCluster))
#define FIRSTDEID(node) ((u32int&)(node->type() == NT_DIRECTORY ? \
((FATDirectoryNode*)(node))->m_firstDirEntryID : \
((FATFileNode*)(node))->m_firstDirEntryID))
FileSystem* FATFS::mount(Partition* p, DirectoryNode* mountpoint, bool readwrite) {
if (readwrite) return 0;
if (mountpoint != 0 and !mountpoint->mountpointable()) return 0;
// *** READ BOOT SECTOR ***
union {
fat_BS_t s;
u8int c[512];
} bs;
if (!p->readBlocks(0, 1, bs.c)) return 0;
// *** CHECK FILESYSTEM TYPE ***
if (bs.s.extBS_16.boot_signature != 0x28 and bs.s.extBS_16.boot_signature != 0x29
and bs.s.extBS_32.boot_signature != 0x28 and bs.s.extBS_32.boot_signature != 0x29) return 0;
// *** DO SOME CALCULATIONS ***
FATFS* fs = new FATFS(p);
fs->m_fatSize = (bs.s.table_size_16 == 0 ? bs.s.extBS_32.table_size_32 : bs.s.table_size_16);
fs->m_totalSectors = (bs.s.total_sectors_16 == 0 ? bs.s.total_sectors_32 : bs.s.total_sectors_16);
fs->m_rootDirSectors = ((bs.s.root_entry_count * 32) + (bs.s.bytes_per_sector - 1)) / bs.s.bytes_per_sector;
fs->m_firstDataSector = bs.s.reserved_sector_count + (fs->m_fatSize * bs.s.table_count);
fs->m_clusterSize = bs.s.bytes_per_sector * bs.s.sectors_per_cluster;
u32int dataSectors = fs->m_totalSectors - (fs->m_firstDataSector + fs->m_rootDirSectors);
fs->m_countOfClusters = dataSectors / bs.s.sectors_per_cluster;
if (fs->m_countOfClusters < 4085) { //Find out FAT type
fs->m_fatType = 12;
} else if (fs->m_countOfClusters < 65525) {
fs->m_fatType = 16;
} else {
fs->m_fatType = 32;
}
fs->m_readOnly = true;
fs->m_bs = bs.s;
// *** CREATE ROOT DIRECTORY NODE ***
fs->m_rootNode = new FATDirectoryNode("/", fs, mountpoint);
FIRSTCLUS(fs->m_rootNode) = 2;
if (fs->m_fatType == 32) FIRSTCLUS(fs->m_rootNode) = bs.s.extBS_32.root_cluster;
if (!fs->m_rootNode->loadContent()) {
*kvt << "Could not read FAT filesystem root directory.\n";
delete fs;
return 0;
}
fs->m_fatCache.init(fs->m_fatType == 12 ? 8 : (fs->m_fatType == 16 ? 20 : 40));
if (mountpoint != 0) mountpoint->mount(fs->m_rootNode);
VFS::registerFilesystem(fs);
*kvt << "Detected a FAT" << (s64int)fs->m_fatType << " filesystem.\n" <<
"root_dir_sectors:" << fs->m_rootDirSectors << " fat_size:" << fs->m_fatSize << " total_sectors:" <<
fs->m_totalSectors << " data_sectors:" << dataSectors << " count_of_clusters:" << fs->m_countOfClusters <<
" sizeof(fat_dir_entry_t):" << sizeof(fat_dir_entry_t) << " first_data_sector:" << fs->m_firstDataSector <<
" cluster_size:" << fs->m_clusterSize << "\n";
return fs;
}
u32int FATFS::nextCluster(u32int cluster) {
u8int fat_table[m_part->blockSize()];
u32int val;
if (m_fatType == 12) {
u32int fat_offset = cluster + (cluster / 2);
u32int fat_sector = m_bs.reserved_sector_count + (fat_offset / m_part->blockSize());
u32int ent_offset = fat_offset % m_part->blockSize();
m_fatCache.readBlocks(fat_sector, 1, fat_table);
u16int tblval = *(u16int*)&fat_table[ent_offset];
if (cluster & 1) val = tblval >> 4;
else val = tblval & 0x0FFF;
if (val >= 0xFF7) val = 0;
} else if (m_fatType == 16) {
u32int fat_offset = cluster * 2;
u32int fat_sector = m_bs.reserved_sector_count + (fat_offset / m_part->blockSize());
u32int ent_offset = fat_offset % m_part->blockSize();
m_fatCache.readBlocks(fat_sector, 1, fat_table);
u16int tblval = *(u16int*)&fat_table[ent_offset];
val = tblval;
if (tblval >= 0xFFF7) val = 0;
} else if (m_fatType == 32) {
u32int fat_offset = cluster * 4;
u32int fat_sector = m_bs.reserved_sector_count + (fat_offset / m_part->blockSize());
u32int ent_offset = fat_offset % m_part->blockSize();
m_fatCache.readBlocks(fat_sector, 1, fat_table);
val = *(u32int*)&fat_table[ent_offset] & 0x0FFFFFFF;
if (val >= 0x0FFFFFF7) val = 0;
}
return val;
}
bool FATFS::readCluster(u32int cluster, u8int* data) {
u32int firstSector = ((cluster - 2) * m_bs.sectors_per_cluster) + m_firstDataSector;
if (cluster > 2 and m_fatType != 32) firstSector += m_rootDirSectors;
return m_part->readBlocks(firstSector, m_bs.sectors_per_cluster, data);
}
bool FATFS::unmount() {
if (m_readOnly) return true;
return false;
}
bool FATFS::setName(FSNode* node, String name) {
if (m_readOnly) return false;
return false;
}
bool FATFS::setPermissions(FSNode* node, u32int permissions) {
if (m_readOnly) return false;
return false;
}
bool FATFS::setUid(FSNode* node, u32int uid) {
if (m_readOnly) return false;
return false;
}
bool FATFS::setGid(FSNode* node, u32int gid) {
if (m_readOnly) return false;
return false;
}
bool FATFS::setParent(FSNode* node, FSNode* parent) {
if (m_readOnly) return false;
return false;
}
u32int FATFS::read(FileNode* file, u64int position, u32int max_length, u8int *data) {
u32int len = max_length;
if (position >= file->getLength()) return 0;
if (position + len > file->getLength()) len = file->getLength() - position;
u32int firstCluster = position / m_clusterSize, clusterOffset = position % m_clusterSize;
u32int clusters = (len + clusterOffset) / m_clusterSize + 1, lastClusBytesToRead = (len + clusterOffset) % m_clusterSize;
u32int clust = FIRSTCLUS(file);
//Find first cluster
for (u32int i = 0; i < firstCluster and clust != 0; i++) clust = nextCluster(clust);
if (clust == 0) return 0;
//Read first cluster
u8int* temp = (u8int*)Mem::alloc(m_clusterSize);
readCluster(clust, temp);
memcpy(data, temp + clusterOffset, (len > m_clusterSize - clusterOffset ? m_clusterSize - clusterOffset : len));
//Read next cluster
u32int pos = (m_clusterSize - clusterOffset);
for (u32int i = 1; i < clusters; i++) {
clust = nextCluster(clust);
if (clust == 0) break;
readCluster(clust, temp);
memcpy(data + pos, temp, (i == clusters - 1 ? lastClusBytesToRead : m_clusterSize));
pos += m_clusterSize;
}
Mem::free(temp);
return len;
}
bool FATFS::write(FileNode* file, u64int position, u32int length, u8int* data) {
if (m_readOnly) return false;
return false;
}
bool FATFS::truncate(FileNode* file) {
if (m_readOnly) return false;
return false;
}
bool FATFS::loadContents(DirectoryNode* dir) {
u32int cluster = FIRSTCLUS(dir);
union {
u8int *c;
fat_dir_entry_t *e;
} e;
u32int entries = m_clusterSize / sizeof(fat_dir_entry_t);
if (cluster == 2 and m_fatType != 32) { //This is the value we use for the root directory
e.c = (u8int*)Mem::alloc(m_rootDirSectors * m_part->blockSize());
if (!m_part->readBlocks(m_firstDataSector, m_rootDirSectors, e.c)) return false;
} else {
e.c = (u8int*)Mem::alloc(m_clusterSize);
}
ByteArray lfnBuffer;
while (cluster != 0) {
if (cluster != 2 or m_fatType == 32) {
if (!readCluster(cluster, e.c)) return false;
}
for (u32int i = 0; i < entries; i++) {
if (e.e[i].attributes == FA_LFN && e.c[i*32] != 0xE5) { //Long file name entry
u8int num = e.c[i*32] & 0x3;
if (lfnBuffer.size() < num * 26) lfnBuffer.resize(num * 26);
num--;
memcpy(lfnBuffer + (num * 26), e.c + (i*32 + 1), 10);
memcpy(lfnBuffer + (num * 26 + 10), e.c + (i*32 + 14), 12);
memcpy(lfnBuffer + (num * 26 + 22), e.c + (i*32 + 28), 4);
}
if (e.e[i].attributes & FA_VOLUMEID) continue;
if (e.e[i].name[0] == 0 or e.e[i].name[0] == 0xE5) continue; //Nothing intresting here.
String name;
if (lfnBuffer.empty()) {
for (int j = 0; j < 8; j++) {
if (e.e[i].name[j] == ' ') break;
name += WChar(e.e[i].name[j]);
}
for (int j = 0; j < 3; j++) {
if (e.e[i].extension[j] == ' ') break;
if (j == 0) name += ".";
name += WChar(e.e[i].extension[j]);
}
} else {
name = lfnBuffer.toString(UE_UTF16_LE);
lfnBuffer.clear();
}
u32int first_clus = (e.e[i].first_clust_high << 16) + e.e[i].first_clust_low;
FSNode* n;
if (e.e[i].attributes & FA_DIRECTORY) {
if (name == "." or name == "..") continue;
n = new FATDirectoryNode(name, this, dir);
} else {
n = new FATFileNode(name, this, dir, e.e[i].size);
}
FIRSTCLUS(n) = first_clus;
dir->getChildren().push(n);
}
if (cluster == 2 && m_fatType != 32) break; //We are in a FAT12/16 root directory
cluster = nextCluster(cluster);
}
Mem::free(e.c);
return true;
}
FileNode* FATFS::createFile(DirectoryNode* parent, String name) {
if (m_readOnly) return false;
return 0;
}
DirectoryNode* FATFS::createDirectory(DirectoryNode* parent, String name) {
if (m_readOnly) return false;
return 0;
}
bool FATFS::remove(DirectoryNode* parent, FSNode* node) {
if (m_readOnly) return false;
return false;
}
