hostfs_rpmsg_server.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656
  1. /****************************************************************************
  2. * fs/hostfs/hostfs_rpmsg_server.c
  3. *
  4. * Licensed to the Apache Software Foundation (ASF) under one or more
  5. * contributor license agreements. See the NOTICE file distributed with
  6. * this work for additional information regarding copyright ownership. The
  7. * ASF licenses this file to you under the Apache License, Version 2.0 (the
  8. * "License"); you may not use this file except in compliance with the
  9. * License. You may obtain a copy of the License at
  10. *
  11. * http://www.apache.org/licenses/LICENSE-2.0
  12. *
  13. * Unless required by applicable law or agreed to in writing, software
  14. * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
  15. * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
  16. * License for the specific language governing permissions and limitations
  17. * under the License.
  18. *
  19. ****************************************************************************/
  20. /****************************************************************************
  21. * Included Files
  22. ****************************************************************************/
  23. #include <nuttx/config.h>
  24. #include <dirent.h>
  25. #include <stdio.h>
  26. #include <string.h>
  27. #include <fcntl.h>
  28. #include <errno.h>
  29. #include <nuttx/kmalloc.h>
  30. #include <nuttx/fs/fs.h>
  31. #include <nuttx/fs/hostfs_rpmsg.h>
  32. #include <nuttx/rptun/openamp.h>
  33. #include "hostfs_rpmsg.h"
  34. /****************************************************************************
  35. * Private Types
  36. ****************************************************************************/
  37. struct hostfs_rpmsg_server_s
  38. {
  39. struct rpmsg_endpoint ept;
  40. struct file files[CONFIG_NFILE_DESCRIPTORS];
  41. void *dirs[CONFIG_NFILE_DESCRIPTORS];
  42. sem_t sem;
  43. };
  44. /****************************************************************************
  45. * Private Function Prototypes
  46. ****************************************************************************/
  47. static int hostfs_rpmsg_open_handler(FAR struct rpmsg_endpoint *ept,
  48. FAR void *data, size_t len,
  49. uint32_t src, FAR void *priv_);
  50. static int hostfs_rpmsg_close_handler(FAR struct rpmsg_endpoint *ept,
  51. FAR void *data, size_t len,
  52. uint32_t src, FAR void *priv_);
  53. static int hostfs_rpmsg_read_handler(FAR struct rpmsg_endpoint *ept,
  54. FAR void *data, size_t len,
  55. uint32_t src, FAR void *priv_);
  56. static int hostfs_rpmsg_write_handler(FAR struct rpmsg_endpoint *ept,
  57. FAR void *data, size_t len,
  58. uint32_t src, FAR void *priv_);
  59. static int hostfs_rpmsg_lseek_handler(FAR struct rpmsg_endpoint *ept,
  60. FAR void *data, size_t len,
  61. uint32_t src, FAR void *priv_);
  62. static int hostfs_rpmsg_ioctl_handler(FAR struct rpmsg_endpoint *ept,
  63. FAR void *data, size_t len,
  64. uint32_t src, FAR void *priv_);
  65. static int hostfs_rpmsg_sync_handler(FAR struct rpmsg_endpoint *ept,
  66. FAR void *data, size_t len,
  67. uint32_t src, FAR void *priv_);
  68. static int hostfs_rpmsg_dup_handler(FAR struct rpmsg_endpoint *ept,
  69. FAR void *data, size_t len,
  70. uint32_t src, FAR void *priv_);
  71. static int hostfs_rpmsg_fstat_handler(FAR struct rpmsg_endpoint *ept,
  72. FAR void *data, size_t len,
  73. uint32_t src, FAR void *priv_);
  74. static int hostfs_rpmsg_ftruncate_handler(FAR struct rpmsg_endpoint *ept,
  75. FAR void *data, size_t len,
  76. uint32_t src, FAR void *priv_);
  77. static int hostfs_rpmsg_opendir_handler(FAR struct rpmsg_endpoint *ept,
  78. FAR void *data, size_t len,
  79. uint32_t src, FAR void *priv_);
  80. static int hostfs_rpmsg_readdir_handler(FAR struct rpmsg_endpoint *ept,
  81. FAR void *data, size_t len,
  82. uint32_t src, FAR void *priv_);
  83. static int hostfs_rpmsg_rewinddir_handler(FAR struct rpmsg_endpoint *ept,
  84. FAR void *data, size_t len,
  85. uint32_t src, FAR void *priv_);
  86. static int hostfs_rpmsg_closedir_handler(FAR struct rpmsg_endpoint *ept,
  87. FAR void *data, size_t len,
  88. uint32_t src, FAR void *priv_);
  89. static int hostfs_rpmsg_statfs_handler(FAR struct rpmsg_endpoint *ept,
  90. FAR void *data, size_t len,
  91. uint32_t src, FAR void *priv);
  92. static int hostfs_rpmsg_unlink_handler(FAR struct rpmsg_endpoint *ept,
  93. FAR void *data, size_t len,
  94. uint32_t src, FAR void *priv);
  95. static int hostfs_rpmsg_mkdir_handler(FAR struct rpmsg_endpoint *ept,
  96. FAR void *data, size_t len,
  97. uint32_t src, FAR void *priv);
  98. static int hostfs_rpmsg_rmdir_handler(FAR struct rpmsg_endpoint *ept,
  99. FAR void *data, size_t len,
  100. uint32_t src, FAR void *priv);
  101. static int hostfs_rpmsg_rename_handler(FAR struct rpmsg_endpoint *ept,
  102. FAR void *data, size_t len,
  103. uint32_t src, FAR void *priv);
  104. static int hostfs_rpmsg_stat_handler(FAR struct rpmsg_endpoint *ept,
  105. FAR void *data, size_t len,
  106. uint32_t src, FAR void *priv);
  107. static void hostfs_rpmsg_ns_bind(FAR struct rpmsg_device *rdev,
  108. FAR void *priv_, FAR const char *name,
  109. uint32_t dest);
  110. static void hostfs_rpmsg_ns_unbind(FAR struct rpmsg_endpoint *ept);
  111. static int hostfs_rpmsg_ept_cb(FAR struct rpmsg_endpoint *ept,
  112. FAR void *data, size_t len, uint32_t src,
  113. FAR void *priv);
  114. /****************************************************************************
  115. * Private Data
  116. ****************************************************************************/
  117. static const rpmsg_ept_cb g_hostfs_rpmsg_handler[] =
  118. {
  119. [HOSTFS_RPMSG_OPEN] = hostfs_rpmsg_open_handler,
  120. [HOSTFS_RPMSG_CLOSE] = hostfs_rpmsg_close_handler,
  121. [HOSTFS_RPMSG_READ] = hostfs_rpmsg_read_handler,
  122. [HOSTFS_RPMSG_WRITE] = hostfs_rpmsg_write_handler,
  123. [HOSTFS_RPMSG_LSEEK] = hostfs_rpmsg_lseek_handler,
  124. [HOSTFS_RPMSG_IOCTL] = hostfs_rpmsg_ioctl_handler,
  125. [HOSTFS_RPMSG_SYNC] = hostfs_rpmsg_sync_handler,
  126. [HOSTFS_RPMSG_DUP] = hostfs_rpmsg_dup_handler,
  127. [HOSTFS_RPMSG_FSTAT] = hostfs_rpmsg_fstat_handler,
  128. [HOSTFS_RPMSG_FTRUNCATE] = hostfs_rpmsg_ftruncate_handler,
  129. [HOSTFS_RPMSG_OPENDIR] = hostfs_rpmsg_opendir_handler,
  130. [HOSTFS_RPMSG_READDIR] = hostfs_rpmsg_readdir_handler,
  131. [HOSTFS_RPMSG_REWINDDIR] = hostfs_rpmsg_rewinddir_handler,
  132. [HOSTFS_RPMSG_CLOSEDIR] = hostfs_rpmsg_closedir_handler,
  133. [HOSTFS_RPMSG_STATFS] = hostfs_rpmsg_statfs_handler,
  134. [HOSTFS_RPMSG_UNLINK] = hostfs_rpmsg_unlink_handler,
  135. [HOSTFS_RPMSG_MKDIR] = hostfs_rpmsg_mkdir_handler,
  136. [HOSTFS_RPMSG_RMDIR] = hostfs_rpmsg_rmdir_handler,
  137. [HOSTFS_RPMSG_RENAME] = hostfs_rpmsg_rename_handler,
  138. [HOSTFS_RPMSG_STAT] = hostfs_rpmsg_stat_handler,
  139. };
  140. /****************************************************************************
  141. * Private Functions
  142. ****************************************************************************/
  143. static int hostfs_rpmsg_open_handler(FAR struct rpmsg_endpoint *ept,
  144. FAR void *data, size_t len,
  145. uint32_t src, FAR void *priv_)
  146. {
  147. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  148. FAR struct hostfs_rpmsg_open_s *msg = data;
  149. int i;
  150. int ret = -ENOENT;
  151. nxsem_wait(&priv->sem);
  152. for (i = 0; i < CONFIG_NFILE_DESCRIPTORS; i++)
  153. {
  154. if (!priv->files[i].f_inode)
  155. {
  156. ret = file_open(&priv->files[i], msg->pathname, msg->flags,
  157. msg->mode);
  158. if (ret >= 0)
  159. {
  160. ret = i;
  161. }
  162. break;
  163. }
  164. }
  165. nxsem_post(&priv->sem);
  166. msg->header.result = ret;
  167. return rpmsg_send(ept, msg, sizeof(*msg));
  168. }
  169. static int hostfs_rpmsg_close_handler(FAR struct rpmsg_endpoint *ept,
  170. FAR void *data, size_t len,
  171. uint32_t src, FAR void *priv_)
  172. {
  173. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  174. FAR struct hostfs_rpmsg_close_s *msg = data;
  175. int ret = -ENOENT;
  176. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  177. {
  178. nxsem_wait(&priv->sem);
  179. ret = file_close(&priv->files[msg->fd]);
  180. nxsem_post(&priv->sem);
  181. }
  182. msg->header.result = ret;
  183. return rpmsg_send(ept, msg, sizeof(*msg));
  184. }
  185. static int hostfs_rpmsg_read_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_read_s *msg = data;
  191. FAR struct hostfs_rpmsg_read_s *rsp;
  192. int ret = -ENOENT;
  193. uint32_t space;
  194. rsp = rpmsg_get_tx_payload_buffer(ept, &space, true);
  195. if (!rsp)
  196. {
  197. return -ENOMEM;
  198. }
  199. *rsp = *msg;
  200. space -= sizeof(*msg);
  201. if (space > msg->count)
  202. {
  203. space = msg->count;
  204. }
  205. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  206. {
  207. ret = file_read(&priv->files[msg->fd], rsp->buf, space);
  208. }
  209. rsp->header.result = ret;
  210. return rpmsg_send_nocopy(ept, rsp, (ret < 0 ? 0 : ret) + sizeof(*rsp));
  211. }
  212. static int hostfs_rpmsg_write_handler(FAR struct rpmsg_endpoint *ept,
  213. FAR void *data, size_t len,
  214. uint32_t src, FAR void *priv_)
  215. {
  216. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  217. FAR struct hostfs_rpmsg_write_s *msg = data;
  218. int ret = -ENOENT;
  219. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  220. {
  221. ret = file_write(&priv->files[msg->fd], msg->buf, msg->count);
  222. }
  223. msg->header.result = ret;
  224. return rpmsg_send(ept, msg, sizeof(*msg));
  225. }
  226. static int hostfs_rpmsg_lseek_handler(FAR struct rpmsg_endpoint *ept,
  227. FAR void *data, size_t len,
  228. uint32_t src, FAR void *priv_)
  229. {
  230. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  231. FAR struct hostfs_rpmsg_lseek_s *msg = data;
  232. int ret = -ENOENT;
  233. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  234. {
  235. ret = file_seek(&priv->files[msg->fd], msg->offset, msg->whence);
  236. }
  237. msg->header.result = ret;
  238. return rpmsg_send(ept, msg, sizeof(*msg));
  239. }
  240. static int hostfs_rpmsg_ioctl_handler(FAR struct rpmsg_endpoint *ept,
  241. FAR void *data, size_t len,
  242. uint32_t src, FAR void *priv_)
  243. {
  244. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  245. FAR struct hostfs_rpmsg_ioctl_s *msg = data;
  246. int ret = -ENOENT;
  247. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  248. {
  249. ret = file_ioctl(&priv->files[msg->fd], msg->request, msg->arg);
  250. }
  251. msg->header.result = ret;
  252. return rpmsg_send(ept, msg, sizeof(*msg));
  253. }
  254. static int hostfs_rpmsg_sync_handler(FAR struct rpmsg_endpoint *ept,
  255. FAR void *data, size_t len,
  256. uint32_t src, FAR void *priv_)
  257. {
  258. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  259. FAR struct hostfs_rpmsg_sync_s *msg = data;
  260. int ret = -ENOENT;
  261. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  262. {
  263. ret = file_fsync(&priv->files[msg->fd]);
  264. }
  265. msg->header.result = ret;
  266. return rpmsg_send(ept, msg, sizeof(*msg));
  267. }
  268. static int hostfs_rpmsg_dup_handler(FAR struct rpmsg_endpoint *ept,
  269. FAR void *data, size_t len,
  270. uint32_t src, FAR void *priv_)
  271. {
  272. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  273. FAR struct hostfs_rpmsg_dup_s *msg = data;
  274. int i;
  275. int ret = -ENOENT;
  276. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  277. {
  278. nxsem_wait(&priv->sem);
  279. for (i = 0; i < CONFIG_NFILE_DESCRIPTORS; i++)
  280. {
  281. if (!priv->files[i].f_inode)
  282. {
  283. ret = file_dup2(&priv->files[msg->fd], &priv->files[i]);
  284. if (ret >= 0)
  285. {
  286. ret = i;
  287. }
  288. break;
  289. }
  290. }
  291. nxsem_post(&priv->sem);
  292. }
  293. msg->header.result = ret;
  294. return rpmsg_send(ept, msg, sizeof(*msg));
  295. }
  296. static int hostfs_rpmsg_fstat_handler(FAR struct rpmsg_endpoint *ept,
  297. FAR void *data, size_t len,
  298. uint32_t src, FAR void *priv_)
  299. {
  300. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  301. FAR struct hostfs_rpmsg_fstat_s *msg = data;
  302. int ret = -ENOENT;
  303. struct stat buf;
  304. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  305. {
  306. ret = file_fstat(&priv->files[msg->fd], &buf);
  307. if (ret >= 0)
  308. {
  309. msg->buf = buf;
  310. }
  311. }
  312. msg->header.result = ret;
  313. return rpmsg_send(ept, msg, sizeof(*msg));
  314. }
  315. static int hostfs_rpmsg_ftruncate_handler(FAR struct rpmsg_endpoint *ept,
  316. FAR void *data, size_t len,
  317. uint32_t src, FAR void *priv_)
  318. {
  319. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  320. FAR struct hostfs_rpmsg_ftruncate_s *msg = data;
  321. int ret = -ENOENT;
  322. if (msg->fd >= 0 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  323. {
  324. ret = file_truncate(&priv->files[msg->fd], msg->length);
  325. }
  326. msg->header.result = ret;
  327. return rpmsg_send(ept, msg, sizeof(*msg));
  328. }
  329. static int hostfs_rpmsg_opendir_handler(FAR struct rpmsg_endpoint *ept,
  330. FAR void *data, size_t len,
  331. uint32_t src, FAR void *priv_)
  332. {
  333. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  334. FAR struct hostfs_rpmsg_opendir_s *msg = data;
  335. FAR void *dir;
  336. int i;
  337. int ret = -ENOENT;
  338. dir = opendir(msg->pathname);
  339. if (dir)
  340. {
  341. nxsem_wait(&priv->sem);
  342. for (i = 1; i < CONFIG_NFILE_DESCRIPTORS; i++)
  343. {
  344. if (!priv->dirs[i])
  345. {
  346. priv->dirs[i] = dir;
  347. ret = i;
  348. break;
  349. }
  350. }
  351. nxsem_post(&priv->sem);
  352. if (ret < 0)
  353. {
  354. closedir(dir);
  355. }
  356. }
  357. msg->header.result = ret;
  358. return rpmsg_send(ept, msg, sizeof(*msg));
  359. }
  360. static int hostfs_rpmsg_readdir_handler(FAR struct rpmsg_endpoint *ept,
  361. FAR void *data, size_t len,
  362. uint32_t src, FAR void *priv_)
  363. {
  364. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  365. FAR struct hostfs_rpmsg_readdir_s *msg = data;
  366. FAR struct dirent *entry;
  367. int ret = -ENOENT;
  368. if (msg->fd >= 1 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  369. {
  370. entry = readdir(priv->dirs[msg->fd]);
  371. if (entry)
  372. {
  373. msg->type = entry->d_type;
  374. strcpy(msg->name, entry->d_name);
  375. len += strlen(entry->d_name) + 1;
  376. ret = 0;
  377. }
  378. }
  379. msg->header.result = ret;
  380. return rpmsg_send(ept, msg, len);
  381. }
  382. static int hostfs_rpmsg_rewinddir_handler(FAR struct rpmsg_endpoint *ept,
  383. FAR void *data, size_t len,
  384. uint32_t src, FAR void *priv_)
  385. {
  386. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  387. FAR struct hostfs_rpmsg_rewinddir_s *msg = data;
  388. int ret = -ENOENT;
  389. if (msg->fd >= 1 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  390. {
  391. rewinddir(priv->dirs[msg->fd]);
  392. ret = 0;
  393. }
  394. msg->header.result = ret;
  395. return rpmsg_send(ept, msg, sizeof(*msg));
  396. }
  397. static int hostfs_rpmsg_closedir_handler(FAR struct rpmsg_endpoint *ept,
  398. FAR void *data, size_t len,
  399. uint32_t src, FAR void *priv_)
  400. {
  401. FAR struct hostfs_rpmsg_server_s *priv = priv_;
  402. FAR struct hostfs_rpmsg_closedir_s *msg = data;
  403. int ret = -ENOENT;
  404. if (msg->fd >= 1 && msg->fd < CONFIG_NFILE_DESCRIPTORS)
  405. {
  406. ret = closedir(priv->dirs[msg->fd]);
  407. nxsem_wait(&priv->sem);
  408. priv->dirs[msg->fd] = NULL;
  409. nxsem_post(&priv->sem);
  410. ret = ret ? -get_errno() : 0;
  411. }
  412. msg->header.result = ret;
  413. return rpmsg_send(ept, msg, sizeof(*msg));
  414. }
  415. static int hostfs_rpmsg_statfs_handler(FAR struct rpmsg_endpoint *ept,
  416. FAR void *data, size_t len,
  417. uint32_t src, FAR void *priv)
  418. {
  419. FAR struct hostfs_rpmsg_statfs_s *msg = data;
  420. struct statfs buf;
  421. int ret;
  422. ret = statfs(msg->pathname, &buf);
  423. if (ret)
  424. {
  425. ret = -get_errno();
  426. }
  427. else
  428. {
  429. msg->buf = buf;
  430. }
  431. msg->header.result = ret;
  432. return rpmsg_send(ept, msg, sizeof(*msg));
  433. }
  434. static int hostfs_rpmsg_unlink_handler(FAR struct rpmsg_endpoint *ept,
  435. FAR void *data, size_t len,
  436. uint32_t src, FAR void *priv)
  437. {
  438. FAR struct hostfs_rpmsg_unlink_s *msg = data;
  439. int ret;
  440. ret = unlink(msg->pathname);
  441. msg->header.result = ret ? -get_errno() : 0;
  442. return rpmsg_send(ept, msg, sizeof(*msg));
  443. }
  444. static int hostfs_rpmsg_mkdir_handler(FAR struct rpmsg_endpoint *ept,
  445. FAR void *data, size_t len,
  446. uint32_t src, FAR void *priv)
  447. {
  448. FAR struct hostfs_rpmsg_mkdir_s *msg = data;
  449. int ret;
  450. ret = mkdir(msg->pathname, msg->mode);
  451. msg->header.result = ret ? -get_errno() : 0;
  452. return rpmsg_send(ept, msg, sizeof(*msg));
  453. }
  454. static int hostfs_rpmsg_rmdir_handler(FAR struct rpmsg_endpoint *ept,
  455. FAR void *data, size_t len,
  456. uint32_t src, FAR void *priv)
  457. {
  458. FAR struct hostfs_rpmsg_rmdir_s *msg = data;
  459. int ret;
  460. ret = rmdir(msg->pathname);
  461. msg->header.result = ret ? -get_errno() : 0;
  462. return rpmsg_send(ept, msg, sizeof(*msg));
  463. }
  464. static int hostfs_rpmsg_rename_handler(FAR struct rpmsg_endpoint *ept,
  465. FAR void *data, size_t len,
  466. uint32_t src, FAR void *priv)
  467. {
  468. FAR struct hostfs_rpmsg_rename_s *msg = data;
  469. FAR char *newpath;
  470. size_t oldlen;
  471. int ret;
  472. oldlen = (strlen(msg->pathname) + 1 + 0x7) & ~0x7;
  473. newpath = msg->pathname + oldlen;
  474. ret = rename(msg->pathname, newpath);
  475. msg->header.result = ret ? -get_errno() : 0;
  476. return rpmsg_send(ept, msg, sizeof(*msg));
  477. }
  478. static int hostfs_rpmsg_stat_handler(FAR struct rpmsg_endpoint *ept,
  479. FAR void *data, size_t len,
  480. uint32_t src, FAR void *priv)
  481. {
  482. FAR struct hostfs_rpmsg_stat_s *msg = data;
  483. struct stat buf;
  484. int ret;
  485. ret = stat(msg->pathname, &buf);
  486. if (ret)
  487. {
  488. ret = -get_errno();
  489. }
  490. else
  491. {
  492. msg->buf = buf;
  493. }
  494. msg->header.result = ret;
  495. return rpmsg_send(ept, msg, sizeof(*msg));
  496. }
  497. static void hostfs_rpmsg_ns_bind(FAR struct rpmsg_device *rdev,
  498. FAR void *priv_, FAR const char *name,
  499. uint32_t dest)
  500. {
  501. FAR struct hostfs_rpmsg_server_s *priv;
  502. int ret;
  503. if (strcmp(name, HOSTFS_RPMSG_EPT_NAME))
  504. {
  505. return;
  506. }
  507. priv = kmm_zalloc(sizeof(*priv));
  508. if (!priv)
  509. {
  510. return;
  511. }
  512. priv->ept.priv = priv;
  513. nxsem_init(&priv->sem, 0, 1);
  514. ret = rpmsg_create_ept(&priv->ept, rdev, HOSTFS_RPMSG_EPT_NAME,
  515. RPMSG_ADDR_ANY, dest,
  516. hostfs_rpmsg_ept_cb, hostfs_rpmsg_ns_unbind);
  517. if (ret)
  518. {
  519. nxsem_destroy(&priv->sem);
  520. kmm_free(priv);
  521. }
  522. }
  523. static void hostfs_rpmsg_ns_unbind(FAR struct rpmsg_endpoint *ept)
  524. {
  525. FAR struct hostfs_rpmsg_server_s *priv = ept->priv;
  526. int i;
  527. for (i = 0; i < CONFIG_NFILE_DESCRIPTORS; i++)
  528. {
  529. if (priv->files[i].f_inode)
  530. {
  531. file_close(&priv->files[i]);
  532. }
  533. }
  534. for (i = 0; i < CONFIG_NFILE_DESCRIPTORS; i++)
  535. {
  536. if (priv->dirs[i])
  537. {
  538. closedir(priv->dirs[i]);
  539. }
  540. }
  541. rpmsg_destroy_ept(&priv->ept);
  542. nxsem_destroy(&priv->sem);
  543. kmm_free(priv);
  544. }
  545. static int hostfs_rpmsg_ept_cb(FAR struct rpmsg_endpoint *ept,
  546. FAR void *data, size_t len, uint32_t src,
  547. FAR void *priv)
  548. {
  549. struct hostfs_rpmsg_header_s *header = data;
  550. uint32_t command = header->command;
  551. if (command < ARRAY_SIZE(g_hostfs_rpmsg_handler))
  552. {
  553. return g_hostfs_rpmsg_handler[command](ept, data, len, src, priv);
  554. }
  555. return -EINVAL;
  556. }
  557. int hostfs_rpmsg_server_init(void)
  558. {
  559. return rpmsg_register_callback(NULL,
  560. NULL,
  561. NULL,
  562. hostfs_rpmsg_ns_bind);
  563. }