lwp_syscall.c 82 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688
  1. /*
  2. * Copyright (c) 2006-2021, 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. * 2021-02-03 lizhirui add limit condition for network syscall and add 64-bit arch support
  10. * 2021-02-06 lizhirui fix some bugs
  11. * 2021-02-12 lizhirui add 64-bit support for sys_brk
  12. * 2021-02-20 lizhirui fix some warnings
  13. */
  14. /* RT-Thread System call */
  15. #include <rthw.h>
  16. #include <board.h>
  17. #include <lwp.h>
  18. #ifdef RT_USING_USERSPACE
  19. #include <lwp_user_mm.h>
  20. #include <lwp_arch.h>
  21. #endif
  22. #ifdef RT_USING_DFS
  23. #include <dfs_poll.h>
  24. #include <dfs_posix.h>
  25. #include <dfs_select.h>
  26. #endif
  27. #if (defined(RT_USING_SAL) && defined(SAL_USING_POSIX))
  28. #include <sys/socket.h>
  29. #define SYSCALL_NET(f) ((void *)(f))
  30. #else
  31. #define SYSCALL_NET(f) ((void *)sys_notimpl)
  32. #endif
  33. #if defined(RT_USING_DFS) && defined(RT_USING_USERSPACE)
  34. #define SYSCALL_USPACE(f) ((void *)(f))
  35. #else
  36. #define SYSCALL_USPACE(f) ((void *)sys_notimpl)
  37. #endif
  38. #define DBG_TAG "SYSCALL"
  39. #define DBG_LVL DBG_INFO
  40. #include <rtdbg.h>
  41. #ifdef RT_USING_SAL
  42. #include <netdev_ipaddr.h>
  43. #include <netdev.h>
  44. #include <sal_netdb.h>
  45. #include <sal.h>
  46. #endif /* RT_USING_SAL */
  47. #include <lwp_console.h>
  48. #include "lwp_ipc_internal.h"
  49. #define ALLOC_KERNEL_STACK_SIZE 5120
  50. struct musl_sockaddr
  51. {
  52. uint16_t sa_family;
  53. char sa_data[14];
  54. };
  55. extern void lwp_user_entry(void *args, const void *text, void *data, void *user_stack);
  56. extern void set_user_context(void *stack);
  57. void lwp_cleanup(struct rt_thread *tid);
  58. #ifdef RT_USING_USERSPACE
  59. static void *kmem_get(size_t size)
  60. {
  61. return rt_malloc(size);
  62. }
  63. static void kmem_put(void *kptr)
  64. {
  65. rt_free(kptr);
  66. }
  67. #endif
  68. int sys_futex(int *uaddr, int op, int val, void *timeout, void *uaddr2, int val3);
  69. /* The same socket option is defined differently in the user interfaces and the
  70. * implementation. The options should be converted in the kernel. */
  71. /* socket levels */
  72. #define INTF_SOL_SOCKET 1
  73. #define IMPL_SOL_SOCKET 0xFFF
  74. #define INTF_IPPROTO_IP 0
  75. #define IMPL_IPPROTO_IP 0
  76. #define INTF_IPPROTO_TCP 6
  77. #define IMPL_IPPROTO_TCP 6
  78. #define INTF_IPPROTO_IPV6 41
  79. #define IMPL_IPPROTO_IPV6 41
  80. /* SOL_SOCKET option names */
  81. #define INTF_SO_BROADCAST 6
  82. #define INTF_SO_KEEPALIVE 9
  83. #define INTF_SO_REUSEADDR 2
  84. #define INTF_SO_TYPE 3
  85. #define INTF_SO_ERROR 4
  86. #define INTF_SO_SNDTIMEO 21
  87. #define INTF_SO_RCVTIMEO 20
  88. #define INTF_SO_RCVBUF 8
  89. #define INTF_SO_LINGER 13
  90. #define INTF_SO_NO_CHECK 11
  91. #define INTF_SO_ACCEPTCONN 30
  92. #define INTF_SO_DONTROUTE 5
  93. #define INTF_SO_OOBINLINE 10
  94. #define INTF_SO_REUSEPORT 15
  95. #define INTF_SO_SNDBUF 7
  96. #define INTF_SO_SNDLOWAT 19
  97. #define INTF_SO_RCVLOWAT 18
  98. #define IMPL_SO_BROADCAST 0x0020
  99. #define IMPL_SO_KEEPALIVE 0x0008
  100. #define IMPL_SO_REUSEADDR 0x0004
  101. #define IMPL_SO_TYPE 0x1008
  102. #define IMPL_SO_ERROR 0x1007
  103. #define IMPL_SO_SNDTIMEO 0x1005
  104. #define IMPL_SO_RCVTIMEO 0x1006
  105. #define IMPL_SO_RCVBUF 0x1002
  106. #define IMPL_SO_LINGER 0x0080
  107. #define IMPL_SO_NO_CHECK 0x100a
  108. #define IMPL_SO_ACCEPTCONN 0x0002
  109. #define IMPL_SO_DONTROUTE 0x0010
  110. #define IMPL_SO_OOBINLINE 0x0100
  111. #define IMPL_SO_REUSEPORT 0x0200
  112. #define IMPL_SO_SNDBUF 0x1001
  113. #define IMPL_SO_SNDLOWAT 0x1003
  114. #define IMPL_SO_RCVLOWAT 0x1004
  115. /* IPPROTO_IP option names */
  116. #define INTF_IP_TTL 2
  117. #define INTF_IP_TOS 1
  118. #define INTF_IP_MULTICAST_TTL 33
  119. #define INTF_IP_MULTICAST_IF 32
  120. #define INTF_IP_MULTICAST_LOOP 34
  121. #define INTF_IP_ADD_MEMBERSHIP 35
  122. #define INTF_IP_DROP_MEMBERSHIP 36
  123. #define IMPL_IP_TTL 2
  124. #define IMPL_IP_TOS 1
  125. #define IMPL_IP_MULTICAST_TTL 5
  126. #define IMPL_IP_MULTICAST_IF 6
  127. #define IMPL_IP_MULTICAST_LOOP 7
  128. #define IMPL_IP_ADD_MEMBERSHIP 3
  129. #define IMPL_IP_DROP_MEMBERSHIP 4
  130. /* IPPROTO_TCP option names */
  131. #define INTF_TCP_NODELAY 1
  132. #define INTF_TCP_KEEPALIVE 9
  133. #define INTF_TCP_KEEPIDLE 4
  134. #define INTF_TCP_KEEPINTVL 5
  135. #define INTF_TCP_KEEPCNT 6
  136. #define IMPL_TCP_NODELAY 0x01
  137. #define IMPL_TCP_KEEPALIVE 0x02
  138. #define IMPL_TCP_KEEPIDLE 0x03
  139. #define IMPL_TCP_KEEPINTVL 0x04
  140. #define IMPL_TCP_KEEPCNT 0x05
  141. /* IPPROTO_IPV6 option names */
  142. #define INTF_IPV6_V6ONLY 26
  143. #define IMPL_IPV6_V6ONLY 27
  144. static void convert_sockopt(int *level, int *optname)
  145. {
  146. if (*level == INTF_SOL_SOCKET)
  147. {
  148. *level = IMPL_SOL_SOCKET;
  149. switch (*optname)
  150. {
  151. case INTF_SO_REUSEADDR:
  152. *optname = IMPL_SO_REUSEADDR;
  153. break;
  154. case INTF_SO_KEEPALIVE:
  155. *optname = IMPL_SO_KEEPALIVE;
  156. break;
  157. case INTF_SO_BROADCAST:
  158. *optname = IMPL_SO_BROADCAST;
  159. break;
  160. case INTF_SO_ACCEPTCONN:
  161. *optname = IMPL_SO_ACCEPTCONN;
  162. break;
  163. case INTF_SO_DONTROUTE:
  164. *optname = IMPL_SO_DONTROUTE;
  165. break;
  166. case INTF_SO_LINGER:
  167. *optname = IMPL_SO_LINGER;
  168. break;
  169. case INTF_SO_OOBINLINE:
  170. *optname = IMPL_SO_OOBINLINE;
  171. break;
  172. case INTF_SO_REUSEPORT:
  173. *optname = IMPL_SO_REUSEPORT;
  174. break;
  175. case INTF_SO_SNDBUF:
  176. *optname = IMPL_SO_SNDBUF;
  177. break;
  178. case INTF_SO_RCVBUF:
  179. *optname = IMPL_SO_RCVBUF;
  180. break;
  181. case INTF_SO_SNDLOWAT:
  182. *optname = IMPL_SO_SNDLOWAT;
  183. break;
  184. case INTF_SO_RCVLOWAT:
  185. *optname = IMPL_SO_RCVLOWAT;
  186. break;
  187. case INTF_SO_SNDTIMEO:
  188. *optname = IMPL_SO_SNDTIMEO;
  189. break;
  190. case INTF_SO_RCVTIMEO:
  191. *optname = IMPL_SO_RCVTIMEO;
  192. break;
  193. case INTF_SO_ERROR:
  194. *optname = IMPL_SO_ERROR;
  195. break;
  196. case INTF_SO_TYPE:
  197. *optname = IMPL_SO_TYPE;
  198. break;
  199. case INTF_SO_NO_CHECK:
  200. *optname = IMPL_SO_NO_CHECK;
  201. break;
  202. /*
  203. * SO_DONTLINGER (*level = ((int)(~SO_LINGER))),
  204. * SO_USELOOPBACK (*level = 0x0040) and
  205. * SO_CONTIMEO (*level = 0x1009) are not supported for now.
  206. */
  207. default:
  208. *optname = 0;
  209. break;
  210. }
  211. return;
  212. }
  213. if (*level == INTF_IPPROTO_IP)
  214. {
  215. *level = IMPL_IPPROTO_IP;
  216. switch (*optname)
  217. {
  218. case INTF_IP_TTL:
  219. *optname = IMPL_IP_TTL;
  220. break;
  221. case INTF_IP_TOS:
  222. *optname = IMPL_IP_TOS;
  223. break;
  224. case INTF_IP_MULTICAST_TTL:
  225. *optname = IMPL_IP_MULTICAST_TTL;
  226. break;
  227. case INTF_IP_MULTICAST_IF:
  228. *optname = IMPL_IP_MULTICAST_IF;
  229. break;
  230. case INTF_IP_MULTICAST_LOOP:
  231. *optname = IMPL_IP_MULTICAST_LOOP;
  232. break;
  233. case INTF_IP_ADD_MEMBERSHIP:
  234. *optname = IMPL_IP_ADD_MEMBERSHIP;
  235. break;
  236. case INTF_IP_DROP_MEMBERSHIP:
  237. *optname = IMPL_IP_DROP_MEMBERSHIP;
  238. break;
  239. default:
  240. break;
  241. }
  242. }
  243. if (*level == INTF_IPPROTO_TCP)
  244. {
  245. *level = IMPL_IPPROTO_TCP;
  246. switch (*optname)
  247. {
  248. case INTF_TCP_NODELAY:
  249. *optname = IMPL_TCP_NODELAY;
  250. break;
  251. case INTF_TCP_KEEPALIVE:
  252. *optname = IMPL_TCP_KEEPALIVE;
  253. break;
  254. case INTF_TCP_KEEPIDLE:
  255. *optname = IMPL_TCP_KEEPIDLE;
  256. break;
  257. case INTF_TCP_KEEPINTVL:
  258. *optname = IMPL_TCP_KEEPINTVL;
  259. break;
  260. case INTF_TCP_KEEPCNT:
  261. *optname = IMPL_TCP_KEEPCNT;
  262. break;
  263. default:
  264. break;
  265. }
  266. return;
  267. }
  268. if (*level == INTF_IPPROTO_IPV6)
  269. {
  270. *level = IMPL_IPPROTO_IPV6;
  271. switch (*optname)
  272. {
  273. case INTF_IPV6_V6ONLY:
  274. *optname = IMPL_IPV6_V6ONLY;
  275. break;
  276. default:
  277. break;
  278. }
  279. return;
  280. }
  281. }
  282. #ifdef RT_USING_LWIP
  283. static void sockaddr_tolwip(const struct musl_sockaddr *std, struct sockaddr *lwip)
  284. {
  285. if (std && lwip)
  286. {
  287. lwip->sa_len = sizeof(*lwip);
  288. lwip->sa_family = (sa_family_t) std->sa_family;
  289. memcpy(lwip->sa_data, std->sa_data, sizeof(lwip->sa_data));
  290. }
  291. }
  292. static void sockaddr_tomusl(const struct sockaddr *lwip, struct musl_sockaddr *std)
  293. {
  294. if (std && lwip)
  295. {
  296. std->sa_family = (uint16_t) lwip->sa_family;
  297. memcpy(std->sa_data, lwip->sa_data, sizeof(std->sa_data));
  298. }
  299. }
  300. #endif
  301. static void lwp_user_thread(void *parameter)
  302. {
  303. rt_thread_t tid;
  304. rt_size_t user_stack;
  305. struct rt_lwp *lwp;
  306. tid = rt_thread_self();
  307. lwp = lwp_self();
  308. user_stack = (rt_size_t)tid->user_stack + tid->user_stack_size;
  309. user_stack &= ~7; //align 8
  310. set_user_context((void *)user_stack);
  311. lwp_user_entry(parameter, tid->user_entry, lwp->data_entry, RT_NULL);
  312. }
  313. /* thread/process */
  314. void sys_exit(int value)
  315. {
  316. rt_base_t level;
  317. rt_thread_t tid, main_thread;
  318. struct rt_lwp *lwp;
  319. LOG_D("thread/process exit.");
  320. tid = rt_thread_self();
  321. lwp = (struct rt_lwp *)tid->lwp;
  322. level = rt_hw_interrupt_disable();
  323. if (tid->clear_child_tid)
  324. {
  325. int t = 0;
  326. int *clear_child_tid = tid->clear_child_tid;
  327. tid->clear_child_tid = RT_NULL;
  328. lwp_put_to_user(clear_child_tid, &t, sizeof t);
  329. sys_futex(tid->clear_child_tid, FUTEX_WAKE, 1, RT_NULL, RT_NULL, 0);
  330. }
  331. main_thread = rt_list_entry(lwp->t_grp.prev, struct rt_thread, sibling);
  332. if (main_thread == tid)
  333. {
  334. lwp_terminate(lwp);
  335. lwp_wait_subthread_exit();
  336. lwp->lwp_ret = value;
  337. }
  338. rt_thread_delete(tid);
  339. rt_schedule();
  340. rt_hw_interrupt_enable(level);
  341. return;
  342. }
  343. /* exit group */
  344. void sys_exit_group(int status)
  345. {
  346. return;
  347. }
  348. /* syscall: "read" ret: "ssize_t" args: "int" "void *" "size_t" */
  349. ssize_t sys_read(int fd, void *buf, size_t nbyte)
  350. {
  351. #ifdef RT_USING_USERSPACE
  352. void *kmem = RT_NULL;
  353. ssize_t ret = -1;
  354. if (!nbyte)
  355. {
  356. rt_set_errno(EINVAL);
  357. return -1;
  358. }
  359. if (!lwp_user_accessable((void *)buf, nbyte))
  360. {
  361. rt_set_errno(EFAULT);
  362. return -1;
  363. }
  364. kmem = kmem_get(nbyte);
  365. if (!kmem)
  366. {
  367. rt_set_errno(ENOMEM);
  368. return -1;
  369. }
  370. ret = read(fd, kmem, nbyte);
  371. if (ret > 0)
  372. {
  373. lwp_put_to_user(buf, kmem, ret);
  374. }
  375. kmem_put(kmem);
  376. return ret;
  377. #else
  378. return read(fd, buf, nbyte);
  379. #endif
  380. }
  381. /* syscall: "write" ret: "ssize_t" args: "int" "const void *" "size_t" */
  382. ssize_t sys_write(int fd, const void *buf, size_t nbyte)
  383. {
  384. #ifdef RT_USING_USERSPACE
  385. void *kmem = RT_NULL;
  386. ssize_t ret = -1;
  387. if (!nbyte)
  388. {
  389. rt_set_errno(EINVAL);
  390. return -1;
  391. }
  392. if (!lwp_user_accessable((void *)buf, nbyte))
  393. {
  394. rt_set_errno(EFAULT);
  395. return -1;
  396. }
  397. kmem = kmem_get(nbyte);
  398. if (!kmem)
  399. {
  400. rt_set_errno(ENOMEM);
  401. return -1;
  402. }
  403. lwp_get_from_user(kmem, (void *)buf, nbyte);
  404. ret = write(fd, kmem, nbyte);
  405. kmem_put(kmem);
  406. return ret;
  407. #else
  408. return write(fd, buf, nbyte);
  409. #endif
  410. }
  411. /* syscall: "lseek" ret: "off_t" args: "int" "off_t" "int" */
  412. off_t sys_lseek(int fd, off_t offset, int whence)
  413. {
  414. return lseek(fd, offset, whence);
  415. }
  416. /* syscall: "open" ret: "int" args: "const char *" "int" "..." */
  417. int sys_open(const char *name, int flag, ...)
  418. {
  419. #ifdef RT_USING_USERSPACE
  420. int ret = -1;
  421. rt_size_t len = 0;
  422. char *kname = RT_NULL;
  423. if (!lwp_user_accessable((void *)name, 1))
  424. {
  425. rt_set_errno(EFAULT);
  426. return -1;
  427. }
  428. len = rt_strlen(name);
  429. if (!len)
  430. {
  431. rt_set_errno(EINVAL);
  432. return -1;
  433. }
  434. kname = (char *)kmem_get(len + 1);
  435. if (!kname)
  436. {
  437. rt_set_errno(ENOMEM);
  438. return -1;
  439. }
  440. lwp_get_from_user(kname, (void *)name, len + 1);
  441. ret = open(kname, flag, 0);
  442. kmem_put(kname);
  443. return ret;
  444. #else
  445. return open(name, flag, 0);
  446. #endif
  447. }
  448. /* syscall: "close" ret: "int" args: "int" */
  449. int sys_close(int fd)
  450. {
  451. return close(fd);
  452. }
  453. /* syscall: "ioctl" ret: "int" args: "int" "u_long" "..." */
  454. int sys_ioctl(int fd, unsigned long cmd, void* data)
  455. {
  456. return ioctl(fd, cmd, data);
  457. }
  458. int sys_fstat(int file, struct stat *buf)
  459. {
  460. #ifdef RT_USING_USERSPACE
  461. int ret = -1;
  462. struct stat statbuff;
  463. if (!lwp_user_accessable((void *)buf, sizeof(struct stat)))
  464. {
  465. rt_set_errno(EFAULT);
  466. ret = -1;
  467. }
  468. else
  469. {
  470. ret = fstat(file, &statbuff);
  471. lwp_put_to_user(buf, &statbuff, sizeof statbuff);
  472. }
  473. return ret;
  474. #else
  475. return fstat(file, buf);
  476. #endif
  477. }
  478. /* DFS and lwip definitions */
  479. #define IMPL_POLLIN (0x01)
  480. #define IMPL_POLLOUT (0x02)
  481. #define IMPL_POLLERR (0x04)
  482. #define IMPL_POLLHUP (0x08)
  483. #define IMPL_POLLNVAL (0x10)
  484. /* musl definitions */
  485. #define INTF_POLLIN 0x001
  486. #define INTF_POLLPRI 0x002
  487. #define INTF_POLLOUT 0x004
  488. #define INTF_POLLERR 0x008
  489. #define INTF_POLLHUP 0x010
  490. #define INTF_POLLNVAL 0x020
  491. #define INTF_POLLRDNORM 0x040
  492. #define INTF_POLLRDBAND 0x080
  493. #define INTF_POLLWRNORM 0x100
  494. #define INTF_POLLWRBAND 0x200
  495. #define INTF_POLLMSG 0x400
  496. #define INTF_POLLRDHUP 0x2000
  497. #define INTF_POLLIN_MASK (INTF_POLLIN | INTF_POLLRDNORM | INTF_POLLRDBAND | INTF_POLLPRI)
  498. #define INTF_POLLOUT_MASK (INTF_POLLOUT | INTF_POLLWRNORM | INTF_POLLWRBAND)
  499. static void musl2dfs_events(short *events)
  500. {
  501. short origin_e = *events;
  502. short result_e = 0;
  503. if (origin_e & INTF_POLLIN_MASK)
  504. {
  505. result_e |= IMPL_POLLIN;
  506. }
  507. if (origin_e & INTF_POLLOUT_MASK)
  508. {
  509. result_e |= IMPL_POLLOUT;
  510. }
  511. if (origin_e & INTF_POLLERR)
  512. {
  513. result_e |= IMPL_POLLERR;
  514. }
  515. if (origin_e & INTF_POLLHUP)
  516. {
  517. result_e |= IMPL_POLLHUP;
  518. }
  519. if (origin_e & INTF_POLLNVAL)
  520. {
  521. result_e |= IMPL_POLLNVAL;
  522. }
  523. *events = result_e;
  524. }
  525. static void dfs2musl_events(short *events)
  526. {
  527. short origin_e = *events;
  528. short result_e = 0;
  529. if (origin_e & IMPL_POLLIN)
  530. {
  531. result_e |= INTF_POLLIN_MASK;
  532. }
  533. if (origin_e & IMPL_POLLOUT)
  534. {
  535. result_e |= INTF_POLLOUT_MASK;
  536. }
  537. if (origin_e & IMPL_POLLERR)
  538. {
  539. result_e |= INTF_POLLERR;
  540. }
  541. if (origin_e & IMPL_POLLHUP)
  542. {
  543. result_e |= INTF_POLLHUP;
  544. }
  545. if (origin_e & IMPL_POLLNVAL)
  546. {
  547. result_e |= INTF_POLLNVAL;
  548. }
  549. *events = result_e;
  550. }
  551. int sys_poll(struct pollfd *fds, nfds_t nfds, int timeout)
  552. {
  553. int ret = -1;
  554. int i = 0;
  555. #ifdef RT_USING_USERSPACE
  556. struct pollfd *kfds = RT_NULL;
  557. if (!lwp_user_accessable((void *)fds, nfds * sizeof *fds))
  558. {
  559. rt_set_errno(EFAULT);
  560. return -1;
  561. }
  562. kfds = (struct pollfd *)kmem_get(nfds * sizeof *kfds);
  563. if (!kfds)
  564. {
  565. rt_set_errno(ENOMEM);
  566. return -1;
  567. }
  568. lwp_get_from_user(kfds, fds, nfds * sizeof *kfds);
  569. for (i = 0; i < nfds; i++)
  570. {
  571. musl2dfs_events(&kfds[i].events);
  572. }
  573. ret = poll(kfds, nfds, timeout);
  574. if (ret > 0)
  575. {
  576. for (i = 0; i < nfds; i++)
  577. {
  578. dfs2musl_events(&kfds->revents);
  579. }
  580. lwp_put_to_user(fds, kfds, nfds * sizeof *kfds);
  581. }
  582. kmem_put(kfds);
  583. return ret;
  584. #else
  585. for (i = 0; i < nfds; i++)
  586. {
  587. musl2dfs_events(&fds->events);
  588. }
  589. ret = poll(fds, nfds, timeout);
  590. if (ret > 0)
  591. {
  592. for (i = 0; i < nfds; i++)
  593. {
  594. dfs2musl_events(&fds->revents);
  595. }
  596. }
  597. return ret;
  598. #endif
  599. }
  600. int sys_select(int nfds, fd_set *readfds, fd_set *writefds, fd_set *exceptfds, struct timeval *timeout)
  601. {
  602. #ifdef RT_USING_USERSPACE
  603. int ret = -1;
  604. fd_set *kreadfds = RT_NULL, *kwritefds = RT_NULL, *kexceptfds = RT_NULL;
  605. if (readfds)
  606. {
  607. if (!lwp_user_accessable((void *)readfds, sizeof *readfds))
  608. {
  609. rt_set_errno(EFAULT);
  610. goto quit;
  611. }
  612. kreadfds = (fd_set *)kmem_get(sizeof *kreadfds);
  613. if (!kreadfds)
  614. {
  615. rt_set_errno(ENOMEM);
  616. goto quit;
  617. }
  618. lwp_get_from_user(kreadfds, readfds, sizeof *kreadfds);
  619. }
  620. if (writefds)
  621. {
  622. if (!lwp_user_accessable((void *)writefds, sizeof *writefds))
  623. {
  624. rt_set_errno(EFAULT);
  625. goto quit;
  626. }
  627. kwritefds = (fd_set *)kmem_get(sizeof *kwritefds);
  628. if (!kwritefds)
  629. {
  630. rt_set_errno(ENOMEM);
  631. goto quit;
  632. }
  633. lwp_get_from_user(kwritefds, writefds, sizeof *kwritefds);
  634. }
  635. if (exceptfds)
  636. {
  637. if (!lwp_user_accessable((void *)exceptfds, sizeof *exceptfds))
  638. {
  639. rt_set_errno(EFAULT);
  640. goto quit;
  641. }
  642. kexceptfds = (fd_set *)kmem_get(sizeof *kexceptfds);
  643. if (!kexceptfds)
  644. {
  645. rt_set_errno(EINVAL);
  646. goto quit;
  647. }
  648. lwp_get_from_user(kexceptfds, exceptfds, sizeof *kexceptfds);
  649. }
  650. ret = select(nfds, kreadfds, kwritefds, kexceptfds, timeout);
  651. if (kreadfds)
  652. {
  653. lwp_put_to_user(readfds, kreadfds, sizeof *kreadfds);
  654. }
  655. if (kwritefds)
  656. {
  657. lwp_put_to_user(writefds, kwritefds, sizeof *kwritefds);
  658. }
  659. if (kexceptfds)
  660. {
  661. lwp_put_to_user(exceptfds, kexceptfds, sizeof *kexceptfds);
  662. }
  663. quit:
  664. if (kreadfds)
  665. {
  666. kmem_put(kreadfds);
  667. }
  668. if (kwritefds)
  669. {
  670. kmem_put(kwritefds);
  671. }
  672. if (kexceptfds)
  673. {
  674. kmem_put(kexceptfds);
  675. }
  676. return ret;
  677. #else
  678. return select(nfds, readfds, writefds, exceptfds, timeout);
  679. #endif
  680. }
  681. int sys_unlink(const char *pathname)
  682. {
  683. #ifdef RT_USING_USERSPACE
  684. int ret = -1;
  685. rt_size_t len = 0;
  686. char *kname = RT_NULL;
  687. int a_err = 0;
  688. lwp_user_strlen(pathname, &a_err);
  689. if (a_err)
  690. {
  691. rt_set_errno(EFAULT);
  692. return -1;
  693. }
  694. len = rt_strlen(pathname);
  695. if (!len)
  696. {
  697. rt_set_errno(EINVAL);
  698. return -1;
  699. }
  700. kname = (char *)kmem_get(len + 1);
  701. if (!kname)
  702. {
  703. rt_set_errno(ENOMEM);
  704. return -1;
  705. }
  706. lwp_get_from_user(kname, (void *)pathname, len + 1);
  707. ret = unlink(kname);
  708. kmem_put(kname);
  709. return ret;
  710. #else
  711. return unlink(pathname);
  712. #endif
  713. }
  714. /* syscall: "nanosleep" ret: "int" args: "const struct timespec *" "struct timespec *" */
  715. int sys_nanosleep(const struct timespec *rqtp, struct timespec *rmtp)
  716. {
  717. rt_tick_t tick;
  718. #ifdef RT_USING_USERSPACE
  719. struct timespec rqtp_k;
  720. struct timespec rmtp_k;
  721. dbg_log(DBG_LOG, "sys_nanosleep\n");
  722. if (!lwp_user_accessable((void *)rqtp, sizeof *rqtp))
  723. {
  724. rt_set_errno(EFAULT);
  725. return -1;
  726. }
  727. lwp_get_from_user(&rqtp_k, (void *)rqtp, sizeof rqtp_k);
  728. tick = rqtp_k.tv_sec * RT_TICK_PER_SECOND + ((uint64_t)rqtp_k.tv_nsec * RT_TICK_PER_SECOND) / 1000000000;
  729. rt_thread_delay(tick);
  730. if (rmtp)
  731. {
  732. if (!lwp_user_accessable((void *)rmtp, sizeof *rmtp))
  733. {
  734. rt_set_errno(EFAULT);
  735. return -1;
  736. }
  737. tick = rt_tick_get() - tick;
  738. /* get the passed time */
  739. rmtp_k.tv_sec = tick / RT_TICK_PER_SECOND;
  740. rmtp_k.tv_nsec = (tick % RT_TICK_PER_SECOND) * (1000000000 / RT_TICK_PER_SECOND);
  741. lwp_put_to_user(rmtp, (void *)&rmtp_k, sizeof rmtp_k);
  742. }
  743. #else
  744. dbg_log(DBG_LOG, "sys_nanosleep\n");
  745. tick = rqtp->tv_sec * RT_TICK_PER_SECOND + ((uint64_t)rqtp->tv_nsec * RT_TICK_PER_SECOND) / 1000000000;
  746. rt_thread_delay(tick);
  747. if (rmtp)
  748. {
  749. tick = rt_tick_get() - tick;
  750. /* get the passed time */
  751. rmtp->tv_sec = tick / RT_TICK_PER_SECOND;
  752. rmtp->tv_nsec = (tick % RT_TICK_PER_SECOND) * (1000000000 / RT_TICK_PER_SECOND);
  753. }
  754. #endif
  755. return 0;
  756. }
  757. /* syscall: "gettimeofday" ret: "int" args: "struct timeval *" "struct timezone *" */
  758. int sys_gettimeofday(struct timeval *tp, struct timezone *tzp)
  759. {
  760. struct timeval t_k;
  761. #ifdef RT_USING_USERSPACE
  762. if (tp)
  763. {
  764. if (!lwp_user_accessable((void *)tp, sizeof *tp))
  765. {
  766. rt_set_errno(EFAULT);
  767. return -1;
  768. }
  769. t_k.tv_sec = rt_tick_get() / RT_TICK_PER_SECOND;
  770. t_k.tv_usec = (rt_tick_get() % RT_TICK_PER_SECOND) * (1000000 / RT_TICK_PER_SECOND);
  771. lwp_put_to_user(tp, (void *)&t_k, sizeof t_k);
  772. }
  773. #else
  774. if (tp)
  775. {
  776. tp->tv_sec = rt_tick_get() / RT_TICK_PER_SECOND;
  777. tp->tv_usec = (rt_tick_get() % RT_TICK_PER_SECOND) * (1000000 / RT_TICK_PER_SECOND);
  778. }
  779. #endif
  780. return 0;
  781. }
  782. int sys_settimeofday(const struct timeval *tv, const struct timezone *tzp)
  783. {
  784. return 0;
  785. }
  786. #ifdef RT_USING_GDBSERVER
  787. int lwp_execve(char *filename, int debug, int argc, char **argv, char **envp);
  788. #else
  789. int lwp_execve(char *filename, int argc, char **argv, char **envp);
  790. #endif
  791. int sys_exec(char *filename, int argc, char **argv, char **envp)
  792. {
  793. #ifdef RT_USING_GDBSERVER
  794. return lwp_execve(filename, 0, argc, argv, envp);
  795. #else
  796. return lwp_execve(filename, argc, argv, envp);
  797. #endif
  798. }
  799. int sys_kill(int pid, int sig)
  800. {
  801. return lwp_kill(pid, sig);
  802. }
  803. int sys_getpid(void)
  804. {
  805. return lwp_getpid();
  806. }
  807. /* syscall: "getpriority" ret: "int" args: "int" "id_t" */
  808. int sys_getpriority(int which, id_t who)
  809. {
  810. if (which == PRIO_PROCESS)
  811. {
  812. rt_thread_t tid;
  813. tid = rt_thread_self();
  814. if (who == (id_t)(rt_size_t)tid || who == 0xff)
  815. {
  816. return tid->current_priority;
  817. }
  818. }
  819. return 0xff;
  820. }
  821. /* syscall: "setpriority" ret: "int" args: "int" "id_t" "int" */
  822. int sys_setpriority(int which, id_t who, int prio)
  823. {
  824. if (which == PRIO_PROCESS)
  825. {
  826. rt_thread_t tid;
  827. tid = rt_thread_self();
  828. if ((who == (id_t)(rt_size_t)tid || who == 0xff) && (prio >= 0 && prio < RT_THREAD_PRIORITY_MAX))
  829. {
  830. rt_thread_control(tid, RT_THREAD_CTRL_CHANGE_PRIORITY, &prio);
  831. return 0;
  832. }
  833. }
  834. return -1;
  835. }
  836. rt_sem_t sys_sem_create(const char *name, rt_uint32_t value, rt_uint8_t flag)
  837. {
  838. rt_sem_t sem = rt_sem_create(name, value, flag);
  839. if (lwp_user_object_add(lwp_self(), (rt_object_t)sem) != 0)
  840. {
  841. rt_sem_delete(sem);
  842. sem = NULL;
  843. }
  844. return sem;
  845. }
  846. rt_err_t sys_sem_delete(rt_sem_t sem)
  847. {
  848. return lwp_user_object_delete(lwp_self(), (rt_object_t)sem);
  849. }
  850. rt_err_t sys_sem_take(rt_sem_t sem, rt_int32_t time)
  851. {
  852. return rt_sem_take_interruptible(sem, time);
  853. }
  854. rt_err_t sys_sem_release(rt_sem_t sem)
  855. {
  856. return rt_sem_release(sem);
  857. }
  858. rt_mutex_t sys_mutex_create(const char *name, rt_uint8_t flag)
  859. {
  860. rt_mutex_t mutex = rt_mutex_create(name, flag);
  861. if (lwp_user_object_add(lwp_self(), (rt_object_t)mutex) != 0)
  862. {
  863. rt_mutex_delete(mutex);
  864. mutex = NULL;
  865. }
  866. return mutex;
  867. }
  868. rt_err_t sys_mutex_delete(rt_mutex_t mutex)
  869. {
  870. return lwp_user_object_delete(lwp_self(), (rt_object_t)mutex);
  871. }
  872. rt_err_t sys_mutex_take(rt_mutex_t mutex, rt_int32_t time)
  873. {
  874. return rt_mutex_take_interruptible(mutex, time);
  875. }
  876. rt_err_t sys_mutex_release(rt_mutex_t mutex)
  877. {
  878. return rt_mutex_release(mutex);
  879. }
  880. #ifdef RT_USING_USERSPACE
  881. /* memory allocation */
  882. extern rt_base_t lwp_brk(void *addr);
  883. rt_base_t sys_brk(void *addr)
  884. {
  885. return lwp_brk(addr);
  886. }
  887. extern void *lwp_mmap2(void *addr, size_t length, int prot,
  888. int flags, int fd, off_t pgoffset);
  889. void *sys_mmap2(void *addr, size_t length, int prot,
  890. int flags, int fd, off_t pgoffset)
  891. {
  892. return lwp_mmap2(addr, length, prot, flags, fd, pgoffset);
  893. }
  894. extern int lwp_munmap(void *addr);
  895. int sys_munmap(void *addr, size_t length)
  896. {
  897. return lwp_munmap(addr);
  898. }
  899. #endif
  900. rt_event_t sys_event_create(const char *name, rt_uint8_t flag)
  901. {
  902. rt_event_t event = rt_event_create(name, flag);
  903. if (lwp_user_object_add(lwp_self(), (rt_object_t)event) != 0)
  904. {
  905. rt_event_delete(event);
  906. event = NULL;
  907. }
  908. return event;
  909. }
  910. rt_err_t sys_event_delete(rt_event_t event)
  911. {
  912. return lwp_user_object_delete(lwp_self(), (rt_object_t)event);
  913. }
  914. rt_err_t sys_event_send(rt_event_t event, rt_uint32_t set)
  915. {
  916. return rt_event_send(event, set);
  917. }
  918. rt_err_t sys_event_recv(rt_event_t event,
  919. rt_uint32_t set,
  920. rt_uint8_t opt,
  921. rt_int32_t timeout,
  922. rt_uint32_t *recved)
  923. {
  924. return rt_event_recv(event, set, opt, timeout, recved);
  925. }
  926. rt_mailbox_t sys_mb_create(const char *name, rt_size_t size, rt_uint8_t flag)
  927. {
  928. rt_mailbox_t mb = rt_mb_create(name, size, flag);
  929. if (lwp_user_object_add(lwp_self(), (rt_object_t)mb) != 0)
  930. {
  931. rt_mb_delete(mb);
  932. mb = NULL;
  933. }
  934. return mb;
  935. }
  936. rt_err_t sys_mb_delete(rt_mailbox_t mb)
  937. {
  938. return lwp_user_object_delete(lwp_self(), (rt_object_t)mb);
  939. }
  940. rt_err_t sys_mb_send(rt_mailbox_t mb, rt_uint32_t value)
  941. {
  942. return rt_mb_send(mb, value);
  943. }
  944. rt_err_t sys_mb_send_wait(rt_mailbox_t mb,
  945. rt_uint32_t value,
  946. rt_int32_t timeout)
  947. {
  948. return rt_mb_send_wait(mb, value, timeout);
  949. }
  950. rt_err_t sys_mb_recv(rt_mailbox_t mb, rt_uint32_t *value, rt_int32_t timeout)
  951. {
  952. return rt_mb_recv(mb, (rt_ubase_t *)value, timeout);
  953. }
  954. rt_mq_t sys_mq_create(const char *name,
  955. rt_size_t msg_size,
  956. rt_size_t max_msgs,
  957. rt_uint8_t flag)
  958. {
  959. rt_mq_t mq = rt_mq_create(name, msg_size, max_msgs, flag);
  960. if (lwp_user_object_add(lwp_self(), (rt_object_t)mq) != 0)
  961. {
  962. rt_mq_delete(mq);
  963. mq = NULL;
  964. }
  965. return mq;
  966. }
  967. rt_err_t sys_mq_delete(rt_mq_t mq)
  968. {
  969. return lwp_user_object_delete(lwp_self(), (rt_object_t)mq);
  970. }
  971. rt_err_t sys_mq_send(rt_mq_t mq, void *buffer, rt_size_t size)
  972. {
  973. return rt_mq_send(mq, buffer, size);
  974. }
  975. rt_err_t sys_mq_urgent(rt_mq_t mq, void *buffer, rt_size_t size)
  976. {
  977. return rt_mq_urgent(mq, buffer, size);
  978. }
  979. rt_err_t sys_mq_recv(rt_mq_t mq,
  980. void *buffer,
  981. rt_size_t size,
  982. rt_int32_t timeout)
  983. {
  984. return rt_mq_recv(mq, buffer, size, timeout);
  985. }
  986. static void timer_timeout_callback(void *parameter)
  987. {
  988. rt_sem_t sem = (rt_sem_t)parameter;
  989. rt_sem_release(sem);
  990. }
  991. rt_timer_t sys_timer_create(const char *name,
  992. void *data,
  993. rt_tick_t time,
  994. rt_uint8_t flag)
  995. {
  996. rt_timer_t timer = rt_timer_create(name, timer_timeout_callback, (void *)data, time, flag);
  997. if (lwp_user_object_add(lwp_self(), (rt_object_t)timer) != 0)
  998. {
  999. rt_timer_delete(timer);
  1000. timer = NULL;
  1001. }
  1002. return timer;
  1003. }
  1004. rt_err_t sys_timer_delete(rt_timer_t timer)
  1005. {
  1006. return lwp_user_object_delete(lwp_self(), (rt_object_t)timer);
  1007. }
  1008. rt_err_t sys_timer_start(rt_timer_t timer)
  1009. {
  1010. return rt_timer_start(timer);
  1011. }
  1012. rt_err_t sys_timer_stop(rt_timer_t timer)
  1013. {
  1014. return rt_timer_stop(timer);
  1015. }
  1016. rt_err_t sys_timer_control(rt_timer_t timer, int cmd, void *arg)
  1017. {
  1018. return rt_timer_control(timer, cmd, arg);
  1019. }
  1020. rt_thread_t sys_thread_create(void *arg[])
  1021. {
  1022. rt_base_t level = 0;
  1023. void *user_stack = 0;
  1024. struct rt_lwp *lwp = 0;
  1025. rt_thread_t thread = RT_NULL;
  1026. int tid = 0;
  1027. lwp = rt_thread_self()->lwp;
  1028. lwp_ref_inc(lwp);
  1029. #ifdef RT_USING_USERSPACE
  1030. user_stack = lwp_map_user(lwp, 0, (size_t)arg[3], 0);
  1031. #else
  1032. user_stack = (void *)RT_KERNEL_MALLOC((uint32_t)arg[3]);
  1033. #endif
  1034. if (!user_stack)
  1035. {
  1036. rt_set_errno(EINVAL);
  1037. goto fail;
  1038. }
  1039. if ((tid = lwp_tid_get()) == 0)
  1040. {
  1041. rt_set_errno(ENOMEM);
  1042. goto fail;
  1043. }
  1044. thread = rt_thread_create((const char *)arg[0],
  1045. lwp_user_thread,
  1046. (void *)arg[2],
  1047. ALLOC_KERNEL_STACK_SIZE,
  1048. (rt_uint8_t)(size_t)arg[4],
  1049. (rt_uint32_t)(rt_size_t)arg[5]);
  1050. if (!thread)
  1051. {
  1052. goto fail;
  1053. }
  1054. thread->cleanup = lwp_cleanup;
  1055. thread->user_entry = (void (*)(void *))arg[1];
  1056. thread->user_stack = (void *)user_stack;
  1057. thread->user_stack_size = (rt_size_t)arg[3];
  1058. thread->lwp = (void*)lwp;
  1059. thread->tid = tid;
  1060. lwp_tid_set_thread(tid, thread);
  1061. level = rt_hw_interrupt_disable();
  1062. rt_list_insert_after(&lwp->t_grp, &thread->sibling);
  1063. rt_hw_interrupt_enable(level);
  1064. return thread;
  1065. fail:
  1066. lwp_tid_put(tid);
  1067. #ifndef RT_USING_USERSPACE
  1068. if (user_stack)
  1069. {
  1070. RT_KERNEL_FREE(user_stack);
  1071. }
  1072. #endif
  1073. if (lwp)
  1074. {
  1075. lwp_ref_dec(lwp);
  1076. }
  1077. return RT_NULL;
  1078. }
  1079. #define CLONE_VM 0x00000100
  1080. #define CLONE_FS 0x00000200
  1081. #define CLONE_FILES 0x00000400
  1082. #define CLONE_SIGHAND 0x00000800
  1083. #define CLONE_PTRACE 0x00002000
  1084. #define CLONE_VFORK 0x00004000
  1085. #define CLONE_PARENT 0x00008000
  1086. #define CLONE_THREAD 0x00010000
  1087. #define CLONE_NEWNS 0x00020000
  1088. #define CLONE_SYSVSEM 0x00040000
  1089. #define CLONE_SETTLS 0x00080000
  1090. #define CLONE_PARENT_SETTID 0x00100000
  1091. #define CLONE_CHILD_CLEARTID 0x00200000
  1092. #define CLONE_DETACHED 0x00400000
  1093. #define CLONE_UNTRACED 0x00800000
  1094. #define CLONE_CHILD_SETTID 0x01000000
  1095. #define CLONE_NEWCGROUP 0x02000000
  1096. #define CLONE_NEWUTS 0x04000000
  1097. #define CLONE_NEWIPC 0x08000000
  1098. #define CLONE_NEWUSER 0x10000000
  1099. #define CLONE_NEWPID 0x20000000
  1100. #define CLONE_NEWNET 0x40000000
  1101. #define CLONE_IO 0x80000000
  1102. /* arg[] -> flags
  1103. * stack
  1104. * new_tid
  1105. * tls
  1106. * set_clear_tid_address
  1107. * quit_func
  1108. * start_args
  1109. * */
  1110. #define SYS_CLONE_ARGS_NR 7
  1111. int lwp_set_thread_context(void (*exit)(void), void *new_thread_stack,
  1112. void *user_stack, void **thread_sp);
  1113. long sys_clone(void *arg[]);
  1114. void sys_clone_exit(void);
  1115. long _sys_clone(void *arg[])
  1116. {
  1117. rt_base_t level = 0;
  1118. struct rt_lwp *lwp = 0;
  1119. rt_thread_t thread = RT_NULL;
  1120. rt_thread_t self = RT_NULL;
  1121. int tid = 0;
  1122. unsigned long flags = 0;
  1123. void *user_stack = RT_NULL;
  1124. int *new_tid = RT_NULL;
  1125. void *tls = RT_NULL;
  1126. /*
  1127. musl call flags (CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND
  1128. | CLONE_THREAD | CLONE_SYSVSEM | CLONE_SETTLS
  1129. | CLONE_PARENT_SETTID | CLONE_CHILD_CLEARTID | CLONE_DETACHED);
  1130. */
  1131. /* check args */
  1132. if (!lwp_user_accessable(arg, sizeof(void *[SYS_CLONE_ARGS_NR])))
  1133. {
  1134. rt_set_errno(EFAULT);
  1135. return -1;
  1136. }
  1137. flags = (unsigned long)(size_t)arg[0];
  1138. if ((flags & (CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_THREAD | CLONE_SYSVSEM))
  1139. != (CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_THREAD | CLONE_SYSVSEM))
  1140. {
  1141. rt_set_errno(EINVAL);
  1142. return -1;
  1143. }
  1144. user_stack = arg[1];
  1145. new_tid = (int *)arg[2];
  1146. tls = (void *)arg[3];
  1147. if ((flags & CLONE_PARENT_SETTID) == CLONE_PARENT_SETTID)
  1148. {
  1149. if (!lwp_user_accessable(new_tid, sizeof(int)))
  1150. {
  1151. rt_set_errno(EFAULT);
  1152. return -1;
  1153. }
  1154. }
  1155. self = rt_thread_self();
  1156. lwp = self->lwp;
  1157. lwp_ref_inc(lwp);
  1158. if (!user_stack)
  1159. {
  1160. rt_set_errno(EINVAL);
  1161. goto fail;
  1162. }
  1163. if ((tid = lwp_tid_get()) == 0)
  1164. {
  1165. rt_set_errno(ENOMEM);
  1166. goto fail;
  1167. }
  1168. thread = rt_thread_create(self->name,
  1169. RT_NULL,
  1170. RT_NULL,
  1171. self->stack_size,
  1172. self->init_priority,
  1173. self->init_tick);
  1174. if (!thread)
  1175. {
  1176. goto fail;
  1177. }
  1178. thread->cleanup = lwp_cleanup;
  1179. thread->user_entry = RT_NULL;
  1180. thread->user_stack = RT_NULL;
  1181. thread->user_stack_size = 0;
  1182. thread->lwp = (void *)lwp;
  1183. thread->tid = tid;
  1184. if ((flags & CLONE_SETTLS) == CLONE_SETTLS)
  1185. {
  1186. thread->thread_idr = tls;
  1187. }
  1188. if ((flags & CLONE_PARENT_SETTID) == CLONE_PARENT_SETTID)
  1189. {
  1190. *new_tid = (int)(tid);
  1191. }
  1192. if ((flags & CLONE_CHILD_CLEARTID) == CLONE_CHILD_CLEARTID)
  1193. {
  1194. thread->clear_child_tid = (int *)arg[4];
  1195. }
  1196. level = rt_hw_interrupt_disable();
  1197. rt_list_insert_after(&lwp->t_grp, &thread->sibling);
  1198. rt_hw_interrupt_enable(level);
  1199. /* copy origin stack */
  1200. rt_memcpy(thread->stack_addr, self->stack_addr, thread->stack_size);
  1201. lwp_tid_set_thread(tid, thread);
  1202. lwp_set_thread_context(sys_clone_exit,
  1203. (void *)((char *)thread->stack_addr + thread->stack_size),
  1204. user_stack, &thread->sp);
  1205. /* new thread never reach there */
  1206. rt_thread_startup(thread);
  1207. return (long)tid;
  1208. fail:
  1209. lwp_tid_put(tid);
  1210. if (lwp)
  1211. {
  1212. lwp_ref_dec(lwp);
  1213. }
  1214. return -1;
  1215. }
  1216. int lwp_dup_user(struct lwp_avl_struct* ptree, void *arg);
  1217. void *lwp_get_user_sp(void);
  1218. static int _copy_process(struct rt_lwp *dest_lwp, struct rt_lwp *src_lwp)
  1219. {
  1220. return lwp_avl_traversal(src_lwp->map_area, lwp_dup_user, dest_lwp);
  1221. }
  1222. static void lwp_struct_copy(struct rt_lwp *dst, struct rt_lwp *src)
  1223. {
  1224. #ifdef RT_USING_USERSPACE
  1225. dst->end_heap = src->end_heap;
  1226. #endif
  1227. dst->lwp_type = src->lwp_type;
  1228. dst->text_entry = src->text_entry;
  1229. dst->text_size = src->text_size;
  1230. dst->data_entry = src->data_entry;
  1231. dst->data_size = src->data_size;
  1232. dst->args = src->args;
  1233. rt_memcpy(dst->cmd, src->cmd, RT_NAME_MAX);
  1234. dst->sa_flags = src->sa_flags;
  1235. dst->signal_mask = src->signal_mask;
  1236. rt_memcpy(dst->signal_handler, src->signal_handler, sizeof dst->signal_handler);
  1237. }
  1238. static int lwp_copy_files(struct rt_lwp *dst, struct rt_lwp *src)
  1239. {
  1240. struct dfs_fdtable *dst_fdt;
  1241. struct dfs_fdtable *src_fdt;
  1242. src_fdt = &src->fdt;
  1243. dst_fdt = &dst->fdt;
  1244. /* init fds */
  1245. dst_fdt->fds = rt_calloc(src_fdt->maxfd, sizeof(void *));
  1246. if (dst_fdt->fds)
  1247. {
  1248. struct dfs_fd *d_s;
  1249. struct dfs_fd *d_d;
  1250. int i;
  1251. dst_fdt->maxfd = src_fdt->maxfd;
  1252. dfs_fd_lock();
  1253. /* copy stdio */
  1254. for (i = 0; i < src_fdt->maxfd; i++)
  1255. {
  1256. d_s = fdt_fd_get(src_fdt, i);
  1257. if (d_s)
  1258. {
  1259. dfs_fm_lock();
  1260. if (!d_s->fnode)
  1261. {
  1262. dfs_fm_unlock();
  1263. continue;
  1264. }
  1265. d_s->fnode->ref_count++;
  1266. dfs_fm_unlock();
  1267. /* alloc dfs_fd struct */
  1268. d_d = (struct dfs_fd *)rt_calloc(1, sizeof(struct dfs_fd));
  1269. if (!d_d)
  1270. {
  1271. dfs_fd_unlock();
  1272. return -1;
  1273. }
  1274. dst_fdt->fds[i] = d_d;
  1275. d_d->magic = d_s->magic;
  1276. d_d->ref_count = 1;
  1277. d_d->pos = d_s->pos;
  1278. d_d->fnode = d_s->fnode;
  1279. d_d->data = d_s->data;
  1280. }
  1281. }
  1282. dfs_fd_unlock();
  1283. return 0;
  1284. }
  1285. return -1;
  1286. }
  1287. int sys_fork(void);
  1288. int sys_vfork(void);
  1289. void sys_fork_exit(void);
  1290. int _sys_fork(void)
  1291. {
  1292. rt_base_t level;
  1293. int tid = 0;
  1294. struct rt_lwp *lwp = RT_NULL;
  1295. struct rt_lwp *self_lwp = RT_NULL;
  1296. rt_thread_t thread = RT_NULL;
  1297. rt_thread_t self_thread = RT_NULL;
  1298. void *user_stack = RT_NULL;
  1299. /* new lwp */
  1300. lwp = lwp_new();
  1301. if (!lwp)
  1302. {
  1303. rt_set_errno(ENOMEM);
  1304. goto fail;
  1305. }
  1306. /* new tid */
  1307. if ((tid = lwp_tid_get()) == 0)
  1308. {
  1309. rt_set_errno(ENOMEM);
  1310. goto fail;
  1311. }
  1312. /* user space init */
  1313. if (lwp_user_space_init(lwp) != 0)
  1314. {
  1315. rt_set_errno(ENOMEM);
  1316. goto fail;
  1317. }
  1318. self_lwp = lwp_self();
  1319. /* copy process */
  1320. if (_copy_process(lwp, self_lwp) != 0)
  1321. {
  1322. rt_set_errno(ENOMEM);
  1323. goto fail;
  1324. }
  1325. /* copy lwp struct data */
  1326. lwp_struct_copy(lwp, self_lwp);
  1327. /* copy files */
  1328. if (lwp_copy_files(lwp, self_lwp) != 0)
  1329. {
  1330. rt_set_errno(ENOMEM);
  1331. goto fail;
  1332. }
  1333. /* create thread */
  1334. self_thread = rt_thread_self();
  1335. thread = rt_thread_create(self_thread->name,
  1336. RT_NULL,
  1337. RT_NULL,
  1338. self_thread->stack_size,
  1339. self_thread->init_priority,
  1340. self_thread->init_tick);
  1341. if (!thread)
  1342. {
  1343. goto fail;
  1344. }
  1345. thread->cleanup = self_thread->cleanup;
  1346. thread->user_entry = self_thread->user_entry;
  1347. thread->user_stack = self_thread->user_stack;
  1348. thread->user_stack_size = self_thread->user_stack_size;
  1349. thread->signal_mask = self_thread->signal_mask;
  1350. thread->thread_idr = self_thread->thread_idr;
  1351. thread->lwp = (void *)lwp;
  1352. thread->tid = tid;
  1353. level = rt_hw_interrupt_disable();
  1354. /* add thread to lwp process */
  1355. rt_list_insert_after(&lwp->t_grp, &thread->sibling);
  1356. /* lwp add to children link */
  1357. lwp->sibling = self_lwp->first_child;
  1358. self_lwp->first_child = lwp;
  1359. lwp->parent = self_lwp;
  1360. rt_hw_interrupt_enable(level);
  1361. /* copy origin stack */
  1362. rt_memcpy(thread->stack_addr, self_thread->stack_addr, self_thread->stack_size);
  1363. lwp_tid_set_thread(tid, thread);
  1364. /* duplicate user objects */
  1365. lwp_user_object_dup(lwp, self_lwp);
  1366. level = rt_hw_interrupt_disable();
  1367. user_stack = lwp_get_user_sp();
  1368. rt_hw_interrupt_enable(level);
  1369. lwp_set_thread_context(sys_fork_exit,
  1370. (void *)((char *)thread->stack_addr + thread->stack_size),
  1371. user_stack, &thread->sp);
  1372. /* new thread never reach there */
  1373. level = rt_hw_interrupt_disable();
  1374. if (rt_console_get_foreground() == self_lwp)
  1375. {
  1376. rt_console_set_foreground(lwp);
  1377. }
  1378. rt_hw_interrupt_enable(level);
  1379. rt_thread_startup(thread);
  1380. return lwp_to_pid(lwp);
  1381. fail:
  1382. if (tid != 0)
  1383. {
  1384. lwp_tid_put(tid);
  1385. }
  1386. if (lwp)
  1387. {
  1388. lwp_ref_dec(lwp);
  1389. }
  1390. return -1;
  1391. }
  1392. size_t lwp_user_strlen(const char *s, int *err)
  1393. {
  1394. size_t len = 0;
  1395. while (1)
  1396. {
  1397. if (!lwp_user_accessable((void *)(s + len), sizeof(char)))
  1398. {
  1399. if (err)
  1400. {
  1401. *err = 1;
  1402. }
  1403. return 0;
  1404. }
  1405. if (s[len] == '\0')
  1406. {
  1407. if (err)
  1408. {
  1409. *err = 0;
  1410. }
  1411. return len;
  1412. }
  1413. len++;
  1414. }
  1415. }
  1416. struct process_aux *lwp_argscopy(struct rt_lwp *lwp, int argc, char **argv, char **envp);
  1417. int lwp_load(const char *filename, struct rt_lwp *lwp, uint8_t *load_addr, size_t addr_size, struct process_aux *aux);
  1418. void lwp_exec_user(void *args, void *kernel_stack, void *user_entry);
  1419. void lwp_user_obj_free(struct rt_lwp *lwp);
  1420. #define _swap_lwp_data(lwp_used, lwp_new, type, member) \
  1421. do {\
  1422. type tmp;\
  1423. tmp = lwp_used->member;\
  1424. lwp_used->member = lwp_new->member;\
  1425. lwp_new->member = tmp;\
  1426. } while (0)
  1427. static char *_insert_args(int new_argc, char *new_argv[], struct lwp_args_info *args)
  1428. {
  1429. void *page = NULL;
  1430. int err = 0;
  1431. char **nargv;
  1432. char **nenvp;
  1433. char *p;
  1434. int i, len;
  1435. int nsize;
  1436. if (new_argc == 0)
  1437. {
  1438. goto quit;
  1439. }
  1440. page = rt_pages_alloc(0); /* 1 page */
  1441. if (!page)
  1442. {
  1443. goto quit;
  1444. }
  1445. nsize = new_argc * sizeof(char *);
  1446. for (i = 0; i < new_argc; i++)
  1447. {
  1448. nsize += rt_strlen(new_argv[i]) + 1;
  1449. }
  1450. if (nsize + args->size > ARCH_PAGE_SIZE)
  1451. {
  1452. err = 1;
  1453. goto quit;
  1454. }
  1455. nargv = (char **)page;
  1456. nenvp = nargv + args->argc + new_argc + 1;
  1457. p = (char *)(nenvp + args->envc + 1);
  1458. /* insert argv */
  1459. for (i = 0; i < new_argc; i++)
  1460. {
  1461. nargv[i] = p;
  1462. len = rt_strlen(new_argv[i]) + 1;
  1463. rt_memcpy(p, new_argv[i], len);
  1464. p += len;
  1465. }
  1466. /* copy argv */
  1467. nargv += new_argc;
  1468. for (i = 0; i < args->argc; i++)
  1469. {
  1470. nargv[i] = p;
  1471. len = rt_strlen(args->argv[i]) + 1;
  1472. rt_memcpy(p, args->argv[i], len);
  1473. p += len;
  1474. }
  1475. nargv[i] = NULL;
  1476. /* copy envp */
  1477. for (i = 0; i < args->envc; i++)
  1478. {
  1479. nenvp[i] = p;
  1480. len = rt_strlen(args->envp[i]) + 1;
  1481. rt_memcpy(p, args->envp[i], len);
  1482. p += len;
  1483. }
  1484. nenvp[i] = NULL;
  1485. /* update args */
  1486. args->argv = (char **)page;
  1487. args->argc = args->argc + new_argc;
  1488. args->envp = args->argv + args->argc + 1;
  1489. /* args->envc no change */
  1490. args->size = args->size + nsize;
  1491. quit:
  1492. if (err && page)
  1493. {
  1494. rt_pages_free(page, 0);
  1495. page = NULL;
  1496. }
  1497. return page;
  1498. }
  1499. #define INTERP_BUF_SIZE 128
  1500. static char *_load_script(const char *filename, struct lwp_args_info *args)
  1501. {
  1502. void *page = NULL;
  1503. char *new_page;
  1504. int fd = -1;
  1505. int len;
  1506. char interp[INTERP_BUF_SIZE];
  1507. char *cp;
  1508. char *i_name;
  1509. char *i_arg;
  1510. fd = open(filename, O_BINARY | O_RDONLY, 0);
  1511. if (fd < 0)
  1512. {
  1513. goto quit;
  1514. }
  1515. len = read(fd, interp, INTERP_BUF_SIZE);
  1516. if (len < 2)
  1517. {
  1518. goto quit;
  1519. }
  1520. if ((interp[0] != '#') || (interp[1] != '!'))
  1521. {
  1522. goto quit;
  1523. }
  1524. if (len == INTERP_BUF_SIZE)
  1525. {
  1526. len--;
  1527. }
  1528. interp[len] = '\0';
  1529. if ((cp = strchr(interp, '\n')) == NULL)
  1530. {
  1531. cp = interp + INTERP_BUF_SIZE - 1;
  1532. }
  1533. *cp = '\0';
  1534. while (cp > interp)
  1535. {
  1536. cp--;
  1537. if ((*cp == ' ') || (*cp == '\t'))
  1538. {
  1539. *cp = '\0';
  1540. }
  1541. else
  1542. {
  1543. break;
  1544. }
  1545. }
  1546. for (cp = interp + 2; (*cp == ' ') || (*cp == '\t'); cp++)
  1547. {
  1548. /* nothing */
  1549. }
  1550. if (*cp == '\0')
  1551. {
  1552. goto quit; /* No interpreter name found */
  1553. }
  1554. i_name = cp;
  1555. i_arg = NULL;
  1556. for (; *cp && (*cp != ' ') && (*cp != '\t'); cp++)
  1557. {
  1558. /* nothing */
  1559. }
  1560. while ((*cp == ' ') || (*cp == '\t'))
  1561. {
  1562. *cp++ = '\0';
  1563. }
  1564. if (*cp)
  1565. {
  1566. i_arg = cp;
  1567. }
  1568. if (i_arg)
  1569. {
  1570. new_page = _insert_args(1, &i_arg, args);
  1571. rt_pages_free(page, 0);
  1572. page = new_page;
  1573. if (!page)
  1574. {
  1575. goto quit;
  1576. }
  1577. }
  1578. new_page = _insert_args(1, &i_name, args);
  1579. rt_pages_free(page, 0);
  1580. page = new_page;
  1581. quit:
  1582. if (fd >= 0)
  1583. {
  1584. close(fd);
  1585. }
  1586. return page;
  1587. }
  1588. int sys_execve(const char *path, char *const argv[], char *const envp[])
  1589. {
  1590. int ret = -1;
  1591. int argc = 0;
  1592. int envc = 0;
  1593. void *page = NULL;
  1594. void *new_page;
  1595. int size = 0;
  1596. size_t len;
  1597. int access_err;
  1598. char **kargv;
  1599. char **kenvp;
  1600. char *p;
  1601. struct rt_lwp *new_lwp = NULL;
  1602. struct rt_lwp *lwp;
  1603. rt_base_t level;
  1604. int uni_thread;
  1605. rt_thread_t thread;
  1606. struct process_aux *aux;
  1607. int i;
  1608. struct lwp_args_info args_info;
  1609. lwp = lwp_self();
  1610. thread = rt_thread_self();
  1611. uni_thread = 1;
  1612. level = rt_hw_interrupt_disable();
  1613. if (lwp->t_grp.prev != &thread->sibling)
  1614. {
  1615. uni_thread = 0;
  1616. }
  1617. if (lwp->t_grp.next != &thread->sibling)
  1618. {
  1619. uni_thread = 0;
  1620. }
  1621. rt_hw_interrupt_enable(level);
  1622. if (!uni_thread)
  1623. {
  1624. rt_set_errno(EINVAL);
  1625. goto quit;
  1626. }
  1627. len = lwp_user_strlen(path, &access_err);
  1628. if (access_err)
  1629. {
  1630. rt_set_errno(EFAULT);
  1631. goto quit;
  1632. }
  1633. size += sizeof(char *);
  1634. if (argv)
  1635. {
  1636. while (1)
  1637. {
  1638. if (!lwp_user_accessable((void *)(argv + argc), sizeof(char *)))
  1639. {
  1640. rt_set_errno(EFAULT);
  1641. goto quit;
  1642. }
  1643. if (!argv[argc])
  1644. {
  1645. break;
  1646. }
  1647. len = lwp_user_strlen((const char *)argv[argc], &access_err);
  1648. if (access_err)
  1649. {
  1650. rt_set_errno(EFAULT);
  1651. goto quit;
  1652. }
  1653. size += sizeof(char *) + len + 1;
  1654. argc++;
  1655. }
  1656. }
  1657. size += sizeof(char *);
  1658. if (envp)
  1659. {
  1660. while (1)
  1661. {
  1662. if (!lwp_user_accessable((void *)(envp + envc), sizeof(char *)))
  1663. {
  1664. rt_set_errno(EFAULT);
  1665. goto quit;
  1666. }
  1667. if (!envp[envc])
  1668. {
  1669. break;
  1670. }
  1671. len = lwp_user_strlen((const char *)envp[envc], &access_err);
  1672. if (access_err)
  1673. {
  1674. rt_set_errno(EFAULT);
  1675. goto quit;
  1676. }
  1677. size += sizeof(char *) + len + 1;
  1678. envc++;
  1679. }
  1680. }
  1681. if (size > ARCH_PAGE_SIZE)
  1682. {
  1683. rt_set_errno(EINVAL);
  1684. goto quit;
  1685. }
  1686. page = rt_pages_alloc(0); /* 1 page */
  1687. if (!page)
  1688. {
  1689. rt_set_errno(ENOMEM);
  1690. goto quit;
  1691. }
  1692. kargv = (char **)page;
  1693. kenvp = kargv + argc + 1;
  1694. p = (char *)(kenvp + envc + 1);
  1695. /* copy argv */
  1696. if (argv)
  1697. {
  1698. for (i = 0; i < argc; i++)
  1699. {
  1700. kargv[i] = p;
  1701. len = rt_strlen(argv[i]) + 1;
  1702. rt_memcpy(p, argv[i], len);
  1703. p += len;
  1704. }
  1705. kargv[i] = NULL;
  1706. }
  1707. /* copy envp */
  1708. if (envp)
  1709. {
  1710. for (i = 0; i < envc; i++)
  1711. {
  1712. kenvp[i] = p;
  1713. len = rt_strlen(envp[i]) + 1;
  1714. rt_memcpy(p, envp[i], len);
  1715. p += len;
  1716. }
  1717. kenvp[i] = NULL;
  1718. }
  1719. /* alloc new lwp to operation */
  1720. new_lwp = (struct rt_lwp *)rt_malloc(sizeof(struct rt_lwp));
  1721. if (!new_lwp)
  1722. {
  1723. rt_set_errno(ENOMEM);
  1724. goto quit;
  1725. }
  1726. rt_memset(new_lwp, 0, sizeof(struct rt_lwp));
  1727. new_lwp->ref = 1;
  1728. lwp_user_object_lock_init(new_lwp);
  1729. ret = arch_user_space_init(new_lwp);
  1730. if (ret != 0)
  1731. {
  1732. rt_set_errno(ENOMEM);
  1733. goto quit;
  1734. }
  1735. /* file is a script ? */
  1736. args_info.argc = argc;
  1737. args_info.argv = kargv;
  1738. args_info.envc = envc;
  1739. args_info.envp = kenvp;
  1740. args_info.size = size;
  1741. while (1)
  1742. {
  1743. new_page = _load_script(path, &args_info);
  1744. if (!new_page)
  1745. {
  1746. break;
  1747. }
  1748. rt_pages_free(page, 0);
  1749. page = new_page;
  1750. path = args_info.argv[0];
  1751. }
  1752. /* now load elf */
  1753. if ((aux = lwp_argscopy(new_lwp, args_info.argc, args_info.argv, args_info.envp)) == NULL)
  1754. {
  1755. rt_set_errno(ENOMEM);
  1756. goto quit;
  1757. }
  1758. ret = lwp_load(path, new_lwp, RT_NULL, 0, aux);
  1759. if (ret == RT_EOK)
  1760. {
  1761. int off = 0;
  1762. int last_backslash = 0;
  1763. char *run_name = args_info.argv[0];
  1764. /* clear all user objects */
  1765. lwp_user_object_clear(lwp);
  1766. /* find last \ or / */
  1767. while (1)
  1768. {
  1769. char c = run_name[off++];
  1770. if (c == '\0')
  1771. {
  1772. break;
  1773. }
  1774. if (c == '\\' || c == '/')
  1775. {
  1776. last_backslash = off;
  1777. }
  1778. }
  1779. /* load ok, now set thread name and swap the data of lwp and new_lwp */
  1780. level = rt_hw_interrupt_disable();
  1781. rt_strncpy(thread->name, run_name + last_backslash, RT_NAME_MAX);
  1782. rt_pages_free(page, 0);
  1783. #ifdef RT_USING_USERSPACE
  1784. _swap_lwp_data(lwp, new_lwp, rt_mmu_info, mmu_info);
  1785. _swap_lwp_data(lwp, new_lwp, struct lwp_avl_struct *, map_area);
  1786. _swap_lwp_data(lwp, new_lwp, size_t, end_heap);
  1787. #endif
  1788. _swap_lwp_data(lwp, new_lwp, uint8_t, lwp_type);
  1789. _swap_lwp_data(lwp, new_lwp, void *, text_entry);
  1790. _swap_lwp_data(lwp, new_lwp, uint32_t, text_size);
  1791. _swap_lwp_data(lwp, new_lwp, void *, data_entry);
  1792. _swap_lwp_data(lwp, new_lwp, uint32_t, data_size);
  1793. _swap_lwp_data(lwp, new_lwp, void *, args);
  1794. rt_memset(&thread->signal_mask, 0, sizeof(thread->signal_mask));
  1795. rt_memset(&thread->signal_mask_bak, 0, sizeof(thread->signal_mask_bak));
  1796. lwp->sa_flags = 0;
  1797. rt_memset(&lwp->signal_mask, 0, sizeof(lwp->signal_mask));
  1798. rt_memset(&lwp->signal_mask_bak, 0, sizeof(lwp->signal_mask_bak));
  1799. rt_memset(lwp->signal_handler, 0, sizeof(lwp->signal_handler));
  1800. /* to do: clsoe files with flag CLOEXEC */
  1801. lwp_mmu_switch(thread);
  1802. rt_hw_interrupt_enable(level);
  1803. lwp_ref_dec(new_lwp);
  1804. lwp_exec_user(lwp->args,
  1805. thread->stack_addr + thread->stack_size,
  1806. lwp->text_entry);
  1807. /* never reach here */
  1808. }
  1809. rt_set_errno(EINVAL);
  1810. quit:
  1811. if (page)
  1812. {
  1813. rt_pages_free(page, 0);
  1814. }
  1815. if (new_lwp)
  1816. {
  1817. lwp_ref_dec(new_lwp);
  1818. }
  1819. return -1;
  1820. }
  1821. rt_err_t sys_thread_delete(rt_thread_t thread)
  1822. {
  1823. return rt_thread_delete(thread);
  1824. }
  1825. rt_err_t sys_thread_startup(rt_thread_t thread)
  1826. {
  1827. return rt_thread_startup(thread);
  1828. }
  1829. rt_thread_t sys_thread_self(void)
  1830. {
  1831. return rt_thread_self();
  1832. }
  1833. /* sys channel */
  1834. int sys_channel_open(const char *name, int flags)
  1835. {
  1836. return lwp_channel_open(FDT_TYPE_LWP, name, flags);
  1837. }
  1838. rt_err_t sys_channel_close(int fd)
  1839. {
  1840. return lwp_channel_close(FDT_TYPE_LWP, fd);
  1841. }
  1842. rt_err_t sys_channel_send(int fd, rt_channel_msg_t data)
  1843. {
  1844. return lwp_channel_send(FDT_TYPE_LWP, fd, data);
  1845. }
  1846. 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)
  1847. {
  1848. return lwp_channel_send_recv_timeout(FDT_TYPE_LWP, fd, data, data_ret, time);
  1849. }
  1850. rt_err_t sys_channel_reply(int fd, rt_channel_msg_t data)
  1851. {
  1852. return lwp_channel_reply(FDT_TYPE_LWP, fd, data);
  1853. }
  1854. rt_err_t sys_channel_recv_timeout(int fd, rt_channel_msg_t data, rt_int32_t time)
  1855. {
  1856. return lwp_channel_recv_timeout(FDT_TYPE_LWP, fd, data, time);
  1857. }
  1858. /*****/
  1859. static struct rt_semaphore critical_lock;
  1860. static int critical_init(void)
  1861. {
  1862. rt_sem_init(&critical_lock, "ct_lock", 1, RT_IPC_FLAG_FIFO);
  1863. return 0;
  1864. }
  1865. INIT_DEVICE_EXPORT(critical_init);
  1866. void sys_enter_critical(void)
  1867. {
  1868. rt_sem_take(&critical_lock, RT_WAITING_FOREVER);
  1869. }
  1870. void sys_exit_critical(void)
  1871. {
  1872. rt_sem_release(&critical_lock);
  1873. }
  1874. /* syscall: "sys_log" ret: "int" args: "const char*" "size" */
  1875. static int __sys_log_enable = 0;
  1876. static int sys_log_enable(int argc, char** argv)
  1877. {
  1878. if (argc == 1)
  1879. {
  1880. rt_kprintf("sys_log = %d\n", __sys_log_enable);
  1881. return 0;
  1882. }
  1883. else
  1884. {
  1885. __sys_log_enable = atoi(argv[1]);
  1886. }
  1887. return 0;
  1888. }
  1889. MSH_CMD_EXPORT_ALIAS(sys_log_enable, sys_log, sys_log 1(enable)/0(disable));
  1890. int sys_log(const char* log, int size)
  1891. {
  1892. rt_device_t console = rt_console_get_device();
  1893. if (console && __sys_log_enable)
  1894. {
  1895. rt_device_write(console, -1, log, size);
  1896. }
  1897. return 0;
  1898. }
  1899. int sys_stat(const char *file, struct stat *buf)
  1900. {
  1901. return stat(file, buf);
  1902. }
  1903. int sys_notimpl(void)
  1904. {
  1905. rt_set_errno(ENOSYS);
  1906. return -ENOSYS;
  1907. }
  1908. uint32_t sys_hw_interrupt_disable(void)
  1909. {
  1910. return rt_hw_interrupt_disable();
  1911. }
  1912. void sys_hw_interrupt_enable(uint32_t level)
  1913. {
  1914. rt_hw_interrupt_enable(level);
  1915. }
  1916. #ifdef RT_USING_USERSPACE
  1917. int sys_shmget(size_t key, size_t size, int create)
  1918. {
  1919. return lwp_shmget(key, size, create);
  1920. }
  1921. int sys_shmrm(int id)
  1922. {
  1923. return lwp_shmrm(id);
  1924. }
  1925. void* sys_shmat(int id, void* shm_vaddr)
  1926. {
  1927. return lwp_shmat(id, shm_vaddr);
  1928. }
  1929. int sys_shmdt(void* shm_vaddr)
  1930. {
  1931. return lwp_shmdt(shm_vaddr);
  1932. }
  1933. #endif
  1934. /* device interfaces */
  1935. rt_err_t sys_device_init(rt_device_t dev)
  1936. {
  1937. return rt_device_init(dev);
  1938. }
  1939. rt_err_t sys_device_register(rt_device_t dev, const char *name, rt_uint16_t flags)
  1940. {
  1941. return rt_device_register(dev, name, flags);
  1942. }
  1943. rt_err_t sys_device_control(rt_device_t dev, int cmd, void *arg)
  1944. {
  1945. return rt_device_control(dev, cmd, arg);
  1946. }
  1947. rt_device_t sys_device_find(const char* name)
  1948. {
  1949. return rt_device_find(name);
  1950. }
  1951. rt_err_t sys_device_open(rt_device_t dev, rt_uint16_t oflag)
  1952. {
  1953. return rt_device_open(dev, oflag);
  1954. }
  1955. rt_err_t sys_device_close(rt_device_t dev)
  1956. {
  1957. return rt_device_close(dev);
  1958. }
  1959. rt_size_t sys_device_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
  1960. {
  1961. return rt_device_read(dev, pos, buffer, size);
  1962. }
  1963. rt_size_t sys_device_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
  1964. {
  1965. return rt_device_write(dev, pos, buffer, size);
  1966. }
  1967. #ifdef RT_USING_SAL
  1968. /* network interfaces */
  1969. int sys_accept(int socket, struct musl_sockaddr *addr, socklen_t *addrlen)
  1970. {
  1971. int ret = -1;
  1972. struct sockaddr ksa;
  1973. struct musl_sockaddr kmusladdr;
  1974. socklen_t uaddrlen;
  1975. socklen_t kaddrlen;
  1976. if (addr)
  1977. {
  1978. if (!lwp_user_accessable(addrlen, sizeof (socklen_t *)))
  1979. {
  1980. rt_set_errno(EFAULT);
  1981. return -1;
  1982. }
  1983. lwp_get_from_user(&uaddrlen, addrlen, sizeof (socklen_t *));
  1984. if (!uaddrlen)
  1985. {
  1986. rt_set_errno(EINVAL);
  1987. return -1;
  1988. }
  1989. if (!lwp_user_accessable(addr, uaddrlen))
  1990. {
  1991. rt_set_errno(EFAULT);
  1992. return -1;
  1993. }
  1994. }
  1995. kaddrlen = sizeof(struct sockaddr);
  1996. ret = accept(socket, &ksa, &kaddrlen);
  1997. if (ret >= 0)
  1998. {
  1999. if (addr)
  2000. {
  2001. sockaddr_tomusl(&ksa, &kmusladdr);
  2002. if (uaddrlen > sizeof(struct musl_sockaddr))
  2003. {
  2004. uaddrlen = sizeof(struct musl_sockaddr);
  2005. }
  2006. lwp_put_to_user(addr, &kmusladdr, uaddrlen);
  2007. lwp_put_to_user(addrlen, &uaddrlen, sizeof (socklen_t *));
  2008. }
  2009. }
  2010. return ret;
  2011. }
  2012. int sys_bind(int socket, const struct musl_sockaddr *name, socklen_t namelen)
  2013. {
  2014. struct sockaddr sa;
  2015. struct musl_sockaddr kname;
  2016. if (!lwp_user_accessable((void *)name, namelen))
  2017. {
  2018. rt_set_errno(EFAULT);
  2019. return -1;
  2020. }
  2021. lwp_get_from_user(&kname, (void *)name, namelen);
  2022. sockaddr_tolwip(&kname, &sa);
  2023. return bind(socket, &sa, namelen);
  2024. }
  2025. int sys_shutdown(int socket, int how)
  2026. {
  2027. return shutdown(socket, how);
  2028. }
  2029. int sys_getpeername (int socket, struct musl_sockaddr *name, socklen_t *namelen)
  2030. {
  2031. int ret = -1;
  2032. struct sockaddr sa;
  2033. struct musl_sockaddr kname;
  2034. socklen_t unamelen;
  2035. socklen_t knamelen;
  2036. if (!lwp_user_accessable(namelen, sizeof (socklen_t *)))
  2037. {
  2038. rt_set_errno(EFAULT);
  2039. return -1;
  2040. }
  2041. lwp_get_from_user(&unamelen, namelen, sizeof (socklen_t *));
  2042. if (!unamelen)
  2043. {
  2044. rt_set_errno(EINVAL);
  2045. return -1;
  2046. }
  2047. if (!lwp_user_accessable(name, unamelen))
  2048. {
  2049. rt_set_errno(EFAULT);
  2050. return -1;
  2051. }
  2052. knamelen = sizeof(struct sockaddr);
  2053. ret = getpeername(socket, &sa, &knamelen);
  2054. if (ret == 0)
  2055. {
  2056. sockaddr_tomusl(&sa, &kname);
  2057. if (unamelen > sizeof(struct musl_sockaddr))
  2058. {
  2059. unamelen = sizeof(struct musl_sockaddr);
  2060. }
  2061. lwp_put_to_user(name, &kname, unamelen);
  2062. lwp_put_to_user(namelen, &unamelen, sizeof (socklen_t *));
  2063. }
  2064. return ret;
  2065. }
  2066. int sys_getsockname (int socket, struct musl_sockaddr *name, socklen_t *namelen)
  2067. {
  2068. int ret = -1;
  2069. struct sockaddr sa;
  2070. struct musl_sockaddr kname;
  2071. socklen_t unamelen;
  2072. socklen_t knamelen;
  2073. if (!lwp_user_accessable(namelen, sizeof (socklen_t *)))
  2074. {
  2075. rt_set_errno(EFAULT);
  2076. return -1;
  2077. }
  2078. lwp_get_from_user(&unamelen, namelen, sizeof (socklen_t *));
  2079. if (!unamelen)
  2080. {
  2081. rt_set_errno(EINVAL);
  2082. return -1;
  2083. }
  2084. if (!lwp_user_accessable(name, unamelen))
  2085. {
  2086. rt_set_errno(EFAULT);
  2087. return -1;
  2088. }
  2089. knamelen = sizeof(struct sockaddr);
  2090. ret = getsockname(socket, &sa, &knamelen);
  2091. if (ret == 0)
  2092. {
  2093. sockaddr_tomusl(&sa, &kname);
  2094. if (unamelen > sizeof(struct musl_sockaddr))
  2095. {
  2096. unamelen = sizeof(struct musl_sockaddr);
  2097. }
  2098. lwp_put_to_user(name, &kname, unamelen);
  2099. lwp_put_to_user(namelen, &unamelen, sizeof(socklen_t *));
  2100. }
  2101. return ret;
  2102. }
  2103. int sys_getsockopt(int socket, int level, int optname, void *optval, socklen_t *optlen)
  2104. {
  2105. convert_sockopt(&level, &optname);
  2106. return getsockopt(socket, level, optname, optval, optlen);
  2107. }
  2108. int sys_setsockopt(int socket, int level, int optname, const void *optval, socklen_t optlen)
  2109. {
  2110. convert_sockopt(&level, &optname);
  2111. return setsockopt(socket, level, optname, optval, optlen);
  2112. }
  2113. int sys_connect(int socket, const struct musl_sockaddr *name, socklen_t namelen)
  2114. {
  2115. struct sockaddr sa;
  2116. struct musl_sockaddr kname;
  2117. if (!lwp_user_accessable((void *)name, namelen))
  2118. {
  2119. rt_set_errno(EFAULT);
  2120. return -1;
  2121. }
  2122. lwp_get_from_user(&kname, (void *)name, namelen);
  2123. sockaddr_tolwip(&kname, &sa);
  2124. return connect(socket, &sa, namelen);
  2125. }
  2126. int sys_listen(int socket, int backlog)
  2127. {
  2128. return listen(socket, backlog);
  2129. }
  2130. #define MUSLC_MSG_OOB 0x0001
  2131. #define MUSLC_MSG_PEEK 0x0002
  2132. #define MUSLC_MSG_DONTWAIT 0x0040
  2133. #define MUSLC_MSG_WAITALL 0x0100
  2134. #define MUSLC_MSG_MORE 0x8000
  2135. static int netflags_muslc_2_lwip(int flags)
  2136. {
  2137. int flgs = 0;
  2138. if (flags & MUSLC_MSG_PEEK)
  2139. {
  2140. flgs |= MSG_PEEK;
  2141. }
  2142. if (flags & MUSLC_MSG_WAITALL)
  2143. {
  2144. flgs |= MSG_WAITALL;
  2145. }
  2146. if (flags & MUSLC_MSG_OOB)
  2147. {
  2148. flgs |= MSG_OOB;
  2149. }
  2150. if (flags & MUSLC_MSG_DONTWAIT)
  2151. {
  2152. flgs |= MSG_DONTWAIT;
  2153. }
  2154. if (flags & MUSLC_MSG_MORE)
  2155. {
  2156. flgs |= MSG_MORE;
  2157. }
  2158. return flgs;
  2159. }
  2160. int sys_recvfrom(int socket, void *mem, size_t len, int flags,
  2161. struct musl_sockaddr *from, socklen_t *fromlen)
  2162. {
  2163. int flgs = 0;
  2164. #ifdef RT_USING_USERSPACE
  2165. int ret = -1;
  2166. void *kmem = RT_NULL;
  2167. #endif
  2168. flgs = netflags_muslc_2_lwip(flags);
  2169. #ifdef RT_USING_USERSPACE
  2170. if (!len)
  2171. {
  2172. rt_set_errno(EINVAL);
  2173. return -1;
  2174. }
  2175. if (!lwp_user_accessable((void *)mem, len))
  2176. {
  2177. rt_set_errno(EFAULT);
  2178. return -1;
  2179. }
  2180. kmem = kmem_get(len);
  2181. if (!kmem)
  2182. {
  2183. rt_set_errno(ENOMEM);
  2184. return -1;
  2185. }
  2186. if (flags == 0x2)
  2187. {
  2188. flags = 0x1;
  2189. }
  2190. if (from)
  2191. {
  2192. struct sockaddr sa;
  2193. ret = recvfrom(socket, kmem, len, flgs, &sa, fromlen);
  2194. sockaddr_tomusl(&sa, from);
  2195. }
  2196. else
  2197. {
  2198. ret = recvfrom(socket, kmem, len, flgs, NULL, NULL);
  2199. }
  2200. if (ret > 0)
  2201. {
  2202. lwp_put_to_user(mem, kmem, len);
  2203. }
  2204. kmem_put(kmem);
  2205. return ret;
  2206. #else
  2207. if (from)
  2208. {
  2209. int ret = -1;
  2210. struct sockaddr sa = {0};
  2211. ret = recvfrom(socket, mem, len, flgs, &sa, fromlen);
  2212. sockaddr_tomusl(&sa, from);
  2213. return ret;
  2214. }
  2215. return recvfrom(socket, mem, len, flags, NULL, NULL);
  2216. #endif
  2217. }
  2218. int sys_recv(int socket, void *mem, size_t len, int flags)
  2219. {
  2220. int flgs = 0;
  2221. flgs = netflags_muslc_2_lwip(flags);
  2222. return recvfrom(socket, mem, len, flgs, NULL, NULL);
  2223. }
  2224. int sys_sendto(int socket, const void *dataptr, size_t size, int flags,
  2225. const struct musl_sockaddr *to, socklen_t tolen)
  2226. {
  2227. int flgs = 0;
  2228. #ifdef RT_USING_USERSPACE
  2229. int ret = -1;
  2230. void *kmem = RT_NULL;
  2231. #endif
  2232. flgs = netflags_muslc_2_lwip(flags);
  2233. #ifdef RT_USING_USERSPACE
  2234. if (!size)
  2235. {
  2236. rt_set_errno(EINVAL);
  2237. return -1;
  2238. }
  2239. if (!lwp_user_accessable((void *)dataptr, size))
  2240. {
  2241. rt_set_errno(EFAULT);
  2242. return -1;
  2243. }
  2244. kmem = kmem_get(size);
  2245. if (!kmem)
  2246. {
  2247. rt_set_errno(ENOMEM);
  2248. return -1;
  2249. }
  2250. lwp_get_from_user(kmem, (void *)dataptr, size);
  2251. if (to)
  2252. {
  2253. struct sockaddr sa;
  2254. sockaddr_tolwip(to, &sa);
  2255. ret = sendto(socket, kmem, size, flgs, &sa, tolen);
  2256. }
  2257. else
  2258. {
  2259. ret = sendto(socket, kmem, size, flgs, NULL, tolen);
  2260. }
  2261. kmem_put(kmem);
  2262. return ret;
  2263. #else
  2264. if (to)
  2265. {
  2266. struct sockaddr sa;
  2267. sockaddr_tolwip(to, &sa);
  2268. return sendto(socket, dataptr, size, flgs, &sa, tolen);
  2269. }
  2270. return sendto(socket, dataptr, size, flgs, NULL, tolen);
  2271. #endif
  2272. }
  2273. int sys_send(int socket, const void *dataptr, size_t size, int flags)
  2274. {
  2275. int flgs = 0;
  2276. flgs = netflags_muslc_2_lwip(flags);
  2277. return sendto(socket, dataptr, size, flgs, NULL, 0);
  2278. }
  2279. int sys_socket(int domain, int type, int protocol)
  2280. {
  2281. int fd = -1;
  2282. int nonblock = 0;
  2283. /* not support SOCK_CLOEXEC type */
  2284. if (type & SOCK_CLOEXEC)
  2285. {
  2286. type &= ~SOCK_CLOEXEC;
  2287. }
  2288. if (type & SOCK_NONBLOCK)
  2289. {
  2290. nonblock = 1;
  2291. type &= ~SOCK_NONBLOCK;
  2292. }
  2293. fd = socket(domain, type, protocol);
  2294. if (fd < 0)
  2295. {
  2296. goto out;
  2297. }
  2298. if (nonblock)
  2299. {
  2300. fcntl(fd, F_SETFL, O_NONBLOCK);
  2301. }
  2302. out:
  2303. return fd;
  2304. }
  2305. int sys_closesocket(int socket)
  2306. {
  2307. return closesocket(socket);
  2308. }
  2309. #endif
  2310. rt_thread_t sys_thread_find(char *name)
  2311. {
  2312. return rt_thread_find(name);
  2313. }
  2314. rt_tick_t sys_tick_get(void)
  2315. {
  2316. return rt_tick_get();
  2317. }
  2318. rt_err_t sys_thread_mdelay(rt_int32_t ms)
  2319. {
  2320. return rt_thread_mdelay(ms);
  2321. }
  2322. struct k_sigaction {
  2323. void (*handler)(int);
  2324. unsigned long flags;
  2325. void (*restorer)(void);
  2326. unsigned mask[2];
  2327. };
  2328. int sys_sigaction(int sig, const struct k_sigaction *act,
  2329. struct k_sigaction *oact, size_t sigsetsize)
  2330. {
  2331. int ret = -RT_EINVAL;
  2332. struct lwp_sigaction kact, *pkact = RT_NULL;
  2333. struct lwp_sigaction koact, *pkoact = RT_NULL;
  2334. if (!sigsetsize)
  2335. {
  2336. rt_set_errno(EINVAL);
  2337. goto out;
  2338. }
  2339. if (sigsetsize > sizeof(lwp_sigset_t))
  2340. {
  2341. sigsetsize = sizeof(lwp_sigset_t);
  2342. }
  2343. if (!act && !oact)
  2344. {
  2345. rt_set_errno(EINVAL);
  2346. goto out;
  2347. }
  2348. if (oact)
  2349. {
  2350. if (!lwp_user_accessable((void *)oact, sizeof(*oact)))
  2351. {
  2352. rt_set_errno(EFAULT);
  2353. goto out;
  2354. }
  2355. pkoact = &koact;
  2356. }
  2357. if (act)
  2358. {
  2359. if (!lwp_user_accessable((void *)act, sizeof(*act)))
  2360. {
  2361. rt_set_errno(EFAULT);
  2362. goto out;
  2363. }
  2364. kact.sa_flags = act->flags;
  2365. kact.__sa_handler._sa_handler = act->handler;
  2366. memcpy(&kact.sa_mask, &act->mask, sigsetsize);
  2367. kact.sa_restorer = act->restorer;
  2368. pkact = &kact;
  2369. }
  2370. ret = lwp_sigaction(sig, pkact, pkoact, sigsetsize);
  2371. if (ret == 0 && oact)
  2372. {
  2373. lwp_put_to_user(&oact->handler, &pkoact->__sa_handler._sa_handler, sizeof(void (*)(int)));
  2374. lwp_put_to_user(&oact->mask, &pkoact->sa_mask, sigsetsize);
  2375. lwp_put_to_user(&oact->flags, &pkoact->sa_flags, sizeof(int));
  2376. lwp_put_to_user(&oact->restorer, &pkoact->sa_restorer, sizeof(void (*)(void)));
  2377. }
  2378. out:
  2379. return ret;
  2380. }
  2381. int sys_sigprocmask(int how, const sigset_t *sigset, sigset_t *oset, size_t size)
  2382. {
  2383. int ret = -1;
  2384. lwp_sigset_t newset, *pnewset = RT_NULL;
  2385. lwp_sigset_t oldset, *poldset = RT_NULL;
  2386. if (!size)
  2387. {
  2388. rt_set_errno(EINVAL);
  2389. return ret;
  2390. }
  2391. if (!oset && !sigset)
  2392. {
  2393. rt_set_errno(EINVAL);
  2394. return ret;
  2395. }
  2396. if (size > sizeof(lwp_sigset_t))
  2397. {
  2398. size = sizeof(lwp_sigset_t);
  2399. }
  2400. if (oset)
  2401. {
  2402. if (!lwp_user_accessable((void *)oset, size))
  2403. {
  2404. rt_set_errno(EFAULT);
  2405. return ret;
  2406. }
  2407. poldset = &oldset;
  2408. }
  2409. if (sigset)
  2410. {
  2411. if (!lwp_user_accessable((void *)sigset, size))
  2412. {
  2413. rt_set_errno(EFAULT);
  2414. return ret;
  2415. }
  2416. lwp_get_from_user(&newset, (void *)sigset, size);
  2417. pnewset = &newset;
  2418. }
  2419. ret = lwp_sigprocmask(how, pnewset, poldset);
  2420. if (ret < 0)
  2421. {
  2422. return ret;
  2423. }
  2424. if (oset)
  2425. {
  2426. lwp_put_to_user(oset, poldset, size);
  2427. }
  2428. return ret;
  2429. }
  2430. int sys_tkill(int tid, int sig)
  2431. {
  2432. rt_base_t level;
  2433. rt_thread_t thread;
  2434. int ret;
  2435. level = rt_hw_interrupt_disable();
  2436. thread = lwp_tid_get_thread(tid);
  2437. ret = lwp_thread_kill(thread, sig);
  2438. rt_hw_interrupt_enable(level);
  2439. return ret;
  2440. }
  2441. int sys_thread_sigprocmask(int how, const lwp_sigset_t *sigset, lwp_sigset_t *oset, size_t size)
  2442. {
  2443. int ret = -1;
  2444. lwp_sigset_t newset, *pnewset = RT_NULL;
  2445. lwp_sigset_t oldset, *poldset = RT_NULL;
  2446. if (!size)
  2447. {
  2448. rt_set_errno(EINVAL);
  2449. return ret;
  2450. }
  2451. if (!oset && !sigset)
  2452. {
  2453. rt_set_errno(EINVAL);
  2454. return ret;
  2455. }
  2456. if (size != sizeof(lwp_sigset_t))
  2457. {
  2458. rt_set_errno(EINVAL);
  2459. return ret;
  2460. }
  2461. if (oset)
  2462. {
  2463. #ifdef RT_USING_USERSPACE
  2464. if (!lwp_user_accessable((void *)oset, size))
  2465. {
  2466. rt_set_errno(EFAULT);
  2467. return ret;
  2468. }
  2469. poldset = &oldset;
  2470. #else
  2471. poldset = oset;
  2472. #endif
  2473. }
  2474. if (sigset)
  2475. {
  2476. #ifdef RT_USING_USERSPACE
  2477. if (!lwp_user_accessable((void *)sigset, size))
  2478. {
  2479. rt_set_errno(EFAULT);
  2480. return ret;
  2481. }
  2482. lwp_get_from_user(&newset, (void *)sigset, sizeof(lwp_sigset_t));
  2483. pnewset = &newset;
  2484. #else
  2485. pnewset = sigset;
  2486. #endif
  2487. }
  2488. ret = lwp_thread_sigprocmask(how, pnewset, poldset);
  2489. if (ret < 0)
  2490. {
  2491. return ret;
  2492. }
  2493. #ifdef RT_USING_USERSPACE
  2494. if (oset)
  2495. {
  2496. lwp_put_to_user(oset, poldset, sizeof(lwp_sigset_t));
  2497. }
  2498. #endif
  2499. return ret;
  2500. }
  2501. int32_t sys_waitpid(int32_t pid, int *status, int options)
  2502. {
  2503. int ret = -1;
  2504. #ifdef RT_USING_USERSPACE
  2505. if (!lwp_user_accessable((void *)status, sizeof(int)))
  2506. {
  2507. rt_set_errno(EFAULT);
  2508. ret = -1;
  2509. }
  2510. else
  2511. {
  2512. ret = waitpid(pid, status, options);
  2513. }
  2514. #else
  2515. ret = waitpid(pid, status, options);
  2516. #endif
  2517. return ret;
  2518. }
  2519. #if defined(RT_USING_SAL) && defined(SAL_USING_POSIX)
  2520. struct musl_addrinfo
  2521. {
  2522. int ai_flags;
  2523. int ai_family;
  2524. int ai_socktype;
  2525. int ai_protocol;
  2526. socklen_t ai_addrlen;
  2527. struct musl_sockaddr *ai_addr;
  2528. char *ai_canonname;
  2529. struct musl_addrinfo *ai_next;
  2530. };
  2531. int sys_getaddrinfo(const char *nodename,
  2532. const char *servname,
  2533. const struct musl_addrinfo *hints,
  2534. struct musl_addrinfo *res)
  2535. {
  2536. int ret = -1;
  2537. struct addrinfo *k_res = NULL;
  2538. char *k_nodename = NULL;
  2539. char *k_servname = NULL;
  2540. struct addrinfo *k_hints = NULL;
  2541. #ifdef RT_USING_USERSPACE
  2542. int err;
  2543. #endif
  2544. #ifdef RT_USING_USERSPACE
  2545. if (!lwp_user_accessable((void *)res, sizeof(*res)))
  2546. {
  2547. rt_set_errno(EFAULT);
  2548. goto exit;
  2549. }
  2550. #endif
  2551. if (nodename)
  2552. {
  2553. #ifdef RT_USING_USERSPACE
  2554. lwp_user_strlen(nodename, &err);
  2555. if (err)
  2556. {
  2557. rt_set_errno(EFAULT);
  2558. goto exit;
  2559. }
  2560. #endif
  2561. k_nodename = rt_strdup(nodename);
  2562. if (!k_nodename)
  2563. {
  2564. rt_set_errno(ENOMEM);
  2565. goto exit;
  2566. }
  2567. }
  2568. if (servname)
  2569. {
  2570. #ifdef RT_USING_USERSPACE
  2571. lwp_user_strlen(servname, &err);
  2572. if (err)
  2573. {
  2574. rt_set_errno(EFAULT);
  2575. goto exit;
  2576. }
  2577. #endif
  2578. k_servname = rt_strdup(servname);
  2579. if (!k_servname)
  2580. {
  2581. rt_set_errno(ENOMEM);
  2582. goto exit;
  2583. }
  2584. }
  2585. if (hints)
  2586. {
  2587. #ifdef RT_USING_USERSPACE
  2588. if (!lwp_user_accessable((void *)hints, sizeof(*hints)))
  2589. {
  2590. rt_set_errno(EFAULT);
  2591. goto exit;
  2592. }
  2593. #endif
  2594. k_hints = (struct addrinfo *) rt_malloc(sizeof *hints);
  2595. if (!k_hints)
  2596. {
  2597. rt_set_errno(ENOMEM);
  2598. goto exit;
  2599. }
  2600. rt_memset(k_hints, 0x0, sizeof(struct addrinfo));
  2601. k_hints->ai_flags = hints->ai_flags;
  2602. k_hints->ai_family = hints->ai_family;
  2603. k_hints->ai_socktype = hints->ai_socktype;
  2604. k_hints->ai_protocol = hints->ai_protocol;
  2605. k_hints->ai_addrlen = hints->ai_addrlen;
  2606. }
  2607. ret = sal_getaddrinfo(k_nodename, k_servname, k_hints, &k_res);
  2608. if (ret == 0)
  2609. {
  2610. /* set sockaddr */
  2611. sockaddr_tomusl(k_res->ai_addr, res->ai_addr);
  2612. res->ai_addrlen = k_res->ai_addrlen;
  2613. /* set up addrinfo */
  2614. res->ai_family = k_res->ai_family;
  2615. res->ai_flags = k_res->ai_flags;
  2616. res->ai_next = NULL;
  2617. if (hints != NULL)
  2618. {
  2619. /* copy socktype & protocol from hints if specified */
  2620. res->ai_socktype = hints->ai_socktype;
  2621. res->ai_protocol = hints->ai_protocol;
  2622. }
  2623. sal_freeaddrinfo(k_res);
  2624. k_res = NULL;
  2625. }
  2626. exit:
  2627. if (k_nodename)
  2628. {
  2629. rt_free(k_nodename);
  2630. }
  2631. if (k_servname)
  2632. {
  2633. rt_free(k_servname);
  2634. }
  2635. if (k_hints)
  2636. {
  2637. rt_free(k_hints);
  2638. }
  2639. return ret;
  2640. }
  2641. #define HOSTENT_BUFSZ 512
  2642. int sys_gethostbyname2_r(const char *name, int af, struct hostent *ret,
  2643. char *buf, size_t buflen,
  2644. struct hostent **result, int *err)
  2645. {
  2646. int ret_val = -1;
  2647. int sal_ret = -1 , sal_err = -1;
  2648. struct hostent sal_he;
  2649. struct hostent *sal_result = NULL;
  2650. char *sal_buf = NULL;
  2651. char *k_name = NULL;
  2652. int a_err = 0;
  2653. #ifdef RT_USING_USERSPACE
  2654. if (!lwp_user_accessable((void *)err, sizeof(*err)))
  2655. {
  2656. rt_set_errno(EFAULT);
  2657. goto __exit;
  2658. }
  2659. if (!lwp_user_accessable((void *)result, sizeof(*result))
  2660. || !lwp_user_accessable((void *)ret, sizeof(*ret))
  2661. || !lwp_user_accessable((void *)buf, buflen))
  2662. {
  2663. /* not all arguments given */
  2664. *err = EFAULT;
  2665. rt_set_errno(EFAULT);
  2666. goto __exit;
  2667. }
  2668. lwp_user_strlen(name, &a_err);
  2669. if (a_err)
  2670. {
  2671. *err = EFAULT;
  2672. rt_set_errno(EFAULT);
  2673. goto __exit;
  2674. }
  2675. #endif
  2676. *result = ret;
  2677. sal_buf = (char *)malloc(HOSTENT_BUFSZ);
  2678. if (sal_buf == NULL)
  2679. {
  2680. rt_set_errno(ENOMEM);
  2681. goto __exit;
  2682. }
  2683. k_name = rt_strdup(name);
  2684. if (k_name == NULL)
  2685. {
  2686. rt_set_errno(ENOMEM);
  2687. goto __exit;
  2688. }
  2689. /* get host by name in SAL */
  2690. sal_ret = sal_gethostbyname_r(k_name, &sal_he, sal_buf, HOSTENT_BUFSZ, &sal_result, &sal_err);
  2691. if (sal_ret == 0)
  2692. {
  2693. int index = 0, cnt = 0;
  2694. char *ptr = buf;
  2695. /* get counter */
  2696. index = 0;
  2697. while (sal_he.h_addr_list[index] != NULL)
  2698. {
  2699. index++;
  2700. }
  2701. cnt = index + 1;
  2702. /* update user space hostent */
  2703. ret->h_addrtype = sal_he.h_addrtype;
  2704. ret->h_length = sal_he.h_length;
  2705. rt_strncpy(ptr, k_name, buflen - (ptr - buf));
  2706. ret->h_name = ptr;
  2707. ptr += rt_strlen(k_name);
  2708. ret->h_addr_list = (char**)ptr;
  2709. ptr += cnt * sizeof(char *);
  2710. index = 0;
  2711. while (sal_he.h_addr_list[index] != NULL)
  2712. {
  2713. ret->h_addr_list[index] = ptr;
  2714. rt_memcpy(ptr, sal_he.h_addr_list[index], sal_he.h_length);
  2715. ptr += sal_he.h_length;
  2716. index++;
  2717. }
  2718. ret->h_addr_list[index] = NULL;
  2719. }
  2720. ret_val = 0;
  2721. __exit:
  2722. /* release buffer */
  2723. if (sal_buf)
  2724. {
  2725. free(sal_buf);
  2726. }
  2727. if (k_name)
  2728. {
  2729. free(k_name);
  2730. }
  2731. return ret_val;
  2732. }
  2733. #endif
  2734. char *sys_getcwd(char *buf, size_t size)
  2735. {
  2736. #ifdef RT_USING_USERSPACE
  2737. if (!lwp_user_accessable((void *)buf, size))
  2738. {
  2739. rt_set_errno(EFAULT);
  2740. return RT_NULL;
  2741. }
  2742. #endif
  2743. return getcwd(buf, size);
  2744. }
  2745. int sys_chdir(const char *path)
  2746. {
  2747. #ifdef RT_USING_USERSPACE
  2748. int err = 0;
  2749. lwp_user_strlen(path, &err);
  2750. if (err)
  2751. {
  2752. rt_set_errno(EFAULT);
  2753. return -1;
  2754. }
  2755. #endif
  2756. return chdir(path);
  2757. }
  2758. int sys_mkdir(const char *path, mode_t mode)
  2759. {
  2760. #ifdef RT_USING_USERSPACE
  2761. int err = 0;
  2762. lwp_user_strlen(path, &err);
  2763. if (err)
  2764. {
  2765. rt_set_errno(EFAULT);
  2766. return -1;
  2767. }
  2768. #endif
  2769. return mkdir(path, mode);
  2770. }
  2771. int sys_rmdir(const char *path)
  2772. {
  2773. #ifdef RT_USING_USERSPACE
  2774. int err = 0;
  2775. lwp_user_strlen(path, &err);
  2776. if (err)
  2777. {
  2778. rt_set_errno(EFAULT);
  2779. return -1;
  2780. }
  2781. #endif
  2782. return unlink(path);
  2783. }
  2784. typedef uint64_t ino_t;
  2785. struct libc_dirent {
  2786. ino_t d_ino;
  2787. off_t d_off;
  2788. unsigned short d_reclen;
  2789. unsigned char d_type;
  2790. char d_name[256];
  2791. };
  2792. int sys_getdents(int fd, struct libc_dirent *dirp, size_t nbytes)
  2793. {
  2794. int ret = -1;
  2795. struct dfs_fd *dfs_fd;
  2796. size_t cnt = (nbytes / sizeof(struct libc_dirent));
  2797. size_t rtt_nbytes = 0;
  2798. struct dirent *rtt_dirp;
  2799. #ifdef RT_USING_USERSPACE
  2800. if (!lwp_user_accessable((void *)dirp, sizeof(struct libc_dirent)))
  2801. {
  2802. rt_set_errno(EFAULT);
  2803. return -1;
  2804. }
  2805. #endif
  2806. if (cnt == 0)
  2807. {
  2808. rt_set_errno(EINVAL);
  2809. return -1;
  2810. }
  2811. rtt_nbytes = cnt * sizeof(struct dirent);
  2812. rtt_dirp = (struct dirent *)rt_malloc(rtt_nbytes);
  2813. if (!rtt_dirp)
  2814. {
  2815. rt_set_errno(ENOMEM);
  2816. return -1;
  2817. }
  2818. dfs_fd = fd_get(fd);
  2819. ret = dfs_file_getdents(dfs_fd, rtt_dirp, nbytes);
  2820. if (ret)
  2821. {
  2822. size_t i = 0;
  2823. cnt = ret / sizeof(struct dirent);
  2824. for (i = 0; i < cnt; i++)
  2825. {
  2826. dirp[i].d_ino = 0;
  2827. dirp[i].d_off = i*sizeof(struct libc_dirent);
  2828. dirp[i].d_type = rtt_dirp[i].d_type;
  2829. dirp[i].d_reclen = sizeof(struct libc_dirent);
  2830. strcpy(dirp[i].d_name, rtt_dirp[i].d_name);
  2831. }
  2832. ret = cnt * sizeof(struct libc_dirent);
  2833. }
  2834. rt_free(rtt_dirp);
  2835. return ret;
  2836. }
  2837. rt_err_t sys_get_errno(void)
  2838. {
  2839. return rt_get_errno();
  2840. }
  2841. int sys_set_thread_area(void *p)
  2842. {
  2843. rt_thread_t thread;
  2844. thread = rt_thread_self();
  2845. thread->thread_idr = p;
  2846. lwp_set_thread_area(p);
  2847. return 0;
  2848. }
  2849. int sys_set_tid_address(int *tidptr)
  2850. {
  2851. rt_thread_t thread;
  2852. #ifdef RT_USING_USERSPACE
  2853. if (!lwp_user_accessable((void *)tidptr, sizeof(int)))
  2854. {
  2855. rt_set_errno(EFAULT);
  2856. return -1;
  2857. }
  2858. #endif
  2859. thread = rt_thread_self();
  2860. thread->clear_child_tid = tidptr;
  2861. return thread->tid;
  2862. }
  2863. int sys_gettid(void)
  2864. {
  2865. return rt_thread_self()->tid;
  2866. }
  2867. int sys_access(const char *filename, int mode)
  2868. {
  2869. int ret = 0;
  2870. #ifdef RT_USING_USERSPACE
  2871. rt_size_t len = 0;
  2872. char *kname = RT_NULL;
  2873. int a_err = 0;
  2874. lwp_user_strlen(filename, &a_err);
  2875. if (a_err)
  2876. {
  2877. rt_set_errno(EFAULT);
  2878. ret = -1;
  2879. }
  2880. kname = (char *)kmem_get(len + 1);
  2881. if (!ret && !kname)
  2882. {
  2883. rt_set_errno(ENOMEM);
  2884. ret = -1;
  2885. }
  2886. if (!ret)
  2887. {
  2888. lwp_get_from_user(kname, (void *)filename, len + 1);
  2889. ret = access(kname, mode);
  2890. kmem_put(kname);
  2891. }
  2892. #else
  2893. ret = access(filename, mode);
  2894. #endif
  2895. return (ret >= 0) ? 0: ret;
  2896. }
  2897. int sys_pipe(int fd[2])
  2898. {
  2899. if (!lwp_user_accessable((void *)fd, sizeof(int[2])))
  2900. {
  2901. rt_set_errno(EFAULT);
  2902. return -1;
  2903. }
  2904. return pipe(fd);
  2905. }
  2906. int sys_clock_settime(clockid_t clk, const struct timespec *ts)
  2907. {
  2908. rt_device_t device;
  2909. time_t now;
  2910. device = rt_device_find("rtc");
  2911. if (device == RT_NULL)
  2912. {
  2913. return -ENODEV;
  2914. }
  2915. #ifdef RT_USING_USERSPACE
  2916. size_t size = sizeof(struct timespec);
  2917. struct timespec *kts = NULL;
  2918. if (!lwp_user_accessable((void *)ts, size))
  2919. {
  2920. return -EFAULT;
  2921. }
  2922. kts = kmem_get(size);
  2923. if (!kts)
  2924. {
  2925. return -ENOMEM;
  2926. }
  2927. lwp_get_from_user(kts, (void *)ts, size);
  2928. now = kts->tv_sec;
  2929. kmem_put(kts);
  2930. #else
  2931. now = ts->tv_sec;
  2932. #endif
  2933. return rt_device_control(device, RT_DEVICE_CTRL_RTC_SET_TIME, &now);
  2934. }
  2935. int sys_clock_gettime(clockid_t clk, struct timespec *ts)
  2936. {
  2937. int ret = 0;
  2938. rt_device_t device;
  2939. time_t now;
  2940. device = rt_device_find("rtc");
  2941. if (device == RT_NULL)
  2942. {
  2943. return -ENODEV;
  2944. }
  2945. ret = rt_device_control(device, RT_DEVICE_CTRL_RTC_GET_TIME, &now);
  2946. #ifdef RT_USING_USERSPACE
  2947. size_t size = sizeof(struct timespec);
  2948. struct timespec *kts = NULL;
  2949. if (!lwp_user_accessable((void *)ts, size))
  2950. {
  2951. return -EFAULT;
  2952. }
  2953. kts = kmem_get(size);
  2954. if (!kts)
  2955. {
  2956. return -ENOMEM;
  2957. }
  2958. kts->tv_sec = now;
  2959. kts->tv_nsec = 0;
  2960. lwp_put_to_user(ts, kts, size);
  2961. kmem_put(kts);
  2962. #else
  2963. ts->tv_sec = now;
  2964. ts->tv_nsec = 0;
  2965. #endif
  2966. return ret;
  2967. }
  2968. int sys_clock_getres(clockid_t clk, struct timespec *ts)
  2969. {
  2970. #ifdef RT_USING_USERSPACE
  2971. struct timespec kts;
  2972. size_t size = sizeof(struct timespec);
  2973. if (!lwp_user_accessable((void *)ts, size))
  2974. {
  2975. return -EFAULT;
  2976. }
  2977. kts.tv_sec = 1;
  2978. kts.tv_nsec = 0;
  2979. lwp_put_to_user(ts, &kts, size);
  2980. #else
  2981. ts->tv_sec = 1;
  2982. ts->tv_nsec = 0;
  2983. #endif
  2984. return 0;
  2985. }
  2986. int sys_futex(int *uaddr, int op, int val, void *timeout, void *uaddr2, int val3);
  2987. int sys_pmutex(void *umutex, int op, void *arg);
  2988. int sys_dup(int oldfd);
  2989. int sys_dup2(int oldfd, int new);
  2990. int sys_rename(const char *oldpath, const char *newpath)
  2991. {
  2992. int ret = -1;
  2993. #ifdef RT_USING_USERSPACE
  2994. int err;
  2995. lwp_user_strlen(oldpath, &err);
  2996. if (err)
  2997. {
  2998. rt_set_errno(EFAULT);
  2999. return -1;
  3000. }
  3001. lwp_user_strlen(newpath, &err);
  3002. if (err)
  3003. {
  3004. rt_set_errno(EFAULT);
  3005. return -1;
  3006. }
  3007. #endif
  3008. ret = rename(oldpath, newpath);
  3009. return (ret >= 0) ? 0: ret;
  3010. }
  3011. typedef unsigned long long rlim_t;
  3012. struct rlimit {
  3013. rlim_t rlim_cur;
  3014. rlim_t rlim_max;
  3015. };
  3016. #define RLIMIT_CPU 0
  3017. #define RLIMIT_FSIZE 1
  3018. #define RLIMIT_DATA 2
  3019. #define RLIMIT_STACK 3
  3020. #define RLIMIT_CORE 4
  3021. #define RLIMIT_RSS 5
  3022. #define RLIMIT_NPROC 6
  3023. #define RLIMIT_NOFILE 7
  3024. #define RLIMIT_MEMLOCK 8
  3025. #define RLIMIT_AS 9
  3026. int sys_prlimit64(pid_t pid,
  3027. unsigned int resource,
  3028. const struct rlimit *new_rlim,
  3029. struct rlimit *old_rlim)
  3030. {
  3031. rt_set_errno(ENOSYS);
  3032. return -1;
  3033. }
  3034. int sys_getrlimit(unsigned int resource, unsigned long rlim[2])
  3035. {
  3036. int ret = -1;
  3037. if (!lwp_user_accessable((void *)rlim, sizeof(unsigned long [2])))
  3038. {
  3039. rt_set_errno(EFAULT);
  3040. return -1;
  3041. }
  3042. switch (resource)
  3043. {
  3044. case RLIMIT_NOFILE:
  3045. {
  3046. struct dfs_fdtable *fdt = dfs_fdtable_get();
  3047. dfs_fd_lock();
  3048. rlim[0] = fdt->maxfd;
  3049. dfs_fd_unlock();
  3050. rlim[1] = DFS_FD_MAX;
  3051. ret = 0;
  3052. }
  3053. break;
  3054. default:
  3055. rt_set_errno(EINVAL);
  3056. break;
  3057. }
  3058. return ret;
  3059. }
  3060. int sys_setrlimit(unsigned int resource, struct rlimit *rlim)
  3061. {
  3062. rt_set_errno(ENOSYS);
  3063. return -1;
  3064. }
  3065. const static void* func_table[] =
  3066. {
  3067. (void *)sys_exit, /* 01 */
  3068. (void *)sys_read,
  3069. (void *)sys_write,
  3070. (void *)sys_lseek,
  3071. (void *)sys_open, /* 05 */
  3072. (void *)sys_close,
  3073. (void *)sys_ioctl,
  3074. (void *)sys_fstat,
  3075. (void *)sys_poll,
  3076. (void *)sys_nanosleep, /* 10 */
  3077. (void *)sys_gettimeofday,
  3078. (void *)sys_settimeofday,
  3079. (void *)sys_exec,
  3080. (void *)sys_kill,
  3081. (void *)sys_getpid, /* 15 */
  3082. (void *)sys_getpriority,
  3083. (void *)sys_setpriority,
  3084. (void *)sys_sem_create,
  3085. (void *)sys_sem_delete,
  3086. (void *)sys_sem_take, /* 20 */
  3087. (void *)sys_sem_release,
  3088. (void *)sys_mutex_create,
  3089. (void *)sys_mutex_delete,
  3090. (void *)sys_mutex_take,
  3091. (void *)sys_mutex_release, /* 25 */
  3092. (void *)sys_event_create,
  3093. (void *)sys_event_delete,
  3094. (void *)sys_event_send,
  3095. (void *)sys_event_recv,
  3096. (void *)sys_mb_create, /* 30 */
  3097. (void *)sys_mb_delete,
  3098. (void *)sys_mb_send,
  3099. (void *)sys_mb_send_wait,
  3100. (void *)sys_mb_recv,
  3101. (void *)sys_mq_create, /* 35 */
  3102. (void *)sys_mq_delete,
  3103. (void *)sys_mq_send,
  3104. (void *)sys_mq_urgent,
  3105. (void *)sys_mq_recv,
  3106. (void *)sys_thread_create, /* 40 */
  3107. (void *)sys_thread_delete,
  3108. (void *)sys_thread_startup,
  3109. (void *)sys_thread_self,
  3110. (void *)sys_channel_open,
  3111. (void *)sys_channel_close, /* 45 */
  3112. (void *)sys_channel_send,
  3113. (void *)sys_channel_send_recv_timeout,
  3114. (void *)sys_channel_reply,
  3115. (void *)sys_channel_recv_timeout,
  3116. (void *)sys_enter_critical, /* 50 */
  3117. (void *)sys_exit_critical,
  3118. SYSCALL_USPACE(sys_brk),
  3119. SYSCALL_USPACE(sys_mmap2),
  3120. SYSCALL_USPACE(sys_munmap),
  3121. SYSCALL_USPACE(sys_shmget), /* 55 */
  3122. SYSCALL_USPACE(sys_shmrm),
  3123. SYSCALL_USPACE(sys_shmat),
  3124. SYSCALL_USPACE(sys_shmdt),
  3125. (void *)sys_device_init,
  3126. (void *)sys_device_register, /* 60 */
  3127. (void *)sys_device_control,
  3128. (void *)sys_device_find,
  3129. (void *)sys_device_open,
  3130. (void *)sys_device_close,
  3131. (void *)sys_device_read, /* 65 */
  3132. (void *)sys_device_write,
  3133. (void *)sys_stat,
  3134. (void *)sys_thread_find,
  3135. SYSCALL_NET(sys_accept),
  3136. SYSCALL_NET(sys_bind), /* 70 */
  3137. SYSCALL_NET(sys_shutdown),
  3138. SYSCALL_NET(sys_getpeername),
  3139. SYSCALL_NET(sys_getsockname),
  3140. SYSCALL_NET(sys_getsockopt),
  3141. SYSCALL_NET(sys_setsockopt), /* 75 */
  3142. SYSCALL_NET(sys_connect),
  3143. SYSCALL_NET(sys_listen),
  3144. SYSCALL_NET(sys_recv),
  3145. SYSCALL_NET(sys_recvfrom),
  3146. SYSCALL_NET(sys_send), /* 80 */
  3147. SYSCALL_NET(sys_sendto),
  3148. SYSCALL_NET(sys_socket),
  3149. SYSCALL_NET(sys_closesocket),
  3150. SYSCALL_NET(sys_getaddrinfo),
  3151. SYSCALL_NET(sys_gethostbyname2_r), /* 85 */
  3152. (void *)sys_notimpl, //(void *)network,
  3153. (void *)sys_notimpl, //(void *)network,
  3154. (void *)sys_notimpl, //(void *)network,
  3155. (void *)sys_notimpl, //(void *)network,
  3156. (void *)sys_notimpl, //(void *)network, /* 90 */
  3157. (void *)sys_notimpl, //(void *)network,
  3158. (void *)sys_notimpl, //(void *)network,
  3159. (void *)sys_notimpl, //(void *)network,
  3160. #ifdef RT_USING_DFS
  3161. (void *)sys_select,
  3162. #else
  3163. (void *)sys_notimpl,
  3164. #endif
  3165. (void *)sys_notimpl, //(void *)sys_hw_interrupt_disable, /* 95 */
  3166. (void *)sys_notimpl, //(void *)sys_hw_interrupt_enable,
  3167. (void *)sys_tick_get,
  3168. (void *)sys_exit_group,
  3169. (void *)sys_notimpl, //(void *)rt_delayed_work_init,
  3170. (void *)sys_notimpl, //(void *)rt_work_submit, /* 100 */
  3171. (void *)sys_notimpl, //(void *)rt_wqueue_wakeup,
  3172. (void *)sys_thread_mdelay,
  3173. (void *)sys_sigaction,
  3174. (void *)sys_sigprocmask,
  3175. (void *)sys_tkill, /* 105 */
  3176. (void *)sys_notimpl,
  3177. (void *)sys_thread_sigprocmask,
  3178. (void *)sys_notimpl,
  3179. (void *)sys_notimpl,
  3180. (void *)sys_waitpid, /* 110 */
  3181. (void *)sys_timer_create,
  3182. (void *)sys_timer_delete,
  3183. (void *)sys_timer_start,
  3184. (void *)sys_timer_stop,
  3185. (void *)sys_timer_control, /* 115 */
  3186. (void *)sys_getcwd,
  3187. (void *)sys_chdir,
  3188. (void *)sys_unlink,
  3189. (void *)sys_mkdir,
  3190. (void *)sys_rmdir, /* 120 */
  3191. (void *)sys_getdents,
  3192. (void *)sys_get_errno,
  3193. (void *)sys_set_thread_area,
  3194. (void *)sys_set_tid_address,
  3195. (void *)sys_access, /* 125 */
  3196. (void *)sys_pipe,
  3197. (void *)sys_clock_settime,
  3198. (void *)sys_clock_gettime,
  3199. (void *)sys_clock_getres,
  3200. (void *)sys_clone, /* 130 */
  3201. (void *)sys_futex,
  3202. (void *)sys_pmutex,
  3203. (void *)sys_dup,
  3204. (void *)sys_dup2,
  3205. (void *)sys_rename, /* 135 */
  3206. (void *)sys_fork,
  3207. (void *)sys_execve,
  3208. (void *)sys_vfork,
  3209. (void *)sys_gettid,
  3210. (void *)sys_prlimit64, /* 140 */
  3211. (void *)sys_getrlimit,
  3212. (void *)sys_setrlimit,
  3213. };
  3214. const void *lwp_get_sys_api(rt_uint32_t number)
  3215. {
  3216. const void *func = (const void *)sys_notimpl;
  3217. if (number == 0xff)
  3218. {
  3219. func = (void *)sys_log;
  3220. }
  3221. else
  3222. {
  3223. number -= 1;
  3224. if (number < sizeof(func_table) / sizeof(func_table[0]))
  3225. {
  3226. func = func_table[number];
  3227. }
  3228. }
  3229. return func;
  3230. }