lwp_syscall.c 40 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813
  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_data_access_ok(&lwp_self()->mmu_info, (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_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (void*)buf, nbyte))
  262. return 0;
  263. kmem = kmem_get(nbyte);
  264. if (!kmem)
  265. return 0;
  266. lwp_data_get(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (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_data_get(&lwp_self()->mmu_info, 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_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (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_data_get(&lwp_self()->mmu_info, kfds, fds, nfds * sizeof *kfds);
  339. ret = poll(kfds, nfds, timeout);
  340. lwp_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (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_data_get(&lwp_self()->mmu_info, kreadfds, readfds, sizeof *kreadfds);
  364. }
  365. if (writefds)
  366. {
  367. if (!lwp_data_access_ok(&lwp_self()->mmu_info, (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_data_get(&lwp_self()->mmu_info, kwritefds, writefds, sizeof *kwritefds);
  377. }
  378. if (exceptfds)
  379. {
  380. if (!lwp_data_access_ok(&lwp_self()->mmu_info, (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_data_get(&lwp_self()->mmu_info, kexceptfds, exceptfds, sizeof *kexceptfds);
  390. }
  391. ret = select(nfds, kreadfds, kwritefds, kexceptfds, timeout);
  392. if (kreadfds)
  393. {
  394. lwp_data_put(&lwp_self()->mmu_info, readfds, kreadfds, sizeof *kreadfds);
  395. }
  396. if (kwritefds)
  397. {
  398. lwp_data_put(&lwp_self()->mmu_info, writefds, kwritefds, sizeof *kwritefds);
  399. }
  400. if (kexceptfds)
  401. {
  402. lwp_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (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_data_get(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (void*)rqtp, sizeof *rqtp))
  453. return -1;
  454. lwp_data_get(&lwp_self()->mmu_info, &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_data_access_ok(&lwp_self()->mmu_info, (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_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (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_data_put(&lwp_self()->mmu_info, 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(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(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. struct sockaddr sa;
  898. sockaddr_tolwip(addr, &sa);
  899. return accept(socket, &sa, addrlen);
  900. }
  901. int sys_bind(int socket, const struct musl_sockaddr *name, socklen_t namelen)
  902. {
  903. struct sockaddr sa;
  904. sockaddr_tolwip(name, &sa);
  905. return bind(socket, &sa, namelen);
  906. }
  907. int sys_shutdown(int socket, int how)
  908. {
  909. return shutdown(socket, how);
  910. }
  911. int sys_getpeername (int socket, struct musl_sockaddr *name, socklen_t *namelen)
  912. {
  913. int ret;
  914. struct sockaddr sa;
  915. sockaddr_tolwip(name, &sa);
  916. ret = getpeername (socket, &sa, namelen);
  917. if (name) sockaddr_tomusl(&sa, name);
  918. return ret;
  919. }
  920. int sys_getsockname (int socket, struct musl_sockaddr *name, socklen_t *namelen)
  921. {
  922. int ret;
  923. struct sockaddr sa;
  924. sockaddr_tolwip(name, &sa);
  925. ret = getsockname (socket, &sa, namelen);
  926. if (name) sockaddr_tomusl(&sa, name);
  927. return ret;
  928. }
  929. int sys_getsockopt (int socket, int level, int optname, void *optval, socklen_t *optlen)
  930. {
  931. LOG_I("syscall: getsockopt");
  932. convert_sockopt(&level, &optname);
  933. return getsockopt (socket, level, optname, optval, optlen);
  934. }
  935. int sys_setsockopt (int socket, int level, int optname, const void *optval, socklen_t optlen)
  936. {
  937. LOG_I("syscall: setsockopt");
  938. convert_sockopt(&level, &optname);
  939. return setsockopt (socket, level, optname, optval, optlen);
  940. }
  941. int sys_connect(int socket, const struct musl_sockaddr *name, socklen_t namelen)
  942. {
  943. struct sockaddr sa;
  944. sockaddr_tolwip(name, &sa);
  945. return connect(socket, &sa, namelen);
  946. }
  947. int sys_listen(int socket, int backlog)
  948. {
  949. return listen(socket, backlog);
  950. }
  951. #define MUSLC_MSG_OOB 0x0001
  952. #define MUSLC_MSG_PEEK 0x0002
  953. #define MUSLC_MSG_DONTWAIT 0x0040
  954. #define MUSLC_MSG_WAITALL 0x0100
  955. #define MUSLC_MSG_MORE 0x8000
  956. static int netflags_muslc_2_lwip(int flags)
  957. {
  958. int flgs = 0;
  959. if (flags & MUSLC_MSG_PEEK)
  960. flgs |= MSG_PEEK;
  961. if (flags & MUSLC_MSG_WAITALL)
  962. flgs |= MSG_WAITALL;
  963. if (flags & MUSLC_MSG_OOB)
  964. flgs |= MSG_OOB;
  965. if (flags & MUSLC_MSG_DONTWAIT)
  966. flgs |= MSG_DONTWAIT;
  967. if (flags & MUSLC_MSG_MORE)
  968. flgs |= MSG_MORE;
  969. return flgs;
  970. }
  971. int sys_recvfrom(int socket, void *mem, size_t len, int flags,
  972. struct musl_sockaddr *from, socklen_t *fromlen)
  973. {
  974. int flgs = 0;
  975. #ifdef RT_USING_USERSPACE
  976. int ret = -1;
  977. void *kmem = RT_NULL;
  978. #endif
  979. flgs = netflags_muslc_2_lwip(flags);
  980. #ifdef RT_USING_USERSPACE
  981. if (!len)
  982. return -1;
  983. if (!lwp_data_access_ok(&lwp_self()->mmu_info, (void*)mem, len))
  984. return -1;
  985. kmem = kmem_get(len);
  986. if (!kmem)
  987. return -1;
  988. if (flags == 0x2) {
  989. flags = 0x1;
  990. }
  991. if (from)
  992. {
  993. struct sockaddr sa;
  994. ret = recvfrom(socket, kmem, len, flgs, &sa, fromlen);
  995. sockaddr_tomusl(&sa, from);
  996. } else
  997. ret = recvfrom(socket, kmem, len, flgs, NULL, NULL);
  998. if (ret > 0)
  999. lwp_data_put(&lwp_self()->mmu_info, mem, kmem, len);
  1000. kmem_put(kmem);
  1001. return ret;
  1002. #else
  1003. if (from)
  1004. {
  1005. int ret = -1;
  1006. struct sockaddr sa = {0};
  1007. ret = recvfrom(socket, mem, len, flgs, &sa, fromlen);
  1008. sockaddr_tomusl(&sa, from);
  1009. return ret;
  1010. }
  1011. return recvfrom(socket, mem, len, flags, NULL, NULL);
  1012. #endif
  1013. }
  1014. int sys_recv(int socket, void *mem, size_t len, int flags)
  1015. {
  1016. int flgs = 0;
  1017. flgs = netflags_muslc_2_lwip(flags);
  1018. return recvfrom(socket, mem, len, flgs, NULL, NULL);
  1019. }
  1020. int sys_sendto(int socket, const void *dataptr, size_t size, int flags,
  1021. const struct musl_sockaddr *to, socklen_t tolen)
  1022. {
  1023. int flgs = 0;
  1024. #ifdef RT_USING_USERSPACE
  1025. int ret = -1;
  1026. void *kmem = RT_NULL;
  1027. #endif
  1028. flgs = netflags_muslc_2_lwip(flags);
  1029. #ifdef RT_USING_USERSPACE
  1030. if (!size)
  1031. return -1;
  1032. if (!lwp_data_access_ok(&lwp_self()->mmu_info, (void*)dataptr, size))
  1033. return -1;
  1034. kmem = kmem_get(size);
  1035. if (!kmem)
  1036. return -1;
  1037. lwp_data_get(&lwp_self()->mmu_info, kmem, (void *)dataptr, size);
  1038. if (to)
  1039. {
  1040. struct sockaddr sa;
  1041. sockaddr_tolwip(to, &sa);
  1042. ret = sendto(socket, kmem, size, flgs, &sa, tolen);
  1043. }
  1044. else
  1045. ret = sendto(socket, kmem, size, flgs, NULL, tolen);
  1046. kmem_put(kmem);
  1047. return ret;
  1048. #else
  1049. if (to)
  1050. {
  1051. struct sockaddr sa;
  1052. sockaddr_tolwip(to, &sa);
  1053. return sendto(socket, dataptr, size, flgs, &sa, tolen);
  1054. }
  1055. return sendto(socket, dataptr, size, flgs, NULL, tolen);
  1056. #endif
  1057. }
  1058. int sys_send(int socket, const void *dataptr, size_t size, int flags)
  1059. {
  1060. int flgs = 0;
  1061. flgs = netflags_muslc_2_lwip(flags);
  1062. return sendto(socket, dataptr, size, flgs, NULL, 0);
  1063. }
  1064. int sys_socket(int domain, int type, int protocol)
  1065. {
  1066. int fd = -1;
  1067. int nonblock = 0;
  1068. /* not support SOCK_CLOEXEC type */
  1069. if (type & SOCK_CLOEXEC) type &= ~SOCK_CLOEXEC;
  1070. if (type & SOCK_NONBLOCK)
  1071. {
  1072. nonblock = 1;
  1073. type &= ~SOCK_NONBLOCK;
  1074. }
  1075. fd = socket(domain, type, protocol);
  1076. if (fd < 0)
  1077. {
  1078. goto out;
  1079. }
  1080. if (nonblock)
  1081. {
  1082. fcntl(fd, F_SETFL, O_NONBLOCK);
  1083. }
  1084. out:
  1085. return fd;
  1086. }
  1087. int sys_closesocket(int socket)
  1088. {
  1089. return closesocket(socket);
  1090. }
  1091. rt_thread_t sys_thread_find(char *name)
  1092. {
  1093. return rt_thread_find(name);
  1094. }
  1095. rt_tick_t sys_tick_get(void)
  1096. {
  1097. return rt_tick_get();
  1098. }
  1099. rt_err_t sys_thread_mdelay(rt_int32_t ms)
  1100. {
  1101. return rt_thread_mdelay(ms);
  1102. }
  1103. void sys_sighandler_set(int sig, lwp_sighandler_t func)
  1104. {
  1105. lwp_sighandler_set(sig, func);
  1106. }
  1107. int sys_sigprocmask(const lwp_sigset_t *sigset, lwp_sigset_t *oset)
  1108. {
  1109. return lwp_sigprocmask(sigset, oset);
  1110. }
  1111. int sys_thread_kill(rt_thread_t thread, int sig)
  1112. {
  1113. return lwp_thread_kill(thread, sig);
  1114. }
  1115. void sys_thread_sighandler_set(int sig, lwp_sighandler_t func)
  1116. {
  1117. lwp_thread_sighandler_set(sig, func);
  1118. }
  1119. int sys_thread_sigprocmask(const lwp_sigset_t *sigset, lwp_sigset_t *oset)
  1120. {
  1121. return lwp_thread_sigprocmask(sigset, oset);
  1122. }
  1123. int32_t sys_waitpid(int32_t pid, int *status, int options)
  1124. {
  1125. return waitpid(pid, status, options);
  1126. }
  1127. #if defined(RT_USING_SAL) && defined(SAL_USING_POSIX)
  1128. struct musl_addrinfo
  1129. {
  1130. int ai_flags;
  1131. int ai_family;
  1132. int ai_socktype;
  1133. int ai_protocol;
  1134. socklen_t ai_addrlen;
  1135. struct musl_sockaddr *ai_addr;
  1136. char *ai_canonname;
  1137. struct musl_addrinfo *ai_next;
  1138. };
  1139. int sys_getaddrinfo(const char *nodename, const char *servname, const struct musl_addrinfo *hints, struct musl_addrinfo *res)
  1140. {
  1141. int ret = -1;
  1142. struct addrinfo *k_res = NULL;
  1143. char *k_nodename = NULL;
  1144. char *k_servname = NULL;
  1145. struct addrinfo *k_hints = NULL;
  1146. LOG_I("syscall: getaddrinfo");
  1147. if (nodename)
  1148. {
  1149. k_nodename = rt_strdup(nodename);
  1150. if (!k_nodename) goto exit;
  1151. }
  1152. if (servname)
  1153. {
  1154. k_servname = rt_strdup(servname);
  1155. if (!k_servname)
  1156. {
  1157. goto exit;
  1158. }
  1159. }
  1160. if (hints)
  1161. {
  1162. k_hints = (struct addrinfo*) rt_malloc(sizeof *hints);
  1163. if (!k_hints)
  1164. {
  1165. goto exit;
  1166. }
  1167. rt_memset(k_hints, 0x0, sizeof(struct addrinfo));
  1168. k_hints->ai_flags = hints->ai_flags;
  1169. k_hints->ai_family = hints->ai_family;
  1170. k_hints->ai_socktype = hints->ai_socktype;
  1171. k_hints->ai_protocol = hints->ai_protocol;
  1172. k_hints->ai_addrlen = hints->ai_addrlen;
  1173. }
  1174. ret = sal_getaddrinfo(k_nodename, k_servname, k_hints, &k_res);
  1175. if (ret == 0)
  1176. {
  1177. /* set sockaddr */
  1178. sockaddr_tomusl(k_res->ai_addr, res->ai_addr);
  1179. res->ai_addrlen = k_res->ai_addrlen;
  1180. /* set up addrinfo */
  1181. res->ai_family = k_res->ai_family;
  1182. res->ai_flags = k_res->ai_flags;
  1183. res->ai_next = NULL;
  1184. if (hints != NULL)
  1185. {
  1186. /* copy socktype & protocol from hints if specified */
  1187. res->ai_socktype = hints->ai_socktype;
  1188. res->ai_protocol = hints->ai_protocol;
  1189. }
  1190. sal_freeaddrinfo(k_res);
  1191. k_res = NULL;
  1192. }
  1193. exit:
  1194. if (k_nodename)
  1195. {
  1196. rt_free(k_nodename);
  1197. }
  1198. if (k_servname)
  1199. {
  1200. rt_free(k_servname);
  1201. }
  1202. if (k_hints)
  1203. {
  1204. rt_free(k_hints);
  1205. }
  1206. return ret;
  1207. }
  1208. #define HOSTENT_BUFSZ 512
  1209. int sys_gethostbyname2_r(const char *name, int af, struct hostent *ret,
  1210. char *buf, size_t buflen,
  1211. struct hostent **result, int *err)
  1212. {
  1213. int sal_ret, sal_err;
  1214. struct hostent sal_he;
  1215. struct hostent *sal_result = NULL;
  1216. char *sal_buf = NULL;
  1217. char *k_name = NULL;
  1218. if (result == NULL)
  1219. {
  1220. /* not all arguments given */
  1221. *err = EINVAL;
  1222. return -1;
  1223. }
  1224. if ((name == NULL) || (ret == NULL) || (buf == NULL))
  1225. {
  1226. /* not all arguments given */
  1227. *err = EINVAL;
  1228. return -1;
  1229. }
  1230. *result = ret;
  1231. sal_buf = (char *)malloc (HOSTENT_BUFSZ);
  1232. if (sal_buf == NULL)
  1233. {
  1234. goto __exit;
  1235. }
  1236. k_name = rt_strdup(name);
  1237. if (k_name == NULL)
  1238. {
  1239. goto __exit;
  1240. }
  1241. /* get host by name in SAL */
  1242. sal_ret = sal_gethostbyname_r(k_name, &sal_he, sal_buf, HOSTENT_BUFSZ, &sal_result, &sal_err);
  1243. if (sal_ret == 0)
  1244. {
  1245. int index, cnt;
  1246. char *ptr = buf;
  1247. /* get counter */
  1248. index = 0;
  1249. while (sal_he.h_addr_list[index] != NULL) index ++;
  1250. cnt = index + 1;
  1251. /* update user space hostent */
  1252. ret->h_addrtype = sal_he.h_addrtype;
  1253. ret->h_length = sal_he.h_length;
  1254. rt_strncpy(ptr, k_name, buflen - (ptr - buf));
  1255. ret->h_name = ptr;
  1256. ptr += rt_strlen(k_name);
  1257. ret->h_addr_list = (char**)ptr;
  1258. ptr += cnt * sizeof(char*);
  1259. index = 0;
  1260. while (sal_he.h_addr_list[index] != NULL)
  1261. {
  1262. ret->h_addr_list[index] = ptr;
  1263. rt_memcpy(ptr, sal_he.h_addr_list[index], sal_he.h_length);
  1264. ptr += sal_he.h_length;
  1265. index ++;
  1266. }
  1267. ret->h_addr_list[index] = NULL;
  1268. }
  1269. __exit:
  1270. /* release buffer */
  1271. if (sal_buf) free(sal_buf);
  1272. if (k_name) free(k_name);
  1273. return 0;
  1274. }
  1275. #endif
  1276. char *sys_getcwd(char *buf, size_t size)
  1277. {
  1278. return getcwd(buf, size);
  1279. }
  1280. int sys_chdir(const char *path)
  1281. {
  1282. return chdir(path);
  1283. }
  1284. int sys_mkdir(const char *path, mode_t mode)
  1285. {
  1286. return mkdir(path, mode);
  1287. }
  1288. int sys_rmdir(const char *path)
  1289. {
  1290. return unlink(path);
  1291. }
  1292. typedef uint64_t ino_t;
  1293. struct libc_dirent {
  1294. ino_t d_ino;
  1295. off_t d_off;
  1296. unsigned short d_reclen;
  1297. unsigned char d_type;
  1298. char d_name[256];
  1299. };
  1300. int sys_getdents(int fd, struct libc_dirent *dirp, size_t nbytes)
  1301. {
  1302. int ret;
  1303. struct dfs_fd *dfs_fd;
  1304. size_t cnt = (nbytes / sizeof(struct libc_dirent));
  1305. size_t rtt_nbytes;
  1306. struct dirent *rtt_dirp;
  1307. if (cnt == 0)
  1308. {
  1309. return 0;
  1310. }
  1311. rtt_nbytes = cnt * sizeof(struct dirent);
  1312. rtt_dirp = (struct dirent*)rt_malloc(rtt_nbytes);
  1313. if (!rtt_dirp)
  1314. {
  1315. return 0;
  1316. }
  1317. dfs_fd = fd_get(fd);
  1318. ret = dfs_file_getdents(dfs_fd, rtt_dirp, nbytes);
  1319. fd_put(dfs_fd);
  1320. if (ret)
  1321. {
  1322. size_t i;
  1323. cnt = ret / sizeof(struct dirent);
  1324. for (i = 0; i < cnt; i++)
  1325. {
  1326. dirp[i].d_ino = 0;
  1327. dirp[i].d_off = 0;
  1328. dirp[i].d_type = rtt_dirp[i].d_type;
  1329. dirp[i].d_reclen = sizeof(struct libc_dirent);
  1330. strcpy(dirp[i].d_name, rtt_dirp[i].d_name);
  1331. }
  1332. ret = cnt * sizeof(struct libc_dirent);
  1333. }
  1334. rt_free(rtt_dirp);
  1335. return ret;
  1336. }
  1337. rt_err_t sys_get_errno(void)
  1338. {
  1339. return rt_get_errno();
  1340. }
  1341. void sys_set_thread_area(void *p)
  1342. {
  1343. lwp_set_thread_area(p);
  1344. }
  1345. long sys_set_tid_address(int *tidptr)
  1346. {
  1347. return 0;
  1348. }
  1349. int sys_access(const char *filename, int mode)
  1350. {
  1351. int ret;
  1352. #ifdef RT_USING_USERSPACE
  1353. rt_size_t len;
  1354. char *kname;
  1355. if (!lwp_data_access_ok(&lwp_self()->mmu_info, (void*)filename, 1))
  1356. return -1;
  1357. len = rt_strlen(filename);
  1358. if (!len)
  1359. return -1;
  1360. kname = (char *)kmem_get(len + 1);
  1361. if (!kname)
  1362. return -1;
  1363. lwp_data_get(&lwp_self()->mmu_info, kname, (void *)filename, len + 1);
  1364. ret = open(kname, mode, 0);
  1365. kmem_put(kname);
  1366. #else
  1367. ret = open(filename, mode, 0);
  1368. #endif
  1369. if (ret >= 0)
  1370. {
  1371. close(ret);
  1372. }
  1373. return (ret >= 0)? 0: ret;
  1374. }
  1375. const static void* func_table[] =
  1376. {
  1377. (void*)sys_exit, /* 01 */
  1378. (void*)sys_read,
  1379. (void*)sys_write,
  1380. (void*)sys_lseek,
  1381. (void*)sys_open, /* 05 */
  1382. (void*)sys_close,
  1383. (void*)sys_ioctl,
  1384. (void*)sys_fstat,
  1385. (void*)sys_poll,
  1386. (void*)sys_nanosleep, /* 10 */
  1387. (void*)sys_gettimeofday,
  1388. (void*)sys_settimeofday,
  1389. (void*)sys_exec,
  1390. (void*)sys_kill,
  1391. (void*)sys_getpid, /* 15 */
  1392. (void*)sys_getpriority,
  1393. (void*)sys_setpriority,
  1394. (void*)sys_sem_create,
  1395. (void*)sys_sem_delete,
  1396. (void*)sys_sem_take, /* 20 */
  1397. (void*)sys_sem_release,
  1398. (void*)sys_mutex_create,
  1399. (void*)sys_mutex_delete,
  1400. (void*)sys_mutex_take,
  1401. (void*)sys_mutex_release, /* 25 */
  1402. (void*)sys_event_create,
  1403. (void*)sys_event_delete,
  1404. (void*)sys_event_send,
  1405. (void*)sys_event_recv,
  1406. (void*)sys_mb_create, /* 30 */
  1407. (void*)sys_mb_delete,
  1408. (void*)sys_mb_send,
  1409. (void*)sys_mb_send_wait,
  1410. (void*)sys_mb_recv,
  1411. (void*)sys_mq_create, /* 35 */
  1412. (void*)sys_mq_delete,
  1413. (void*)sys_mq_send,
  1414. (void*)sys_mq_urgent,
  1415. (void*)sys_mq_recv,
  1416. (void*)sys_thread_create, /* 40 */
  1417. (void*)sys_thread_delete,
  1418. (void*)sys_thread_startup,
  1419. (void*)sys_thread_self,
  1420. (void*)sys_channel_open,
  1421. (void*)sys_channel_close, /* 45 */
  1422. (void*)sys_channel_send,
  1423. (void*)sys_channel_send_recv_timeout,
  1424. (void*)sys_channel_reply,
  1425. (void*)sys_channel_recv_timeout,
  1426. (void*)sys_enter_critical, /* 50 */
  1427. (void*)sys_exit_critical,
  1428. SYSCALL_USPACE(sys_brk),
  1429. SYSCALL_USPACE(sys_mmap2),
  1430. SYSCALL_USPACE(sys_munmap),
  1431. SYSCALL_USPACE(sys_shmget),
  1432. SYSCALL_USPACE(sys_shmrm),
  1433. SYSCALL_USPACE(sys_shmat),
  1434. SYSCALL_USPACE(sys_shmdt),
  1435. (void *)sys_device_init,
  1436. (void *)sys_device_register,
  1437. (void *)sys_device_control,
  1438. (void *)sys_device_find,
  1439. (void *)sys_device_open,
  1440. (void *)sys_device_close,
  1441. (void *)sys_device_read,
  1442. (void *)sys_device_write,
  1443. (void *)sys_stat,
  1444. (void *)sys_thread_find,
  1445. SYSCALL_NET(sys_accept),
  1446. SYSCALL_NET(sys_bind),
  1447. SYSCALL_NET(sys_shutdown),
  1448. SYSCALL_NET(sys_getpeername),
  1449. SYSCALL_NET(sys_getsockname),
  1450. SYSCALL_NET(sys_getsockopt),
  1451. SYSCALL_NET(sys_setsockopt),
  1452. SYSCALL_NET(sys_connect),
  1453. SYSCALL_NET(sys_listen),
  1454. SYSCALL_NET(sys_recv),
  1455. SYSCALL_NET(sys_recvfrom),
  1456. SYSCALL_NET(sys_send),
  1457. SYSCALL_NET(sys_sendto),
  1458. SYSCALL_NET(sys_socket),
  1459. SYSCALL_NET(sys_closesocket),
  1460. SYSCALL_NET(sys_getaddrinfo),
  1461. SYSCALL_NET(sys_gethostbyname2_r),
  1462. (void *)sys_notimpl, //(void *)network,
  1463. (void *)sys_notimpl, //(void *)network,
  1464. (void *)sys_notimpl, //(void *)network,
  1465. (void *)sys_notimpl, //(void *)network,
  1466. (void *)sys_notimpl, //(void *)network,
  1467. (void *)sys_notimpl, //(void *)network,
  1468. (void *)sys_notimpl, //(void *)network,
  1469. (void *)sys_notimpl, //(void *)network,
  1470. #ifdef RT_USING_DFS
  1471. (void *)sys_select,
  1472. #else
  1473. (void *)sys_notimpl,
  1474. #endif
  1475. (void *)sys_notimpl, //(void *)sys_hw_interrupt_disable,
  1476. (void *)sys_notimpl, //(void *)sys_hw_interrupt_enable,
  1477. (void *)sys_tick_get,
  1478. (void *)sys_exit_group,
  1479. (void *)sys_notimpl, //(void *)rt_delayed_work_init,
  1480. (void *)sys_notimpl, //(void *)rt_work_submit,
  1481. (void *)sys_notimpl, //(void *)rt_wqueue_wakeup,
  1482. (void *)sys_thread_mdelay,
  1483. (void*)sys_sighandler_set,
  1484. (void*)sys_sigprocmask,
  1485. (void*)sys_thread_kill,
  1486. (void*)sys_thread_sighandler_set,
  1487. (void*)sys_thread_sigprocmask,
  1488. (void*)sys_notimpl,
  1489. (void*)sys_notimpl,
  1490. (void*)sys_waitpid,
  1491. (void *)sys_timer_create,
  1492. (void *)sys_timer_delete,
  1493. (void *)sys_timer_start,
  1494. (void *)sys_timer_stop,
  1495. (void *)sys_timer_control,
  1496. (void *)sys_getcwd,
  1497. (void *)sys_chdir,
  1498. (void *)sys_unlink,
  1499. (void *)sys_mkdir,
  1500. (void *)sys_rmdir,
  1501. (void *)sys_getdents,
  1502. (void *)sys_get_errno,
  1503. (void *)sys_set_thread_area,
  1504. (void *)sys_set_tid_address,
  1505. (void *)sys_access,
  1506. };
  1507. const void *lwp_get_sys_api(rt_uint32_t number)
  1508. {
  1509. const void *func = (const void*)sys_notimpl;
  1510. if (number == 0xff)
  1511. {
  1512. func = (void *)sys_log;
  1513. }
  1514. else
  1515. {
  1516. number -= 1;
  1517. if (number < sizeof(func_table)/sizeof(func_table[0]))
  1518. {
  1519. func = func_table[number];
  1520. }
  1521. }
  1522. return func;
  1523. }