lwp_syscall.c 42 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913
  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. const static void* func_table[] =
  1466. {
  1467. (void*)sys_exit, /* 01 */
  1468. (void*)sys_read,
  1469. (void*)sys_write,
  1470. (void*)sys_lseek,
  1471. (void*)sys_open, /* 05 */
  1472. (void*)sys_close,
  1473. (void*)sys_ioctl,
  1474. (void*)sys_fstat,
  1475. (void*)sys_poll,
  1476. (void*)sys_nanosleep, /* 10 */
  1477. (void*)sys_gettimeofday,
  1478. (void*)sys_settimeofday,
  1479. (void*)sys_exec,
  1480. (void*)sys_kill,
  1481. (void*)sys_getpid, /* 15 */
  1482. (void*)sys_getpriority,
  1483. (void*)sys_setpriority,
  1484. (void*)sys_sem_create,
  1485. (void*)sys_sem_delete,
  1486. (void*)sys_sem_take, /* 20 */
  1487. (void*)sys_sem_release,
  1488. (void*)sys_mutex_create,
  1489. (void*)sys_mutex_delete,
  1490. (void*)sys_mutex_take,
  1491. (void*)sys_mutex_release, /* 25 */
  1492. (void*)sys_event_create,
  1493. (void*)sys_event_delete,
  1494. (void*)sys_event_send,
  1495. (void*)sys_event_recv,
  1496. (void*)sys_mb_create, /* 30 */
  1497. (void*)sys_mb_delete,
  1498. (void*)sys_mb_send,
  1499. (void*)sys_mb_send_wait,
  1500. (void*)sys_mb_recv,
  1501. (void*)sys_mq_create, /* 35 */
  1502. (void*)sys_mq_delete,
  1503. (void*)sys_mq_send,
  1504. (void*)sys_mq_urgent,
  1505. (void*)sys_mq_recv,
  1506. (void*)sys_thread_create, /* 40 */
  1507. (void*)sys_thread_delete,
  1508. (void*)sys_thread_startup,
  1509. (void*)sys_thread_self,
  1510. (void*)sys_channel_open,
  1511. (void*)sys_channel_close, /* 45 */
  1512. (void*)sys_channel_send,
  1513. (void*)sys_channel_send_recv_timeout,
  1514. (void*)sys_channel_reply,
  1515. (void*)sys_channel_recv_timeout,
  1516. (void*)sys_enter_critical, /* 50 */
  1517. (void*)sys_exit_critical,
  1518. SYSCALL_USPACE(sys_brk),
  1519. SYSCALL_USPACE(sys_mmap2),
  1520. SYSCALL_USPACE(sys_munmap),
  1521. SYSCALL_USPACE(sys_shmget),
  1522. SYSCALL_USPACE(sys_shmrm),
  1523. SYSCALL_USPACE(sys_shmat),
  1524. SYSCALL_USPACE(sys_shmdt),
  1525. (void *)sys_device_init,
  1526. (void *)sys_device_register,
  1527. (void *)sys_device_control,
  1528. (void *)sys_device_find,
  1529. (void *)sys_device_open,
  1530. (void *)sys_device_close,
  1531. (void *)sys_device_read,
  1532. (void *)sys_device_write,
  1533. (void *)sys_stat,
  1534. (void *)sys_thread_find,
  1535. SYSCALL_NET(sys_accept),
  1536. SYSCALL_NET(sys_bind),
  1537. SYSCALL_NET(sys_shutdown),
  1538. SYSCALL_NET(sys_getpeername),
  1539. SYSCALL_NET(sys_getsockname),
  1540. SYSCALL_NET(sys_getsockopt),
  1541. SYSCALL_NET(sys_setsockopt),
  1542. SYSCALL_NET(sys_connect),
  1543. SYSCALL_NET(sys_listen),
  1544. SYSCALL_NET(sys_recv),
  1545. SYSCALL_NET(sys_recvfrom),
  1546. SYSCALL_NET(sys_send),
  1547. SYSCALL_NET(sys_sendto),
  1548. SYSCALL_NET(sys_socket),
  1549. SYSCALL_NET(sys_closesocket),
  1550. SYSCALL_NET(sys_getaddrinfo),
  1551. SYSCALL_NET(sys_gethostbyname2_r),
  1552. (void *)sys_notimpl, //(void *)network,
  1553. (void *)sys_notimpl, //(void *)network,
  1554. (void *)sys_notimpl, //(void *)network,
  1555. (void *)sys_notimpl, //(void *)network,
  1556. (void *)sys_notimpl, //(void *)network,
  1557. (void *)sys_notimpl, //(void *)network,
  1558. (void *)sys_notimpl, //(void *)network,
  1559. (void *)sys_notimpl, //(void *)network,
  1560. #ifdef RT_USING_DFS
  1561. (void *)sys_select,
  1562. #else
  1563. (void *)sys_notimpl,
  1564. #endif
  1565. (void *)sys_notimpl, //(void *)sys_hw_interrupt_disable,
  1566. (void *)sys_notimpl, //(void *)sys_hw_interrupt_enable,
  1567. (void *)sys_tick_get,
  1568. (void *)sys_exit_group,
  1569. (void *)sys_notimpl, //(void *)rt_delayed_work_init,
  1570. (void *)sys_notimpl, //(void *)rt_work_submit,
  1571. (void *)sys_notimpl, //(void *)rt_wqueue_wakeup,
  1572. (void *)sys_thread_mdelay,
  1573. (void*)sys_sighandler_set,
  1574. (void*)sys_sigprocmask,
  1575. (void*)sys_thread_kill,
  1576. (void*)sys_thread_sighandler_set,
  1577. (void*)sys_thread_sigprocmask,
  1578. (void*)sys_notimpl,
  1579. (void*)sys_notimpl,
  1580. (void*)sys_waitpid,
  1581. (void *)sys_timer_create,
  1582. (void *)sys_timer_delete,
  1583. (void *)sys_timer_start,
  1584. (void *)sys_timer_stop,
  1585. (void *)sys_timer_control,
  1586. (void *)sys_getcwd,
  1587. (void *)sys_chdir,
  1588. (void *)sys_unlink,
  1589. (void *)sys_mkdir,
  1590. (void *)sys_rmdir,
  1591. (void *)sys_getdents,
  1592. (void *)sys_get_errno,
  1593. (void *)sys_set_thread_area,
  1594. (void *)sys_set_tid_address,
  1595. (void *)sys_access,
  1596. };
  1597. const void *lwp_get_sys_api(rt_uint32_t number)
  1598. {
  1599. const void *func = (const void*)sys_notimpl;
  1600. if (number == 0xff)
  1601. {
  1602. func = (void *)sys_log;
  1603. }
  1604. else
  1605. {
  1606. number -= 1;
  1607. if (number < sizeof(func_table)/sizeof(func_table[0]))
  1608. {
  1609. func = func_table[number];
  1610. }
  1611. }
  1612. return func;
  1613. }