lwp_syscall.c 42 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920
  1. /*
  2. * Copyright (c) 2006-2020, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2018-06-10 Bernard first version
  9. */
  10. /* RT-Thread System call */
  11. #include <rthw.h>
  12. #include <board.h>
  13. #include <lwp.h>
  14. #ifdef RT_USING_USERSPACE
  15. #include <lwp_user_mm.h>
  16. #endif
  17. #ifdef RT_USING_DFS
  18. #include <dfs_poll.h>
  19. #include <dfs_posix.h>
  20. #include <dfs_select.h>
  21. #endif
  22. #if (defined(RT_USING_SAL) && defined(SAL_USING_POSIX))
  23. #include <sys/socket.h>
  24. #define SYSCALL_NET(f) ((void*)(f))
  25. #else
  26. #define SYSCALL_NET(f) ((void*)sys_notimpl)
  27. #endif
  28. #if defined(RT_USING_DFS) && defined(RT_USING_USERSPACE)
  29. #define SYSCALL_USPACE(f) ((void*)(f))
  30. #else
  31. #define SYSCALL_USPACE(f) ((void*)sys_notimpl)
  32. #endif
  33. #define DBG_TAG "SYSCALL"
  34. #define DBG_LVL DBG_INFO
  35. #include <rtdbg.h>
  36. #ifdef RT_USING_SAL
  37. #include <netdev_ipaddr.h>
  38. #include <netdev.h>
  39. #include <sal_netdb.h>
  40. #include <sal.h>
  41. #endif /* RT_USING_SAL */
  42. #include "lwp_ipc_internal.h"
  43. #define ALLOC_KERNEL_STACK_SIZE 5120
  44. struct musl_sockaddr
  45. {
  46. uint16_t sa_family;
  47. char sa_data[14];
  48. };
  49. extern void lwp_user_entry(void *args, const void *text, void *data, void *user_stack);
  50. extern void set_user_context(void *stack);
  51. void lwp_cleanup(struct rt_thread *tid);
  52. #ifdef RT_USING_USERSPACE
  53. static void *kmem_get(size_t size)
  54. {
  55. return rt_malloc(size);
  56. }
  57. static void kmem_put(void *kptr)
  58. {
  59. rt_free(kptr);
  60. }
  61. #endif
  62. /* The same socket option is defined differently in the user interfaces and the
  63. * implementation. The options should be converted in the kernel. */
  64. /* socket levels */
  65. #define INTF_SOL_SOCKET 1
  66. #define IMPL_SOL_SOCKET 0xFFF
  67. /* socket option name */
  68. #define INTF_SO_REUSEADDR 2
  69. #define INTF_SO_KEEPALIVE 9
  70. #define INTF_SO_BROADCAST 6
  71. #define INTF_SO_ACCEPTCONN 30
  72. #define INTF_SO_DONTROUTE 5
  73. #define INTF_SO_LINGER 13
  74. #define INTF_SO_OOBINLINE 10
  75. #define INTF_SO_REUSEPORT 15
  76. #define INTF_SO_SNDBUF 7
  77. #define INTF_SO_RCVBUF 8
  78. #define INTF_SO_SNDLOWAT 19
  79. #define INTF_SO_RCVLOWAT 18
  80. #define INTF_SO_SNDTIMEO 21
  81. #define INTF_SO_RCVTIMEO 20
  82. #define INTF_SO_ERROR 4
  83. #define INTF_SO_TYPE 3
  84. #define INTF_SO_NO_CHECK 11
  85. #define IMPL_SO_REUSEADDR 0x0004
  86. #define IMPL_SO_KEEPALIVE 0x0008
  87. #define IMPL_SO_BROADCAST 0x0020
  88. #define IMPL_SO_ACCEPTCONN 0x0002
  89. #define IMPL_SO_DONTROUTE 0x0010
  90. #define IMPL_SO_LINGER 0x0080
  91. #define IMPL_SO_OOBINLINE 0x0100
  92. #define IMPL_SO_REUSEPORT 0x0200
  93. #define IMPL_SO_SNDBUF 0x1001
  94. #define IMPL_SO_RCVBUF 0x1002
  95. #define IMPL_SO_SNDLOWAT 0x1003
  96. #define IMPL_SO_RCVLOWAT 0x1004
  97. #define IMPL_SO_SNDTIMEO 0x1005
  98. #define IMPL_SO_RCVTIMEO 0x1006
  99. #define IMPL_SO_ERROR 0x1007
  100. #define IMPL_SO_TYPE 0x1008
  101. #define IMPL_SO_NO_CHECK 0x100a
  102. static void convert_sockopt(int *level, int *optname)
  103. {
  104. switch (*level)
  105. {
  106. case INTF_SOL_SOCKET:
  107. *level = IMPL_SOL_SOCKET;
  108. break;
  109. default:
  110. break;
  111. }
  112. switch (*optname)
  113. {
  114. case INTF_SO_REUSEADDR:
  115. *optname = IMPL_SO_REUSEADDR;
  116. break;
  117. case INTF_SO_KEEPALIVE:
  118. *optname = IMPL_SO_KEEPALIVE;
  119. break;
  120. case INTF_SO_BROADCAST:
  121. *optname = IMPL_SO_BROADCAST;
  122. break;
  123. case INTF_SO_ACCEPTCONN:
  124. *optname = IMPL_SO_ACCEPTCONN;
  125. break;
  126. case INTF_SO_DONTROUTE:
  127. *optname = IMPL_SO_DONTROUTE;
  128. break;
  129. case INTF_SO_LINGER:
  130. *optname = IMPL_SO_LINGER;
  131. break;
  132. case INTF_SO_OOBINLINE:
  133. *optname = IMPL_SO_OOBINLINE;
  134. break;
  135. case INTF_SO_REUSEPORT:
  136. *optname = IMPL_SO_REUSEPORT;
  137. break;
  138. case INTF_SO_SNDBUF:
  139. *optname = IMPL_SO_SNDBUF;
  140. break;
  141. case INTF_SO_RCVBUF:
  142. *optname = IMPL_SO_RCVBUF;
  143. break;
  144. case INTF_SO_SNDLOWAT:
  145. *optname = IMPL_SO_SNDLOWAT;
  146. break;
  147. case INTF_SO_RCVLOWAT:
  148. *optname = IMPL_SO_RCVLOWAT;
  149. break;
  150. case INTF_SO_SNDTIMEO:
  151. *optname = IMPL_SO_SNDTIMEO;
  152. break;
  153. case INTF_SO_RCVTIMEO:
  154. *optname = IMPL_SO_RCVTIMEO;
  155. break;
  156. case INTF_SO_ERROR:
  157. *optname = IMPL_SO_ERROR;
  158. break;
  159. case INTF_SO_TYPE:
  160. *optname = IMPL_SO_TYPE;
  161. break;
  162. case INTF_SO_NO_CHECK:
  163. *optname = IMPL_SO_NO_CHECK;
  164. break;
  165. /*
  166. * SO_DONTLINGER (*level = ((int)(~SO_LINGER))),
  167. * SO_USELOOPBACK (*level = 0x0040) and
  168. * SO_CONTIMEO (*level = 0x1009) are not supported for now.
  169. */
  170. default:
  171. *optname = 0;
  172. break;
  173. }
  174. }
  175. static void sockaddr_tolwip(const struct musl_sockaddr *std, struct sockaddr *lwip)
  176. {
  177. if (std && lwip)
  178. {
  179. lwip->sa_len = sizeof(*lwip);
  180. lwip->sa_family = (sa_family_t) std->sa_family;
  181. memcpy(lwip->sa_data, std->sa_data, sizeof(lwip->sa_data));
  182. }
  183. }
  184. static void sockaddr_tomusl(const struct sockaddr *lwip, struct musl_sockaddr *std)
  185. {
  186. if (std && lwip)
  187. {
  188. std->sa_family = (uint16_t) lwip->sa_family;
  189. memcpy(std->sa_data, lwip->sa_data, sizeof(std->sa_data));
  190. }
  191. }
  192. static void lwp_user_thread(void *parameter)
  193. {
  194. rt_thread_t tid;
  195. uint32_t user_stack;
  196. struct rt_lwp *lwp;
  197. tid = rt_thread_self();
  198. lwp = lwp_self();
  199. user_stack = (uint32_t)tid->user_stack + tid->user_stack_size;
  200. user_stack &= ~7; //align 8
  201. set_user_context((void*)user_stack);
  202. lwp_user_entry(parameter, tid->user_entry, lwp->data_entry, (void*)user_stack);
  203. }
  204. /* thread/process */
  205. void sys_exit(int value)
  206. {
  207. rt_base_t level;
  208. rt_thread_t tid, main_thread;
  209. struct rt_lwp *lwp;
  210. LOG_D("thread/process exit.");
  211. tid = rt_thread_self();
  212. lwp = (struct rt_lwp*)tid->lwp;
  213. level = rt_hw_interrupt_disable();
  214. main_thread = rt_list_entry(lwp->t_grp.prev, struct rt_thread, sibling);
  215. if (main_thread == tid)
  216. {
  217. lwp_terminate(lwp);
  218. lwp_wait_subthread_exit();
  219. lwp->lwp_ret = value;
  220. }
  221. rt_thread_delete(tid);
  222. rt_schedule();
  223. rt_hw_interrupt_enable(level);
  224. return;
  225. }
  226. /* exit group */
  227. void sys_exit_group(int status)
  228. {
  229. return;
  230. }
  231. /* syscall: "read" ret: "ssize_t" args: "int" "void *" "size_t" */
  232. ssize_t sys_read(int fd, void *buf, size_t nbyte)
  233. {
  234. #ifdef RT_USING_USERSPACE
  235. void *kmem;
  236. ssize_t ret;
  237. if (!nbyte)
  238. return 0;
  239. if (!lwp_user_accessable((void*)buf, nbyte))
  240. return 0;
  241. kmem = kmem_get(nbyte);
  242. if (!kmem)
  243. return 0;
  244. ret = read(fd, kmem, nbyte);
  245. if (ret)
  246. lwp_put_to_user(buf, kmem, ret);
  247. kmem_put(kmem);
  248. return ret;
  249. #else
  250. return read(fd, buf, nbyte);
  251. #endif
  252. }
  253. /* syscall: "write" ret: "ssize_t" args: "int" "const void *" "size_t" */
  254. ssize_t sys_write(int fd, const void *buf, size_t nbyte)
  255. {
  256. #ifdef RT_USING_USERSPACE
  257. void *kmem;
  258. ssize_t ret;
  259. if (!nbyte)
  260. return 0;
  261. if (!lwp_user_accessable((void*)buf, nbyte))
  262. return 0;
  263. kmem = kmem_get(nbyte);
  264. if (!kmem)
  265. return 0;
  266. lwp_get_from_user(kmem, (void *)buf, nbyte);
  267. ret = write(fd, kmem, nbyte);
  268. kmem_put(kmem);
  269. return ret;
  270. #else
  271. return write(fd, buf, nbyte);
  272. #endif
  273. }
  274. /* syscall: "lseek" ret: "off_t" args: "int" "off_t" "int" */
  275. off_t sys_lseek(int fd, off_t offset, int whence)
  276. {
  277. return lseek(fd, offset, whence);
  278. }
  279. /* syscall: "open" ret: "int" args: "const char *" "int" "..." */
  280. int sys_open(const char *name, int flag, ...)
  281. {
  282. #ifdef RT_USING_USERSPACE
  283. int ret;
  284. rt_size_t len;
  285. char *kname;
  286. if (!lwp_user_accessable((void*)name, 1))
  287. return -1;
  288. len = rt_strlen(name);
  289. if (!len)
  290. return -1;
  291. kname = (char *)kmem_get(len + 1);
  292. if (!kname)
  293. return -1;
  294. lwp_get_from_user(kname, (void *)name, len + 1);
  295. ret = open(kname, flag, 0);
  296. kmem_put(kname);
  297. return ret;
  298. #else
  299. return open(name, flag, 0);
  300. #endif
  301. }
  302. /* syscall: "close" ret: "int" args: "int" */
  303. int sys_close(int fd)
  304. {
  305. if ((0 <= fd) && (fd <= 2))
  306. {
  307. return 0;
  308. }
  309. return close(fd);
  310. }
  311. /* syscall: "ioctl" ret: "int" args: "int" "u_long" "..." */
  312. int sys_ioctl(int fd, unsigned long cmd, void* data)
  313. {
  314. return ioctl(fd, cmd, data);
  315. }
  316. int sys_fstat(int file, struct stat *buf)
  317. {
  318. #ifdef RT_USING_USERSPACE
  319. int ret;
  320. struct stat statbuff;
  321. ret = fstat(file, &statbuff);
  322. lwp_put_to_user(buf, &statbuff, sizeof statbuff);
  323. return ret;
  324. #else
  325. return fstat(file, buf);
  326. #endif
  327. }
  328. int sys_poll(struct pollfd *fds, nfds_t nfds, int timeout)
  329. {
  330. #ifdef RT_USING_USERSPACE
  331. int ret;
  332. struct pollfd *kfds;
  333. if (!lwp_user_accessable((void*)fds, nfds * sizeof *fds))
  334. return -1;
  335. kfds = (struct pollfd *)kmem_get(nfds * sizeof *kfds);
  336. if (!kfds)
  337. return -1;
  338. lwp_get_from_user(kfds, fds, nfds * sizeof *kfds);
  339. ret = poll(kfds, nfds, timeout);
  340. lwp_put_to_user(fds, kfds, nfds * sizeof *kfds);
  341. kmem_put(kfds);
  342. return ret;
  343. #else
  344. return poll(fds, nfds, timeout);
  345. #endif
  346. }
  347. int sys_select(int nfds, fd_set *readfds, fd_set *writefds, fd_set *exceptfds, struct timeval *timeout)
  348. {
  349. #ifdef RT_USING_USERSPACE
  350. int ret = -1;
  351. fd_set *kreadfds = RT_NULL, *kwritefds = RT_NULL, *kexceptfds = RT_NULL;
  352. if (readfds)
  353. {
  354. if (!lwp_user_accessable((void*)readfds, sizeof *readfds))
  355. {
  356. return -1;
  357. }
  358. kreadfds = (fd_set *)kmem_get(sizeof *kreadfds);
  359. if (!kreadfds)
  360. {
  361. goto quit;
  362. }
  363. lwp_get_from_user(kreadfds, readfds, sizeof *kreadfds);
  364. }
  365. if (writefds)
  366. {
  367. if (!lwp_user_accessable((void*)writefds, sizeof *writefds))
  368. {
  369. return -1;
  370. }
  371. kwritefds = (fd_set *)kmem_get(sizeof *kwritefds);
  372. if (!kwritefds)
  373. {
  374. goto quit;
  375. }
  376. lwp_get_from_user(kwritefds, writefds, sizeof *kwritefds);
  377. }
  378. if (exceptfds)
  379. {
  380. if (!lwp_user_accessable((void*)exceptfds, sizeof *exceptfds))
  381. {
  382. return -1;
  383. }
  384. kexceptfds = (fd_set *)kmem_get(sizeof *kexceptfds);
  385. if (!kexceptfds)
  386. {
  387. goto quit;
  388. }
  389. lwp_get_from_user(kexceptfds, exceptfds, sizeof *kexceptfds);
  390. }
  391. ret = select(nfds, kreadfds, kwritefds, kexceptfds, timeout);
  392. if (kreadfds)
  393. {
  394. lwp_put_to_user(readfds, kreadfds, sizeof *kreadfds);
  395. }
  396. if (kwritefds)
  397. {
  398. lwp_put_to_user(writefds, kwritefds, sizeof *kwritefds);
  399. }
  400. if (kexceptfds)
  401. {
  402. lwp_put_to_user(exceptfds, kexceptfds, sizeof *kexceptfds);
  403. }
  404. quit:
  405. if (kreadfds)
  406. {
  407. kmem_put(kreadfds);
  408. }
  409. if (kwritefds)
  410. {
  411. kmem_put(kwritefds);
  412. }
  413. if (kexceptfds)
  414. {
  415. kmem_put(kexceptfds);
  416. }
  417. return ret;
  418. #else
  419. return select(nfds, readfds, writefds, exceptfds, timeout);
  420. #endif
  421. }
  422. int sys_unlink(const char *pathname)
  423. {
  424. #ifdef RT_USING_USERSPACE
  425. int ret;
  426. rt_size_t len;
  427. char *kname;
  428. if (!lwp_user_accessable((void*)pathname, 1))
  429. return -1;
  430. len = rt_strlen(pathname);
  431. if (!len)
  432. return -1;
  433. kname = (char *)kmem_get(len + 1);
  434. if (!kname)
  435. return -1;
  436. lwp_get_from_user(kname, (void *)pathname, len + 1);
  437. ret = unlink(kname);
  438. kmem_put(kname);
  439. return ret;
  440. #else
  441. return unlink(pathname);
  442. #endif
  443. }
  444. /* syscall: "nanosleep" ret: "int" args: "const struct timespec *" "struct timespec *" */
  445. int sys_nanosleep(const struct timespec *rqtp, struct timespec *rmtp)
  446. {
  447. rt_tick_t tick;
  448. #ifdef RT_USING_USERSPACE
  449. struct timespec rqtp_k;
  450. struct timespec rmtp_k;
  451. dbg_log(DBG_LOG, "sys_nanosleep\n");
  452. if (!lwp_user_accessable((void*)rqtp, sizeof *rqtp))
  453. return -1;
  454. lwp_get_from_user(&rqtp_k, (void *)rqtp, sizeof rqtp_k);
  455. tick = rqtp_k.tv_sec * RT_TICK_PER_SECOND + ((uint64_t)rqtp_k.tv_nsec * RT_TICK_PER_SECOND)/ 1000000000;
  456. rt_thread_delay(tick);
  457. if (rmtp)
  458. {
  459. if (!lwp_user_accessable((void*)rmtp, sizeof *rmtp))
  460. return -1;
  461. tick = rt_tick_get() - tick;
  462. /* get the passed time */
  463. rmtp_k.tv_sec = tick/RT_TICK_PER_SECOND;
  464. rmtp_k.tv_nsec = (tick%RT_TICK_PER_SECOND) * (1000000000/RT_TICK_PER_SECOND);
  465. lwp_put_to_user(rmtp, (void *)&rmtp_k, sizeof rmtp_k);
  466. }
  467. #else
  468. dbg_log(DBG_LOG, "sys_nanosleep\n");
  469. tick = rqtp->tv_sec * RT_TICK_PER_SECOND + ((uint64_t)rqtp->tv_nsec * RT_TICK_PER_SECOND)/ 1000000000;
  470. rt_thread_delay(tick);
  471. if (rmtp)
  472. {
  473. tick = rt_tick_get() - tick;
  474. /* get the passed time */
  475. rmtp->tv_sec = tick/RT_TICK_PER_SECOND;
  476. rmtp->tv_nsec = (tick%RT_TICK_PER_SECOND) * (1000000000/RT_TICK_PER_SECOND);
  477. }
  478. #endif
  479. return 0;
  480. }
  481. /* syscall: "gettimeofday" ret: "int" args: "struct timeval *" "struct timezone *" */
  482. int sys_gettimeofday(struct timeval *tp, struct timezone *tzp)
  483. {
  484. struct timeval t_k;
  485. #ifdef RT_USING_USERSPACE
  486. if (tp)
  487. {
  488. if (!lwp_user_accessable((void*)tp, sizeof *tp))
  489. return -1;
  490. t_k.tv_sec = rt_tick_get() / RT_TICK_PER_SECOND;
  491. t_k.tv_usec = (rt_tick_get() % RT_TICK_PER_SECOND) * (1000000 / RT_TICK_PER_SECOND);
  492. lwp_put_to_user(tp, (void *)&t_k, sizeof t_k);
  493. }
  494. #else
  495. if (tp)
  496. {
  497. tp->tv_sec = rt_tick_get() / RT_TICK_PER_SECOND;
  498. tp->tv_usec = (rt_tick_get() % RT_TICK_PER_SECOND) * (1000000 / RT_TICK_PER_SECOND);
  499. }
  500. #endif
  501. return 0;
  502. }
  503. int sys_settimeofday(const struct timeval *tv, const struct timezone *tzp)
  504. {
  505. return 0;
  506. }
  507. #ifdef RT_USING_GDBSERVER
  508. int lwp_execve(char *filename, int debug, int argc, char **argv, char **envp);
  509. #else
  510. int lwp_execve(char *filename, int argc, char **argv, char **envp);
  511. #endif
  512. int sys_exec(char *filename, int argc, char **argv, char **envp)
  513. {
  514. #ifdef RT_USING_GDBSERVER
  515. return lwp_execve(filename, 0, argc, argv, envp);
  516. #else
  517. return lwp_execve(filename, argc, argv, envp);
  518. #endif
  519. }
  520. int sys_kill(int pid, int sig)
  521. {
  522. return lwp_kill(pid, sig);
  523. }
  524. int sys_getpid(void)
  525. {
  526. return lwp_getpid();
  527. }
  528. /* syscall: "getpriority" ret: "int" args: "int" "id_t" */
  529. int sys_getpriority(int which, id_t who)
  530. {
  531. if (which == PRIO_PROCESS)
  532. {
  533. rt_thread_t tid;
  534. tid = rt_thread_self();
  535. if (who == (id_t)tid || who == 0xff)
  536. {
  537. return tid->current_priority;
  538. }
  539. }
  540. return 0xff;
  541. }
  542. /* syscall: "setpriority" ret: "int" args: "int" "id_t" "int" */
  543. int sys_setpriority(int which, id_t who, int prio)
  544. {
  545. if (which == PRIO_PROCESS)
  546. {
  547. rt_thread_t tid;
  548. tid = rt_thread_self();
  549. if ((who == (id_t)tid || who == 0xff) && (prio >= 0 && prio < RT_THREAD_PRIORITY_MAX))
  550. {
  551. rt_thread_control(tid, RT_THREAD_CTRL_CHANGE_PRIORITY, &prio);
  552. return 0;
  553. }
  554. }
  555. return -1;
  556. }
  557. rt_sem_t sys_sem_create(const char *name, rt_uint32_t value, rt_uint8_t flag)
  558. {
  559. return rt_sem_create(name, value, flag);
  560. }
  561. rt_err_t sys_sem_delete(rt_sem_t sem)
  562. {
  563. return rt_sem_delete(sem);
  564. }
  565. rt_err_t sys_sem_take(rt_sem_t sem, rt_int32_t time)
  566. {
  567. return rt_sem_take_interruptible(sem, time);
  568. }
  569. rt_err_t sys_sem_release(rt_sem_t sem)
  570. {
  571. return rt_sem_release(sem);
  572. }
  573. rt_mutex_t sys_mutex_create(const char *name, rt_uint8_t flag)
  574. {
  575. return rt_mutex_create(name, flag);
  576. }
  577. rt_err_t sys_mutex_delete(rt_mutex_t mutex)
  578. {
  579. return rt_mutex_delete(mutex);
  580. }
  581. rt_err_t sys_mutex_take(rt_mutex_t mutex, rt_int32_t time)
  582. {
  583. return rt_mutex_take_interruptible(mutex, time);
  584. }
  585. rt_err_t sys_mutex_release(rt_mutex_t mutex)
  586. {
  587. return rt_mutex_release(mutex);
  588. }
  589. #ifdef RT_USING_USERSPACE
  590. /* memory allocation */
  591. extern int lwp_brk(void *addr);
  592. int sys_brk(void *addr)
  593. {
  594. return lwp_brk(addr);
  595. }
  596. extern void *lwp_mmap2(void *addr, size_t length, int prot,
  597. int flags, int fd, off_t pgoffset);
  598. void *sys_mmap2(void *addr, size_t length, int prot,
  599. int flags, int fd, off_t pgoffset)
  600. {
  601. return lwp_mmap2(addr, length, prot, flags, fd, pgoffset);
  602. }
  603. extern int lwp_munmap(void *addr, size_t length);
  604. int sys_munmap(void *addr, size_t length)
  605. {
  606. return lwp_munmap(addr, length);
  607. }
  608. #endif
  609. rt_event_t sys_event_create(const char *name, rt_uint8_t flag)
  610. {
  611. return rt_event_create(name, flag);
  612. }
  613. rt_err_t sys_event_delete(rt_event_t event)
  614. {
  615. return rt_event_delete(event);
  616. }
  617. rt_err_t sys_event_send(rt_event_t event, rt_uint32_t set)
  618. {
  619. return rt_event_send(event, set);
  620. }
  621. rt_err_t sys_event_recv(rt_event_t event,
  622. rt_uint32_t set,
  623. rt_uint8_t opt,
  624. rt_int32_t timeout,
  625. rt_uint32_t *recved)
  626. {
  627. return rt_event_recv(event, set, opt, timeout, recved);
  628. }
  629. rt_mailbox_t sys_mb_create(const char *name, rt_size_t size, rt_uint8_t flag)
  630. {
  631. return rt_mb_create(name, size, flag);
  632. }
  633. rt_err_t sys_mb_delete(rt_mailbox_t mb)
  634. {
  635. return rt_mb_delete(mb);
  636. }
  637. rt_err_t sys_mb_send(rt_mailbox_t mb, rt_uint32_t value)
  638. {
  639. return rt_mb_send(mb, value);
  640. }
  641. rt_err_t sys_mb_send_wait(rt_mailbox_t mb,
  642. rt_uint32_t value,
  643. rt_int32_t timeout)
  644. {
  645. return rt_mb_send_wait(mb, value, timeout);
  646. }
  647. rt_err_t sys_mb_recv(rt_mailbox_t mb, rt_uint32_t *value, rt_int32_t timeout)
  648. {
  649. return rt_mb_recv(mb, (rt_ubase_t*)value, timeout);
  650. }
  651. rt_mq_t sys_mq_create(const char *name,
  652. rt_size_t msg_size,
  653. rt_size_t max_msgs,
  654. rt_uint8_t flag)
  655. {
  656. return rt_mq_create(name, msg_size, max_msgs, flag);
  657. }
  658. rt_err_t sys_mq_delete(rt_mq_t mq)
  659. {
  660. return rt_mq_delete(mq);
  661. }
  662. rt_err_t sys_mq_send(rt_mq_t mq, void *buffer, rt_size_t size)
  663. {
  664. return rt_mq_send(mq, buffer, size);
  665. }
  666. rt_err_t sys_mq_urgent(rt_mq_t mq, void *buffer, rt_size_t size)
  667. {
  668. return rt_mq_urgent(mq, buffer, size);
  669. }
  670. rt_err_t sys_mq_recv(rt_mq_t mq,
  671. void *buffer,
  672. rt_size_t size,
  673. rt_int32_t timeout)
  674. {
  675. return rt_mq_recv(mq, buffer, size, timeout);
  676. }
  677. static void timer_timeout_callback(void *parameter)
  678. {
  679. rt_sem_t sem = (rt_sem_t)parameter;
  680. rt_sem_release(sem);
  681. }
  682. rt_timer_t sys_timer_create(const char *name,
  683. void *data,
  684. rt_tick_t time,
  685. rt_uint8_t flag)
  686. {
  687. return rt_timer_create(name, timer_timeout_callback, (void*)data, time, flag);
  688. }
  689. rt_err_t sys_timer_delete(rt_timer_t timer)
  690. {
  691. return rt_timer_delete(timer);
  692. }
  693. rt_err_t sys_timer_start(rt_timer_t timer)
  694. {
  695. return rt_timer_start(timer);
  696. }
  697. rt_err_t sys_timer_stop(rt_timer_t timer)
  698. {
  699. return rt_timer_stop(timer);
  700. }
  701. rt_err_t sys_timer_control(rt_timer_t timer, int cmd, void *arg)
  702. {
  703. return rt_timer_control(timer, cmd, arg);
  704. }
  705. #ifdef RT_USING_USERSPACE
  706. void *lwp_map_user(struct rt_lwp *lwp, void *map_va, size_t map_size);
  707. #endif
  708. rt_thread_t sys_thread_create(void *arg[])
  709. {
  710. rt_base_t level;
  711. void *user_stack = 0;
  712. struct rt_lwp *lwp = 0;
  713. rt_thread_t tid;
  714. lwp = rt_thread_self()->lwp;
  715. lwp_ref_inc(lwp);
  716. #ifdef RT_USING_USERSPACE
  717. user_stack = lwp_map_user(lwp, 0, (size_t)arg[3]);
  718. #else
  719. user_stack = (void *)RT_KERNEL_MALLOC((uint32_t)arg[3]);
  720. #endif
  721. if (!user_stack)
  722. {
  723. return RT_NULL;
  724. }
  725. tid = rt_thread_create((const char*)arg[0], lwp_user_thread, (void*)arg[2], ALLOC_KERNEL_STACK_SIZE, (rt_uint8_t)(size_t)arg[4], (rt_uint32_t)arg[5]);
  726. if (!tid)
  727. {
  728. goto fail;
  729. }
  730. tid->cleanup = lwp_cleanup;
  731. tid->user_entry = (void (*)(void *))arg[1];
  732. tid->user_stack = (void *)user_stack;
  733. tid->user_stack_size = (uint32_t)arg[3];
  734. tid->lwp = (void*)lwp;
  735. level = rt_hw_interrupt_disable();
  736. rt_list_insert_after(&lwp->t_grp, &tid->sibling);
  737. rt_hw_interrupt_enable(level);
  738. return tid;
  739. fail:
  740. #ifndef RT_USING_USERSPACE
  741. if (user_stack)
  742. {
  743. RT_KERNEL_FREE(user_stack);
  744. }
  745. #endif
  746. if (lwp)
  747. {
  748. lwp_ref_dec(lwp);
  749. }
  750. return RT_NULL;
  751. }
  752. rt_err_t sys_thread_delete(rt_thread_t thread)
  753. {
  754. return rt_thread_delete(thread);
  755. }
  756. rt_err_t sys_thread_startup(rt_thread_t thread)
  757. {
  758. return rt_thread_startup(thread);
  759. }
  760. rt_thread_t sys_thread_self(void)
  761. {
  762. return rt_thread_self();
  763. }
  764. /* sys channel */
  765. int sys_channel_open(const char *name, int flags)
  766. {
  767. return lwp_channel_open(FDT_TYPE_LWP, name, flags);
  768. }
  769. rt_err_t sys_channel_close(int fd)
  770. {
  771. return lwp_channel_close(FDT_TYPE_LWP, fd);
  772. }
  773. rt_err_t sys_channel_send(int fd, rt_channel_msg_t data)
  774. {
  775. return lwp_channel_send(FDT_TYPE_LWP, fd, data);
  776. }
  777. rt_err_t sys_channel_send_recv_timeout(int fd, rt_channel_msg_t data, rt_channel_msg_t data_ret, rt_int32_t time)
  778. {
  779. return lwp_channel_send_recv_timeout(FDT_TYPE_LWP, fd, data, data_ret, time);
  780. }
  781. rt_err_t sys_channel_reply(int fd, rt_channel_msg_t data)
  782. {
  783. return lwp_channel_reply(FDT_TYPE_LWP, fd, data);
  784. }
  785. rt_err_t sys_channel_recv_timeout(int fd, rt_channel_msg_t data, rt_int32_t time)
  786. {
  787. return lwp_channel_recv_timeout(FDT_TYPE_LWP, fd, data, time);
  788. }
  789. /*****/
  790. static struct rt_semaphore critical_lock;
  791. static int critical_init(void)
  792. {
  793. rt_sem_init(&critical_lock, "ct_lock", 1, RT_IPC_FLAG_FIFO);
  794. return 0;
  795. }
  796. INIT_DEVICE_EXPORT(critical_init);
  797. void sys_enter_critical(void)
  798. {
  799. rt_sem_take(&critical_lock, RT_WAITING_FOREVER);
  800. }
  801. void sys_exit_critical(void)
  802. {
  803. rt_sem_release(&critical_lock);
  804. }
  805. /* syscall: "sys_log" ret: "int" args: "const char*" "size" */
  806. static int __sys_log_enable = 0;
  807. static int sys_log_enable(int argc, char** argv)
  808. {
  809. if (argc == 1)
  810. {
  811. rt_kprintf("sys_log = %d\n", __sys_log_enable);
  812. return 0;
  813. }
  814. else
  815. {
  816. __sys_log_enable = atoi(argv[1]);
  817. }
  818. return 0;
  819. }
  820. MSH_CMD_EXPORT_ALIAS(sys_log_enable, sys_log, sys_log 1(enable)/0(disable));
  821. int sys_log(const char* log, int size)
  822. {
  823. rt_device_t console = rt_console_get_device();
  824. if (console && __sys_log_enable) rt_device_write(console, -1, log, size);
  825. return 0;
  826. }
  827. int sys_stat(const char *file, struct stat *buf)
  828. {
  829. return stat(file, buf);
  830. }
  831. int sys_notimpl(void)
  832. {
  833. return -ENOSYS;
  834. }
  835. uint32_t sys_hw_interrupt_disable(void)
  836. {
  837. return rt_hw_interrupt_disable();
  838. }
  839. void sys_hw_interrupt_enable(uint32_t level)
  840. {
  841. rt_hw_interrupt_enable(level);
  842. }
  843. #ifdef RT_USING_USERSPACE
  844. int sys_shmget(size_t key, size_t size, int create)
  845. {
  846. return lwp_shmget(key, size, create);
  847. }
  848. int sys_shmrm(int id)
  849. {
  850. return lwp_shmrm(id);
  851. }
  852. void* sys_shmat(int id, void* shm_vaddr)
  853. {
  854. return lwp_shmat(id, shm_vaddr);
  855. }
  856. int sys_shmdt(void* shm_vaddr)
  857. {
  858. return lwp_shmdt(shm_vaddr);
  859. }
  860. #endif
  861. /* device interfaces */
  862. rt_err_t sys_device_init(rt_device_t dev)
  863. {
  864. return rt_device_init(dev);
  865. }
  866. rt_err_t sys_device_register(rt_device_t dev, const char *name, rt_uint16_t flags)
  867. {
  868. return rt_device_register(dev, name, flags);
  869. }
  870. rt_err_t sys_device_control(rt_device_t dev, int cmd, void *arg)
  871. {
  872. return rt_device_control(dev, cmd, arg);
  873. }
  874. rt_device_t sys_device_find(const char* name)
  875. {
  876. return rt_device_find(name);
  877. }
  878. rt_err_t sys_device_open(rt_device_t dev, rt_uint16_t oflag)
  879. {
  880. return rt_device_open(dev, oflag);
  881. }
  882. rt_err_t sys_device_close(rt_device_t dev)
  883. {
  884. return rt_device_close(dev);
  885. }
  886. rt_size_t sys_device_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
  887. {
  888. return rt_device_read(dev, pos, buffer, size);
  889. }
  890. rt_size_t sys_device_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
  891. {
  892. return rt_device_write(dev, pos, buffer, size);
  893. }
  894. /* network interfaces */
  895. int sys_accept(int socket, struct musl_sockaddr *addr, socklen_t *addrlen)
  896. {
  897. int ret;
  898. struct sockaddr ksa;
  899. struct musl_sockaddr kmusladdr;
  900. socklen_t uaddrlen;
  901. socklen_t kaddrlen;
  902. if (!lwp_user_accessable(addrlen, sizeof (socklen_t *)))
  903. {
  904. return -1;
  905. }
  906. lwp_get_from_user(&uaddrlen, addrlen, sizeof (socklen_t *));
  907. if (!uaddrlen)
  908. {
  909. return -1;
  910. }
  911. if (!lwp_user_accessable(addr, uaddrlen))
  912. {
  913. return -1;
  914. }
  915. kaddrlen = sizeof(struct sockaddr);
  916. ret = accept(socket, &ksa, &kaddrlen);
  917. if (ret >= 0)
  918. {
  919. sockaddr_tomusl(&ksa, &kmusladdr);
  920. if (uaddrlen > sizeof(struct musl_sockaddr))
  921. {
  922. uaddrlen = sizeof(struct musl_sockaddr);
  923. }
  924. lwp_put_to_user(addr, &kmusladdr, uaddrlen);
  925. lwp_put_to_user(addrlen, &uaddrlen, sizeof (socklen_t *));
  926. }
  927. return ret;
  928. }
  929. int sys_bind(int socket, const struct musl_sockaddr *name, socklen_t namelen)
  930. {
  931. struct sockaddr sa;
  932. struct musl_sockaddr kname;
  933. if (!lwp_user_accessable((void*)name, namelen))
  934. {
  935. return -1;
  936. }
  937. lwp_get_from_user(&kname, (void*)name, namelen);
  938. sockaddr_tolwip(&kname, &sa);
  939. return bind(socket, &sa, namelen);
  940. }
  941. int sys_shutdown(int socket, int how)
  942. {
  943. return shutdown(socket, how);
  944. }
  945. int sys_getpeername (int socket, struct musl_sockaddr *name, socklen_t *namelen)
  946. {
  947. int ret;
  948. struct sockaddr sa;
  949. struct musl_sockaddr kname;
  950. socklen_t unamelen;
  951. socklen_t knamelen;
  952. if (!lwp_user_accessable(namelen, sizeof (socklen_t *)))
  953. {
  954. return -1;
  955. }
  956. lwp_get_from_user(&unamelen, namelen, sizeof (socklen_t *));
  957. if (!unamelen)
  958. {
  959. return -1;
  960. }
  961. if (!lwp_user_accessable(name, unamelen))
  962. {
  963. return -1;
  964. }
  965. knamelen = sizeof(struct sockaddr);
  966. ret = getpeername (socket, &sa, &knamelen);
  967. if (ret == 0)
  968. {
  969. sockaddr_tomusl(&sa, &kname);
  970. if (unamelen > sizeof(struct musl_sockaddr))
  971. {
  972. unamelen = sizeof(struct musl_sockaddr);
  973. }
  974. lwp_put_to_user(name, &kname, unamelen);
  975. lwp_put_to_user(namelen, &unamelen, sizeof (socklen_t *));
  976. }
  977. return ret;
  978. }
  979. int sys_getsockname (int socket, struct musl_sockaddr *name, socklen_t *namelen)
  980. {
  981. int ret;
  982. struct sockaddr sa;
  983. struct musl_sockaddr kname;
  984. socklen_t unamelen;
  985. socklen_t knamelen;
  986. if (!lwp_user_accessable(namelen, sizeof (socklen_t *)))
  987. {
  988. return -1;
  989. }
  990. lwp_get_from_user(&unamelen, namelen, sizeof (socklen_t *));
  991. if (!unamelen)
  992. {
  993. return -1;
  994. }
  995. if (!lwp_user_accessable(name, unamelen))
  996. {
  997. return -1;
  998. }
  999. knamelen = sizeof(struct sockaddr);
  1000. ret = getsockname (socket, &sa, &knamelen);
  1001. if (ret == 0)
  1002. {
  1003. sockaddr_tomusl(&sa, &kname);
  1004. if (unamelen > sizeof(struct musl_sockaddr))
  1005. {
  1006. unamelen = sizeof(struct musl_sockaddr);
  1007. }
  1008. lwp_put_to_user(name, &kname, unamelen);
  1009. lwp_put_to_user(namelen, &unamelen, sizeof (socklen_t *));
  1010. }
  1011. return ret;
  1012. }
  1013. int sys_getsockopt (int socket, int level, int optname, void *optval, socklen_t *optlen)
  1014. {
  1015. LOG_I("syscall: getsockopt");
  1016. convert_sockopt(&level, &optname);
  1017. return getsockopt (socket, level, optname, optval, optlen);
  1018. }
  1019. int sys_setsockopt (int socket, int level, int optname, const void *optval, socklen_t optlen)
  1020. {
  1021. LOG_I("syscall: setsockopt");
  1022. convert_sockopt(&level, &optname);
  1023. return setsockopt (socket, level, optname, optval, optlen);
  1024. }
  1025. int sys_connect(int socket, const struct musl_sockaddr *name, socklen_t namelen)
  1026. {
  1027. struct sockaddr sa;
  1028. struct musl_sockaddr kname;
  1029. if (!lwp_user_accessable((void*)name, namelen))
  1030. {
  1031. return -1;
  1032. }
  1033. lwp_get_from_user(&kname, (void*)name, namelen);
  1034. sockaddr_tolwip(&kname, &sa);
  1035. return connect(socket, &sa, namelen);
  1036. }
  1037. int sys_listen(int socket, int backlog)
  1038. {
  1039. return listen(socket, backlog);
  1040. }
  1041. #define MUSLC_MSG_OOB 0x0001
  1042. #define MUSLC_MSG_PEEK 0x0002
  1043. #define MUSLC_MSG_DONTWAIT 0x0040
  1044. #define MUSLC_MSG_WAITALL 0x0100
  1045. #define MUSLC_MSG_MORE 0x8000
  1046. static int netflags_muslc_2_lwip(int flags)
  1047. {
  1048. int flgs = 0;
  1049. if (flags & MUSLC_MSG_PEEK)
  1050. flgs |= MSG_PEEK;
  1051. if (flags & MUSLC_MSG_WAITALL)
  1052. flgs |= MSG_WAITALL;
  1053. if (flags & MUSLC_MSG_OOB)
  1054. flgs |= MSG_OOB;
  1055. if (flags & MUSLC_MSG_DONTWAIT)
  1056. flgs |= MSG_DONTWAIT;
  1057. if (flags & MUSLC_MSG_MORE)
  1058. flgs |= MSG_MORE;
  1059. return flgs;
  1060. }
  1061. int sys_recvfrom(int socket, void *mem, size_t len, int flags,
  1062. struct musl_sockaddr *from, socklen_t *fromlen)
  1063. {
  1064. int flgs = 0;
  1065. #ifdef RT_USING_USERSPACE
  1066. int ret = -1;
  1067. void *kmem = RT_NULL;
  1068. #endif
  1069. flgs = netflags_muslc_2_lwip(flags);
  1070. #ifdef RT_USING_USERSPACE
  1071. if (!len)
  1072. return -1;
  1073. if (!lwp_user_accessable((void*)mem, len))
  1074. return -1;
  1075. kmem = kmem_get(len);
  1076. if (!kmem)
  1077. return -1;
  1078. if (flags == 0x2) {
  1079. flags = 0x1;
  1080. }
  1081. if (from)
  1082. {
  1083. struct sockaddr sa;
  1084. ret = recvfrom(socket, kmem, len, flgs, &sa, fromlen);
  1085. sockaddr_tomusl(&sa, from);
  1086. } else
  1087. ret = recvfrom(socket, kmem, len, flgs, NULL, NULL);
  1088. if (ret > 0)
  1089. lwp_put_to_user(mem, kmem, len);
  1090. kmem_put(kmem);
  1091. return ret;
  1092. #else
  1093. if (from)
  1094. {
  1095. int ret = -1;
  1096. struct sockaddr sa = {0};
  1097. ret = recvfrom(socket, mem, len, flgs, &sa, fromlen);
  1098. sockaddr_tomusl(&sa, from);
  1099. return ret;
  1100. }
  1101. return recvfrom(socket, mem, len, flags, NULL, NULL);
  1102. #endif
  1103. }
  1104. int sys_recv(int socket, void *mem, size_t len, int flags)
  1105. {
  1106. int flgs = 0;
  1107. flgs = netflags_muslc_2_lwip(flags);
  1108. return recvfrom(socket, mem, len, flgs, NULL, NULL);
  1109. }
  1110. int sys_sendto(int socket, const void *dataptr, size_t size, int flags,
  1111. const struct musl_sockaddr *to, socklen_t tolen)
  1112. {
  1113. int flgs = 0;
  1114. #ifdef RT_USING_USERSPACE
  1115. int ret = -1;
  1116. void *kmem = RT_NULL;
  1117. #endif
  1118. flgs = netflags_muslc_2_lwip(flags);
  1119. #ifdef RT_USING_USERSPACE
  1120. if (!size)
  1121. return -1;
  1122. if (!lwp_user_accessable((void*)dataptr, size))
  1123. return -1;
  1124. kmem = kmem_get(size);
  1125. if (!kmem)
  1126. return -1;
  1127. lwp_get_from_user(kmem, (void *)dataptr, size);
  1128. if (to)
  1129. {
  1130. struct sockaddr sa;
  1131. sockaddr_tolwip(to, &sa);
  1132. ret = sendto(socket, kmem, size, flgs, &sa, tolen);
  1133. }
  1134. else
  1135. ret = sendto(socket, kmem, size, flgs, NULL, tolen);
  1136. kmem_put(kmem);
  1137. return ret;
  1138. #else
  1139. if (to)
  1140. {
  1141. struct sockaddr sa;
  1142. sockaddr_tolwip(to, &sa);
  1143. return sendto(socket, dataptr, size, flgs, &sa, tolen);
  1144. }
  1145. return sendto(socket, dataptr, size, flgs, NULL, tolen);
  1146. #endif
  1147. }
  1148. int sys_send(int socket, const void *dataptr, size_t size, int flags)
  1149. {
  1150. int flgs = 0;
  1151. flgs = netflags_muslc_2_lwip(flags);
  1152. return sendto(socket, dataptr, size, flgs, NULL, 0);
  1153. }
  1154. int sys_socket(int domain, int type, int protocol)
  1155. {
  1156. int fd = -1;
  1157. int nonblock = 0;
  1158. /* not support SOCK_CLOEXEC type */
  1159. if (type & SOCK_CLOEXEC) type &= ~SOCK_CLOEXEC;
  1160. if (type & SOCK_NONBLOCK)
  1161. {
  1162. nonblock = 1;
  1163. type &= ~SOCK_NONBLOCK;
  1164. }
  1165. fd = socket(domain, type, protocol);
  1166. if (fd < 0)
  1167. {
  1168. goto out;
  1169. }
  1170. if (nonblock)
  1171. {
  1172. fcntl(fd, F_SETFL, O_NONBLOCK);
  1173. }
  1174. out:
  1175. return fd;
  1176. }
  1177. int sys_closesocket(int socket)
  1178. {
  1179. return closesocket(socket);
  1180. }
  1181. rt_thread_t sys_thread_find(char *name)
  1182. {
  1183. return rt_thread_find(name);
  1184. }
  1185. rt_tick_t sys_tick_get(void)
  1186. {
  1187. return rt_tick_get();
  1188. }
  1189. rt_err_t sys_thread_mdelay(rt_int32_t ms)
  1190. {
  1191. return rt_thread_mdelay(ms);
  1192. }
  1193. void sys_sighandler_set(int sig, lwp_sighandler_t func)
  1194. {
  1195. lwp_sighandler_set(sig, func);
  1196. }
  1197. int sys_sigprocmask(const lwp_sigset_t *sigset, lwp_sigset_t *oset)
  1198. {
  1199. return lwp_sigprocmask(sigset, oset);
  1200. }
  1201. int sys_thread_kill(rt_thread_t thread, int sig)
  1202. {
  1203. return lwp_thread_kill(thread, sig);
  1204. }
  1205. void sys_thread_sighandler_set(int sig, lwp_sighandler_t func)
  1206. {
  1207. lwp_thread_sighandler_set(sig, func);
  1208. }
  1209. int sys_thread_sigprocmask(const lwp_sigset_t *sigset, lwp_sigset_t *oset)
  1210. {
  1211. return lwp_thread_sigprocmask(sigset, oset);
  1212. }
  1213. int32_t sys_waitpid(int32_t pid, int *status, int options)
  1214. {
  1215. return waitpid(pid, status, options);
  1216. }
  1217. #if defined(RT_USING_SAL) && defined(SAL_USING_POSIX)
  1218. struct musl_addrinfo
  1219. {
  1220. int ai_flags;
  1221. int ai_family;
  1222. int ai_socktype;
  1223. int ai_protocol;
  1224. socklen_t ai_addrlen;
  1225. struct musl_sockaddr *ai_addr;
  1226. char *ai_canonname;
  1227. struct musl_addrinfo *ai_next;
  1228. };
  1229. int sys_getaddrinfo(const char *nodename, const char *servname, const struct musl_addrinfo *hints, struct musl_addrinfo *res)
  1230. {
  1231. int ret = -1;
  1232. struct addrinfo *k_res = NULL;
  1233. char *k_nodename = NULL;
  1234. char *k_servname = NULL;
  1235. struct addrinfo *k_hints = NULL;
  1236. LOG_I("syscall: getaddrinfo");
  1237. if (nodename)
  1238. {
  1239. k_nodename = rt_strdup(nodename);
  1240. if (!k_nodename) goto exit;
  1241. }
  1242. if (servname)
  1243. {
  1244. k_servname = rt_strdup(servname);
  1245. if (!k_servname)
  1246. {
  1247. goto exit;
  1248. }
  1249. }
  1250. if (hints)
  1251. {
  1252. k_hints = (struct addrinfo*) rt_malloc(sizeof *hints);
  1253. if (!k_hints)
  1254. {
  1255. goto exit;
  1256. }
  1257. rt_memset(k_hints, 0x0, sizeof(struct addrinfo));
  1258. k_hints->ai_flags = hints->ai_flags;
  1259. k_hints->ai_family = hints->ai_family;
  1260. k_hints->ai_socktype = hints->ai_socktype;
  1261. k_hints->ai_protocol = hints->ai_protocol;
  1262. k_hints->ai_addrlen = hints->ai_addrlen;
  1263. }
  1264. ret = sal_getaddrinfo(k_nodename, k_servname, k_hints, &k_res);
  1265. if (ret == 0)
  1266. {
  1267. /* set sockaddr */
  1268. sockaddr_tomusl(k_res->ai_addr, res->ai_addr);
  1269. res->ai_addrlen = k_res->ai_addrlen;
  1270. /* set up addrinfo */
  1271. res->ai_family = k_res->ai_family;
  1272. res->ai_flags = k_res->ai_flags;
  1273. res->ai_next = NULL;
  1274. if (hints != NULL)
  1275. {
  1276. /* copy socktype & protocol from hints if specified */
  1277. res->ai_socktype = hints->ai_socktype;
  1278. res->ai_protocol = hints->ai_protocol;
  1279. }
  1280. sal_freeaddrinfo(k_res);
  1281. k_res = NULL;
  1282. }
  1283. exit:
  1284. if (k_nodename)
  1285. {
  1286. rt_free(k_nodename);
  1287. }
  1288. if (k_servname)
  1289. {
  1290. rt_free(k_servname);
  1291. }
  1292. if (k_hints)
  1293. {
  1294. rt_free(k_hints);
  1295. }
  1296. return ret;
  1297. }
  1298. #define HOSTENT_BUFSZ 512
  1299. int sys_gethostbyname2_r(const char *name, int af, struct hostent *ret,
  1300. char *buf, size_t buflen,
  1301. struct hostent **result, int *err)
  1302. {
  1303. int sal_ret, sal_err;
  1304. struct hostent sal_he;
  1305. struct hostent *sal_result = NULL;
  1306. char *sal_buf = NULL;
  1307. char *k_name = NULL;
  1308. if (result == NULL)
  1309. {
  1310. /* not all arguments given */
  1311. *err = EINVAL;
  1312. return -1;
  1313. }
  1314. if ((name == NULL) || (ret == NULL) || (buf == NULL))
  1315. {
  1316. /* not all arguments given */
  1317. *err = EINVAL;
  1318. return -1;
  1319. }
  1320. *result = ret;
  1321. sal_buf = (char *)malloc (HOSTENT_BUFSZ);
  1322. if (sal_buf == NULL)
  1323. {
  1324. goto __exit;
  1325. }
  1326. k_name = rt_strdup(name);
  1327. if (k_name == NULL)
  1328. {
  1329. goto __exit;
  1330. }
  1331. /* get host by name in SAL */
  1332. sal_ret = sal_gethostbyname_r(k_name, &sal_he, sal_buf, HOSTENT_BUFSZ, &sal_result, &sal_err);
  1333. if (sal_ret == 0)
  1334. {
  1335. int index, cnt;
  1336. char *ptr = buf;
  1337. /* get counter */
  1338. index = 0;
  1339. while (sal_he.h_addr_list[index] != NULL) index ++;
  1340. cnt = index + 1;
  1341. /* update user space hostent */
  1342. ret->h_addrtype = sal_he.h_addrtype;
  1343. ret->h_length = sal_he.h_length;
  1344. rt_strncpy(ptr, k_name, buflen - (ptr - buf));
  1345. ret->h_name = ptr;
  1346. ptr += rt_strlen(k_name);
  1347. ret->h_addr_list = (char**)ptr;
  1348. ptr += cnt * sizeof(char*);
  1349. index = 0;
  1350. while (sal_he.h_addr_list[index] != NULL)
  1351. {
  1352. ret->h_addr_list[index] = ptr;
  1353. rt_memcpy(ptr, sal_he.h_addr_list[index], sal_he.h_length);
  1354. ptr += sal_he.h_length;
  1355. index ++;
  1356. }
  1357. ret->h_addr_list[index] = NULL;
  1358. }
  1359. __exit:
  1360. /* release buffer */
  1361. if (sal_buf) free(sal_buf);
  1362. if (k_name) free(k_name);
  1363. return 0;
  1364. }
  1365. #endif
  1366. char *sys_getcwd(char *buf, size_t size)
  1367. {
  1368. return getcwd(buf, size);
  1369. }
  1370. int sys_chdir(const char *path)
  1371. {
  1372. return chdir(path);
  1373. }
  1374. int sys_mkdir(const char *path, mode_t mode)
  1375. {
  1376. return mkdir(path, mode);
  1377. }
  1378. int sys_rmdir(const char *path)
  1379. {
  1380. return unlink(path);
  1381. }
  1382. typedef uint64_t ino_t;
  1383. struct libc_dirent {
  1384. ino_t d_ino;
  1385. off_t d_off;
  1386. unsigned short d_reclen;
  1387. unsigned char d_type;
  1388. char d_name[256];
  1389. };
  1390. int sys_getdents(int fd, struct libc_dirent *dirp, size_t nbytes)
  1391. {
  1392. int ret;
  1393. struct dfs_fd *dfs_fd;
  1394. size_t cnt = (nbytes / sizeof(struct libc_dirent));
  1395. size_t rtt_nbytes;
  1396. struct dirent *rtt_dirp;
  1397. if (cnt == 0)
  1398. {
  1399. return 0;
  1400. }
  1401. rtt_nbytes = cnt * sizeof(struct dirent);
  1402. rtt_dirp = (struct dirent*)rt_malloc(rtt_nbytes);
  1403. if (!rtt_dirp)
  1404. {
  1405. return 0;
  1406. }
  1407. dfs_fd = fd_get(fd);
  1408. ret = dfs_file_getdents(dfs_fd, rtt_dirp, nbytes);
  1409. fd_put(dfs_fd);
  1410. if (ret)
  1411. {
  1412. size_t i;
  1413. cnt = ret / sizeof(struct dirent);
  1414. for (i = 0; i < cnt; i++)
  1415. {
  1416. dirp[i].d_ino = 0;
  1417. dirp[i].d_off = 0;
  1418. dirp[i].d_type = rtt_dirp[i].d_type;
  1419. dirp[i].d_reclen = sizeof(struct libc_dirent);
  1420. strcpy(dirp[i].d_name, rtt_dirp[i].d_name);
  1421. }
  1422. ret = cnt * sizeof(struct libc_dirent);
  1423. }
  1424. rt_free(rtt_dirp);
  1425. return ret;
  1426. }
  1427. rt_err_t sys_get_errno(void)
  1428. {
  1429. return rt_get_errno();
  1430. }
  1431. void sys_set_thread_area(void *p)
  1432. {
  1433. lwp_set_thread_area(p);
  1434. }
  1435. long sys_set_tid_address(int *tidptr)
  1436. {
  1437. return 0;
  1438. }
  1439. int sys_access(const char *filename, int mode)
  1440. {
  1441. int ret;
  1442. #ifdef RT_USING_USERSPACE
  1443. rt_size_t len;
  1444. char *kname;
  1445. if (!lwp_user_accessable((void*)filename, 1))
  1446. return -1;
  1447. len = rt_strlen(filename);
  1448. if (!len)
  1449. return -1;
  1450. kname = (char *)kmem_get(len + 1);
  1451. if (!kname)
  1452. return -1;
  1453. lwp_get_from_user(kname, (void *)filename, len + 1);
  1454. ret = open(kname, mode, 0);
  1455. kmem_put(kname);
  1456. #else
  1457. ret = open(filename, mode, 0);
  1458. #endif
  1459. if (ret >= 0)
  1460. {
  1461. close(ret);
  1462. }
  1463. return (ret >= 0)? 0: ret;
  1464. }
  1465. int sys_pipe(int fd[2])
  1466. {
  1467. /* not implemented */
  1468. return -1;
  1469. }
  1470. const static void* func_table[] =
  1471. {
  1472. (void*)sys_exit, /* 01 */
  1473. (void*)sys_read,
  1474. (void*)sys_write,
  1475. (void*)sys_lseek,
  1476. (void*)sys_open, /* 05 */
  1477. (void*)sys_close,
  1478. (void*)sys_ioctl,
  1479. (void*)sys_fstat,
  1480. (void*)sys_poll,
  1481. (void*)sys_nanosleep, /* 10 */
  1482. (void*)sys_gettimeofday,
  1483. (void*)sys_settimeofday,
  1484. (void*)sys_exec,
  1485. (void*)sys_kill,
  1486. (void*)sys_getpid, /* 15 */
  1487. (void*)sys_getpriority,
  1488. (void*)sys_setpriority,
  1489. (void*)sys_sem_create,
  1490. (void*)sys_sem_delete,
  1491. (void*)sys_sem_take, /* 20 */
  1492. (void*)sys_sem_release,
  1493. (void*)sys_mutex_create,
  1494. (void*)sys_mutex_delete,
  1495. (void*)sys_mutex_take,
  1496. (void*)sys_mutex_release, /* 25 */
  1497. (void*)sys_event_create,
  1498. (void*)sys_event_delete,
  1499. (void*)sys_event_send,
  1500. (void*)sys_event_recv,
  1501. (void*)sys_mb_create, /* 30 */
  1502. (void*)sys_mb_delete,
  1503. (void*)sys_mb_send,
  1504. (void*)sys_mb_send_wait,
  1505. (void*)sys_mb_recv,
  1506. (void*)sys_mq_create, /* 35 */
  1507. (void*)sys_mq_delete,
  1508. (void*)sys_mq_send,
  1509. (void*)sys_mq_urgent,
  1510. (void*)sys_mq_recv,
  1511. (void*)sys_thread_create, /* 40 */
  1512. (void*)sys_thread_delete,
  1513. (void*)sys_thread_startup,
  1514. (void*)sys_thread_self,
  1515. (void*)sys_channel_open,
  1516. (void*)sys_channel_close, /* 45 */
  1517. (void*)sys_channel_send,
  1518. (void*)sys_channel_send_recv_timeout,
  1519. (void*)sys_channel_reply,
  1520. (void*)sys_channel_recv_timeout,
  1521. (void*)sys_enter_critical, /* 50 */
  1522. (void*)sys_exit_critical,
  1523. SYSCALL_USPACE(sys_brk),
  1524. SYSCALL_USPACE(sys_mmap2),
  1525. SYSCALL_USPACE(sys_munmap),
  1526. SYSCALL_USPACE(sys_shmget),
  1527. SYSCALL_USPACE(sys_shmrm),
  1528. SYSCALL_USPACE(sys_shmat),
  1529. SYSCALL_USPACE(sys_shmdt),
  1530. (void *)sys_device_init,
  1531. (void *)sys_device_register,
  1532. (void *)sys_device_control,
  1533. (void *)sys_device_find,
  1534. (void *)sys_device_open,
  1535. (void *)sys_device_close,
  1536. (void *)sys_device_read,
  1537. (void *)sys_device_write,
  1538. (void *)sys_stat,
  1539. (void *)sys_thread_find,
  1540. SYSCALL_NET(sys_accept),
  1541. SYSCALL_NET(sys_bind),
  1542. SYSCALL_NET(sys_shutdown),
  1543. SYSCALL_NET(sys_getpeername),
  1544. SYSCALL_NET(sys_getsockname),
  1545. SYSCALL_NET(sys_getsockopt),
  1546. SYSCALL_NET(sys_setsockopt),
  1547. SYSCALL_NET(sys_connect),
  1548. SYSCALL_NET(sys_listen),
  1549. SYSCALL_NET(sys_recv),
  1550. SYSCALL_NET(sys_recvfrom),
  1551. SYSCALL_NET(sys_send),
  1552. SYSCALL_NET(sys_sendto),
  1553. SYSCALL_NET(sys_socket),
  1554. SYSCALL_NET(sys_closesocket),
  1555. SYSCALL_NET(sys_getaddrinfo),
  1556. SYSCALL_NET(sys_gethostbyname2_r),
  1557. (void *)sys_notimpl, //(void *)network,
  1558. (void *)sys_notimpl, //(void *)network,
  1559. (void *)sys_notimpl, //(void *)network,
  1560. (void *)sys_notimpl, //(void *)network,
  1561. (void *)sys_notimpl, //(void *)network,
  1562. (void *)sys_notimpl, //(void *)network,
  1563. (void *)sys_notimpl, //(void *)network,
  1564. (void *)sys_notimpl, //(void *)network,
  1565. #ifdef RT_USING_DFS
  1566. (void *)sys_select,
  1567. #else
  1568. (void *)sys_notimpl,
  1569. #endif
  1570. (void *)sys_notimpl, //(void *)sys_hw_interrupt_disable,
  1571. (void *)sys_notimpl, //(void *)sys_hw_interrupt_enable,
  1572. (void *)sys_tick_get,
  1573. (void *)sys_exit_group,
  1574. (void *)sys_notimpl, //(void *)rt_delayed_work_init,
  1575. (void *)sys_notimpl, //(void *)rt_work_submit,
  1576. (void *)sys_notimpl, //(void *)rt_wqueue_wakeup,
  1577. (void *)sys_thread_mdelay,
  1578. (void*)sys_sighandler_set,
  1579. (void*)sys_sigprocmask,
  1580. (void*)sys_thread_kill,
  1581. (void*)sys_thread_sighandler_set,
  1582. (void*)sys_thread_sigprocmask,
  1583. (void*)sys_notimpl,
  1584. (void*)sys_notimpl,
  1585. (void*)sys_waitpid,
  1586. (void *)sys_timer_create,
  1587. (void *)sys_timer_delete,
  1588. (void *)sys_timer_start,
  1589. (void *)sys_timer_stop,
  1590. (void *)sys_timer_control,
  1591. (void *)sys_getcwd,
  1592. (void *)sys_chdir,
  1593. (void *)sys_unlink,
  1594. (void *)sys_mkdir,
  1595. (void *)sys_rmdir,
  1596. (void *)sys_getdents,
  1597. (void *)sys_get_errno,
  1598. (void *)sys_set_thread_area,
  1599. (void *)sys_set_tid_address,
  1600. (void *)sys_access,
  1601. (void *)sys_pipe,
  1602. };
  1603. const void *lwp_get_sys_api(rt_uint32_t number)
  1604. {
  1605. const void *func = (const void*)sys_notimpl;
  1606. if (number == 0xff)
  1607. {
  1608. func = (void *)sys_log;
  1609. }
  1610. else
  1611. {
  1612. number -= 1;
  1613. if (number < sizeof(func_table)/sizeof(func_table[0]))
  1614. {
  1615. func = func_table[number];
  1616. }
  1617. }
  1618. return func;
  1619. }