FreeCalypso > hg > freecalypso-sw
changeset 211:847e2585a0f2
gsm-fw/services/ffs: core.c integrated
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Thu, 26 Dec 2013 07:23:38 +0000 |
parents | 1d87b335fc50 |
children | 3ebe6409e8bc |
files | gsm-fw/services/ffs/Makefile gsm-fw/services/ffs/core.c gsm-fw/services/ffs/core.h gsm-fw/services/ffs/tmffs.h |
diffstat | 4 files changed, 2297 insertions(+), 13 deletions(-) [+] |
line wrap: on
line diff
--- a/gsm-fw/services/ffs/Makefile Thu Dec 26 04:37:10 2013 +0000 +++ b/gsm-fw/services/ffs/Makefile Thu Dec 26 07:23:38 2013 +0000 @@ -2,10 +2,10 @@ CFLAGS= -O2 -fno-builtin -mthumb-interwork -mthumb LD= arm-elf-ld -OBJS= cfgffs.o drv.o +OBJS= cfgffs.o core.o drv.o HDRS= core.h drv.h ffs.h ffs_api.h ffs_env.h ffs_pool_size.h ffstrace.h \ - intctl.h ramffs.h + intctl.h ramffs.h tmffs.h all: xipcode.o
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/gsm-fw/services/ffs/core.c Thu Dec 26 07:23:38 2013 +0000 @@ -0,0 +1,2141 @@ +/****************************************************************************** + * Flash File System (ffs) + * Idea, design and coding by Mads Meisner-Jensen, mmj@ti.com + * + * FFS core functions (not public) + * + * $Id: core.c 1.156.1.13.1.1.1.50 Thu, 08 Jan 2004 15:05:23 +0100 tsj $ + * + ******************************************************************************/ + +#include "ffs.h" +#include "core.h" +#include "drv.h" +#include "ffstrace.h" +#include "tmffs.h" +#include <string.h> +#include <limits.h> + +/****************************************************************************** + * Globals + ******************************************************************************/ + +struct fs_s fs; +struct block_stat_s bstat[FFS_BLOCKS_MAX]; + +struct ffs_stats_s stats; + +// The following line is automatically expanded by the revision control +// system to make a unique ffs revision. The revision can be retrieved by +// ffs_query(). + +//$Format: "static const uint16 ffs_revision = ($ProjectMajorVersion$<<12)|(0x$ProjectMinorVersion$);"$ +static const uint16 ffs_revision = (5<<12)|(0x56); + + +/****************************************************************************** + * Main Functions + ******************************************************************************/ + +// Create a new ffs object (object type is undefined) +iref_t object_create(const char *name, const char *buf, int size, iref_t dir) +{ + iref_t i; + struct inode_s *ip; + int realsize, namelength; + offset_t offset; + char *dataaddr; + char is_journal; + char name_copy[FFS_FILENAME_MAX + 1]; // NOTEME: make dynamic? + + ttw(ttr(TTrObj, "ocr(%s){" NL, name)); + tw(tr(TR_BEGIN, TrObject, "object_create('%s', ?, %d, %d) {\n", + name, size, dir)); + + // NOTEME: special case just for format()!? + if (dir == 0) + namelength = ffs_strlen(name); + else + namelength = is_filename(name); + + if (namelength < 0) { + tw(tr(TR_END, TrObject, "} %d\n", namelength)); + ttw(ttr(TTrObj, "} %d" NL, namelength)); + return namelength; + } + + is_journal = (name[0] == '.' && ffs_strcmp(name, FFS_JOURNAL_NAME) == 0); + if (is_journal) + tw(tr(TR_FUNC, TrObject, "Journal file creation!\n")); + else + if (buf == NULL && size > 0) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_INVALID)); + ttw(ttr(TTrObj, "} %d" NL, EFFS_INVALID)); + return EFFS_INVALID; + } + + // We don't write the data null_terminator if no data exists + realsize = namelength + 1 + size + (size > 0 ? 1 : 0); + fs.journal.size = realsize = atomalign(realsize); + + // We save the diri in the ram journal because this will be updated if + // chunk_alloc trigger a data_reclaim + fs.journal.diri = dir; + + // We have to make a local copy of name because name can be destroyed if + // it points into an object that is relocated by an ffs_data_reclaim. + memcpy(name_copy, name, ffs_strlen(name) + 1); + + if ((i = chunk_alloc(realsize, is_journal, &offset)) < 0) + return i; + + ip = inode_addr(i); + + // Write filename including null-terminator + ffsdrv.write(addr2name(offset2addr(offset)), name_copy, namelength + 1); + + // Write data and null terminator. We null-terminate the data block, + // such that blocks_fsck() can determine the amount of used data block + // space correctly. Note that we don't write null-terminator for objects + // with no data, e.g. empty files and directories. + if (size > 0) { + dataaddr = addr2name(offset2addr(offset)) + namelength + 1; + // Do NOT write data if we are creating the journal file --- it must + // be created as empty! + if (!is_journal) + ffsdrv.write(dataaddr, buf, size); + ffsdrv_write_byte(dataaddr + size, 0); + } + + // Insert object in parent directory if this is not the root dir + if (dir != 0) + fs.journal.diri = dir_traverse(fs.journal.diri, 0); + else + fs.journal.diri = 0; + + tw(tr(TR_END, TrObject, "} %d\n", i)); + ttw(ttr(TTrObj, "} %d" NL,i)); + + return i; +} + +int file_read(const char *name, void *addr, int size) +{ + int size_read, object_size, total_read = 0; + iref_t i, dir; + char *not_used; + fd_t fdi; + + if (size < 0) + return EFFS_INVALID; + + if ((i = object_lookup(name, ¬_used, &dir)) < 0) + return i; + + if ((fdi = get_fdi(i)) >= 0) + if (is_open_option(fs.fd[fdi].options, FFS_O_WRONLY)) + return EFFS_LOCKED; + + object_size = object_datasize(i); + + do { + size_read = segment_read(i, (char*)addr + total_read, + size - total_read, 0); + total_read += size_read; + } while ((i = segment_next(i)) != 0 && size > total_read); + + // Did we read the comlete object? + if (object_size > size) + return EFFS_FILETOOBIG; + + return total_read; // number of bytes read +} + + +int stream_read(fd_t fdi, void *src, int size) +{ + int offset, size_read = 0, copied = 0; + iref_t i; + + if (!is_fd_valid(fdi)) + return EFFS_BADFD; + + if (!is_open_option(fs.fd[fdi].options, FFS_O_RDONLY)) + return EFFS_INVALID; + + if (src == NULL || size < 0) + return EFFS_INVALID; + + // NOTEME: do this in another way? + // No data to read because fp is ad eof. + if (fs.fd[fdi].fp >= fs.fd[fdi].size) { + tw(tr(TR_FUNC, TrObject, "eof(no data read)\n")); + return 0; + } + + segfile_seek(fs.fd[fdi].seghead, fs.fd[fdi].fp, &i, &offset); + + // Read data from chunks or buffer until all data is read or eof is reach. + do { + if (is_offset_in_buf(fs.fd[fdi].fp, fdi)) { + offset = fs.fd[fdi].fp - fs.fd[fdi].wfp; + size_read = size - copied; // requested data that is left + // Saturate size to max left in buf or max left to eof + if (size_read > (fs.chunk_size_max - offset)) + size_read = fs.chunk_size_max - offset; + if (size_read > (fs.fd[fdi].size - fs.fd[fdi].fp)) + size_read = fs.fd[fdi].size - fs.fd[fdi].fp; + + memcpy((char*)src + copied, fs.fd[fdi].buf + offset, size_read); + } + else { + // Data is only in the chunk + size_read = segment_read(i, (char*) src + copied, + size - copied, offset); + } + + offset = 0; + fs.fd[fdi].fp += size_read; + copied += size_read; + + if ((i = segment_next(i)) < 0) + return i; + + } while (copied != size && fs.fd[fdi].fp < fs.fd[fdi].size); + + if (copied == size) { + tw(tr(TR_FUNC, TrObject, "All requested data has been read\n")); + } + if (fs.fd[fdi].fp >= fs.fd[fdi].size) { + tw(tr(TR_FUNC, TrObject, "eof\n")); + } + + return copied; // number of bytes read +} + + +int object_read(const char *name, char *buf, int size, int linkflag) +{ + iref_t i; + struct inode_s *ip; + struct xstat_s stat; + char *p; + + tw(tr(TR_BEGIN, TrObject, "object_read('%s', 0x%x, %d, %d) {\n", + name, buf, size, linkflag)); + + if (buf == NULL || size < 0) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_INVALID)); + return EFFS_INVALID; + } + + i = object_stat(name, &stat, linkflag, 0, 0); + if (i < 0) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_NOTFOUND)); + return i; + } + + ip = inode_addr(i); + + if (stat.size > size) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_FILETOOBIG)); + return EFFS_FILETOOBIG; + } + + // return error if called as readlink() and object is not a link + if (!is_object(ip, OT_LINK) && linkflag) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_INVALID)); + return EFFS_INVALID; + } + + // Even though the ffs architecture allows to have data in directory + // objects, we don't want to complicate matters, so we return an error + if (is_object(ip, OT_DIR) && !(fs.flags & FS_DIR_DATA)) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_NOTAFILE)); + return EFFS_NOTAFILE; + } + + p = offset2addr(location2offset(ip->location)); + size = stat.size; + + p = addr2data(p, ip); + + // Copy data. NOTEME: Should be optimized! + while (size--) + *buf++ = *p++; + + tw(tr(TR_END, TrObject, "} %d\n", stat.size)); + return stat.size; +} + + +// Convert an object data addres to pure data address +char *addr2data(const char *addr, const struct inode_s *ip) +{ + // OT_SEGMENT is pure data so it do not have any name to skip + if (!is_object(ip, OT_SEGMENT)) { + while (*addr++) + ; + } + + return (char *) addr; +} + +// Calculate exact size of file data; without filename and null terminator +// and without data null terminator and succeeding alignment padding. +// NOTEME: Does this also work for empty files and directories? +int object_datasize(iref_t i) +{ + iref_t not_used; + return segfile_seek(i, INT_MAX, ¬_used, 0); +} + +iref_t object_stat(const char *name, struct xstat_s *stat, + int linkflag, int fdi, int extended) +{ + iref_t i; + fd_t other_fdi; + struct inode_s *ip; + + tw(tr(TR_BEGIN, TrObject, "object_stat('%s', ?, %x, %d, %d) {\n", + name, linkflag, fdi, extended)); + + if (stat == NULL) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_INVALID)); + return EFFS_INVALID; + } + + if (linkflag) + i = object_lookup_once(name, 0, 0); + else if (name == 0) { + fdi -= FFS_FD_OFFSET; + if (!is_fd_valid(fdi)) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_BADFD)); + return EFFS_BADFD; + } + i = fs.fd[fdi].seghead; + } + else + i = object_lookup(name, 0, 0); + + if (i > 0) { + ip = inode_addr(i); + stat->type = ip->flags & OT_MASK;; + stat->flags = ~ip->flags & OF_MASK; + stat->inode = i; + + // If the file is open so get the size from the file descriptor + if ((other_fdi = get_fdi(i)) >= 0) { + if (i == fs.fd[other_fdi].seghead) { + stat->size = fs.fd[other_fdi].size; + } + } + + else + stat->size = object_datasize(i); + + if (extended) { + stat->location = ip->location; + stat->block = offset2block(location2offset(stat->location)); + stat->space = ip->size; + while ((i = segment_next(i)) > 0) { + ip = inode_addr(i); + stat->space += ip->size; + } + stat->reserved = 0; + stat->sequence = ip->sequence; + stat->updates = ip->updates; + } + } + + tw(tr(TR_END, TrObject, "} %d\n", i)); + + return i; +} + + +/****************************************************************************** + * Remove and Rename + ******************************************************************************/ + +// Delete a ffs object +effs_t object_remove(iref_t i) +{ + struct inode_s *ip = inode_addr(i); + iref_t entries; + + tw(tr(TR_BEGIN, TrObject, "object_remove(%d) {\n", i)); + + // if object is a dir, ensure it is empty + if (is_object(ip, OT_DIR)) { + dir_traverse(-i, &entries); + if (entries) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_DIRNOTEMPTY)); + return EFFS_DIRNOTEMPTY; + } + } + + // We don't actually journal deletions, this is why we call + // journal_commit() instead of journal_end(). We have to set + // journal.location to something else, otherwise journal_commit() will + // not discount the number of bytes lost by this delete. + if (is_object(ip, OT_DIR)) { + journal_begin(i); + fs.journal.location = 0; + journal_commit(0); + } + else { + // NOTE: This is not nice if we get a break down however the + // remaning chunks will be removed later by a block reclaim. + do { + journal_begin(i); + fs.journal.location = 0; + journal_commit(0); + } while ((i = segment_next(i)) != 0); + } + + tw(tr(TR_END, TrObject, "} %d\n", EFFS_OK)); + + return EFFS_OK; +} + +// Rename an object. <newname> is the new name. +iref_t object_rename(iref_t oldi, const char *newname, iref_t newdir) +{ + iref_t newi; + struct inode_s *oldip; + char *olddata; + int oldsize, namelength, realsize, offset; + + tw(tr(TR_BEGIN, TrObject, "object_rename(%d, '%s', %d) {\n", + oldi, newname, newdir)); + + oldip = inode_addr(oldi); + oldsize = segment_datasize(oldip); + + // Make sure that there is enough space to make the rename without + // object_create() trigger a data_reclaim() (awoid relocate oldi/data + // source) + namelength = is_filename(newname); + realsize = namelength + 1 + oldsize + (oldsize > 0 ? 1 : 0); + realsize = atomalign(realsize); + + // Save newdir in fs.xx because it will be updated if it is relocated. + fs.i_backup = newdir; + + if ((offset = data_prealloc(realsize)) <= 0) + return EFFS_NOSPACE; + + // Use fs.journal.oldi because i would have been updated if + // data_reclaim() relocate oldi + oldip = inode_addr(fs.journal.oldi); + olddata = offset2addr(location2offset(oldip->location)); + olddata = addr2data(olddata, oldip); + + newi = object_create(newname, olddata, oldsize, fs.i_backup); + + tw(tr(TR_END, TrObject, "} %d\n", newi)); + return newi; +} + + +/****************************************************************************** + * Object Lookup + ******************************************************************************/ + +// We can *not* use global variables, only local --- we must be re-entrant! + +#if 0 + +// NEW CODE! + +iref_t ffs_object_lookup_do(const char **path, iref_t *dir, int readlink); + +iref_t ffs_object_lookup_once(const char *path, char **leaf, iref_t *dir) +{ + iref_t i, mydir; + const char *mypath; + + tw(tr(TR_BEGIN, TrLookup, "object_lookup_once('%s', ?, ?) {\n", path)); + ttw(ttr(TTrInode, "olu(%s){" NL, path)); + + mypath = path; + mydir = 0; + i = object_lookup_do(&mypath, &mydir, 0); + if (leaf) *leaf = (char *) mypath; + if (dir) *dir = mydir; + + tw(tr(TR_END, TrLookup, "} (%d, '%s') %d\n", + (dir ? *dir : 0), (leaf ? *leaf : ""), i)); + ttw(ttr(TTrInode, "} %d" NL, i)); + + return i; +} + +// Lookup an object. Symlinks are followed. +iref_t ffs_object_lookup(const char *path, char **leaf, iref_t *dir) +{ + iref_t i, mydir; + const char *mypath; + + tw(tr(TR_BEGIN, TrLookup, "object_lookup('%s', ?, ?) {\n", path)); + ttw(ttr(TTrInode, "olu(%s){" NL, path)); + + mypath = path; + mydir = 0; + i = object_lookup_do(&mypath, &mydir, 1); + + if (is_object(ip, OT_LINK)) { + // If it is a link, we unconditionally follow it + mypath = offset2addr(location2offset(ip->location)); + mypath += ffs_strlen(mypath) + 1; // point to data + if (*mypath == '/') { + mypath++; + depth = 0; + d = fs.root; + } + i = d; + ip = inode_addr(d); + } + + if (leaf) *leaf = (char *) mypath; + if (dir) *dir = mydir; + + tw(tr(TR_END, TrLookup, "} (%d, '%s') %d\n", + (dir ? *dir : 0), (leaf ? *leaf : ""), i)); + ttw(ttr(TTrInode, "} %d" NL, i)); + + return i; +} + +// NEW CODE! + +// Ignore all occurrences of two successive slashes. Accept trailing slash +// in directory name. +iref_t ffs_object_lookup_do(const char **path, iref_t *dir, int followlink) +{ + // int lookup_followed; // number of symlinks followed + iref_t i, j, d; + struct inode_s *ip; + const char *p, *q, *mypath = *path; + uint8 depth = 1; + + tw(tr(TR_FUNC, TrLookup, "object_lookup_do('%s', ?, %d) {\n", + *path, followlink)); + + d = fs.root; + if (*mypath == '/') { + mypath++; // silently ignore and skip prefix slash + // root directory is a special case + if (*mypath == 0) { + j = d; + if (path) *path = mypath; + if (dir) *dir = 0; + tw(tr(TR_NULL, TrLookup, "} ('%s', %d) %d\n", mypath, 0, j)); + return j; + } + } + + // set default return value if root dir is empty (child link empty) + j = EFFS_NOTFOUND; + + ip = inode_addr(d); + + tw(tr(TR_FUNC, TrLookup, "")); + + while ((i = ip->child) != (iref_t) IREF_NULL) + { + j = 0; // default to not found + do { + tw(tr(TR_NULL, TrLookup, " %d", (int) i)); + + p = mypath; + ip = inode_addr(i); + if (is_object_valid(ip) && !is_object(ip, OT_SEGMENT)) { + q = addr2name(offset2addr(location2offset(ip->location))); + tw(tr(TR_NULL, TrLookup, ":%s", q)); + while (*p == *q && *p != 0 && *q != 0) { + p++; + q++; + } + if (*q == 0 && (*p == 0 || *p == '/')) { + j = i; + break; + } + } + } while ((i = ip->sibling) != (iref_t) IREF_NULL); + + if (j == 0) { + // we did not find this component of the mypath. Let's see if this + // was the leafname component or not... + while (*p != 0 && *p != '/') + p++; + + if (*p == 0) + // The mypath component was indeed the leafname + j = EFFS_NOTFOUND; + else + // The path component was not the last, so it obviously + // contained an object that was not a directory. + j = EFFS_NOTADIR; + break; + } + + if (*p == '/') { + // if there are more path components, the object found must be a + // directory or a symlink... + if (is_object(ip, OT_LINK)) { + // If it is a link, we unconditionally follow it + mypath = offset2addr(location2offset(ip->location)); + mypath += ffs_strlen(mypath) + 1; // point to data + if (*mypath == '/') { + mypath++; + depth = 0; + d = fs.root; + } + i = d; + ip = inode_addr(d); + } + else if (is_object(ip, OT_DIR)) { + mypath = p + 1; + d = i; + } + else { + j = EFFS_NOTADIR; + break; + } + if (++depth > fs.path_depth_max) { + j = EFFS_PATHTOODEEP; + break; + } + + // if this dir inode has no children, we will leave the while + // loop, so we preset the return error code. NOTEME: Not + // strictly correct because if we still have a lot of the + // pathname left, it should return the error EFFS_NOTADIR + j = EFFS_NOTFOUND; + + tw(tr(TR_NULL, TrLookup, " /")); + + } + else { + // It is a fact that *p == 0. So we found the object + if (is_object(ip, OT_LINK) && followlink) { + // If object is a link, we conditionally follow it... + mypath = offset2addr(location2offset(ip->location)); + mypath += ffs_strlen(mypath) + 1; // point to data + if (*mypath == '/') { + mypath++; + depth = 0; + d = fs.root; + i = fs.root; + } + else + i = d; + ip = inode_addr(d); + tw(tr(TR_NULL, TrLookup, " -%d->", d)); + } + else { + break; // Success, we found the object! + } + } + } + + if (path) *path = (char *) mypath; + if (dir) *dir = d; + + tw(tr(TR_NULL, TrLookup, "} (%d, '%s') %d\n", d, mypath, j)); + + return j; +} + +#else + +// Lookup an object. Symlinks are followed. +iref_t object_lookup(const char *path, char **leaf, iref_t *dir) +{ + iref_t i; + struct inode_s *ip; + + tw(tr(TR_BEGIN, TrLookup, "object_lookup('%s', ?, ?) {\n", path)); + ttw(ttr(TTrInode, "olu(%s){" NL, path)); + + i = object_lookup_once(path, leaf, dir); + ip = inode_addr(i); + + if (i > 0 && is_object(ip, OT_LINK)) { + path = offset2addr(location2offset(ip->location)); + path += ffs_strlen(path) + 1; // point to data portion + i = object_lookup_once(path, leaf, dir); + + // Links may only point to regular files... + ip = inode_addr(i); + if (+i > 0 && !is_object(ip, OT_FILE)) + i = EFFS_NOTAFILE; + } + else { + leaf = 0; + dir = 0; + } + tw(tr(TR_END, TrLookup, "} (%d, '%s') %d\n", + (dir ? *dir : 0), (leaf ? *leaf : ""), i)); + + ttw(ttr(TTrInode, "} %d" NL, i)); + return i; +} + +// Lookup an object. If object is found: Return iref of object and +// directory of object in <dir>. If object is not found: Return +// EFFS_NOTFOUND and last directory component of path in <dir> and leafname +// of pathname in <leaf> +iref_t object_lookup_once(const char *path, char **leaf, iref_t *dir) +{ + iref_t i, j, d; + struct inode_s *ip; + const char *p, *q; + uint8 depth = 1; + + tw(tr(TR_FUNC, TrLookup, "object_lookup_once('%s', ?, ?) { ", path)); + + if (path == NULL) + return EFFS_BADNAME; + + d = fs.root; + if (*path == '/') { + path++; // silently ignore and skip prefix slash + // root directory is a special case + if (*path == 0) { + j = d; + if (leaf) *leaf = (char *) path; + if (dir) *dir = 0; + tw(tr(TR_NULL, TrLookup, "} ('%s', %d) %d\n", path, 0, j)); + return j; + } + } + else + return EFFS_BADNAME; + + // set default return value if root dir is completely empty + // (child link empty) + j = EFFS_NOTFOUND; + + ip = inode_addr(d); + + while ((i = ip->child) != (iref_t) IREF_NULL) + { + j = 0; // default to not found + do { + tw(tr(TR_NULL, TrLookup, "i%d ", (int) i)); + + p = path; + ip = inode_addr(i); + if (is_object_valid(ip) && !is_object(ip, OT_SEGMENT)) { + q = addr2name(offset2addr(location2offset(ip->location))); + tw(tr(TR_NULL, TrLookup, "%s ", q)); + while (*p == *q && *p != 0 && *q != 0) { + p++; + q++; + } + if (*q == 0 && (*p == 0 || *p == '/')) { + j = i; + break; + } + } + } while ((i = ip->sibling) != (iref_t) IREF_NULL); + + + if (j == 0) { + // we did not find this component of the path. Let's + // see if this was the leafname component or not... + while (*p != 0 && *p != '/') + p++; + + if (*p == 0) + // The path component was indeed the leafname + j = EFFS_NOTFOUND; + else + // The path component was not the last, so it + // obviously contained an object that was not a + // directory. + j = EFFS_NOTADIR; + break; + } + + if (*p == '/') { + // if there are more path components, the object found + // must be a directory... + if (!is_object(ip, OT_DIR)) { + j = EFFS_NOTADIR; + break; + } + if (++depth > fs.path_depth_max) { + j = EFFS_PATHTOODEEP; + break; + } + path = p + 1; + d = i; + + // if this dir inode has no children, we will leave the + // while loop, so we preset the return error code. NOTEME: + // Not strictly correct because if we still have a lot of + // the pathname left, it should return the error + // EFFS_NOTADIR + j = EFFS_NOTFOUND; + + tw(tr(TR_NULL, TrLookup, "/ ")); + + } + else { + // It is a fact that *p == 0. So we found the object! + break; + } + } + + if (leaf) *leaf = (char *) path; + if (dir) *dir = d; + + tw(tr(TR_NULL, TrLookup, "} (%d, '%s') %d\n", d, path, j)); + + return j; +} + +#endif + + +/****************************************************************************** + * Directory Operations + ******************************************************************************/ + +// Open a directory, returning the iref of the directory's inode. +iref_t dir_open(const char *name) +{ + iref_t i; + struct inode_s *ip; + + tw(tr(TR_BEGIN, TrDirHigh, "dir_open('%s') {\n", name)); + + if ((i = object_lookup(name, 0, 0)) < 0) { + tw(tr(TR_END, TrDirHigh, "} %d\n", i)); + return i; + } + + ip = inode_addr(i); + if (!is_object(ip, OT_DIR)) + i = EFFS_NOTADIR; + + tw(tr(TR_END, TrDirHigh, "} %d\n", i)); + + return i; +} + +// Return name and iref of next entry in directory <dir>. <i> is the last +// entry we returned from this function. In case this is the first call +// after the initial call to dir_open(), <i> equals <dir>. +iref_t dir_next(iref_t dir, iref_t i, char *name, int8 size) +{ + struct inode_s *ip = inode_addr(i); + char *p; + + tw(tr(TR_BEGIN, TrDirHigh, "dir_next(%d, %d, ?, %d) {\n", dir, i, size)); + + i = (i == dir ? ip->child : ip->sibling); + + while (i != (iref_t) IREF_NULL) { + ip = inode_addr(i); + if (is_object_valid(ip)) { + p = offset2addr(location2offset(ip->location)); + while (size-- && (*name++ = *p++)) + ; + break; + } + i = ip->sibling; + } + if (i == (iref_t) IREF_NULL) + i = 0; + + tw(tr(TR_END, TrDirHigh, "} %d\n", i)); + + return i; +} + +// Traverse a directory given by inode reference <i>. If <i> is negative, it +// refers to the actual directory so we start by traversing the child link. +// Otherwise if <i> is positive, it refers to an entry within the directory +// and we only traverse sibling links. Returns iref of last object in +// directory (or negative iref of directory if the child link is empty). +// <entries> is number of non-deleted objects in the dir (only valid if +// traversed from the start, eg. with negative <i>). +iref_t dir_traverse(iref_t i, iref_t *entries) +{ + iref_t j = 0, valid = 0, erased = 0, invalid = 0; + struct inode_s *ip; + + tw(tr(TR_FUNC, TrDirLow, "dir_traverse(%d, ?) { ", i)); + + if (i < 0) { + // If directory's child is empty, this is a virgin directory and we + // return negative iref of the directory itself. + j = i; + i = -i; + ip = inode_addr(i); + i = ip->child; + } + if (i != (iref_t) IREF_NULL) { + do { + if (j == i) { + tw(tr(TR_NULL, TrDirLow, "LOOP! ")); + return EFFS_SIBLINGLOOP; + } + + j = i; + ip = inode_addr(j); + + tw(tr(TR_NULL, TrDirLow, "%d/%x ", j, ip->flags)); + + if (is_object_valid(ip)) + valid++; + else if (is_object(ip, OT_ERASED)) + erased++; + else + invalid++; + + } while ((i = ip->sibling) != (iref_t) IREF_NULL); + } + + if (entries != 0) + *entries = valid; + + tw(tr(TR_NULL, TrDirLow, "} (valid = %d, erased = %d, invalid = %d) %d\n", + valid, erased, invalid, j)); + + return j; +} + + +/****************************************************************************** + * Block, Inode and Data Allocation + ******************************************************************************/ + +// Find the youngest free block. Return block index on success. If the +// argument <priority> is zero, this is a normal alloc and it will leave at +// least fs.blocks_free_min spare blocks. Otherwise, if it is non-zero, it +// is a privileged alloc (initiated by a reclaim operation) and it will not +// necessarily leave any spare blocks. +bref_t block_alloc(bref_t priority, uint16 flags) +{ + bref_t i, b, b_min, b_max, blocks_free; + struct block_header_s *bhp; + age_t age, age_min, age_max; + + tw(tr(TR_BEGIN, TrBlock, "block_alloc(%d, 0x%x) {\n", priority, flags)); + ttw(ttr(TTrData, "ba(%d,0x%x) {" NL, priority, flags)); + + age_min = BLOCK_AGE_MAX; + age_max = 0; + blocks_free = 0; + b_min = b_max = -1; + + tw(tr(TR_FUNC, TrBlock, "blocks(age): ")); + for (i = dev.numblocks - 1; i >= 0; i--) + { + if (is_block(i, BF_IS_FREE)) + { + blocks_free++; + bhp = (struct block_header_s *) offset2addr(dev.binfo[i].offset); + age = bhp->age; + + tw(tr(TR_NULL, TrBlock, "%d(%d) ", i, age)); + + // Remember index of block found. We use '<=' and '>=' operators + // (instead of '<' and '>') to ensure we have both limits + // properly set on exit from this loop. + if (age <= age_min) { + b_min = i; + age_min = age; + } + if (age >= age_max) { + b_max = i; + age_max = age; + } + } + } + tw(tr(TR_NULL, TrBlock, "\n")); + + // Handle age wrap around + b = b_min; + if (b_min != -1) { + // Either age_max really is max age, so b_min is youngest block OR + // age_max really is min age, so b_max is youngest block + b = (age_max - age_min) < 0x8000 ? b_min : b_max; + } + + // Only privileged allocs will get the last free block + if (blocks_free <= fs.blocks_free_min - priority) { + b = -1; + tw(tr(TR_FUNC, TrBlock, "Only %d block(s) left, required = %d\n", + blocks_free, fs.blocks_free_min - priority)); + } + else { + // Prepare/format the block for holding data/inodes + if (flags == BF_DATA) { + bstat[b].used = BHEADER_SIZE; + bstat[b].lost = 0; + bstat[b].objects = 0; + block_flags_write(b, BF_DATA); + } + else if (flags == BF_COPYING) { + // This code is used on a fresh format and when allocating a new + // block for reclaiming inodes + block_flags_write(b, BF_COPYING); + bstat[b].used = 0; + bstat[b].lost = 0; + bstat[b].objects = 1; // first inode to be allocated + } + else { + tw(tr(TR_FUNC, TrBlock, "FATAL: Bad input (flags = 0x%X)\n", flags)); + } + } + + tw(tr(TR_END, TrBlock, "} (%d) %d\n", blocks_free, b)); + ttw(ttr(TTrData, "} 0x%x" NL, b)); + + return b; +} + +// Free and schedule a block for erase. +void block_free(bref_t b) +{ + tw(tr(TR_BEGIN, TrBlock, "block_free(%d) {\n", b)); + + // mark block as invalid and schedule erasure + block_flags_write(b, BF_LOST); + block_reclaim(b); + + tw(tr(TR_END, TrBlock, "}\n")); +} + +void block_flags_write(uint8 block, uint8 flags) +{ + struct block_header_s *bhp = + (struct block_header_s *) offset2addr(dev.binfo[block].offset); + + tw(tr(TR_BEGIN, TrBlock, "block_flags_write(%d, 0x%x)\n", block, flags)); + + bstat[block].flags = BIT_SET(bstat[block].flags, flags); + ffsdrv.write_halfword((uint16 *) &bhp->flags, bstat[block].flags ); + + tw(tr(TR_END, TrBlock, "")); +} + +// Allocate an inode for a new object. We use bstat[fs.inodes].objects to +// start our scan for a free inode instead of starting from the first time +// each time. +iref_t inode_alloc(void) +{ + iref_t i; + + tw(tr(TR_BEGIN, TrInode, "inode_alloc() {\n")); + ttw(ttr(TTrInode, "i_a() {" NL)); + + if ((i = inode_alloc_try()) == 0) { + // FIXME NO we are not always of inodes, maybe dos there exist to + // many objects! It will not help to reclaim the inodes in that case! + tw(tr(TR_FUNC, TrInode, "NOTE: Out of free inodes...\n")); + inodes_reclaim(); + i = inode_alloc_try(); + } + + tw(tr(TR_END, TrInode, "} %d\n", i)); + ttw(ttr(TTrInode, "} %d" NL, i)); + + return i; +} + +iref_t inode_alloc_try(void) +{ + iref_t i = fs.inodes_max; + struct inode_s *ip; + + // If we have not yet reached the maximum allowed number of objects, + // search for next free inode... + if (bstat[fs.inodes].used - bstat[fs.inodes].lost < fs.objects_max) + { + ip = inode_addr(bstat[fs.inodes].objects); + for (i = bstat[fs.inodes].objects; + i < fs.inodes_max - FFS_INODES_MARGIN; i++, ip++) { + if (ip->location == FLASH_NULL32) { + bstat[fs.inodes].objects = i; + bstat[fs.inodes].used++; + break; + } + } + } + if (i >= fs.inodes_max - FFS_INODES_MARGIN) + i = 0; + + tw(tr(TR_FUNC, TrInode, "inode_alloc_try() %d\n", i)); + ttw(ttr(TTrInode, "i_a_t() %d" NL, i)); + + return i; +} + +// NOTEME: Should file data be word aligned to enable faster reads and +// writes in word quantities AND to be more compatible with the inherent +// 16-bit access width of flash memories? +offset_t data_alloc(int size) +{ + offset_t offset = 0; + bref_t b; + + tw(tr(TR_BEGIN, TrData, "data_alloc(%d) {\n", size)); + ttw(ttr(TTrData, "da(%d) {" NL, size)); + + offset = data_prealloc(size); + + // If we did allocate the space, we update bstat[] + if (offset > 0) { + b = offset2block(offset); + bstat[b].used += size; + stats.data_allocated += size; // STATS + } + + tw(tr(TR_END, TrData, "} 0x%04x\n", offset)); + ttw(ttr(TTrData, "} %x" NL, offset)); + + return offset; +} + +offset_t data_prealloc(int realsize) +{ + int result, i, bytes_free; + offset_t offset; + + // Is it possible to get this amount of free space and still have enough + // reserved space? + ffs_query(Q_BYTES_FREE_RAW, &bytes_free); + if (realsize > (bytes_free + FFS_FILENAME_MAX + dev.atomsize)) + return 0; // Not enough unused space + + for (i = 0; i < dev.numblocks; i++) { + if ((offset = data_alloc_try(realsize)) > 0) + return offset; // Space found + + if ((result = data_reclaim(realsize)) < 0) + return 0; // Data reclaim failed! + } + + return 0; // No space found +} + +// Find free data space of size <size>. Return zero if no space available. +// Note that we ensure that we always have space immediately available for a +// privileged data_alloc(), e.g. a data_alloc() that allocates data space +// without performing a data_reclaim(). This is important when +// re-creating/re-locating the journal file. +offset_t data_alloc_try(int size) +{ + bref_t b; + int free; + offset_t offset_big = 0, offset_small = 0; + int size_big_ok = 0, size_small_ok = 0; + int size_big, size_small; + int reserved; + + tw(tr(TR_FUNC, TrData, "data_alloc_try(%d) { ", size)); + ttw(ttr(TTrData, "dat(%d) {" NL, size)); + + // NOTE when we alloc do we only need to have reserved space for X + // number of journal files, where X is the max number of used journals + // per data reclaim. The only exception is when an object_relocate has + // failed thus we set reserved_space to zero. + reserved = RESERVED_LOW; + + if (fs.reserved_space < reserved) + reserved = fs.reserved_space; + + // Set size_big to the grater of the sizes and size_small to the lesser. + size_big = (size > reserved ? size : reserved); + size_small = (size > reserved ? reserved : size); + tw(tr(TR_NULL, TrData, "(size_big, small = %d, %d) ", size_big, size_small)); + + // First search for free space in data blocks + tw(tr(TR_NULL, TrData, "block:free,objects: ")); + + for (b = 0; b < dev.numblocks; b++) { + if (is_block(b, BF_IS_DATA)) { + free = dev.blocksize - bstat[b].used; + tw(tr(TR_NULL, TrData, "%d:%d,%d ", b, free, bstat[b].objects)); + if (bstat[b].objects < fs.block_files_max - fs.block_files_reserved) { + if (!size_big_ok && !size_small_ok && + (free >= size_big + size_small)) { + size_big_ok = size_small_ok = 1; + offset_big = offset_small = + dev.binfo[b].offset + bstat[b].used; + tw(tr(TR_NULL, TrData, "big/small_ok ")); + break; + } + else if (!size_big_ok && free >= size_big) { + size_big_ok = 1; + offset_big = dev.binfo[b].offset + bstat[b].used; + tw(tr(TR_NULL, TrData, "big_ok ")); + } + else if (!size_small_ok && free >= size_small) { + size_small_ok = 1; + offset_small = dev.binfo[b].offset + bstat[b].used; + tw(tr(TR_NULL, TrData, "small_ok ")); + } + } + } + if (size_small_ok && size_big_ok) + break; + } + + if (size_big_ok && size_small_ok) + offset_big = (size > reserved ? offset_big : offset_small); + else + offset_big = 0; + + tw(tr(TR_NULL, TrData, "} 0x%x\n", offset_big)); + ttw(ttr(TTrData, "} %x " NL, offset_big)); + + return offset_big; +} + +offset_t data_reserved_alloc(int size) +{ + bref_t b; + offset_t offset = 0; + int free; + + tw(tr(TR_BEGIN, TrData, "data_reserved_alloc(%d) {\n", size)); + ttw(ttr(TTrData, "dra(%d) {" NL, size)); + + tw(tr(TR_NULL, TrData, "block:free,objects: ")); + for (b = 0; b < dev.numblocks; b++) { + if (is_block(b, BF_IS_DATA)) { + free = dev.blocksize - bstat[b].used; + tw(tr(TR_NULL, TrData, "%d:%d,%d ", b, free, bstat[b].objects)); + if (free >= size) { + offset = dev.binfo[b].offset + bstat[b].used; + break; + } + } + } + + // If we did allocate the space, we update bstat[] + if (offset != 0) { + b = offset2block(offset); + bstat[b].used += size; + stats.data_allocated += size; // STATS + } + + tw(tr(TR_END, TrData, "} 0x%04x\n", offset)); + ttw(ttr(TTrData, "} %x" NL, offset)); + + return offset; +} + + +iref_t chunk_alloc(int realsize, int is_journal, offset_t *offset) +{ + iref_t i; + + if (realsize < 0) + return EFFS_INVALID; + + // Have we reached objects_max? We make a similar test in + // inode_alloc_try(), however we need to do it here or else we risk to start + // a data_reclaim we not can finish. + if (bstat[fs.inodes].used - bstat[fs.inodes].lost >= fs.objects_max) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_FSFULL)); + ttw(ttr(TTrObj, "} %d" NL, EFFS_FSFULL)); + return EFFS_FSFULL; + } + + // Allocate space for the object name (and object data) + if (is_journal) + *offset = data_reserved_alloc(realsize); + else + *offset = data_alloc(realsize); + + if (*offset == 0) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_NOSPACE)); + ttw(ttr(TTrObj, "} %d" NL, EFFS_NOSPACE)); + return EFFS_NOSPACE; + } + fs.journal.location = offset2location(*offset); + + // Allocate an inode for the object + i = fs.journal.i = inode_alloc(); + if (i == 0) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_FSFULL)); + ttw(ttr(TTrObj, "} %d" NL, EFFS_FSFULL)); + return EFFS_FSFULL; + } + + return i; +} + +/****************************************************************************** + * query and fcontrol + ******************************************************************************/ + +#if 0 +extern uint16 ffs_flash_device; +extern uint16 ffs_flash_manufact; +#endif + +effs_t object_control(iref_t i, int8 action, int value) +{ + effs_t error = EFFS_OK; + + tw(tr(TR_BEGIN, TrOther, "object_control(%d, %d, 0x%x) {\n", + i, action, value)); + ttw(ttr(TTrApi, "obj_control(%d,%d,0x%x)" NL, i, action, value)); + + switch (action) { + case OC_FLAGS: + // Set/clear object flags. Attempting to modify the "/dev/ffs" + // object (i = 0) or any non-defined flags is an invalid operation. + if (i <= 0 || value & ~OF_ALL) { + error = EFFS_INVALID; + } + else { + // there are two cases; either we only set bits in the flags. + // This is simple, as we just have to update the flags byte. The + // other case is harder because we have to clear bits and for + // this we have to copy the old inode to a new inode, setting + // the flags appropriately. For now we always just allocate a + // new inode and set the flags according to the <value> + // argument. + journal_begin(i); + fs.journal.flags |= OF_MASK; // reset all flags + fs.journal.flags = BIT_SET(fs.journal.flags, value); + if ((fs.journal.i = inode_alloc()) == 0) + error = EFFS_FSFULL; + else { + fs.journal.diri = dir_traverse(fs.journal.diri, 0); + journal_end(0); + } + } + break; + + case OC_FS_FLAGS: fs.flags = value; break; +#if 0 + case OC_DEV_MANUFACT: ffs_flash_manufact = value; break; + case OC_DEV_DEVICE: ffs_flash_device = value; break; +#endif + case OC_FS_TESTFLAGS: fs.testflags = value; break; + case OC_DEBUG_0: + case OC_DEBUG_1: + case OC_DEBUG_2: + case OC_DEBUG_3: fs.debug[action - OC_DEBUG_FIRST] = value; break; + case OC_TRACE_INIT: +#if (TARGET == 1) + ttr_init(value); +#endif + break; + default: + error = EFFS_INVALID; + } + + tw(tr(TR_END, TrOther, "} %d\n", error)); + + return error; +} + +extern int tmffs_bufsize(void); // used by ffs_query() +extern unsigned char *tmffs_bufaddr(void); // used by ffs_query() + +#if (TARGET == 1) +// request_id_last is only used in TARGET not to any use on the PC side +extern req_id_t request_id_last; // from task.c +#else +req_id_t request_id_last; +#endif + +// If tmffs not is represented we define a dummy tm version +#ifndef FFS_TM_VERSION +#define FFS_TM_VERSION ((uint16) 0x0BAD) +#endif + +effs_t ffs_query(int8 query, void *p) +{ + tw(tr(TR_FUNC, TrOther, "query(%d) (?)\n", query)); + + if (p == NULL) + return EFFS_INVALID; + + switch (query) + { + case Q_BYTES_FREE: + case Q_BYTES_USED: + case Q_BYTES_LOST: + case Q_BYTES_MAX: + case Q_OBJECTS_TOTAL: + case Q_BLOCKS_FREE: + case Q_BYTES_FREE_RAW: + { + bref_t b; + bref_t blocks_free = 0; + iref_t objects = 0; + offset_t max, used = 0, lost = 0; + struct block_stat_s *bp; + + // Don't count free blocks, inode block, block header and reserved space. + max = (dev.numblocks - fs.blocks_free_min - 1) * + (dev.blocksize - BHEADER_SIZE) - fs.reserved_space; + + // Furthermore don't count the ovewrhead from each chunk (alignment) + // NOTE: If we call query while FFS not is formatted there is a risk + // of deviding with zero! + if (fs.chunk_size_max > 0) + max -= ((max / fs.chunk_size_max + 1) * dev.atomsize); + + for (b = 0, bp = &bstat[0]; b < dev.numblocks; b++, bp++) { + if (is_block(b, BF_IS_FREE)) + blocks_free++; + if (is_block(b, BF_IS_DATA)) { + objects += bp->objects; + used += bp->used; + lost += bp->lost; + } + } + + switch (query) { + case Q_BYTES_FREE: *(uint32*)p = max - (used - lost) - FFS_FILENAME_MAX; + break; + case Q_BYTES_FREE_RAW:*(uint32*)p = max - (used - lost); break; + case Q_BYTES_USED: *(uint32*)p = used; break; + case Q_BYTES_LOST: *(uint32*)p = lost; break; + case Q_BYTES_MAX: *(uint32*)p = max; break; + case Q_OBJECTS_TOTAL: *(uint16*)p = objects; break; + case Q_BLOCKS_FREE: *(uint16*)p = blocks_free; break; + } + break; + } + + case Q_TM_BUFADDR: *(uint32*)p = (uint32) tmffs_bufaddr(); break; + case Q_TM_BUFSIZE: *(uint32*)p = tmffs_bufsize(); break; + case Q_DEV_BASE: *(uint32*)p = (uint32) dev.base; break; + + // FFS versions + case Q_FFS_API_VERSION: *(uint16*)p = FFS_API_VERSION; break; + case Q_FFS_DRV_VERSION: *(uint16*)p = FFS_DRV_VERSION; break; + case Q_FFS_REVISION: *(uint16*)p = ffs_revision; break; + case Q_FFS_FORMAT_WRITE: *(uint16*)p = FFS_FORMAT_VERSION; break; + case Q_FFS_FORMAT_READ: *(uint16*)p = fs.format; break; + case Q_FFS_LASTERROR: *(int16*)p = fs.initerror; break; + case Q_FFS_TM_VERSION: *(int16*)p = FFS_TM_VERSION; break; + + // File system queries + case Q_FILENAME_MAX: *(uint16*)p = fs.filename_max; break; + case Q_PATH_DEPTH_MAX: *(uint16*)p = fs.path_depth_max; break; + + case Q_OBJECTS_FREE: *(uint16*)p = fs.objects_max - + (bstat[fs.inodes].used - + bstat[fs.inodes].lost); break; + case Q_INODES_USED: *(uint16*)p = bstat[fs.inodes].used; break; + case Q_INODES_LOST: *(uint16*)p = bstat[fs.inodes].lost; break; + case Q_OBJECTS_MAX: *(uint16*)p = fs.objects_max; break; + + case Q_INODES_MAX: *(uint16*)p = fs.inodes_max; break; + case Q_CHUNK_SIZE_MAX: *(uint16*)p = fs.chunk_size_max; break; + + // File descriptor queris + case Q_FD_BUF_SIZE: *(uint32*)p = fs.fd_buf_size; break; + case Q_FD_MAX: *(uint16*)p = fs.fd_max; break; + + // device queries + case Q_DEV_MANUFACTURER: *(uint16*)p = dev.manufact; break; + case Q_DEV_DEVICE: *(uint16*)p = dev.device; break; + case Q_DEV_BLOCKS: *(uint16*)p = dev.numblocks; break; + case Q_DEV_ATOMSIZE: *(uint16*)p = dev.atomsize; break; + case Q_DEV_DRIVER: *(uint16*)p = dev.driver; break; + + // Miscellaneous/Internal + case Q_BLOCKS_FREE_MIN: *(uint16*)p = fs.blocks_free_min; break; + case Q_LOST_HIGH: *(uint16*)p = fs.lost_threshold; break; + + // Debug queries + case Q_FS_FLAGS: *(uint16*)p = fs.flags; break; + case Q_FS_INODES: *(uint16*)p = fs.inodes; break; + case Q_FS_ROOT: *(uint16*)p = fs.root; break; + + case Q_STATS_DRECLAIMS: *(uint32*)p = stats.drec.most_lost + + stats.drec.most_unused + + stats.drec.youngest; break; + case Q_STATS_IRECLAIMS: *(uint32*)p = stats.irec.num; break; + case Q_STATS_DATA_RECLAIMED: *(uint32*)p = stats.drec.valid[0] + + stats.drec.lost[0]; break; + case Q_STATS_INODES_RECLAIMED: *(uint32*)p = stats.irec.valid + stats.irec.lost; + break; + case Q_STATS_DATA_ALLOCATED: *(uint32*)p = stats.data_allocated; break; + case Q_REQUEST_ID_LAST: *(uint32*)p = request_id_last; break; + + default: + if (query >= Q_BSTAT && (query - Q_BSTAT) < dev.numblocks) + { + struct block_header_s *bhp; + uint32 *myp = p; + + query -= Q_BSTAT; + bhp = (struct block_header_s *) offset2addr(dev.binfo[query].offset); + + *myp++ = bstat[query].used; + *myp++ = bstat[query].lost; + // If we are in READ mode or this block is not lost, we can + // safely read the age. Otherwise it is maybe currently erasing + // and thus we cannot read the age. + // NOTEME: Should this not have been handled by a driver function? + if (dev.state == DEV_READ || !is_block_flag(query, BF_LOST)) + *myp++ = (bhp->age << 16) | bstat[query].flags; + else + *myp++ = ( 0xFFFE << 16) | bstat[query].flags; + *myp++ = bstat[query].objects; + } + else if (query >= Q_DEBUG_FIRST && query < Q_DEBUG_LAST) { + *(uint32*)p = fs.debug[query - Q_DEBUG_FIRST]; + } + else + return EFFS_INVALID; + } + + return EFFS_OK; +} + + +/****************************************************************************** + * Miscellaneous Helper Functions + ******************************************************************************/ + +// Check if an object is read-only. Note that the root inode is always +// readonly, no matter what! Returns error or original <i>. +iref_t is_readonly(iref_t i, const char *path) +{ + struct inode_s *ip = inode_addr(i); + + tw(tr(TR_FUNC, TrObject, "is_readonly(%d, '%s') ", i, path)); + + if (i == fs.root || i == fs.ijournal || + (IS_BIT_SET(ip->flags, OF_READONLY) && !ffs_is_modifiable(path))) + i = EFFS_ACCESS; + + tw(tr(TR_NULL, TrObject, "(0x%X) %d\n", ip->flags, i)); + + return i; +} + + +// Check if filename is valid. Return EFFS_BADNAME if name contains +// invalid chars. Return RFFS_NAMETOOLONG if name is too +// long. Otherwise return filename length. +effs_t is_filename(const char *s) +{ + char *p = (char *) s; + int n = 0; + + while ( (*s >= 'a' && *s <= 'z') || + (*s >= 'A' && *s <= 'Z') || + (*s >= '0' && *s <= '9') || + *s == '.' || + *s == ',' || + *s == '_' || + *s == '-' || + *s == '+' || + *s == '%' || + *s == '$' || + *s == '#' ) + { + s++; + } + + if (*s != 0) + n = EFFS_BADNAME; // invalid file name character found + else { + n = s - p; + if (n > fs.filename_max) + n = EFFS_NAMETOOLONG; + if (n == 0) + n = EFFS_BADNAME; + } + + tw(tr(TR_FUNC, TrUtil, "is_filename('%s') %d\n", p, n)); + + return n; +} + +int ffs_strlen(const char *s) +{ + const char *p = s; + + while (*p++) + ; + + tw(tr(TR_FUNC, TrUtil, "strlen('%s') %d\n", s, p-s-1)); + + return p-s-1; +} + +// Return zero if strings are equal, otherwise return non-zero. +int ffs_strcmp(const char *s, const char *p) +{ + int8 n = 1; + + tw(tr(TR_FUNC, TrUtil, "strcmp('%s', '%s') ", s, p)); + + while (*s == *p && *p != 0) { + s++; + p++; + } + if (*s == *p) + n = 0; + + tw(tr(TR_NULL, TrUtil, "(%d)\n", n)); + + return n; +} + +// Note: rename function? like get_fdi.. +fd_t get_fdi(iref_t i) +{ + int j; + + tw(tr(TR_FUNC, TrUtil, "get_fdi(%d)\n", i)); + + if (i > 0) { + for (j = 0; j < fs.fd_max; j++) { + if (i == fs.fd[j].seghead) { + return j; // Return fdi without offset + } + } + } + return -1; +} + + +effs_t is_fd_valid(fd_t fdi) +{ + if (fdi >= fs.fd_max || fdi < 0 || fs.fd[fdi].options == 0) + return 0; // Not valid! + return 1; +} + +effs_t is_offset_in_buf(int offset, fd_t fdi) +{ + if (fs.fd[fdi].dirty == 1) + if (offset >= fs.fd[fdi].wfp && + offset < fs.fd[fdi].wfp + fs.chunk_size_max) + return 1; + return 0; +} + +/****************************************************************************** + * Chunk Operations + ******************************************************************************/ + +iref_t segment_create(const char *buf, int size, iref_t dir) +{ + iref_t i; + struct inode_s *ip; + int realsize; + offset_t offset; + char *dataaddr; + + ttw(ttr(TTrObj, "segc(%d, %d){" NL, size, dir)); + tw(tr(TR_BEGIN, TrObject, "segment_create( ?, %d, %d) {\n", size, dir)); + + fs.journal.size = realsize = atomalign(size + 1); + + // Init journal.diri before chunk_alloc() because it might trigger a + // data_reclaim() which can relocate the dir inode + fs.journal.diri = dir; + + if ((i = chunk_alloc(realsize, 0, &offset)) < 0) + return i; + + ip = inode_addr(i); + dataaddr = offset2addr(offset); + + // Write data and null terminator. We null-terminate the data block, + // such that blocks_fsck() can determine the amount of used data block + // space correctly. + ffsdrv.write(dataaddr, buf, size); + dataaddr += size; + ffsdrv_write_byte(dataaddr, 0); + + // Segments is linked together by the child link(create) or by the + // sibling link(update or relocate). A negativ dir indicate that it is a + // update or relocate and the sign must be reversed so the journal + // system will use the sibling link to link the inode together. + if (dir > 0) + fs.journal.diri = chunk_traverse(fs.journal.diri); + + fs.journal.diri = -fs.journal.diri; + + tw(tr(TR_END, TrObject, "} %d\n", i)); + ttw(ttr(TTrObj, "} %d" NL,i)); + + return i; +} + + +int segment_read(iref_t i, char *buf, int size, int offset) +{ + struct inode_s *ip; + char *p; + int chunk_size; + + tw(tr(TR_BEGIN, TrObject, "segment_read(%d, 0x%x, %d, %d) {\n", + i, buf, offset, size)); + + if (buf == NULL) { + tw(tr(TR_END, TrObject, "} %d\n", EFFS_INVALID)); + return EFFS_INVALID; + } + + ip = inode_addr(i); + + chunk_size = segment_datasize(ip); + + // Saturate read buffer + if (size > chunk_size - offset) + size = chunk_size - offset; + + p = offset2addr(location2offset(ip->location)); + p = addr2data(p, ip); + + memcpy(buf, &p[offset], size); + + tw(tr(TR_END, TrObject, "} %d\n", size)); + return size; +} + +// Find next valid chunk +iref_t segment_next(iref_t i) +{ + struct inode_s *ip = inode_addr(i); + + tw(tr(TR_BEGIN, TrDirHigh, "ffs_segment_next(%d) {\n", i)); + + // Dir is not allowed to contain data + if (is_object(ip, OT_DIR)) { + tw(tr(TR_END, TrDirHigh, "} 0\n")); + return 0; + } + + // Is this the last/only segment + if ((i = ip->child) == (iref_t) IREF_NULL) { + tw(tr(TR_END, TrDirHigh, "} 0\n")); + return 0; + } + + // Get child (is valid?), search though segment by sibling link(is + // valid?), and again.. + do { + i = ip->child; + ip = inode_addr(i); + if (is_object_valid(ip)) { + tw(tr(TR_END, TrDirHigh,"} %d\n", i)); + return i; + } + + while (ip->sibling != (iref_t) IREF_NULL) { + i = ip->sibling; + ip = inode_addr(i); + if (is_object_valid(ip)) { + tw(tr(TR_END, TrDirHigh,"} %d\n", i)); + return i; + } + } + } while (ip->child != (iref_t) IREF_NULL); + + // No segment found + tw(tr(TR_END, TrDirHigh,"} %d\n", i)); + return 0; +} + +// The output "inode" will be the inode that contains the requested data or +// the last inode in the segmentfile. The segmenthead will be skiped if it +// don't contains any data. inode_offset is the offset in the found inode +// pointed to by target_offset. If target_offset point past the last segment +// will inode_offset be the size of the last inode. The return value will be +// the same as target_offset but maximum the total size of the object. +int segfile_seek(iref_t seghead, int target_offset, + iref_t *inode, int *inode_offset) +{ + int priv_count = 0, count_size = 0; + iref_t i = seghead; + struct inode_s *ip; + + tw(tr(TR_BEGIN, TrObject, "segfile_seek(%d, %d, ?, ?) {\n", + seghead, target_offset)); + + if (!is_object_valid(inode_addr(seghead))) { + tw(tr(TR_END, TrAll, "FATAL: Invalid seghead!\n")); + return 0; + } + *inode = seghead; + + while (1) + { + ip = inode_addr(i); + count_size += segment_datasize(ip); + + // Seghead will be skiped if it don't contain any data + if (count_size > target_offset && count_size != 0) { + + if (inode_offset != 0) + *inode_offset = target_offset - priv_count; + + tw(tr(TR_END, TrObject, "} %d\n", target_offset)); + return target_offset; + } + + if ((i = segment_next(i)) == 0) { + tw(tr(TR_END, TrObject, "} (eof!?) %d\n", count_size)); + if (inode_offset != 0) + *inode_offset = count_size - priv_count; + // *inode = 0; + return count_size; // No more segments + } + priv_count = count_size; + + *inode = i; + } +} + +// Calculate exact size of file data; without filename and null terminator +// and without data null terminator and succeeding alignment padding. +// NOTEME: Does this also work for empty files and directories? +int segment_datasize(const struct inode_s *ip) +{ + char *p, *q; + int size; + + p = offset2addr(location2offset(ip->location)); + q = p + ip->size - 1; + + // Segments is not allowed to contain any name + if (!is_object(ip, OT_SEGMENT)) { + // skip filename at start of data + while (*p) + p++; + } + else + // If it contained a name would p pointe to the null terminator of + // the name but because chunks don't have a name decrement we p to get + // the size correct + p--; + + // skip padding at end of data + while (*q) + q--; + + // If there are data, there is also a null-terminator. Otherwise + // there is no null-terminator + size = q - p; + if (size > 0) + size--; + + tw(tr(TR_FUNC, TrObject, "segment_datasize(0x%x) %d\n", ip, size)); + return size; +} + + +int object_truncate(const char *pathname, fd_t fdi, offset_t length) +{ + int segment_offset, flength, realsize, offset; + iref_t i, dir, next_i; + char *name = 0, *olddata; + struct inode_s *oldip; + effs_t error; + + tw(tr(TR_FUNC, TrObject, "ffs_object_truncate('%s', %d, %d) \n", + pathname, fdi, length)); + if (length < 0) return EFFS_INVALID; + + if (pathname == 0) { + // File descriptor must be open and it have to be in write mode + if (!is_fd_valid(fdi)) + return EFFS_BADFD;; + + if (!is_open_option(fs.fd[fdi].options, FFS_O_WRONLY)) + return EFFS_INVALID; + + // It is not possible to truncate an open file to a size less than + // the current file pointer + if (length < fs.fd[fdi].fp) + return EFFS_INVALID; + + i = fs.fd[fdi].seghead; + } + else { + // File must exists and not be open + if ((i = object_lookup(pathname, &name, &dir)) < 0) + return i; + + if (get_fdi(i) >= 0) + return EFFS_LOCKED; + + oldip = inode_addr(i); + // Even though the ffs architecture allows to have data in directory + // objects, we don't want to complicate matters, so we return an error + if (is_object(oldip, OT_DIR) && !(fs.flags & FS_DIR_DATA)) + return EFFS_NOTAFILE; + + if ((i = is_readonly(i, pathname)) < 0) + return i; + } + // Find the segment which length points in to + flength = segfile_seek(i, length, &i, &segment_offset); + + if (pathname == 0) { + if (is_offset_in_buf(length, fdi) == 1) { + fs.fd[fdi].size = (length > fs.fd[fdi].size ? + fs.fd[fdi].size : length); // Truncate the buffer + + if (i == fs.fd[fdi].wch) { + next_i = segment_next(i); + if (next_i > 0) + if ((error = object_remove(next_i)) < 0) + return error; + } + return EFFS_OK; + } + } + + if (flength < length) + return EFFS_OK; + + journal_begin(i); + + // Realsize do not always need to include a name but we simplify it. + realsize = atomalign(segment_offset + 1 + fs.filename_max + 1); + + // Make sure that there is enough space to make the rename without + // object_create() trigger a data_reclaim() (awoid relocate oldi/data + // source) + if ((offset = data_prealloc(realsize)) <= 0) + return EFFS_NOSPACE; + + // Find the next segment if any. + next_i = segment_next(fs.journal.oldi); + + // Find old data source + oldip = inode_addr(fs.journal.oldi); + olddata = offset2addr(location2offset(oldip->location)); + name = addr2name(olddata); // reinit name (maybe relocated) + olddata = addr2data(olddata, oldip); + + if (is_object(oldip, OT_SEGMENT)) { + if (segment_offset == 0) + next_i = fs.journal.oldi; // Remove the found object + else { + if ((i = segment_create(olddata, segment_offset, + -fs.journal.oldi)) < 0) + return i; + + fs.link_child = 0; //Do not link child + journal_end(0); + } + } + else { + if ((i = object_create(name, olddata, length, fs.journal.oldi)) < 0) + return i; + fs.link_child = 0; //Do not link child + journal_end(0); + + if (is_fd_valid(fdi)) + fs.fd[fdi].seghead = i; + } + + if (is_fd_valid(fdi)) + fs.fd[fdi].size = length; + + // If any remaning segment exists then remove them + if (next_i > 0) + if ((error = object_remove(next_i)) < 0) + return error; + + return EFFS_OK; +} + + +// Find the last segment valid or not valid +iref_t chunk_traverse(iref_t i) +{ + struct inode_s *ip = inode_addr(i); + + tw(tr(TR_BEGIN, TrDirHigh, "ffs_chunk_traverse(%d) {\n", i)); + // Is this the last/only segment? + if (ip->child == (iref_t) IREF_NULL) { + tw(tr(TR_END, TrDirHigh, "} %d\n", i)); + return i; + } + + // Get child, find the last segment by sibling link, and again.. + do { + i = ip->child; + ip = inode_addr(i); + + while (ip->sibling != (iref_t) IREF_NULL) { + i = ip->sibling; + ip = inode_addr(i); + } + } while (ip->child != (iref_t) IREF_NULL); + + tw(tr(TR_END, TrDirHigh, "} %d\n", i)); + + return i; +} + +// fdi include offset now but change this so core use pure fdi. +effs_t datasync(fd_t fdi) +{ + int chunk_size; + iref_t i; + struct inode_s *ip; + char *name; + + tw(tr(TR_FUNC, TrObject, "datasync(%d) \n", fdi)); + ttw(ttr(TTrApi, "datasync(%d) {" NL, fdi)); + + // NOTEME: is this necessary? + if (!is_fd_valid(fdi)) + return EFFS_BADFD; + + if (fs.fd[fdi].dirty == 0) + return EFFS_OK; + + // If size - wfp is more than max is the complete buffer valid or else + // is it only a part of it that consist valid data + chunk_size = fs.fd[fdi].size - fs.fd[fdi].wfp; + if (chunk_size > fs.chunk_size_max) + chunk_size = fs.chunk_size_max; + + ip = inode_addr(fs.fd[fdi].wch); + + // Create new chunk or update a old one + if (fs.fd[fdi].wch > 0) { + // Update existing chunk + // Negativ dir input because it is a update (do not traverse) + if (is_object(ip, OT_SEGMENT)) { + journal_begin(fs.fd[fdi].wch); + + if ((i = segment_create(fs.fd[fdi].buf, chunk_size, + -fs.fd[fdi].wch)) < 0) + return i; + } + + else { + // Seghead update (like a normal file) + ip = inode_addr(fs.fd[fdi].seghead); + name = addr2name(offset2addr(location2offset(ip->location))); + journal_begin(fs.fd[fdi].seghead); + + if ((i = object_create(name, fs.fd[fdi].buf, chunk_size, + fs.fd[fdi].seghead)) < 0) + return i; + + fs.fd[fdi].seghead = i; + } + journal_end(0); + } + + else { + // Create new chunk at the end of the existing ones. + // BTW: A seghead will always have been made before this one. + journal_begin(0); + + if ((i = segment_create(fs.fd[fdi].buf, chunk_size, + fs.fd[fdi].seghead)) < 0) + return i; + + journal_end(OT_SEGMENT); + } + fs.fd[fdi].dirty = fs.fd[fdi].wch = 0; + + ttw(ttr(TTrApi, "} 0" NL)); + return EFFS_OK; +} + +/****************************************************************************** + * Development and Tracing + ******************************************************************************/ + +#if (TARGET == 0) + +void tr_bstat(void) +{ + int i, n; + struct block_header_s *bhp; + struct block_stat_s *bsp; + + tw(tr(TR_BEGIN, TrBstat, "bstat = {\n")); + + bsp = &bstat[0]; + tw(tr(TR_FUNC, TrBstat, + " bf used lost free n age state\n")); + for (i = 0, n = 0; i < dev.numblocks; i++, bsp++) { + bhp = (struct block_header_s *) offset2addr(dev.binfo[i].offset); + tw(tr(TR_FUNC, TrBstat, "%2d %02x %6d %6d %6d %3d %5d %s%s%s%s%s%s\n", + i, bsp->flags & 0xFF, + bsp->used, bsp->lost, + dev.blocksize - bsp->used, + bsp->objects, + bhp->age, + (is_block(i, BF_IS_FREE) ? "FREE " : ""), + (is_block(i, BF_IS_DATA) ? "DATA " : ""), + (is_block(i, BF_IS_CLEANING) ? "CLEANING " : ""), + (is_block(i, BF_IS_COPYING) ? "COPYING " : ""), + (is_block(i, BF_IS_INODES) ? "INODES " : ""), + (is_block_flag(i, BF_LOST) ? "lost " : "") + )); + if (is_block(i, BF_IS_DATA)) + n += bsp->objects; + } + i = bstat[fs.inodes].used - bstat[fs.inodes].lost; + tw(tr(TR_FUNC, TrBstat, + " %3d (used-lost = %d)\n", + n, i)); + + if (n != i) { + tw(tr(TR_FUNC, TrAll, "WARNING: sum(bstat[x].objects) != bstat[fs.inodes].used - bstat[fs.inodes].lost\n")); + } + + tw(tr(TR_END, TrBstat, "}\n")); +} + +#else // (TARGET == 1) + +void tr_bstat(void) +{ + int i; + struct block_stat_s *bsp = &bstat[0]; + + for (i = 0; i < dev.numblocks; i++, bsp++) { + ttw(ttr(TTrBstat, "%2d (%2x) u/l/f/n %6d %6d %6d %2d" NL, + i, bsp->flags, + bsp->used, bsp->lost, + dev.blocksize - bsp->used, + bsp->objects + )); + } + ttw(str(TTrBstat,"" NL)); +} + + +void tr_fd(fd_t fdi) +{ + tw(tr(TR_BEGIN, TrHelper, "tr_fd(%d) {\n", fdi)); + tw(tr(TR_FUNC, TrHelper, "options: 0x%x \n", fd[fdi].options)); + tw(tr(TR_FUNC, TrHelper, "inode : %d \n", fd[fdi].inode_first)); + tw(tr(TR_FUNC, TrHelper, "fp : %d \n", fd[fdi].fp)); + tw(tr(TR_FUNC, TrHelper, "size : %d \n", fd[fdi].size)); + tw(tr(TR_FUNC, TrHelper, "dir : %d \n", fd[fdi].dir)); + tw(tr(TR_FUNC, TrHelper, "name : %s \n", fd[fdi].name)); + tw(tr(TR_END, TrHelper, "}\n", fdi)); +} + +#endif // (TARGET == 0)
--- a/gsm-fw/services/ffs/core.h Thu Dec 26 04:37:10 2013 +0000 +++ b/gsm-fw/services/ffs/core.h Thu Dec 26 07:23:38 2013 +0000 @@ -117,17 +117,6 @@ // theoretically possess a high age #define saturate_dage(dage) (dage > (2*FFS_DAGE_MAX) ? (2*FFS_DAGE_MAX) : dage) -/****************************************************************************** - * External declarations - ******************************************************************************/ - -extern struct fs_s fs; -extern struct block_stat_s bstat[FFS_BLOCKS_MAX]; - -extern struct ffs_stats_s stats; - -extern const struct block_info_s *binfo; - /****************************************************************************** * Block Types @@ -203,6 +192,17 @@ uint16 objects; // number of valid objects }; +/****************************************************************************** + * External declarations + ******************************************************************************/ + +extern struct fs_s fs; +extern struct block_stat_s bstat[FFS_BLOCKS_MAX]; + +extern struct ffs_stats_s stats; + +extern const struct block_info_s *binfo; + /****************************************************************************** * Object Types
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/gsm-fw/services/ffs/tmffs.h Thu Dec 26 07:23:38 2013 +0000 @@ -0,0 +1,143 @@ +/****************************************************************************** + * Flash File System (ffs) + * Idea, design and coding by Mads Meisner-Jensen, mmj@ti.com + * + * FFS Testmode protocol definitions + * + * $Id: tmffs.h 1.16.1.3 Fri, 30 Aug 2002 15:11:37 +0200 tsj $ + * + ******************************************************************************/ + + +/****************************************************************************** + * Prototypes + ******************************************************************************/ + +int tm_ffs(unsigned char *outp, int outsize, unsigned char *inp, int insize); +int tmffs_bufsize(void); +unsigned char *tmffs_bufaddr(void); + +// Version of the TMFFS protocol +#define TMFFS1_VERSION ((uint16) 0x0188) + +// Version of the TMFFS2 protocol +#define TMFFS2_VERSION ((uint16) 0x0300) + +#ifdef TMFFS1 +#define FFS_TM_VERSION TMFFS1_VERSION +#endif + +#ifdef TMFFS2 +#define FFS_TM_VERSION TMFFS2_VERSION +#endif + +/****************************************************************************** + * FFS1 Protocol Indentifiers + ******************************************************************************/ + +typedef enum FFS_PROTOCOL_IDENTIFIERS { + FPI_END = 0, /* end */ + FPI_BEGIN, /* begin */ + FPI_TMFFS_VERSION, /* tmffs_version */ + + FPI_PREFORMAT, /* preformat */ + FPI_FORMAT, /* format */ + + FPI_FCREATE, /* fcreate */ + FPI_FUPDATE, /* fupdate */ + FPI_FWRITE, /* fwrite */ + FPI_FREAD, /* fread */ + FPI_REMOVE, /* remove */ + + FPI_MKDIR, /* mkdir */ + FPI_OPENDIR, /* opendir */ + FPI_READDIR, /* readdir */ + + FPI_STAT, /* stat */ + FPI_LINKSTAT, /* linkstat */ + + FPI_SYMLINK, /* symlink */ + FPI_READLINK, /* readlink */ + + FPI_QUERY, /* query */ + FPI_FCONTROL, /* fcontrol */ + + FPI_INIT, /* init */ + FPI_EXIT, /* exit */ + + FPI_PCM_GETFILEINFO, /* getfileinfo */ + FPI_PCM_READFILE, /* readfile */ + FPI_PCM_WRITEFILE, /* writefile */ + FPI_PCM_READRECORD, /* readrecord */ + FPI_PCM_WRITERECORD, /* writerecord */ + + FPI_BUFREAD, /* buf_read */ + FPI_BUFWRITE, /* buf_write */ + FPI_BUFSET, /* buf_set */ + + FPI_UINT8, /* UINT8 */ + FPI_UINT16, /* UINT16 */ + FPI_UINT32, /* UINT32 */ + FPI_INT8, /* INT8 */ + FPI_INT16, /* INT16 */ + FPI_INT32, /* INT32 */ + FPI_BUFFER, /* BUFFER */ + FPI_DATA, /* DATA */ + FPI_STRBUF, /* STRBUF */ + FPI_STRING, /* STRING */ + + FPI_TFFS /* TFFS */ + +} tmffs_cid_t; + +typedef tmffs_cid_t tmffs_proto_type_t; + + +/****************************************************************************** + * FFS2 Protocol Indentifiers + ******************************************************************************/ + +typedef enum FFS2_PROTOCOL_IDENTIFIERS { + TMFFS_FORMAT = 'f', + TMFFS_PREFORMAT = 'p', + + TMFFS_MKDIR = 'm', + TMFFS_OPENDIR = 'o', + TMFFS_READDIR = 'D', + TMFFS_REMOVE = 'd', + TMFFS_RENAME = 'n', + TMFFS_XLSTAT = 'x', + + TMFFS_SYMLINK = 'y', + TMFFS_READLINK = 'Y', + + TMFFS_OPEN = 'O', + TMFFS_CLOSE = 'C', + TMFFS_READ = 'R', + TMFFS_WRITE = 'W', + TMFFS_SEEK = 'S', + + TMFFS_FTRUNCATE = 'T', + TMFFS_TRUNCATE = 't', + + TMFFS_FILE_READ = 'r', + TMFFS_FILE_WRITE = 'w', + + TMFFS_FSTAT = 'F', + TMFFS_LSTAT = 'l', + TMFFS_STAT = 's', + + TMFFS_FCONTROL = 'c', + TMFFS_QUERY = 'q', + + TMFFS_INIT = 'i', + TMFFS_EXIT = 'e', + + // Special + TMFFS_DIRXLSTAT = 'X', + + TMFFS_VERSION = 'v', + TMFFS_TFFS = 'z' +} tmffs2_cid_t; + +