385 lines
8.4 KiB
C
385 lines
8.4 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2006-2022, RT-Thread Development Team
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Change Logs:
|
||
|
|
* Date Author Notes
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <rtthread.h>
|
||
|
|
#include <dfs.h>
|
||
|
|
#include <dfs_fs.h>
|
||
|
|
#include <dfs_file.h>
|
||
|
|
|
||
|
|
#include "dfs_romfs.h"
|
||
|
|
|
||
|
|
int dfs_romfs_mount(struct dfs_filesystem *fs, unsigned long rwflag, const void *data)
|
||
|
|
{
|
||
|
|
struct romfs_dirent *root_dirent;
|
||
|
|
|
||
|
|
if (data == NULL)
|
||
|
|
return -EIO;
|
||
|
|
|
||
|
|
root_dirent = (struct romfs_dirent *)data;
|
||
|
|
fs->data = root_dirent;
|
||
|
|
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dfs_romfs_unmount(struct dfs_filesystem *fs)
|
||
|
|
{
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dfs_romfs_ioctl(struct dfs_file *file, int cmd, void *args)
|
||
|
|
{
|
||
|
|
int ret = RT_EOK;
|
||
|
|
struct romfs_dirent *dirent;
|
||
|
|
|
||
|
|
dirent = (struct romfs_dirent *)file->vnode->data;
|
||
|
|
RT_ASSERT(dirent != NULL);
|
||
|
|
|
||
|
|
switch (cmd)
|
||
|
|
{
|
||
|
|
case RT_FIOGETADDR:
|
||
|
|
{
|
||
|
|
*(rt_ubase_t*)args = (rt_ubase_t)dirent->data;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
case RT_FIOFTRUNCATE:
|
||
|
|
{
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
default:
|
||
|
|
ret = -RT_EINVAL;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
rt_inline int check_dirent(struct romfs_dirent *dirent)
|
||
|
|
{
|
||
|
|
if ((dirent->type != ROMFS_DIRENT_FILE && dirent->type != ROMFS_DIRENT_DIR)
|
||
|
|
|| dirent->size == ~0U)
|
||
|
|
return -1;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
struct romfs_dirent *dfs_romfs_lookup(struct romfs_dirent *root_dirent, const char *path, rt_size_t *size)
|
||
|
|
{
|
||
|
|
rt_size_t index, found;
|
||
|
|
const char *subpath, *subpath_end;
|
||
|
|
struct romfs_dirent *dirent;
|
||
|
|
rt_size_t dirent_size;
|
||
|
|
|
||
|
|
/* Check the root_dirent. */
|
||
|
|
if (check_dirent(root_dirent) != 0)
|
||
|
|
return NULL;
|
||
|
|
|
||
|
|
if (path[0] == '/' && path[1] == '\0')
|
||
|
|
{
|
||
|
|
*size = root_dirent->size;
|
||
|
|
return root_dirent;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* goto root directory entries */
|
||
|
|
dirent = (struct romfs_dirent *)root_dirent->data;
|
||
|
|
dirent_size = root_dirent->size;
|
||
|
|
|
||
|
|
/* get the end position of this subpath */
|
||
|
|
subpath_end = path;
|
||
|
|
/* skip /// */
|
||
|
|
while (*subpath_end && *subpath_end == '/')
|
||
|
|
subpath_end ++;
|
||
|
|
subpath = subpath_end;
|
||
|
|
while ((*subpath_end != '/') && *subpath_end)
|
||
|
|
subpath_end ++;
|
||
|
|
|
||
|
|
while (dirent != NULL)
|
||
|
|
{
|
||
|
|
found = 0;
|
||
|
|
|
||
|
|
/* search in folder */
|
||
|
|
for (index = 0; index < dirent_size; index ++)
|
||
|
|
{
|
||
|
|
if (check_dirent(&dirent[index]) != 0)
|
||
|
|
return NULL;
|
||
|
|
if (rt_strlen(dirent[index].name) == (rt_size_t)(subpath_end - subpath) &&
|
||
|
|
rt_strncmp(dirent[index].name, subpath, (subpath_end - subpath)) == 0)
|
||
|
|
{
|
||
|
|
dirent_size = dirent[index].size;
|
||
|
|
|
||
|
|
/* skip /// */
|
||
|
|
while (*subpath_end && *subpath_end == '/')
|
||
|
|
subpath_end ++;
|
||
|
|
subpath = subpath_end;
|
||
|
|
while ((*subpath_end != '/') && *subpath_end)
|
||
|
|
subpath_end ++;
|
||
|
|
|
||
|
|
if (!(*subpath))
|
||
|
|
{
|
||
|
|
*size = dirent_size;
|
||
|
|
return &dirent[index];
|
||
|
|
}
|
||
|
|
|
||
|
|
if (dirent[index].type == ROMFS_DIRENT_DIR)
|
||
|
|
{
|
||
|
|
/* enter directory */
|
||
|
|
dirent = (struct romfs_dirent *)dirent[index].data;
|
||
|
|
found = 1;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
/* return file dirent */
|
||
|
|
return &dirent[index];
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (!found)
|
||
|
|
break; /* not found */
|
||
|
|
}
|
||
|
|
|
||
|
|
/* not found */
|
||
|
|
return NULL;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dfs_romfs_read(struct dfs_file *file, void *buf, size_t count)
|
||
|
|
{
|
||
|
|
rt_size_t length;
|
||
|
|
struct romfs_dirent *dirent;
|
||
|
|
|
||
|
|
dirent = (struct romfs_dirent *)file->vnode->data;
|
||
|
|
RT_ASSERT(dirent != NULL);
|
||
|
|
|
||
|
|
if (check_dirent(dirent) != 0)
|
||
|
|
{
|
||
|
|
return -EIO;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (count < file->vnode->size - file->pos)
|
||
|
|
length = count;
|
||
|
|
else
|
||
|
|
length = file->vnode->size - file->pos;
|
||
|
|
|
||
|
|
if (length > 0)
|
||
|
|
rt_memcpy(buf, &(dirent->data[file->pos]), length);
|
||
|
|
|
||
|
|
/* update file current position */
|
||
|
|
file->pos += length;
|
||
|
|
|
||
|
|
return length;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dfs_romfs_lseek(struct dfs_file *file, off_t offset)
|
||
|
|
{
|
||
|
|
if (offset <= file->vnode->size)
|
||
|
|
{
|
||
|
|
file->pos = offset;
|
||
|
|
return file->pos;
|
||
|
|
}
|
||
|
|
|
||
|
|
return -EIO;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dfs_romfs_close(struct dfs_file *file)
|
||
|
|
{
|
||
|
|
RT_ASSERT(file->vnode->ref_count > 0);
|
||
|
|
if (file->vnode->ref_count > 1)
|
||
|
|
{
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
file->vnode->data = NULL;
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dfs_romfs_open(struct dfs_file *file)
|
||
|
|
{
|
||
|
|
rt_size_t size;
|
||
|
|
struct romfs_dirent *dirent;
|
||
|
|
struct romfs_dirent *root_dirent;
|
||
|
|
struct dfs_filesystem *fs;
|
||
|
|
|
||
|
|
if (file->flags & (O_CREAT | O_WRONLY | O_APPEND | O_TRUNC | O_RDWR))
|
||
|
|
{
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
RT_ASSERT(file->vnode->ref_count > 0);
|
||
|
|
if (file->vnode->ref_count > 1)
|
||
|
|
{
|
||
|
|
if (file->vnode->type == FT_DIRECTORY
|
||
|
|
&& !(file->flags & O_DIRECTORY))
|
||
|
|
{
|
||
|
|
return -ENOENT;
|
||
|
|
}
|
||
|
|
file->pos = 0;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
fs = file->vnode->fs;
|
||
|
|
root_dirent = (struct romfs_dirent *)fs->data;
|
||
|
|
|
||
|
|
if (check_dirent(root_dirent) != 0)
|
||
|
|
{
|
||
|
|
return -EIO;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (file->flags & (O_CREAT | O_WRONLY | O_APPEND | O_TRUNC | O_RDWR))
|
||
|
|
{
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
dirent = dfs_romfs_lookup(root_dirent, file->vnode->path, &size);
|
||
|
|
if (dirent == NULL)
|
||
|
|
{
|
||
|
|
return -ENOENT;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* entry is a directory file type */
|
||
|
|
if (dirent->type == ROMFS_DIRENT_DIR)
|
||
|
|
{
|
||
|
|
if (!(file->flags & O_DIRECTORY))
|
||
|
|
{
|
||
|
|
return -ENOENT;
|
||
|
|
}
|
||
|
|
file->vnode->type = FT_DIRECTORY;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
/* entry is a file, but open it as a directory */
|
||
|
|
if (file->flags & O_DIRECTORY)
|
||
|
|
{
|
||
|
|
return -ENOENT;
|
||
|
|
}
|
||
|
|
file->vnode->type = FT_REGULAR;
|
||
|
|
}
|
||
|
|
|
||
|
|
file->vnode->data = dirent;
|
||
|
|
file->vnode->size = size;
|
||
|
|
file->pos = 0;
|
||
|
|
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dfs_romfs_stat(struct dfs_filesystem *fs, const char *path, struct stat *st)
|
||
|
|
{
|
||
|
|
rt_size_t size;
|
||
|
|
struct romfs_dirent *dirent;
|
||
|
|
struct romfs_dirent *root_dirent;
|
||
|
|
|
||
|
|
root_dirent = (struct romfs_dirent *)fs->data;
|
||
|
|
dirent = dfs_romfs_lookup(root_dirent, path, &size);
|
||
|
|
|
||
|
|
if (dirent == NULL)
|
||
|
|
{
|
||
|
|
return -ENOENT;
|
||
|
|
}
|
||
|
|
|
||
|
|
st->st_dev = 0;
|
||
|
|
st->st_mode = S_IFREG | S_IRUSR | S_IRGRP | S_IROTH |
|
||
|
|
S_IWUSR | S_IWGRP | S_IWOTH;
|
||
|
|
|
||
|
|
if (dirent->type == ROMFS_DIRENT_DIR)
|
||
|
|
{
|
||
|
|
st->st_mode &= ~S_IFREG;
|
||
|
|
st->st_mode |= S_IFDIR | S_IXUSR | S_IXGRP | S_IXOTH;
|
||
|
|
}
|
||
|
|
|
||
|
|
st->st_size = dirent->size;
|
||
|
|
st->st_mtime = 0;
|
||
|
|
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dfs_romfs_getdents(struct dfs_file *file, struct dirent *dirp, uint32_t count)
|
||
|
|
{
|
||
|
|
rt_size_t index;
|
||
|
|
rt_size_t len;
|
||
|
|
const char *name;
|
||
|
|
struct dirent *d;
|
||
|
|
struct romfs_dirent *dirent, *sub_dirent;
|
||
|
|
|
||
|
|
dirent = (struct romfs_dirent *)file->vnode->data;
|
||
|
|
if (check_dirent(dirent) != 0)
|
||
|
|
{
|
||
|
|
return -EIO;
|
||
|
|
}
|
||
|
|
RT_ASSERT(dirent->type == ROMFS_DIRENT_DIR);
|
||
|
|
|
||
|
|
/* enter directory */
|
||
|
|
dirent = (struct romfs_dirent *)dirent->data;
|
||
|
|
|
||
|
|
/* make integer count */
|
||
|
|
count = (count / sizeof(struct dirent));
|
||
|
|
if (count == 0)
|
||
|
|
{
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
index = 0;
|
||
|
|
for (index = 0; index < count && file->pos < file->vnode->size; index++)
|
||
|
|
{
|
||
|
|
d = dirp + index;
|
||
|
|
|
||
|
|
sub_dirent = &dirent[file->pos];
|
||
|
|
name = sub_dirent->name;
|
||
|
|
|
||
|
|
/* fill dirent */
|
||
|
|
if (sub_dirent->type == ROMFS_DIRENT_DIR)
|
||
|
|
d->d_type = DT_DIR;
|
||
|
|
else
|
||
|
|
d->d_type = DT_REG;
|
||
|
|
|
||
|
|
len = rt_strlen(name);
|
||
|
|
RT_ASSERT(len <= RT_UINT8_MAX);
|
||
|
|
d->d_namlen = (rt_uint8_t)len;
|
||
|
|
d->d_reclen = (rt_uint16_t)sizeof(struct dirent);
|
||
|
|
rt_strncpy(d->d_name, name, DFS_PATH_MAX);
|
||
|
|
|
||
|
|
/* move to next position */
|
||
|
|
++ file->pos;
|
||
|
|
}
|
||
|
|
|
||
|
|
return index * sizeof(struct dirent);
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct dfs_file_ops _rom_fops =
|
||
|
|
{
|
||
|
|
dfs_romfs_open,
|
||
|
|
dfs_romfs_close,
|
||
|
|
dfs_romfs_ioctl,
|
||
|
|
dfs_romfs_read,
|
||
|
|
NULL,
|
||
|
|
NULL,
|
||
|
|
dfs_romfs_lseek,
|
||
|
|
dfs_romfs_getdents,
|
||
|
|
NULL,
|
||
|
|
};
|
||
|
|
static const struct dfs_filesystem_ops _romfs =
|
||
|
|
{
|
||
|
|
"rom",
|
||
|
|
DFS_FS_FLAG_DEFAULT,
|
||
|
|
&_rom_fops,
|
||
|
|
|
||
|
|
dfs_romfs_mount,
|
||
|
|
dfs_romfs_unmount,
|
||
|
|
NULL,
|
||
|
|
NULL,
|
||
|
|
|
||
|
|
NULL,
|
||
|
|
dfs_romfs_stat,
|
||
|
|
NULL,
|
||
|
|
};
|
||
|
|
|
||
|
|
int dfs_romfs_init(void)
|
||
|
|
{
|
||
|
|
/* register rom file system */
|
||
|
|
dfs_register(&_romfs);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
INIT_COMPONENT_EXPORT(dfs_romfs_init);
|
||
|
|
|