fsw_status_t fsw_memdup(void **dest_out, void *src, int len)
{
fsw_status_t status;
status = fsw_alloc(len, dest_out);
if (status)
return status;
fsw_memcpy(*dest_out, src, len);
return FSW_SUCCESS;
}
static fsw_status_t fsw_iso9660_dir_lookup(struct fsw_iso9660_volume *vol, struct fsw_iso9660_dnode *dno,
struct fsw_string *lookup_name, struct fsw_iso9660_dnode **child_dno_out)
{
fsw_status_t status;
struct fsw_shandle shand;
struct iso9660_dirrec_buffer dirrec_buffer;
struct iso9660_dirrec *dirrec = &dirrec_buffer.dirrec;
// Preconditions: The caller has checked that dno is a directory node.
// setup handle to read the directory
status = fsw_shandle_open(dno, &shand);
if (status)
return status;
// scan the directory for the file
while (1) {
// read next entry
status = fsw_iso9660_read_dirrec(vol, &shand, &dirrec_buffer);
if (status)
goto errorexit;
if (dirrec->dirrec_length == 0) {
// end of directory reached
status = FSW_NOT_FOUND;
goto errorexit;
}
// skip . and ..
if (dirrec->file_identifier_length == 1 &&
(dirrec->file_identifier[0] == 0 || dirrec->file_identifier[0] == 1))
continue;
// compare name
if (fsw_streq(lookup_name, &dirrec_buffer.name)) // TODO: compare case-insensitively
break;
}
// setup a dnode for the child item
status = fsw_dnode_create(dno, dirrec_buffer.ino, FSW_DNODE_TYPE_UNKNOWN, &dirrec_buffer.name, child_dno_out);
if (status == FSW_SUCCESS)
fsw_memcpy(&(*child_dno_out)->dirrec, dirrec, sizeof(struct iso9660_dirrec));
errorexit:
fsw_shandle_close(&shand);
return status;
}
static fsw_status_t fsw_iso9660_dir_read(struct fsw_iso9660_volume *vol, struct fsw_iso9660_dnode *dno,
struct fsw_shandle *shand, struct fsw_iso9660_dnode **child_dno_out)
{
fsw_status_t status;
struct iso9660_dirrec_buffer dirrec_buffer;
struct iso9660_dirrec *dirrec = &dirrec_buffer.dirrec;
// Preconditions: The caller has checked that dno is a directory node. The caller
// has opened a storage handle to the directory's storage and keeps it around between
// calls.
/* (vasily) directory nodes are 4096 bytes that is two logical blocks so read dir operation
* should read both blocks.
*/
while (1) {
// read next entry
if (shand->pos >= dno->g.size)
return FSW_NOT_FOUND; // end of directory
status = fsw_iso9660_read_dirrec(vol, shand, &dirrec_buffer);
if (status)
return status;
if (dirrec->dirrec_length == 0)
{
// try the next block
shand->pos =(shand->pos & ~(vol->g.log_blocksize - 1)) + vol->g.log_blocksize;
continue;
}
// skip . and ..
if (dirrec->file_identifier_length == 1 &&
(dirrec->file_identifier[0] == 0 || dirrec->file_identifier[0] == 1))
continue;
break;
}
// setup a dnode for the child item
status = fsw_dnode_create(dno, dirrec_buffer.ino, FSW_DNODE_TYPE_UNKNOWN, &dirrec_buffer.name, child_dno_out);
if (status == FSW_SUCCESS)
fsw_memcpy(&(*child_dno_out)->dirrec, dirrec, sizeof(struct iso9660_dirrec));
return status;
}
fsw_status_t fsw_strdup_coerce(struct fsw_string *dest, int type, struct fsw_string *src)
{
fsw_status_t status;
if (src->type == FSW_STRING_TYPE_EMPTY || src->len == 0) {
dest->type = type;
dest->size = dest->len = 0;
dest->data = NULL;
return FSW_SUCCESS;
}
if (src->type == type) {
dest->type = type;
dest->len = src->len;
dest->size = src->size;
status = fsw_alloc(dest->size, &dest->data);
if (status)
return status;
fsw_memcpy(dest->data, src->data, dest->size);
return FSW_SUCCESS;
}
// dispatch to type-specific functions
#define STRCOERCE_DISPATCH(type1, type2) \
if (src->type == FSW_STRING_TYPE_##type1 && type == FSW_STRING_TYPE_##type2) \
return fsw_strcoerce_##type1##_##type2(src->data, src->len, dest);
STRCOERCE_DISPATCH(UTF8, ISO88591);
STRCOERCE_DISPATCH(UTF16, ISO88591);
STRCOERCE_DISPATCH(UTF16_SWAPPED, ISO88591);
STRCOERCE_DISPATCH(ISO88591, UTF8);
STRCOERCE_DISPATCH(UTF16, UTF8);
STRCOERCE_DISPATCH(UTF16_SWAPPED, UTF8);
STRCOERCE_DISPATCH(ISO88591, UTF16);
STRCOERCE_DISPATCH(UTF8, UTF16);
STRCOERCE_DISPATCH(UTF16_SWAPPED, UTF16);
return FSW_UNSUPPORTED;
}
fsw_status_t fsw_shandle_read(struct fsw_shandle *shand, fsw_u32 *buffer_size_inout, void *buffer_in)
{
fsw_status_t status;
struct fsw_dnode *dno = shand->dnode;
struct fsw_volume *vol = dno->vol;
fsw_u8 *buffer, *block_buffer;
fsw_u32 buflen, copylen, pos;
fsw_u32 log_bno, pos_in_extent, phys_bno, pos_in_physblock;
fsw_u32 cache_level;
if (shand->pos >= dno->size) { // already at EOF
*buffer_size_inout = 0;
return FSW_SUCCESS;
}
// initialize vars
buffer = buffer_in;
buflen = *buffer_size_inout;
pos = (fsw_u32)shand->pos;
cache_level = (dno->type != FSW_DNODE_TYPE_FILE) ? 1 : 0;
// restrict read to file size
if (buflen > dno->size - pos)
buflen = (fsw_u32)(dno->size - pos);
while (buflen > 0) {
// get extent for the current logical block
log_bno = pos / vol->log_blocksize;
if (shand->extent.type == FSW_EXTENT_TYPE_INVALID ||
log_bno < shand->extent.log_start ||
log_bno >= shand->extent.log_start + shand->extent.log_count) {
if (shand->extent.type == FSW_EXTENT_TYPE_BUFFER)
fsw_free(shand->extent.buffer);
// ask the file system for the proper extent
shand->extent.log_start = log_bno;
status = vol->fstype_table->get_extent(vol, dno, &shand->extent);
if (status) {
shand->extent.type = FSW_EXTENT_TYPE_INVALID;
return status;
}
}
pos_in_extent = pos - shand->extent.log_start * vol->log_blocksize;
// dispatch by extent type
if (shand->extent.type == FSW_EXTENT_TYPE_PHYSBLOCK) {
// convert to physical block number and offset
phys_bno = shand->extent.phys_start + pos_in_extent / vol->phys_blocksize;
pos_in_physblock = pos_in_extent & (vol->phys_blocksize - 1);
copylen = vol->phys_blocksize - pos_in_physblock;
if (copylen > buflen)
copylen = buflen;
// get one physical block
status = fsw_block_get(vol, phys_bno, cache_level, (void **)&block_buffer);
if (status)
return status;
// copy data from it
fsw_memcpy(buffer, block_buffer + pos_in_physblock, copylen);
fsw_block_release(vol, phys_bno, block_buffer);
} else if (shand->extent.type == FSW_EXTENT_TYPE_BUFFER) {
copylen = shand->extent.log_count * vol->log_blocksize - pos_in_extent;
if (copylen > buflen)
copylen = buflen;
fsw_memcpy(buffer, (fsw_u8 *)shand->extent.buffer + pos_in_extent, copylen);
} else { // _SPARSE or _INVALID
copylen = shand->extent.log_count * vol->log_blocksize - pos_in_extent;
if (copylen > buflen)
copylen = buflen;
fsw_memzero(buffer, copylen);
}
buffer += copylen;
buflen -= copylen;
pos += copylen;
}
*buffer_size_inout = (fsw_u32)(pos - shand->pos);
shand->pos = pos;
return FSW_SUCCESS;
}
fsw_status_t fsw_block_get(struct VOLSTRUCTNAME *vol, fsw_u32 phys_bno, fsw_u32 cache_level, void **buffer_out)
{
fsw_status_t status;
fsw_u32 i, discard_level, new_bcache_size;
struct fsw_blockcache *new_bcache;
/// @todo allow the host driver to do its own caching; just call through if
// the appropriate function pointers are set
if (cache_level > MAX_CACHE_LEVEL)
cache_level = MAX_CACHE_LEVEL;
// check block cache
for (i = 0; i < vol->bcache_size; i++) {
if (vol->bcache[i].phys_bno == phys_bno) {
// cache hit!
if (vol->bcache[i].cache_level < cache_level)
vol->bcache[i].cache_level = cache_level; // promote the entry
vol->bcache[i].refcount++;
*buffer_out = vol->bcache[i].data;
return FSW_SUCCESS;
}
}
// find a free entry in the cache table
for (i = 0; i < vol->bcache_size; i++) {
if (vol->bcache[i].phys_bno == FSW_INVALID_BNO)
break;
}
if (i >= vol->bcache_size) {
for (discard_level = 0; discard_level <= MAX_CACHE_LEVEL; discard_level++) {
for (i = 0; i < vol->bcache_size; i++) {
if (vol->bcache[i].refcount == 0 && vol->bcache[i].cache_level <= discard_level)
break;
}
if (i < vol->bcache_size)
break;
}
}
if (i >= vol->bcache_size) {
// enlarge / create the cache
if (vol->bcache_size < 16)
new_bcache_size = 16;
else
new_bcache_size = vol->bcache_size << 1;
status = fsw_alloc(new_bcache_size * sizeof(struct fsw_blockcache), &new_bcache);
if (status)
return status;
if (vol->bcache_size > 0)
fsw_memcpy(new_bcache, vol->bcache, vol->bcache_size * sizeof(struct fsw_blockcache));
for (i = vol->bcache_size; i < new_bcache_size; i++) {
new_bcache[i].refcount = 0;
new_bcache[i].cache_level = 0;
new_bcache[i].phys_bno = FSW_INVALID_BNO;
new_bcache[i].data = NULL;
}
i = vol->bcache_size;
// switch caches
if (vol->bcache != NULL)
fsw_free(vol->bcache);
vol->bcache = new_bcache;
vol->bcache_size = new_bcache_size;
}
vol->bcache[i].phys_bno = FSW_INVALID_BNO;
// read the data
if (vol->bcache[i].data == NULL) {
status = fsw_alloc(vol->phys_blocksize, &vol->bcache[i].data);
if (status)
return status;
}
status = vol->host_table->read_block(vol, phys_bno, vol->bcache[i].data);
if (status)
return status;
vol->bcache[i].phys_bno = phys_bno;
vol->bcache[i].cache_level = cache_level;
vol->bcache[i].refcount = 1;
*buffer_out = vol->bcache[i].data;
return FSW_SUCCESS;
}
static fsw_status_t fsw_iso9660_volume_mount(struct fsw_iso9660_volume *vol)
{
fsw_status_t status;
void *buffer;
fsw_u32 blockno;
struct iso9660_volume_descriptor *voldesc;
struct iso9660_primary_volume_descriptor *pvoldesc;
fsw_u32 voldesc_type;
int i;
struct fsw_string s;
struct iso9660_dirrec rootdir;
int sua_pos;
char *sig;
int skip;
struct fsw_rock_ridge_susp_entry *entry;
// read through the Volume Descriptor Set
fsw_set_blocksize(vol, ISO9660_BLOCKSIZE, ISO9660_BLOCKSIZE);
blockno = ISO9660_SUPERBLOCK_BLOCKNO;
do {
status = fsw_block_get(vol, blockno, 0, &buffer);
if (status)
return status;
voldesc = (struct iso9660_volume_descriptor *)buffer;
voldesc_type = voldesc->volume_descriptor_type;
if (fsw_memeq(voldesc->standard_identifier, "CD001", 5)) {
// descriptor follows ISO 9660 standard
if (voldesc_type == 1 && voldesc->volume_descriptor_version == 1) {
// suitable Primary Volume Descriptor found
if (vol->primary_voldesc) {
fsw_free(vol->primary_voldesc);
vol->primary_voldesc = NULL;
}
status = fsw_memdup((void **)&vol->primary_voldesc, voldesc, ISO9660_BLOCKSIZE);
}
} else if (!fsw_memeq(voldesc->standard_identifier, "CD", 2)) {
// completely alien standard identifier, stop reading
voldesc_type = 255;
}
fsw_block_release(vol, blockno, buffer);
blockno++;
} while (!status && voldesc_type != 255);
if (status)
return status;
// get information from Primary Volume Descriptor
if (vol->primary_voldesc == NULL)
return FSW_UNSUPPORTED;
pvoldesc = vol->primary_voldesc;
if (ISOINT(pvoldesc->logical_block_size) != 2048)
return FSW_UNSUPPORTED;
// get volume name
for (i = 32; i > 0; i--)
if (pvoldesc->volume_identifier[i-1] != ' ')
break;
s.type = FSW_STRING_TYPE_ISO88591;
s.size = s.len = i;
s.data = pvoldesc->volume_identifier;
status = fsw_strdup_coerce(&vol->g.label, vol->g.host_string_type, &s);
if (status)
return status;
// setup the root dnode
status = fsw_dnode_create_root(vol, ISO9660_SUPERBLOCK_BLOCKNO << ISO9660_BLOCKSIZE_BITS, &vol->g.root);
if (status)
return status;
fsw_memcpy(&vol->g.root->dirrec, &pvoldesc->root_directory, sizeof(struct iso9660_dirrec));
if ( pvoldesc->escape[0] == 0x25
&& pvoldesc->escape[1] == 0x2f
&& ( pvoldesc->escape[2] == 0x40
|| pvoldesc->escape[2] == 0x43
|| pvoldesc->escape[2] == 0x45))
{
FSW_MSG_DEBUG((FSW_MSGSTR("fsw_iso9660_volume_mount: success (joliet!!!)\n")));
vol->fJoliet = 1;
}
fsw_memcpy(&rootdir, &pvoldesc->root_directory, sizeof(rootdir));
sua_pos = (sizeof(struct iso9660_dirrec)) + rootdir.file_identifier_length + (rootdir.file_identifier_length % 2) - 2;
//int sua_size = rootdir.dirrec_length - rootdir.file_identifier_length;
//FSW_MSG_DEBUG((FSW_MSGSTR("fsw_iso9660_volume_mount: success (SUA(pos:%x, sz:%d)!!!)\n"), sua_pos, sua_size));
#if 1
status = fsw_block_get(vol, ISOINT(rootdir.extent_location), 0, &buffer);
sig = (char *)buffer + sua_pos;
skip = 0;
entry = (struct fsw_rock_ridge_susp_entry *)sig;
if ( entry->sig[0] == 'S'
&& entry->sig[1] == 'P')
{
struct fsw_rock_ridge_susp_sp *sp = (struct fsw_rock_ridge_susp_sp *)entry;
if (sp->magic[0] == 0xbe && sp->magic[1] == 0xef)
{
vol->fRockRidge = 1;
} else {
FSW_MSG_DEBUG((FSW_MSGSTR("fsw_iso9660_volume_mount: SP magic isn't valid\n")));
}
skip = sp->skip;
}
#endif
// release volume descriptors
fsw_free(vol->primary_voldesc);
vol->primary_voldesc = NULL;
FSW_MSG_DEBUG((FSW_MSGSTR("fsw_iso9660_volume_mount: success\n")));
return FSW_SUCCESS;
}
static fsw_status_t rr_find_nm(struct fsw_iso9660_volume *vol, struct iso9660_dirrec *dirrec, int off, struct fsw_string *str)
{
fsw_u8 *r, *begin;
int fCe = 0;
struct fsw_rock_ridge_susp_nm *nm;
int limit = dirrec->dirrec_length;
begin = (fsw_u8 *)dirrec;
r = (fsw_u8 *)dirrec + off;
str->data = NULL;
str->len = 0;
str->size = 0;
str->type = 0;
while(off < limit)
{
if (r[0] == 'C' && r[1] == 'E' && r[2] == 28)
{
int rc;
int ce_off;
union fsw_rock_ridge_susp_ce *ce;
if (fCe == 0)
fsw_alloc_zero(ISO9660_BLOCKSIZE, (void *)&begin);
fCe = 1;
DEBUG((DEBUG_WARN, "%a:%d we found CE before NM or its continuation\n", __FILE__, __LINE__));
ce = (union fsw_rock_ridge_susp_ce *)r;
limit = ISOINT(ce->X.len);
ce_off = ISOINT(ce->X.offset);
rc = rr_read_ce(vol, ce, begin);
if (rc != FSW_SUCCESS)
{
fsw_free(begin);
return rc;
}
begin += ce_off;
r = begin;
}
if (r[0] == 'N' && r[1] == 'M')
{
nm = (struct fsw_rock_ridge_susp_nm *)r;
if( nm->e.sig[0] == 'N'
&& nm->e.sig[1] == 'M')
{
int len = 0;
fsw_u8 *tmp = NULL;
if (nm->flags & RR_NM_CURR)
{
fsw_memdup(str->data, ".", 1);
str->len = 1;
goto done;
}
if (nm->flags & RR_NM_PARE)
{
fsw_memdup(str->data, "..", 2);
str->len = 2;
goto done;
}
len = nm->e.len - sizeof(struct fsw_rock_ridge_susp_nm) + 1;
fsw_alloc_zero(str->len + len, (void **)&tmp);
if (str->data != NULL)
{
fsw_memcpy(tmp, str->data, str->len);
fsw_free(str->data);
}
DEBUG((DEBUG_INFO, "dst:%p src:%p len:%d\n", tmp + str->len, &nm->name[0], len));
fsw_memcpy(tmp + str->len, &nm->name[0], len);
str->data = tmp;
str->len += len;
if ((nm->flags & RR_NM_CONT) == 0)
goto done;
}
}
r++;
off = (int)(r - (fsw_u8 *)begin);
}
if(fCe == 1)
fsw_free(begin);
return FSW_NOT_FOUND;
done:
str->type = FSW_STRING_TYPE_ISO88591;
str->size = str->len;
if(fCe == 1)
fsw_free(begin);
return FSW_SUCCESS;
}
static fsw_status_t fsw_ext2_volume_mount(struct fsw_ext2_volume *vol)
{
fsw_status_t status;
void *buffer;
fsw_u32 blocksize;
fsw_u32 groupcnt, groupno, gdesc_per_block, gdesc_bno, gdesc_index;
struct ext2_group_desc *gdesc;
int i;
struct fsw_string s;
// allocate memory to keep the superblock around
status = fsw_alloc(sizeof(struct ext2_super_block), &vol->sb);
if (status)
return status;
// read the superblock into its buffer
fsw_set_blocksize(vol, EXT2_SUPERBLOCK_BLOCKSIZE, EXT2_SUPERBLOCK_BLOCKSIZE);
status = fsw_block_get(vol, EXT2_SUPERBLOCK_BLOCKNO, 0, &buffer);
if (status)
return status;
fsw_memcpy(vol->sb, buffer, sizeof(struct ext2_super_block));
fsw_block_release(vol, EXT2_SUPERBLOCK_BLOCKNO, buffer);
// check the superblock
if (vol->sb->s_magic != EXT2_SUPER_MAGIC)
return FSW_UNSUPPORTED;
if (vol->sb->s_rev_level != EXT2_GOOD_OLD_REV &&
vol->sb->s_rev_level != EXT2_DYNAMIC_REV)
return FSW_UNSUPPORTED;
if (vol->sb->s_rev_level == EXT2_DYNAMIC_REV &&
(vol->sb->s_feature_incompat & ~(EXT2_FEATURE_INCOMPAT_FILETYPE | EXT3_FEATURE_INCOMPAT_RECOVER)))
return FSW_UNSUPPORTED;
/*
if (vol->sb->s_rev_level == EXT2_DYNAMIC_REV &&
(vol->sb->s_feature_incompat & EXT3_FEATURE_INCOMPAT_RECOVER))
Print(L"Ext2 WARNING: This ext3 file system needs recovery, trying to use it anyway.\n");
*/
// set real blocksize
blocksize = EXT2_BLOCK_SIZE(vol->sb);
fsw_set_blocksize(vol, blocksize, blocksize);
// get other info from superblock
vol->ind_bcnt = EXT2_ADDR_PER_BLOCK(vol->sb);
vol->dind_bcnt = vol->ind_bcnt * vol->ind_bcnt;
vol->inode_size = EXT2_INODE_SIZE(vol->sb);
for (i = 0; i < 16; i++)
if (vol->sb->s_volume_name[i] == 0)
break;
s.type = FSW_STRING_TYPE_ISO88591;
s.size = s.len = i;
s.data = vol->sb->s_volume_name;
status = fsw_strdup_coerce(&vol->g.label, vol->g.host_string_type, &s);
if (status)
return status;
// read the group descriptors to get inode table offsets
groupcnt = ((vol->sb->s_inodes_count - 2) / vol->sb->s_inodes_per_group) + 1;
gdesc_per_block = (vol->g.phys_blocksize / sizeof(struct ext2_group_desc));
status = fsw_alloc(sizeof(fsw_u32) * groupcnt, &vol->inotab_bno);
if (status)
return status;
for (groupno = 0; groupno < groupcnt; groupno++) {
// get the block group descriptor
gdesc_bno = (vol->sb->s_first_data_block + 1) + groupno / gdesc_per_block;
gdesc_index = groupno % gdesc_per_block;
status = fsw_block_get(vol, gdesc_bno, 1, (void **)&buffer);
if (status)
return status;
gdesc = ((struct ext2_group_desc *)(buffer)) + gdesc_index;
vol->inotab_bno[groupno] = gdesc->bg_inode_table;
fsw_block_release(vol, gdesc_bno, buffer);
}
// setup the root dnode
status = fsw_dnode_create_root(vol, EXT2_ROOT_INO, &vol->g.root);
if (status)
return status;
FSW_MSG_DEBUG((FSW_MSGSTR("fsw_ext2_volume_mount: success, blocksize %d\n"), blocksize));
return FSW_SUCCESS;
}
