hostfs_rpmsg_server.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646
  1. /****************************************************************************
  2. * fs/hostfs/hostfs_rpmsg_server.c
  3. * Hostfs rpmsg driver on server
  4. *
  5. * Copyright (C) 2017 Pinecone Inc. All rights reserved.
  6. * Author: Guiding Li<liguiding@pinecone.net>
  7. *
  8. * Redistribution and use in source and binary forms, with or without
  9. * modification, are permitted provided that the following conditions
  10. * are met:
  11. *
  12. * 1. Redistributions of source code must retain the above copyright
  13. * notice, this list of conditions and the following disclaimer.
  14. * 2. Redistributions in binary form must reproduce the above copyright
  15. * notice, this list of conditions and the following disclaimer in
  16. * the documentation and/or other materials provided with the
  17. * distribution.
  18. * 3. Neither the name NuttX nor the names of its contributors may be
  19. * used to endorse or promote products derived from this software
  20. * without specific prior written permission.
  21. *
  22. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  23. * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  24. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  25. * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
  26. * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  27. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  28. * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
  29. * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
  30. * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  31. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
  32. * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  33. * POSSIBILITY OF SUCH DAMAGE.
  34. *
  35. ****************************************************************************/
  36. /****************************************************************************
  37. * Included Files
  38. ****************************************************************************/
  39. #include <nuttx/config.h>
  40. #include <dirent.h>
  41. #include <stdio.h>
  42. #include <string.h>
  43. #include <fcntl.h>
  44. #include <errno.h>
  45. #include <nuttx/kmalloc.h>
  46. #include <nuttx/fs/fs.h>
  47. #include <nuttx/fs/hostfs_rpmsg.h>
  48. #include <nuttx/rptun/openamp.h>
  49. #include "hostfs_rpmsg.h"
  50. /****************************************************************************
  51. * Private Types
  52. ****************************************************************************/
  53. struct hostfs_rpmsg_server_s
  54. {
  55. struct rpmsg_endpoint ept;
  56. struct file files[CONFIG_NFILE_DESCRIPTORS];
  57. void *dirs[CONFIG_NFILE_DESCRIPTORS];
  58. sem_t sem;
  59. };
  60. /****************************************************************************
  61. * Private Function Prototypes
  62. ****************************************************************************/
  63. static int hostfs_rpmsg_open_handler(FAR struct rpmsg_endpoint *ept,
  64. FAR void *data, size_t len,
  65. uint32_t src, FAR void *priv_);
  66. static int hostfs_rpmsg_close_handler(FAR struct rpmsg_endpoint *ept,
  67. FAR void *data, size_t len,
  68. uint32_t src, FAR void *priv_);
  69. static int hostfs_rpmsg_read_handler(FAR struct rpmsg_endpoint *ept,
  70. FAR void *data, size_t len,
  71. uint32_t src, FAR void *priv_);
  72. static int hostfs_rpmsg_write_handler(FAR struct rpmsg_endpoint *ept,
  73. FAR void *data, size_t len,
  74. uint32_t src, FAR void *priv_);
  75. static int hostfs_rpmsg_lseek_handler(FAR struct rpmsg_endpoint *ept,
  76. FAR void *data, size_t len,
  77. uint32_t src, FAR void *priv_);
  78. static int hostfs_rpmsg_ioctl_handler(FAR struct rpmsg_endpoint *ept,
  79. FAR void *data, size_t len,
  80. uint32_t src, FAR void *priv_);
  81. static int hostfs_rpmsg_sync_handler(FAR struct rpmsg_endpoint *ept,
  82. FAR void *data, size_t len,
  83. uint32_t src, FAR void *priv_);
  84. static int hostfs_rpmsg_dup_handler(FAR struct rpmsg_endpoint *ept,
  85. FAR void *data, size_t len,
  86. uint32_t src, FAR void *priv_);
  87. static int hostfs_rpmsg_fstat_handler(FAR struct rpmsg_endpoint *ept,
  88. FAR void *data, size_t len,
  89. uint32_t src, FAR void *priv_);
  90. static int hostfs_rpmsg_ftruncate_handler(FAR struct rpmsg_endpoint *ept,
  91. FAR void *data, size_t len,
  92. uint32_t src, FAR void *priv_);
  93. static int hostfs_rpmsg_opendir_handler(FAR struct rpmsg_endpoint *ept,
  94. FAR void *data, size_t len,
  95. uint32_t src, FAR void *priv_);
  96. static int hostfs_rpmsg_readdir_handler(FAR struct rpmsg_endpoint *ept,
  97. FAR void *data, size_t len,
  98. uint32_t src, FAR void *priv_);
  99. static int hostfs_rpmsg_rewinddir_handler(FAR struct rpmsg_endpoint *ept,
  100. FAR void *data, size_t len,
  101. uint32_t src, FAR void *priv_);
  102. static int hostfs_rpmsg_closedir_handler(FAR struct rpmsg_endpoint *ept,
  103. FAR void *data, size_t len,
  104. uint32_t src, FAR void *priv_);
  105. static int hostfs_rpmsg_statfs_handler(FAR struct rpmsg_endpoint *ept,
  106. FAR void *data, size_t len,
  107. uint32_t src, FAR void *priv);
  108. static int hostfs_rpmsg_unlink_handler(FAR struct rpmsg_endpoint *ept,
  109. FAR void *data, size_t len,
  110. uint32_t src, FAR void *priv);
  111. static int hostfs_rpmsg_mkdir_handler(FAR struct rpmsg_endpoint *ept,
  112. FAR void *data, size_t len,
  113. uint32_t src, FAR void *priv);
  114. static int hostfs_rpmsg_rmdir_handler(FAR struct rpmsg_endpoint *ept,
  115. FAR void *data, size_t len,
  116. uint32_t src, FAR void *priv);
  117. static int hostfs_rpmsg_rename_handler(FAR struct rpmsg_endpoint *ept,
  118. FAR void *data, size_t len,
  119. uint32_t src, FAR void *priv);
  120. static int hostfs_rpmsg_stat_handler(FAR struct rpmsg_endpoint *ept,
  121. FAR void *data, size_t len,
  122. uint32_t src, FAR void *priv);
  123. static void hostfs_rpmsg_ns_bind(FAR struct rpmsg_device *rdev,
  124. FAR void *priv_, FAR const char *name,
  125. uint32_t dest);
  126. static void hostfs_rpmsg_ns_unbind(FAR struct rpmsg_endpoint *ept);
  127. static int hostfs_rpmsg_ept_cb(FAR struct rpmsg_endpoint *ept,
  128. FAR void *data, size_t len, uint32_t src,
  129. FAR void *priv);
  130. /****************************************************************************
  131. * Private Data
  132. ****************************************************************************/
  133. static const rpmsg_ept_cb g_hostfs_rpmsg_handler[] =
  134. {
  135. [HOSTFS_RPMSG_OPEN] = hostfs_rpmsg_open_handler,
  136. [HOSTFS_RPMSG_CLOSE] = hostfs_rpmsg_close_handler,
  137. [HOSTFS_RPMSG_READ] = hostfs_rpmsg_read_handler,
  138. [HOSTFS_RPMSG_WRITE] = hostfs_rpmsg_write_handler,
  139. [HOSTFS_RPMSG_LSEEK] = hostfs_rpmsg_lseek_handler,
  140. [HOSTFS_RPMSG_IOCTL] = hostfs_rpmsg_ioctl_handler,
  141. [HOSTFS_RPMSG_SYNC] = hostfs_rpmsg_sync_handler,
  142. [HOSTFS_RPMSG_DUP] = hostfs_rpmsg_dup_handler,
  143. [HOSTFS_RPMSG_FSTAT] = hostfs_rpmsg_fstat_handler,
  144. [HOSTFS_RPMSG_FTRUNCATE] = hostfs_rpmsg_ftruncate_handler,
  145. [HOSTFS_RPMSG_OPENDIR] = hostfs_rpmsg_opendir_handler,
  146. [HOSTFS_RPMSG_READDIR] = hostfs_rpmsg_readdir_handler,
  147. [HOSTFS_RPMSG_REWINDDIR] = hostfs_rpmsg_rewinddir_handler,
  148. [HOSTFS_RPMSG_CLOSEDIR] = hostfs_rpmsg_closedir_handler,
  149. [HOSTFS_RPMSG_STATFS] = hostfs_rpmsg_statfs_handler,
  150. [HOSTFS_RPMSG_UNLINK] = hostfs_rpmsg_unlink_handler,
  151. [HOSTFS_RPMSG_MKDIR] = hostfs_rpmsg_mkdir_handler,
  152. [HOSTFS_RPMSG_RMDIR] = hostfs_rpmsg_rmdir_handler,
  153. [HOSTFS_RPMSG_RENAME] = hostfs_rpmsg_rename_handler,
  154. [HOSTFS_RPMSG_STAT] = hostfs_rpmsg_stat_handler,
  155. };
  156. /****************************************************************************
  157. * Private Functions
  158. ****************************************************************************/
  159. static int hostfs_rpmsg_open_handler(FAR struct rpmsg_endpoint *ept,
  160. FAR void *data, size_t len,
  161. uint32_t src, FAR void *priv_)
  162. {
  163. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  164. FAR struct hostfs_rpmsg_open_s *msg = data;
  165. int i;
  166. int ret = -ENOENT;
  167. nxsem_wait(&priv->sem);
  168. for (i = 0; i < CONFIG_NFILE_DESCRIPTORS; i++)
  169. {
  170. if (!priv->files[i].f_inode)
  171. {
  172. ret = file_open(&priv->files[i], msg->pathname, msg->flags,
  173. msg->mode);
  174. if (ret >= 0)
  175. {
  176. ret = i;
  177. }
  178. break;
  179. }
  180. }
  181. nxsem_post(&priv->sem);
  182. msg->header.result = ret;
  183. return rpmsg_send(ept, msg, sizeof(*msg));
  184. }
  185. static int hostfs_rpmsg_close_handler(FAR struct rpmsg_endpoint *ept,
  186. FAR void *data, size_t len,
  187. uint32_t src, FAR void *priv_)
  188. {
  189. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  190. FAR struct hostfs_rpmsg_close_s *msg = data;
  191. int ret = -ENOENT;
  192. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  193. {
  194. nxsem_wait(&priv->sem);
  195. ret = file_close(&priv->files[msg->fd]);
  196. nxsem_post(&priv->sem);
  197. }
  198. msg->header.result = ret;
  199. return rpmsg_send(ept, msg, sizeof(*msg));
  200. }
  201. static int hostfs_rpmsg_read_handler(FAR struct rpmsg_endpoint *ept,
  202. FAR void *data, size_t len,
  203. uint32_t src, FAR void *priv_)
  204. {
  205. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  206. FAR struct hostfs_rpmsg_read_s *msg = data;
  207. FAR struct hostfs_rpmsg_read_s *rsp;
  208. int ret = -ENOENT;
  209. uint32_t space;
  210. rsp = rpmsg_get_tx_payload_buffer(ept, &space, true);
  211. if (!rsp)
  212. {
  213. return -ENOMEM;
  214. }
  215. *rsp = *msg;
  216. space -= sizeof(*msg);
  217. if (space > msg->count)
  218. {
  219. space = msg->count;
  220. }
  221. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  222. {
  223. ret = file_read(&priv->files[msg->fd], rsp->buf, space);
  224. }
  225. rsp->header.result = ret;
  226. return rpmsg_send_nocopy(ept, rsp, (ret < 0 ? 0 : ret) + sizeof(*rsp));
  227. }
  228. static int hostfs_rpmsg_write_handler(FAR struct rpmsg_endpoint *ept,
  229. FAR void *data, size_t len,
  230. uint32_t src, FAR void *priv_)
  231. {
  232. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  233. FAR struct hostfs_rpmsg_write_s *msg = data;
  234. int ret = -ENOENT;
  235. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  236. {
  237. ret = file_write(&priv->files[msg->fd], msg->buf, msg->count);
  238. }
  239. msg->header.result = ret;
  240. return rpmsg_send(ept, msg, sizeof(*msg));
  241. }
  242. static int hostfs_rpmsg_lseek_handler(FAR struct rpmsg_endpoint *ept,
  243. FAR void *data, size_t len,
  244. uint32_t src, FAR void *priv_)
  245. {
  246. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  247. FAR struct hostfs_rpmsg_lseek_s *msg = data;
  248. int ret = -ENOENT;
  249. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  250. {
  251. ret = file_seek(&priv->files[msg->fd], msg->offset, msg->whence);
  252. }
  253. msg->header.result = ret;
  254. return rpmsg_send(ept, msg, sizeof(*msg));
  255. }
  256. static int hostfs_rpmsg_ioctl_handler(FAR struct rpmsg_endpoint *ept,
  257. FAR void *data, size_t len,
  258. uint32_t src, FAR void *priv_)
  259. {
  260. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  261. FAR struct hostfs_rpmsg_ioctl_s *msg = data;
  262. int ret = -ENOENT;
  263. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  264. {
  265. ret = file_ioctl(&priv->files[msg->fd], msg->request, msg->arg);
  266. }
  267. msg->header.result = ret;
  268. return rpmsg_send(ept, msg, sizeof(*msg));
  269. }
  270. static int hostfs_rpmsg_sync_handler(FAR struct rpmsg_endpoint *ept,
  271. FAR void *data, size_t len,
  272. uint32_t src, FAR void *priv_)
  273. {
  274. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  275. FAR struct hostfs_rpmsg_sync_s *msg = data;
  276. int ret = -ENOENT;
  277. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  278. {
  279. ret = file_fsync(&priv->files[msg->fd]);
  280. }
  281. msg->header.result = ret;
  282. return rpmsg_send(ept, msg, sizeof(*msg));
  283. }
  284. static int hostfs_rpmsg_dup_handler(FAR struct rpmsg_endpoint *ept,
  285. FAR void *data, size_t len,
  286. uint32_t src, FAR void *priv_)
  287. {
  288. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  289. FAR struct hostfs_rpmsg_dup_s *msg = data;
  290. int i;
  291. int ret = -ENOENT;
  292. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  293. {
  294. nxsem_wait(&priv->sem);
  295. for (i = 0; i < CONFIG_NFILE_DESCRIPTORS; i++)
  296. {
  297. if (!priv->files[i].f_inode)
  298. {
  299. ret = file_dup2(&priv->files[msg->fd], &priv->files[i]);
  300. if (ret >= 0)
  301. {
  302. ret = i;
  303. }
  304. break;
  305. }
  306. }
  307. nxsem_post(&priv->sem);
  308. }
  309. msg->header.result = ret;
  310. return rpmsg_send(ept, msg, sizeof(*msg));
  311. }
  312. static int hostfs_rpmsg_fstat_handler(FAR struct rpmsg_endpoint *ept,
  313. FAR void *data, size_t len,
  314. uint32_t src, FAR void *priv_)
  315. {
  316. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  317. FAR struct hostfs_rpmsg_fstat_s *msg = data;
  318. int ret = -ENOENT;
  319. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  320. {
  321. ret = file_fstat(&priv->files[msg->fd], &msg->buf);
  322. }
  323. msg->header.result = ret;
  324. return rpmsg_send(ept, msg, sizeof(*msg));
  325. }
  326. static int hostfs_rpmsg_ftruncate_handler(FAR struct rpmsg_endpoint *ept,
  327. FAR void *data, size_t len,
  328. uint32_t src, FAR void *priv_)
  329. {
  330. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  331. FAR struct hostfs_rpmsg_ftruncate_s *msg = data;
  332. int ret = -ENOENT;
  333. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  334. {
  335. ret = file_truncate(&priv->files[msg->fd], msg->length);
  336. }
  337. msg->header.result = ret;
  338. return rpmsg_send(ept, msg, sizeof(*msg));
  339. }
  340. static int hostfs_rpmsg_opendir_handler(FAR struct rpmsg_endpoint *ept,
  341. FAR void *data, size_t len,
  342. uint32_t src, FAR void *priv_)
  343. {
  344. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  345. FAR struct hostfs_rpmsg_opendir_s *msg = data;
  346. FAR void *dir;
  347. int i;
  348. int ret = -ENOENT;
  349. dir = opendir(msg->pathname);
  350. if (dir)
  351. {
  352. nxsem_wait(&priv->sem);
  353. for (i = 1; i < CONFIG_NFILE_DESCRIPTORS; i++)
  354. {
  355. if (!priv->dirs[i])
  356. {
  357. priv->dirs[i] = dir;
  358. ret = i;
  359. break;
  360. }
  361. }
  362. nxsem_post(&priv->sem);
  363. if (ret < 0)
  364. {
  365. closedir(dir);
  366. }
  367. }
  368. msg->header.result = ret;
  369. return rpmsg_send(ept, msg, sizeof(*msg));
  370. }
  371. static int hostfs_rpmsg_readdir_handler(FAR struct rpmsg_endpoint *ept,
  372. FAR void *data, size_t len,
  373. uint32_t src, FAR void *priv_)
  374. {
  375. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  376. FAR struct hostfs_rpmsg_readdir_s *msg = data;
  377. FAR struct dirent *entry;
  378. int ret = -ENOENT;
  379. if (msg->fd >= 1 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  380. {
  381. entry = readdir(priv->dirs[msg->fd]);
  382. if (entry)
  383. {
  384. msg->type = entry->d_type;
  385. strcpy(msg->name, entry->d_name);
  386. len += strlen(entry->d_name) + 1;
  387. ret = 0;
  388. }
  389. }
  390. msg->header.result = ret;
  391. return rpmsg_send(ept, msg, len);
  392. }
  393. static int hostfs_rpmsg_rewinddir_handler(FAR struct rpmsg_endpoint *ept,
  394. FAR void *data, size_t len,
  395. uint32_t src, FAR void *priv_)
  396. {
  397. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  398. FAR struct hostfs_rpmsg_rewinddir_s *msg = data;
  399. int ret = -ENOENT;
  400. if (msg->fd >= 1 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  401. {
  402. rewinddir(priv->dirs[msg->fd]);
  403. ret = 0;
  404. }
  405. msg->header.result = ret;
  406. return rpmsg_send(ept, msg, sizeof(*msg));
  407. }
  408. static int hostfs_rpmsg_closedir_handler(FAR struct rpmsg_endpoint *ept,
  409. FAR void *data, size_t len,
  410. uint32_t src, FAR void *priv_)
  411. {
  412. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  413. FAR struct hostfs_rpmsg_closedir_s *msg = data;
  414. int ret = -ENOENT;
  415. if (msg->fd >= 1 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  416. {
  417. ret = closedir(priv->dirs[msg->fd]);
  418. nxsem_wait(&priv->sem);
  419. priv->dirs[msg->fd] = NULL;
  420. nxsem_post(&priv->sem);
  421. ret = ret ? get_errno(ret) : 0;
  422. }
  423. msg->header.result = ret;
  424. return rpmsg_send(ept, msg, sizeof(*msg));
  425. }
  426. static int hostfs_rpmsg_statfs_handler(FAR struct rpmsg_endpoint *ept,
  427. FAR void *data, size_t len,
  428. uint32_t src, FAR void *priv)
  429. {
  430. FAR struct hostfs_rpmsg_statfs_s *msg = data;
  431. int ret;
  432. ret = statfs(msg->pathname, &msg->buf);
  433. msg->header.result = ret ? get_errno(ret) : 0;
  434. return rpmsg_send(ept, msg, sizeof(*msg));
  435. }
  436. static int hostfs_rpmsg_unlink_handler(FAR struct rpmsg_endpoint *ept,
  437. FAR void *data, size_t len,
  438. uint32_t src, FAR void *priv)
  439. {
  440. FAR struct hostfs_rpmsg_unlink_s *msg = data;
  441. int ret;
  442. ret = unlink(msg->pathname);
  443. msg->header.result = ret ? get_errno(ret) : 0;
  444. return rpmsg_send(ept, msg, sizeof(*msg));
  445. }
  446. static int hostfs_rpmsg_mkdir_handler(FAR struct rpmsg_endpoint *ept,
  447. FAR void *data, size_t len,
  448. uint32_t src, FAR void *priv)
  449. {
  450. FAR struct hostfs_rpmsg_mkdir_s *msg = data;
  451. int ret;
  452. ret = mkdir(msg->pathname, msg->mode);
  453. msg->header.result = ret ? get_errno(ret) : 0;
  454. return rpmsg_send(ept, msg, sizeof(*msg));
  455. }
  456. static int hostfs_rpmsg_rmdir_handler(FAR struct rpmsg_endpoint *ept,
  457. FAR void *data, size_t len,
  458. uint32_t src, FAR void *priv)
  459. {
  460. FAR struct hostfs_rpmsg_rmdir_s *msg = data;
  461. int ret;
  462. ret = rmdir(msg->pathname);
  463. msg->header.result = ret ? get_errno(ret) : 0;
  464. return rpmsg_send(ept, msg, sizeof(*msg));
  465. }
  466. static int hostfs_rpmsg_rename_handler(FAR struct rpmsg_endpoint *ept,
  467. FAR void *data, size_t len,
  468. uint32_t src, FAR void *priv)
  469. {
  470. FAR struct hostfs_rpmsg_rename_s *msg = data;
  471. FAR char *newpath;
  472. size_t oldlen;
  473. int ret;
  474. oldlen = (strlen(msg->pathname) + 1 + 0x7) & ~0x7;
  475. newpath = msg->pathname + oldlen;
  476. ret = rename(msg->pathname, newpath);
  477. msg->header.result = ret ? get_errno(ret) : 0;
  478. return rpmsg_send(ept, msg, sizeof(*msg));
  479. }
  480. static int hostfs_rpmsg_stat_handler(FAR struct rpmsg_endpoint *ept,
  481. FAR void *data, size_t len,
  482. uint32_t src, FAR void *priv)
  483. {
  484. FAR struct hostfs_rpmsg_stat_s *msg = data;
  485. int ret;
  486. ret = stat(msg->pathname, &msg->buf);
  487. msg->header.result = ret ? get_errno(ret) : 0;
  488. return rpmsg_send(ept, msg, sizeof(*msg));
  489. }
  490. static void hostfs_rpmsg_ns_bind(FAR struct rpmsg_device *rdev,
  491. FAR void *priv_, FAR const char *name,
  492. uint32_t dest)
  493. {
  494. FAR struct hostfs_rpmsg_server_s *priv;
  495. int ret;
  496. if (strcmp(name, HOSTFS_RPMSG_EPT_NAME))
  497. {
  498. return;
  499. }
  500. priv = kmm_zalloc(sizeof(*priv));
  501. if (!priv)
  502. {
  503. return;
  504. }
  505. priv->ept.priv = priv;
  506. nxsem_init(&priv->sem, 0, 1);
  507. ret = rpmsg_create_ept(&priv->ept, rdev, HOSTFS_RPMSG_EPT_NAME,
  508. RPMSG_ADDR_ANY, dest,
  509. hostfs_rpmsg_ept_cb, hostfs_rpmsg_ns_unbind);
  510. if (ret)
  511. {
  512. nxsem_destroy(&priv->sem);
  513. kmm_free(priv);
  514. }
  515. }
  516. static void hostfs_rpmsg_ns_unbind(FAR struct rpmsg_endpoint *ept)
  517. {
  518. FAR struct hostfs_rpmsg_server_s *priv = ept->priv;
  519. int i;
  520. for (i = 0; i < CONFIG_NFILE_DESCRIPTORS; i++)
  521. {
  522. if (priv->files[i].f_inode)
  523. {
  524. file_close(&priv->files[i]);
  525. }
  526. }
  527. for (i = 0; i < CONFIG_NFILE_DESCRIPTORS; i++)
  528. {
  529. if (priv->dirs[i])
  530. {
  531. closedir(priv->dirs[i]);
  532. }
  533. }
  534. rpmsg_destroy_ept(&priv->ept);
  535. nxsem_destroy(&priv->sem);
  536. kmm_free(priv);
  537. }
  538. static int hostfs_rpmsg_ept_cb(FAR struct rpmsg_endpoint *ept, FAR void *data,
  539. size_t len, uint32_t src, FAR void *priv)
  540. {
  541. struct hostfs_rpmsg_header_s *header = data;
  542. uint32_t command = header->command;
  543. if (command < ARRAY_SIZE(g_hostfs_rpmsg_handler))
  544. {
  545. return g_hostfs_rpmsg_handler[command](ept, data, len, src, priv);
  546. }
  547. return -EINVAL;
  548. }
  549. int hostfs_rpmsg_server_init(void)
  550. {
  551. return rpmsg_register_callback(NULL,
  552. NULL,
  553. NULL,
  554. hostfs_rpmsg_ns_bind);
  555. }