dfs_mqueue.c 6.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240
  1. /*
  2. * Copyright (c) 2006-2023, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2023-07-04 zhkag first Version
  9. */
  10. #include <rtthread.h>
  11. #include <rthw.h>
  12. #include <dfs.h>
  13. #include <dfs_fs.h>
  14. #include <dfs_file.h>
  15. #include <dfs_dentry.h>
  16. #include <dfs_mnt.h>
  17. #include "dfs_mqueue.h"
  18. static rt_list_t _mqueue_file_list = RT_LIST_OBJECT_INIT(_mqueue_file_list);
  19. struct rt_spinlock mqueue_lock;
  20. void dfs_mqueue_insert_after(rt_list_t *n) {
  21. rt_spin_lock(&mqueue_lock);
  22. rt_list_insert_after(&(_mqueue_file_list), n);
  23. rt_spin_unlock(&mqueue_lock);
  24. }
  25. struct mqueue_file *dfs_mqueue_lookup(const char *path, rt_size_t *size) {
  26. struct mqueue_file *file;
  27. rt_list_t *node;
  28. rt_spin_lock(&mqueue_lock);
  29. rt_list_for_each(node, &_mqueue_file_list) {
  30. file = rt_list_entry(node, struct mqueue_file, list);
  31. if (rt_strncmp(file->name, path, RT_NAME_MAX) == 0) {
  32. *size = file->size;
  33. rt_spin_unlock(&mqueue_lock);
  34. return file;
  35. }
  36. }
  37. rt_spin_unlock(&mqueue_lock);
  38. return RT_NULL;
  39. }
  40. int dfs_mqueue_mount(struct dfs_filesystem *fs, unsigned long rwflag, const void *data) {
  41. return RT_EOK;
  42. }
  43. int dfs_mqueue_umount(struct dfs_filesystem *fs) { return RT_EOK; }
  44. int dfs_mqueue_statfs(struct dfs_filesystem *fs, struct statfs *buf) { return RT_EOK; }
  45. int dfs_mqueue_close(struct dfs_file *file) { return RT_EOK; }
  46. int dfs_mqueue_open(struct dfs_file *file) {
  47. rt_size_t size;
  48. if ((file->dentry->pathname[0] == '/') && (file->dentry->pathname[1] == '\0'))
  49. return 0;
  50. }
  51. int dfs_mqueue_stat(struct dfs_dentry *dentry, struct stat *st) {
  52. const char *path = RT_NULL;
  53. struct dfs_vnode *vnode = RT_NULL;
  54. if (dentry && dentry->vnode) {
  55. path = dentry->pathname;
  56. vnode = dentry->vnode;
  57. st->st_dev = 0;
  58. st->st_gid = vnode->gid;
  59. st->st_uid = vnode->uid;
  60. st->st_ino = 0;
  61. st->st_mode = vnode->mode;
  62. st->st_nlink = vnode->nlink;
  63. st->st_size = vnode->size;
  64. st->st_mtim.tv_nsec = vnode->mtime.tv_nsec;
  65. st->st_mtim.tv_sec = vnode->mtime.tv_sec;
  66. st->st_ctim.tv_nsec = vnode->ctime.tv_nsec;
  67. st->st_ctim.tv_sec = vnode->ctime.tv_sec;
  68. st->st_atim.tv_nsec = vnode->atime.tv_nsec;
  69. st->st_atim.tv_sec = vnode->atime.tv_sec;
  70. }
  71. return RT_EOK;
  72. }
  73. int dfs_mqueue_getdents(struct dfs_file *file, struct dirent *dirp, uint32_t count) {
  74. rt_size_t index, end;
  75. struct dirent *d;
  76. count = (count / sizeof(struct dirent));
  77. end = file->fpos + count;
  78. index = 0;
  79. count = 0;
  80. struct mqueue_file *mq_file;
  81. rt_list_t *node;
  82. rt_spin_lock(&mqueue_lock);
  83. rt_list_for_each(node, &_mqueue_file_list) {
  84. if (index >= (rt_size_t)file->fpos) {
  85. mq_file = rt_list_entry(node, struct mqueue_file, list);
  86. d = dirp + count;
  87. d->d_namlen = RT_NAME_MAX;
  88. d->d_reclen = (rt_uint16_t)sizeof(struct dirent);
  89. rt_strncpy(d->d_name, mq_file->name, RT_NAME_MAX);
  90. count += 1;
  91. file->fpos += 1;
  92. }
  93. index += 1;
  94. if (index >= end) {
  95. break;
  96. }
  97. }
  98. rt_spin_unlock(&mqueue_lock);
  99. return count * sizeof(struct dirent);
  100. }
  101. int dfs_mqueue_unlink(struct dfs_dentry *dentry) {
  102. rt_size_t size;
  103. struct mqueue_file *mq_file;
  104. mq_file = dfs_mqueue_lookup(dentry->pathname + 1, &size);
  105. if (mq_file == RT_NULL)
  106. return -ENOENT;
  107. rt_list_remove(&(mq_file->list));
  108. if (mq_file->data != RT_NULL)
  109. rt_mq_delete((rt_mq_t)mq_file->data);
  110. rt_free(mq_file);
  111. return RT_EOK;
  112. }
  113. static struct dfs_vnode *dfs_mqueue_create_vnode(struct dfs_dentry *dentry, int type, mode_t mode) {
  114. struct dfs_vnode *vnode = RT_NULL;
  115. rt_size_t size;
  116. struct mqueue_file *mq_file;
  117. if (dentry == NULL || dentry->mnt == NULL) {
  118. return NULL;
  119. }
  120. vnode = dfs_vnode_create();
  121. if (vnode) {
  122. mq_file = dfs_mqueue_lookup(dentry->pathname + 1, &size);
  123. if (mq_file == RT_NULL) {
  124. mq_file = (struct mqueue_file *)rt_malloc(sizeof(struct mqueue_file));
  125. if (mq_file == RT_NULL) {
  126. return -ENFILE;
  127. }
  128. mq_file->msg_size = 8192;
  129. mq_file->max_msgs = 10;
  130. strncpy(mq_file->name, dentry->pathname + 1, RT_NAME_MAX);
  131. dfs_mqueue_insert_after(&(mq_file->list));
  132. }
  133. vnode->mode = S_IFREG | mode;
  134. vnode->type = FT_REGULAR;
  135. rt_mq_t mq = rt_mq_create(dentry->pathname + 1, mq_file->msg_size, mq_file->max_msgs,
  136. RT_IPC_FLAG_FIFO);
  137. mq_file->data = (void *)mq;
  138. vnode->data = mq_file;
  139. vnode->size = 0;
  140. }
  141. return vnode;
  142. }
  143. static int dfs_mqueue_free_vnode(struct dfs_vnode *vnode) {
  144. /* nothing to be freed */
  145. if (vnode && vnode->ref_count <= 1) {
  146. vnode->data = NULL;
  147. }
  148. return 0;
  149. }
  150. static const struct dfs_file_ops _mqueue_fops = {
  151. .open = dfs_mqueue_open,
  152. .close = dfs_mqueue_close,
  153. .getdents = dfs_mqueue_getdents,
  154. };
  155. struct dfs_vnode *_dfs_mqueue_lookup(struct dfs_dentry *dentry) {
  156. struct dfs_vnode *vnode = RT_NULL;
  157. rt_size_t size;
  158. // struct tmpfs_sb *superblock;
  159. struct mqueue_file *mq_file;
  160. if (dentry == NULL || dentry->mnt == NULL) {
  161. return NULL;
  162. }
  163. if (dentry->pathname[0] == '/' && dentry->pathname[1] == '\0') {
  164. }
  165. mq_file = dfs_mqueue_lookup(dentry->pathname + 1, &size);
  166. vnode = dfs_vnode_create();
  167. if (mq_file && mq_file->data) {
  168. vnode->mode = S_IFREG | S_IRUSR | S_IWUSR | S_IXUSR;
  169. vnode->type = FT_REGULAR;
  170. vnode->mnt = dentry->mnt;
  171. vnode->data = mq_file;
  172. vnode->size = mq_file->size;
  173. } else {
  174. vnode->size = 0;
  175. vnode->nlink = 1;
  176. vnode->fops = &_mqueue_fops;
  177. vnode->mnt = dentry->mnt;
  178. vnode->type = FT_DIRECTORY;
  179. vnode->mode = S_IFDIR | S_IRUSR | S_IWUSR | S_IXUSR;
  180. }
  181. return vnode;
  182. }
  183. static const struct dfs_filesystem_ops _mqueue_ops = {
  184. .name = "mqueue",
  185. .flags = DFS_FS_FLAG_DEFAULT,
  186. .default_fops = &_mqueue_fops,
  187. .mount = dfs_mqueue_mount,
  188. .umount = dfs_mqueue_umount,
  189. .statfs = dfs_mqueue_statfs,
  190. .unlink = dfs_mqueue_unlink,
  191. .stat = dfs_mqueue_stat,
  192. .lookup = _dfs_mqueue_lookup,
  193. .create_vnode = dfs_mqueue_create_vnode,
  194. .free_vnode = dfs_mqueue_free_vnode
  195. };
  196. static struct dfs_filesystem_type _mqueue = {
  197. .fs_ops = &_mqueue_ops,
  198. };
  199. int dfs_mqueue_init(void) {
  200. /* register mqueue file system */
  201. dfs_register(&_mqueue);
  202. mkdir("/dev/mqueue", 0x777);
  203. if (dfs_mount(RT_NULL, "/dev/mqueue", "mqueue", 0, 0) != 0) {
  204. rt_kprintf("Dir /dev/mqueue mount failed!\n");
  205. }
  206. return 0;
  207. }
  208. INIT_COMPONENT_EXPORT(dfs_mqueue_init);