fstream.c 7.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387
  1. /*
  2. * Copyright (c) 2019 Actions Semiconductor Co., Ltd
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. /**
  7. * @file file stream interface
  8. */
  9. #define SYS_LOG_DOMAIN "filestream"
  10. #include <mem_manager.h>
  11. #include <fs_manager.h>
  12. #include <string.h>
  13. #include <stdlib.h>
  14. #include <stdio.h>
  15. #include <assert.h>
  16. #include "file_stream.h"
  17. #include "stream_internal.h"
  18. /** file info ,used for file stream */
  19. typedef struct {
  20. /** hanlde of file fp*/
  21. struct fs_file_t fp;
  22. /** mutex used for sync*/
  23. os_mutex lock;
  24. } file_stream_info_t;
  25. int fstream_open(io_stream_t handle, stream_mode mode)
  26. {
  27. file_stream_info_t *info = (file_stream_info_t *)handle->data;
  28. assert(info);
  29. handle->mode = mode;
  30. handle->write_finished = 0;
  31. handle->cache_size = 0;
  32. handle->total_size = 0;
  33. if (!fs_seek(&info->fp, 0, FS_SEEK_END)) {
  34. handle->total_size = fs_tell(&info->fp);
  35. /* seek back to file begin */
  36. fs_seek(&info->fp, 0, FS_SEEK_SET);
  37. }
  38. if ((handle->mode & MODE_IN_OUT) == MODE_OUT) {
  39. handle->wofs = 0;
  40. } else {
  41. handle->wofs = handle->total_size;
  42. }
  43. SYS_LOG_INF("handle %p total_size %d mode %x \n",handle, handle->total_size, mode);
  44. return 0;
  45. }
  46. int fstream_read(io_stream_t handle, unsigned char *buf,int num)
  47. {
  48. int brw;
  49. file_stream_info_t *info = (file_stream_info_t *)handle->data;
  50. assert(info);
  51. brw = os_mutex_lock(&info->lock, OS_FOREVER);
  52. if (brw < 0){
  53. SYS_LOG_ERR("lock failed %d \n",brw);
  54. return brw;
  55. }
  56. if ((handle->mode & MODE_IN_OUT) == MODE_IN_OUT) {
  57. brw = fs_seek(&info->fp, handle->rofs, FS_SEEK_SET);
  58. if (brw) {
  59. SYS_LOG_ERR("seek failed %d\n", brw);
  60. goto err_out;
  61. }
  62. }
  63. brw = fs_read(&info->fp, buf, num);
  64. if (brw < 0) {
  65. SYS_LOG_ERR(" failed %d\n", brw);
  66. goto err_out;
  67. }
  68. handle->rofs += brw;
  69. err_out:
  70. os_mutex_unlock(&info->lock);
  71. return brw;
  72. }
  73. int fstream_write(io_stream_t handle, unsigned char *buf,int num)
  74. {
  75. int brw;
  76. file_stream_info_t *info = (file_stream_info_t *)handle->data;
  77. assert(info);
  78. if ((handle->mode & MODE_IN_OUT) == MODE_IN_OUT) {
  79. if (num == 0) {
  80. handle->write_finished = 1;
  81. #if 0
  82. if (fs_sync(&info->fp)) {
  83. SYS_LOG_ERR("sync failed\n");
  84. }
  85. #endif
  86. return num;
  87. }
  88. }
  89. brw = os_mutex_lock(&info->lock, OS_FOREVER);
  90. if (brw < 0) {
  91. SYS_LOG_ERR("lock failed %d \n",brw);
  92. return brw;
  93. }
  94. if ((handle->mode & MODE_IN_OUT) == MODE_IN_OUT) {
  95. brw = fs_seek(&info->fp, handle->wofs, FS_SEEK_SET);
  96. if (brw) {
  97. SYS_LOG_ERR("seek failed %d\n", brw);
  98. goto err_out;
  99. }
  100. }
  101. brw = fs_write(&info->fp, buf, num);
  102. if (brw < 0) {
  103. SYS_LOG_ERR("write %d \n", brw);
  104. goto err_out;
  105. }
  106. handle->wofs += brw;
  107. if (handle->wofs > handle->total_size)
  108. handle->total_size = handle->wofs;
  109. if ((handle->mode & MODE_IN_OUT) == MODE_IN_OUT) {
  110. #if 0
  111. if (fs_sync(fp)) {
  112. SYS_LOG_ERR("sync failed \n");
  113. goto err_out;
  114. }
  115. #endif
  116. }
  117. err_out:
  118. os_mutex_unlock(&info->lock);
  119. return brw;
  120. }
  121. int fstream_seek(io_stream_t handle, int offset, seek_dir origin)
  122. {
  123. int whence = FS_SEEK_SET;
  124. int brw = 0;
  125. file_stream_info_t *info = (file_stream_info_t *)handle->data;
  126. assert(info);
  127. switch (origin) {
  128. case SEEK_DIR_CUR:
  129. if ((handle->mode & MODE_IN_OUT) == MODE_OUT) {
  130. offset = handle->wofs + offset;
  131. } else {
  132. offset = handle->rofs + offset;
  133. }
  134. break;
  135. case SEEK_DIR_END:
  136. whence = FS_SEEK_END;
  137. break;
  138. case SEEK_DIR_BEG:
  139. default:
  140. break;
  141. }
  142. brw = fs_seek(&info->fp, offset, whence);
  143. if (brw) {
  144. SYS_LOG_ERR("seek failed %d\n", brw);
  145. return -1;
  146. }
  147. offset = fs_tell(&info->fp);
  148. if ((handle->mode & MODE_IN_OUT) == MODE_OUT) {
  149. handle->wofs = offset;
  150. } else {
  151. handle->rofs = offset;
  152. }
  153. return 0;
  154. }
  155. int fstream_tell(io_stream_t handle)
  156. {
  157. file_stream_info_t *info = (file_stream_info_t *)handle->data;
  158. assert(info);
  159. return fs_tell(&info->fp);
  160. }
  161. int fstream_flush(io_stream_t handle)
  162. {
  163. int res;
  164. file_stream_info_t *info = (file_stream_info_t *)handle->data;
  165. assert(info);
  166. res = os_mutex_lock(&info->lock, OS_FOREVER);
  167. if (res < 0){
  168. SYS_LOG_ERR("lock failed %d \n",res);
  169. return res;
  170. }
  171. res = fs_sync(&info->fp);
  172. os_mutex_unlock(&info->lock);
  173. return res;
  174. }
  175. int fstream_close(io_stream_t handle)
  176. {
  177. int res;
  178. file_stream_info_t *info = (file_stream_info_t *)handle->data;
  179. assert(info);
  180. res = os_mutex_lock(&info->lock, OS_FOREVER);
  181. if (res < 0) {
  182. SYS_LOG_ERR("lock failed %d \n",res);
  183. return res;
  184. }
  185. handle->wofs = 0;
  186. handle->rofs = 0;
  187. handle->state = STATE_CLOSE;
  188. os_mutex_unlock(&info->lock);
  189. return res;
  190. }
  191. int fstream_destroy(io_stream_t handle)
  192. {
  193. int res;
  194. file_stream_info_t *info = (file_stream_info_t *)handle->data;
  195. assert(info);
  196. res = os_mutex_lock(&info->lock, OS_FOREVER);
  197. if (res < 0) {
  198. SYS_LOG_ERR("lock failed %d \n",res);
  199. return res;
  200. }
  201. res = fs_close(&info->fp);
  202. if (res) {
  203. SYS_LOG_ERR("close failed %d\n", res);
  204. }
  205. os_mutex_unlock(&info->lock);
  206. mem_free(info);
  207. return res;
  208. }
  209. int fstream_get_space(io_stream_t handle)
  210. {
  211. return INT_MAX;
  212. }
  213. static int file_name_has_cluster(char *file_name, char *dir, int max_dir_len, uint32_t *clust, uint32_t *blk_ofs)
  214. {
  215. char *str = NULL;
  216. char *cluster = NULL;
  217. char *blk = NULL;
  218. char *temp_ptr = NULL;
  219. int res = 0;
  220. char *temp_url = mem_malloc(strlen(file_name) + 1);
  221. if (!temp_url)
  222. goto exit;
  223. strcpy(temp_url, file_name);
  224. str = strstr(temp_url,"bycluster:");
  225. if (!str)
  226. goto exit;
  227. str += strlen("bycluster:");
  228. temp_ptr = (void *)str;
  229. /*for dir is /SD:*/
  230. if (*str == '/')
  231. str += 1;
  232. str = strchr(str, '/');
  233. if (!str)
  234. goto exit;
  235. str[0] = 0;
  236. if(strlen(temp_ptr) > max_dir_len) {
  237. memcpy(dir, temp_ptr, max_dir_len);
  238. } else {
  239. memcpy(dir, temp_ptr, strlen(temp_ptr));
  240. }
  241. str++;
  242. str = strstr(str,"cluster:");
  243. if (!str)
  244. goto exit;
  245. str += strlen("cluster:");
  246. cluster = str;
  247. str = strchr(str, '/');
  248. if (!str)
  249. goto exit;
  250. str[0] = 0;
  251. str++;
  252. blk = str;
  253. str = strchr(str, '/');
  254. if (!str)
  255. goto exit;
  256. str[0] = 0;
  257. *clust = atoi(cluster);
  258. *blk_ofs = atoi(blk);
  259. SYS_LOG_DBG("dir=%s,clust=%d,blk_ofs=%d\n", *dir, *clust, *blk_ofs);
  260. res = 1;
  261. exit:
  262. if (temp_url)
  263. mem_free(temp_url);
  264. return res;
  265. }
  266. int fstream_init(io_stream_t handle, void *param)
  267. {
  268. int res = 0;
  269. file_stream_info_t *info = NULL;
  270. char *file_name = (char *)param;
  271. char dir[16] = {0};
  272. uint32_t cluster = 0;
  273. uint32_t blk_ofs = 0;
  274. info = mem_malloc(sizeof(file_stream_info_t));
  275. if (!info) {
  276. SYS_LOG_ERR("no memory\n");
  277. return -ENOMEM;
  278. }
  279. if (file_name_has_cluster(file_name, dir, sizeof(dir), &cluster, &blk_ofs)) {
  280. res = fs_open_cluster(&info->fp, dir, cluster, blk_ofs);
  281. if (res) {
  282. SYS_LOG_ERR("open Failed %d\n", res);
  283. goto failed;
  284. }
  285. } else {
  286. res = fs_open(&info->fp, file_name, FA_READ | FA_WRITE | FA_OPEN_ALWAYS);
  287. if (res) {
  288. SYS_LOG_ERR("open Failed %d\n", res);
  289. goto failed;
  290. }
  291. }
  292. os_mutex_init(&info->lock);
  293. handle->data = info;
  294. return res;
  295. failed:
  296. mem_free(info);
  297. return res;
  298. }
  299. const stream_ops_t file_stream_ops = {
  300. .init = fstream_init,
  301. .open = fstream_open,
  302. .read = fstream_read,
  303. .seek = fstream_seek,
  304. .tell = fstream_tell,
  305. .write = fstream_write,
  306. .flush = fstream_flush,
  307. .get_space = fstream_get_space,
  308. .close = fstream_close,
  309. .destroy = fstream_destroy,
  310. };
  311. io_stream_t file_stream_create(const char *param)
  312. {
  313. return stream_create(&file_stream_ops, (void *)param);
  314. }