241 lines
6.8 KiB
C
241 lines
6.8 KiB
C
/*
|
|
* Copyright (c) 2006-2023, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2023-07-04 zhkag first Version
|
|
*/
|
|
|
|
#include <rtthread.h>
|
|
#include <rthw.h>
|
|
#include <dfs.h>
|
|
#include <dfs_fs.h>
|
|
#include <dfs_file.h>
|
|
#include <dfs_dentry.h>
|
|
#include <dfs_mnt.h>
|
|
#include "dfs_mqueue.h"
|
|
|
|
static rt_list_t _mqueue_file_list = RT_LIST_OBJECT_INIT(_mqueue_file_list);
|
|
struct rt_spinlock mqueue_lock;
|
|
|
|
void dfs_mqueue_insert_after(rt_list_t *n) {
|
|
rt_spin_lock(&mqueue_lock);
|
|
rt_list_insert_after(&(_mqueue_file_list), n);
|
|
rt_spin_unlock(&mqueue_lock);
|
|
}
|
|
|
|
struct mqueue_file *dfs_mqueue_lookup(const char *path, rt_size_t *size) {
|
|
struct mqueue_file *file;
|
|
rt_list_t *node;
|
|
rt_spin_lock(&mqueue_lock);
|
|
rt_list_for_each(node, &_mqueue_file_list) {
|
|
file = rt_list_entry(node, struct mqueue_file, list);
|
|
|
|
if (rt_strncmp(file->name, path, RT_NAME_MAX) == 0) {
|
|
*size = file->size;
|
|
rt_spin_unlock(&mqueue_lock);
|
|
return file;
|
|
}
|
|
}
|
|
rt_spin_unlock(&mqueue_lock);
|
|
return RT_NULL;
|
|
}
|
|
|
|
int dfs_mqueue_mount(struct dfs_filesystem *fs, unsigned long rwflag, const void *data) {
|
|
return RT_EOK;
|
|
}
|
|
|
|
int dfs_mqueue_umount(struct dfs_filesystem *fs) { return RT_EOK; }
|
|
|
|
int dfs_mqueue_statfs(struct dfs_filesystem *fs, struct statfs *buf) { return RT_EOK; }
|
|
|
|
int dfs_mqueue_close(struct dfs_file *file) { return RT_EOK; }
|
|
|
|
int dfs_mqueue_open(struct dfs_file *file) {
|
|
rt_size_t size;
|
|
if ((file->dentry->pathname[0] == '/') && (file->dentry->pathname[1] == '\0'))
|
|
return 0;
|
|
|
|
}
|
|
|
|
int dfs_mqueue_stat(struct dfs_dentry *dentry, struct stat *st) {
|
|
const char *path = RT_NULL;
|
|
struct dfs_vnode *vnode = RT_NULL;
|
|
if (dentry && dentry->vnode) {
|
|
path = dentry->pathname;
|
|
vnode = dentry->vnode;
|
|
st->st_dev = 0;
|
|
st->st_gid = vnode->gid;
|
|
st->st_uid = vnode->uid;
|
|
st->st_ino = 0;
|
|
st->st_mode = vnode->mode;
|
|
st->st_nlink = vnode->nlink;
|
|
st->st_size = vnode->size;
|
|
st->st_mtim.tv_nsec = vnode->mtime.tv_nsec;
|
|
st->st_mtim.tv_sec = vnode->mtime.tv_sec;
|
|
st->st_ctim.tv_nsec = vnode->ctime.tv_nsec;
|
|
st->st_ctim.tv_sec = vnode->ctime.tv_sec;
|
|
st->st_atim.tv_nsec = vnode->atime.tv_nsec;
|
|
st->st_atim.tv_sec = vnode->atime.tv_sec;
|
|
}
|
|
return RT_EOK;
|
|
}
|
|
|
|
int dfs_mqueue_getdents(struct dfs_file *file, struct dirent *dirp, uint32_t count) {
|
|
rt_size_t index, end;
|
|
struct dirent *d;
|
|
count = (count / sizeof(struct dirent));
|
|
end = file->fpos + count;
|
|
index = 0;
|
|
count = 0;
|
|
struct mqueue_file *mq_file;
|
|
rt_list_t *node;
|
|
rt_spin_lock(&mqueue_lock);
|
|
rt_list_for_each(node, &_mqueue_file_list) {
|
|
if (index >= (rt_size_t)file->fpos) {
|
|
mq_file = rt_list_entry(node, struct mqueue_file, list);
|
|
d = dirp + count;
|
|
d->d_namlen = RT_NAME_MAX;
|
|
d->d_reclen = (rt_uint16_t)sizeof(struct dirent);
|
|
rt_strncpy(d->d_name, mq_file->name, RT_NAME_MAX);
|
|
count += 1;
|
|
file->fpos += 1;
|
|
}
|
|
index += 1;
|
|
if (index >= end) {
|
|
break;
|
|
}
|
|
}
|
|
rt_spin_unlock(&mqueue_lock);
|
|
return count * sizeof(struct dirent);
|
|
}
|
|
|
|
int dfs_mqueue_unlink(struct dfs_dentry *dentry) {
|
|
rt_size_t size;
|
|
struct mqueue_file *mq_file;
|
|
mq_file = dfs_mqueue_lookup(dentry->pathname + 1, &size);
|
|
if (mq_file == RT_NULL)
|
|
return -ENOENT;
|
|
rt_list_remove(&(mq_file->list));
|
|
if (mq_file->data != RT_NULL)
|
|
rt_mq_delete((rt_mq_t)mq_file->data);
|
|
rt_free(mq_file);
|
|
return RT_EOK;
|
|
}
|
|
|
|
static struct dfs_vnode *dfs_mqueue_create_vnode(struct dfs_dentry *dentry, int type, mode_t mode) {
|
|
struct dfs_vnode *vnode = RT_NULL;
|
|
rt_size_t size;
|
|
struct mqueue_file *mq_file;
|
|
|
|
if (dentry == NULL || dentry->mnt == NULL) {
|
|
return NULL;
|
|
}
|
|
|
|
vnode = dfs_vnode_create();
|
|
if (vnode) {
|
|
mq_file = dfs_mqueue_lookup(dentry->pathname + 1, &size);
|
|
if (mq_file == RT_NULL) {
|
|
mq_file = (struct mqueue_file *)rt_malloc(sizeof(struct mqueue_file));
|
|
if (mq_file == RT_NULL) {
|
|
return -ENFILE;
|
|
}
|
|
mq_file->msg_size = 8192;
|
|
mq_file->max_msgs = 10;
|
|
strncpy(mq_file->name, dentry->pathname + 1, RT_NAME_MAX);
|
|
dfs_mqueue_insert_after(&(mq_file->list));
|
|
}
|
|
|
|
vnode->mode = S_IFREG | mode;
|
|
vnode->type = FT_REGULAR;
|
|
rt_mq_t mq = rt_mq_create(dentry->pathname + 1, mq_file->msg_size, mq_file->max_msgs,
|
|
RT_IPC_FLAG_FIFO);
|
|
mq_file->data = (void *)mq;
|
|
vnode->data = mq_file;
|
|
vnode->size = 0;
|
|
}
|
|
|
|
return vnode;
|
|
}
|
|
|
|
static int dfs_mqueue_free_vnode(struct dfs_vnode *vnode) {
|
|
/* nothing to be freed */
|
|
if (vnode && vnode->ref_count <= 1) {
|
|
vnode->data = NULL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static const struct dfs_file_ops _mqueue_fops = {
|
|
.open = dfs_mqueue_open,
|
|
.close = dfs_mqueue_close,
|
|
.getdents = dfs_mqueue_getdents,
|
|
};
|
|
|
|
struct dfs_vnode *_dfs_mqueue_lookup(struct dfs_dentry *dentry) {
|
|
struct dfs_vnode *vnode = RT_NULL;
|
|
rt_size_t size;
|
|
// struct tmpfs_sb *superblock;
|
|
struct mqueue_file *mq_file;
|
|
|
|
if (dentry == NULL || dentry->mnt == NULL) {
|
|
return NULL;
|
|
}
|
|
|
|
if (dentry->pathname[0] == '/' && dentry->pathname[1] == '\0') {
|
|
}
|
|
|
|
mq_file = dfs_mqueue_lookup(dentry->pathname + 1, &size);
|
|
|
|
vnode = dfs_vnode_create();
|
|
if (mq_file && mq_file->data) {
|
|
vnode->mode = S_IFREG | S_IRUSR | S_IWUSR | S_IXUSR;
|
|
vnode->type = FT_REGULAR;
|
|
vnode->mnt = dentry->mnt;
|
|
vnode->data = mq_file;
|
|
vnode->size = mq_file->size;
|
|
} else {
|
|
vnode->size = 0;
|
|
vnode->nlink = 1;
|
|
vnode->fops = &_mqueue_fops;
|
|
vnode->mnt = dentry->mnt;
|
|
vnode->type = FT_DIRECTORY;
|
|
vnode->mode = S_IFDIR | S_IRUSR | S_IWUSR | S_IXUSR;
|
|
}
|
|
return vnode;
|
|
}
|
|
|
|
static const struct dfs_filesystem_ops _mqueue_ops = {
|
|
.name = "mqueue",
|
|
.flags = DFS_FS_FLAG_DEFAULT,
|
|
.default_fops = &_mqueue_fops,
|
|
|
|
.mount = dfs_mqueue_mount,
|
|
.umount = dfs_mqueue_umount,
|
|
.statfs = dfs_mqueue_statfs,
|
|
|
|
.unlink = dfs_mqueue_unlink,
|
|
.stat = dfs_mqueue_stat,
|
|
|
|
.lookup = _dfs_mqueue_lookup,
|
|
.create_vnode = dfs_mqueue_create_vnode,
|
|
.free_vnode = dfs_mqueue_free_vnode
|
|
};
|
|
|
|
static struct dfs_filesystem_type _mqueue = {
|
|
.fs_ops = &_mqueue_ops,
|
|
};
|
|
|
|
int dfs_mqueue_init(void) {
|
|
/* register mqueue file system */
|
|
dfs_register(&_mqueue);
|
|
mkdir("/dev/mqueue", 0x777);
|
|
if (dfs_mount(RT_NULL, "/dev/mqueue", "mqueue", 0, 0) != 0) {
|
|
rt_kprintf("Dir /dev/mqueue mount failed!\n");
|
|
}
|
|
return 0;
|
|
}
|
|
INIT_COMPONENT_EXPORT(dfs_mqueue_init);
|