| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920 |
- /*
- * Copyright (c) 2006-2020, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2018-06-10 Bernard first version
- */
- /* RT-Thread System call */
- #include <rthw.h>
- #include <board.h>
- #include <lwp.h>
- #ifdef RT_USING_USERSPACE
- #include <lwp_user_mm.h>
- #endif
- #ifdef RT_USING_DFS
- #include <dfs_poll.h>
- #include <dfs_posix.h>
- #include <dfs_select.h>
- #endif
- #if (defined(RT_USING_SAL) && defined(SAL_USING_POSIX))
- #include <sys/socket.h>
- #define SYSCALL_NET(f) ((void*)(f))
- #else
- #define SYSCALL_NET(f) ((void*)sys_notimpl)
- #endif
- #if defined(RT_USING_DFS) && defined(RT_USING_USERSPACE)
- #define SYSCALL_USPACE(f) ((void*)(f))
- #else
- #define SYSCALL_USPACE(f) ((void*)sys_notimpl)
- #endif
- #define DBG_TAG "SYSCALL"
- #define DBG_LVL DBG_INFO
- #include <rtdbg.h>
- #ifdef RT_USING_SAL
- #include <netdev_ipaddr.h>
- #include <netdev.h>
- #include <sal_netdb.h>
- #include <sal.h>
- #endif /* RT_USING_SAL */
- #include "lwp_ipc_internal.h"
- #define ALLOC_KERNEL_STACK_SIZE 5120
- struct musl_sockaddr
- {
- uint16_t sa_family;
- char sa_data[14];
- };
- extern void lwp_user_entry(void *args, const void *text, void *data, void *user_stack);
- extern void set_user_context(void *stack);
- void lwp_cleanup(struct rt_thread *tid);
- #ifdef RT_USING_USERSPACE
- static void *kmem_get(size_t size)
- {
- return rt_malloc(size);
- }
- static void kmem_put(void *kptr)
- {
- rt_free(kptr);
- }
- #endif
- /* The same socket option is defined differently in the user interfaces and the
- * implementation. The options should be converted in the kernel. */
- /* socket levels */
- #define INTF_SOL_SOCKET 1
- #define IMPL_SOL_SOCKET 0xFFF
- /* socket option name */
- #define INTF_SO_REUSEADDR 2
- #define INTF_SO_KEEPALIVE 9
- #define INTF_SO_BROADCAST 6
- #define INTF_SO_ACCEPTCONN 30
- #define INTF_SO_DONTROUTE 5
- #define INTF_SO_LINGER 13
- #define INTF_SO_OOBINLINE 10
- #define INTF_SO_REUSEPORT 15
- #define INTF_SO_SNDBUF 7
- #define INTF_SO_RCVBUF 8
- #define INTF_SO_SNDLOWAT 19
- #define INTF_SO_RCVLOWAT 18
- #define INTF_SO_SNDTIMEO 21
- #define INTF_SO_RCVTIMEO 20
- #define INTF_SO_ERROR 4
- #define INTF_SO_TYPE 3
- #define INTF_SO_NO_CHECK 11
- #define IMPL_SO_REUSEADDR 0x0004
- #define IMPL_SO_KEEPALIVE 0x0008
- #define IMPL_SO_BROADCAST 0x0020
- #define IMPL_SO_ACCEPTCONN 0x0002
- #define IMPL_SO_DONTROUTE 0x0010
- #define IMPL_SO_LINGER 0x0080
- #define IMPL_SO_OOBINLINE 0x0100
- #define IMPL_SO_REUSEPORT 0x0200
- #define IMPL_SO_SNDBUF 0x1001
- #define IMPL_SO_RCVBUF 0x1002
- #define IMPL_SO_SNDLOWAT 0x1003
- #define IMPL_SO_RCVLOWAT 0x1004
- #define IMPL_SO_SNDTIMEO 0x1005
- #define IMPL_SO_RCVTIMEO 0x1006
- #define IMPL_SO_ERROR 0x1007
- #define IMPL_SO_TYPE 0x1008
- #define IMPL_SO_NO_CHECK 0x100a
- static void convert_sockopt(int *level, int *optname)
- {
- switch (*level)
- {
- case INTF_SOL_SOCKET:
- *level = IMPL_SOL_SOCKET;
- break;
- default:
- break;
- }
- switch (*optname)
- {
- case INTF_SO_REUSEADDR:
- *optname = IMPL_SO_REUSEADDR;
- break;
- case INTF_SO_KEEPALIVE:
- *optname = IMPL_SO_KEEPALIVE;
- break;
- case INTF_SO_BROADCAST:
- *optname = IMPL_SO_BROADCAST;
- break;
- case INTF_SO_ACCEPTCONN:
- *optname = IMPL_SO_ACCEPTCONN;
- break;
- case INTF_SO_DONTROUTE:
- *optname = IMPL_SO_DONTROUTE;
- break;
- case INTF_SO_LINGER:
- *optname = IMPL_SO_LINGER;
- break;
- case INTF_SO_OOBINLINE:
- *optname = IMPL_SO_OOBINLINE;
- break;
- case INTF_SO_REUSEPORT:
- *optname = IMPL_SO_REUSEPORT;
- break;
- case INTF_SO_SNDBUF:
- *optname = IMPL_SO_SNDBUF;
- break;
- case INTF_SO_RCVBUF:
- *optname = IMPL_SO_RCVBUF;
- break;
- case INTF_SO_SNDLOWAT:
- *optname = IMPL_SO_SNDLOWAT;
- break;
- case INTF_SO_RCVLOWAT:
- *optname = IMPL_SO_RCVLOWAT;
- break;
- case INTF_SO_SNDTIMEO:
- *optname = IMPL_SO_SNDTIMEO;
- break;
- case INTF_SO_RCVTIMEO:
- *optname = IMPL_SO_RCVTIMEO;
- break;
- case INTF_SO_ERROR:
- *optname = IMPL_SO_ERROR;
- break;
- case INTF_SO_TYPE:
- *optname = IMPL_SO_TYPE;
- break;
- case INTF_SO_NO_CHECK:
- *optname = IMPL_SO_NO_CHECK;
- break;
- /*
- * SO_DONTLINGER (*level = ((int)(~SO_LINGER))),
- * SO_USELOOPBACK (*level = 0x0040) and
- * SO_CONTIMEO (*level = 0x1009) are not supported for now.
- */
- default:
- *optname = 0;
- break;
- }
- }
- static void sockaddr_tolwip(const struct musl_sockaddr *std, struct sockaddr *lwip)
- {
- if (std && lwip)
- {
- lwip->sa_len = sizeof(*lwip);
- lwip->sa_family = (sa_family_t) std->sa_family;
- memcpy(lwip->sa_data, std->sa_data, sizeof(lwip->sa_data));
- }
- }
- static void sockaddr_tomusl(const struct sockaddr *lwip, struct musl_sockaddr *std)
- {
- if (std && lwip)
- {
- std->sa_family = (uint16_t) lwip->sa_family;
- memcpy(std->sa_data, lwip->sa_data, sizeof(std->sa_data));
- }
- }
- static void lwp_user_thread(void *parameter)
- {
- rt_thread_t tid;
- uint32_t user_stack;
- struct rt_lwp *lwp;
- tid = rt_thread_self();
- lwp = lwp_self();
- user_stack = (uint32_t)tid->user_stack + tid->user_stack_size;
- user_stack &= ~7; //align 8
- set_user_context((void*)user_stack);
- lwp_user_entry(parameter, tid->user_entry, lwp->data_entry, (void*)user_stack);
- }
- /* thread/process */
- void sys_exit(int value)
- {
- rt_base_t level;
- rt_thread_t tid, main_thread;
- struct rt_lwp *lwp;
- LOG_D("thread/process exit.");
- tid = rt_thread_self();
- lwp = (struct rt_lwp*)tid->lwp;
- level = rt_hw_interrupt_disable();
- main_thread = rt_list_entry(lwp->t_grp.prev, struct rt_thread, sibling);
- if (main_thread == tid)
- {
- lwp_terminate(lwp);
- lwp_wait_subthread_exit();
- lwp->lwp_ret = value;
- }
- rt_thread_delete(tid);
- rt_schedule();
- rt_hw_interrupt_enable(level);
- return;
- }
- /* exit group */
- void sys_exit_group(int status)
- {
- return;
- }
- /* syscall: "read" ret: "ssize_t" args: "int" "void *" "size_t" */
- ssize_t sys_read(int fd, void *buf, size_t nbyte)
- {
- #ifdef RT_USING_USERSPACE
- void *kmem;
- ssize_t ret;
- if (!nbyte)
- return 0;
- if (!lwp_user_accessable((void*)buf, nbyte))
- return 0;
- kmem = kmem_get(nbyte);
- if (!kmem)
- return 0;
- ret = read(fd, kmem, nbyte);
- if (ret)
- lwp_put_to_user(buf, kmem, ret);
- kmem_put(kmem);
- return ret;
- #else
- return read(fd, buf, nbyte);
- #endif
- }
- /* syscall: "write" ret: "ssize_t" args: "int" "const void *" "size_t" */
- ssize_t sys_write(int fd, const void *buf, size_t nbyte)
- {
- #ifdef RT_USING_USERSPACE
- void *kmem;
- ssize_t ret;
- if (!nbyte)
- return 0;
- if (!lwp_user_accessable((void*)buf, nbyte))
- return 0;
- kmem = kmem_get(nbyte);
- if (!kmem)
- return 0;
- lwp_get_from_user(kmem, (void *)buf, nbyte);
- ret = write(fd, kmem, nbyte);
- kmem_put(kmem);
- return ret;
- #else
- return write(fd, buf, nbyte);
- #endif
- }
- /* syscall: "lseek" ret: "off_t" args: "int" "off_t" "int" */
- off_t sys_lseek(int fd, off_t offset, int whence)
- {
- return lseek(fd, offset, whence);
- }
- /* syscall: "open" ret: "int" args: "const char *" "int" "..." */
- int sys_open(const char *name, int flag, ...)
- {
- #ifdef RT_USING_USERSPACE
- int ret;
- rt_size_t len;
- char *kname;
- if (!lwp_user_accessable((void*)name, 1))
- return -1;
- len = rt_strlen(name);
- if (!len)
- return -1;
- kname = (char *)kmem_get(len + 1);
- if (!kname)
- return -1;
- lwp_get_from_user(kname, (void *)name, len + 1);
- ret = open(kname, flag, 0);
- kmem_put(kname);
- return ret;
- #else
- return open(name, flag, 0);
- #endif
- }
- /* syscall: "close" ret: "int" args: "int" */
- int sys_close(int fd)
- {
- if ((0 <= fd) && (fd <= 2))
- {
- return 0;
- }
- return close(fd);
- }
- /* syscall: "ioctl" ret: "int" args: "int" "u_long" "..." */
- int sys_ioctl(int fd, unsigned long cmd, void* data)
- {
- return ioctl(fd, cmd, data);
- }
- int sys_fstat(int file, struct stat *buf)
- {
- #ifdef RT_USING_USERSPACE
- int ret;
- struct stat statbuff;
- ret = fstat(file, &statbuff);
- lwp_put_to_user(buf, &statbuff, sizeof statbuff);
- return ret;
- #else
- return fstat(file, buf);
- #endif
- }
- int sys_poll(struct pollfd *fds, nfds_t nfds, int timeout)
- {
- #ifdef RT_USING_USERSPACE
- int ret;
- struct pollfd *kfds;
- if (!lwp_user_accessable((void*)fds, nfds * sizeof *fds))
- return -1;
- kfds = (struct pollfd *)kmem_get(nfds * sizeof *kfds);
- if (!kfds)
- return -1;
- lwp_get_from_user(kfds, fds, nfds * sizeof *kfds);
- ret = poll(kfds, nfds, timeout);
- lwp_put_to_user(fds, kfds, nfds * sizeof *kfds);
- kmem_put(kfds);
- return ret;
- #else
- return poll(fds, nfds, timeout);
- #endif
- }
- int sys_select(int nfds, fd_set *readfds, fd_set *writefds, fd_set *exceptfds, struct timeval *timeout)
- {
- #ifdef RT_USING_USERSPACE
- int ret = -1;
- fd_set *kreadfds = RT_NULL, *kwritefds = RT_NULL, *kexceptfds = RT_NULL;
- if (readfds)
- {
- if (!lwp_user_accessable((void*)readfds, sizeof *readfds))
- {
- return -1;
- }
- kreadfds = (fd_set *)kmem_get(sizeof *kreadfds);
- if (!kreadfds)
- {
- goto quit;
- }
- lwp_get_from_user(kreadfds, readfds, sizeof *kreadfds);
- }
- if (writefds)
- {
- if (!lwp_user_accessable((void*)writefds, sizeof *writefds))
- {
- return -1;
- }
- kwritefds = (fd_set *)kmem_get(sizeof *kwritefds);
- if (!kwritefds)
- {
- goto quit;
- }
- lwp_get_from_user(kwritefds, writefds, sizeof *kwritefds);
- }
- if (exceptfds)
- {
- if (!lwp_user_accessable((void*)exceptfds, sizeof *exceptfds))
- {
- return -1;
- }
- kexceptfds = (fd_set *)kmem_get(sizeof *kexceptfds);
- if (!kexceptfds)
- {
- goto quit;
- }
- lwp_get_from_user(kexceptfds, exceptfds, sizeof *kexceptfds);
- }
- ret = select(nfds, kreadfds, kwritefds, kexceptfds, timeout);
- if (kreadfds)
- {
- lwp_put_to_user(readfds, kreadfds, sizeof *kreadfds);
- }
- if (kwritefds)
- {
- lwp_put_to_user(writefds, kwritefds, sizeof *kwritefds);
- }
- if (kexceptfds)
- {
- lwp_put_to_user(exceptfds, kexceptfds, sizeof *kexceptfds);
- }
- quit:
- if (kreadfds)
- {
- kmem_put(kreadfds);
- }
- if (kwritefds)
- {
- kmem_put(kwritefds);
- }
- if (kexceptfds)
- {
- kmem_put(kexceptfds);
- }
- return ret;
- #else
- return select(nfds, readfds, writefds, exceptfds, timeout);
- #endif
- }
- int sys_unlink(const char *pathname)
- {
- #ifdef RT_USING_USERSPACE
- int ret;
- rt_size_t len;
- char *kname;
- if (!lwp_user_accessable((void*)pathname, 1))
- return -1;
- len = rt_strlen(pathname);
- if (!len)
- return -1;
- kname = (char *)kmem_get(len + 1);
- if (!kname)
- return -1;
- lwp_get_from_user(kname, (void *)pathname, len + 1);
- ret = unlink(kname);
- kmem_put(kname);
- return ret;
- #else
- return unlink(pathname);
- #endif
- }
- /* syscall: "nanosleep" ret: "int" args: "const struct timespec *" "struct timespec *" */
- int sys_nanosleep(const struct timespec *rqtp, struct timespec *rmtp)
- {
- rt_tick_t tick;
- #ifdef RT_USING_USERSPACE
- struct timespec rqtp_k;
- struct timespec rmtp_k;
- dbg_log(DBG_LOG, "sys_nanosleep\n");
- if (!lwp_user_accessable((void*)rqtp, sizeof *rqtp))
- return -1;
- lwp_get_from_user(&rqtp_k, (void *)rqtp, sizeof rqtp_k);
- tick = rqtp_k.tv_sec * RT_TICK_PER_SECOND + ((uint64_t)rqtp_k.tv_nsec * RT_TICK_PER_SECOND)/ 1000000000;
- rt_thread_delay(tick);
- if (rmtp)
- {
- if (!lwp_user_accessable((void*)rmtp, sizeof *rmtp))
- return -1;
- tick = rt_tick_get() - tick;
- /* get the passed time */
- rmtp_k.tv_sec = tick/RT_TICK_PER_SECOND;
- rmtp_k.tv_nsec = (tick%RT_TICK_PER_SECOND) * (1000000000/RT_TICK_PER_SECOND);
- lwp_put_to_user(rmtp, (void *)&rmtp_k, sizeof rmtp_k);
- }
- #else
- dbg_log(DBG_LOG, "sys_nanosleep\n");
- tick = rqtp->tv_sec * RT_TICK_PER_SECOND + ((uint64_t)rqtp->tv_nsec * RT_TICK_PER_SECOND)/ 1000000000;
- rt_thread_delay(tick);
- if (rmtp)
- {
- tick = rt_tick_get() - tick;
- /* get the passed time */
- rmtp->tv_sec = tick/RT_TICK_PER_SECOND;
- rmtp->tv_nsec = (tick%RT_TICK_PER_SECOND) * (1000000000/RT_TICK_PER_SECOND);
- }
- #endif
- return 0;
- }
- /* syscall: "gettimeofday" ret: "int" args: "struct timeval *" "struct timezone *" */
- int sys_gettimeofday(struct timeval *tp, struct timezone *tzp)
- {
- struct timeval t_k;
- #ifdef RT_USING_USERSPACE
- if (tp)
- {
- if (!lwp_user_accessable((void*)tp, sizeof *tp))
- return -1;
- t_k.tv_sec = rt_tick_get() / RT_TICK_PER_SECOND;
- t_k.tv_usec = (rt_tick_get() % RT_TICK_PER_SECOND) * (1000000 / RT_TICK_PER_SECOND);
- lwp_put_to_user(tp, (void *)&t_k, sizeof t_k);
- }
- #else
- if (tp)
- {
- tp->tv_sec = rt_tick_get() / RT_TICK_PER_SECOND;
- tp->tv_usec = (rt_tick_get() % RT_TICK_PER_SECOND) * (1000000 / RT_TICK_PER_SECOND);
- }
- #endif
- return 0;
- }
- int sys_settimeofday(const struct timeval *tv, const struct timezone *tzp)
- {
- return 0;
- }
- #ifdef RT_USING_GDBSERVER
- int lwp_execve(char *filename, int debug, int argc, char **argv, char **envp);
- #else
- int lwp_execve(char *filename, int argc, char **argv, char **envp);
- #endif
- int sys_exec(char *filename, int argc, char **argv, char **envp)
- {
- #ifdef RT_USING_GDBSERVER
- return lwp_execve(filename, 0, argc, argv, envp);
- #else
- return lwp_execve(filename, argc, argv, envp);
- #endif
- }
- int sys_kill(int pid, int sig)
- {
- return lwp_kill(pid, sig);
- }
- int sys_getpid(void)
- {
- return lwp_getpid();
- }
- /* syscall: "getpriority" ret: "int" args: "int" "id_t" */
- int sys_getpriority(int which, id_t who)
- {
- if (which == PRIO_PROCESS)
- {
- rt_thread_t tid;
- tid = rt_thread_self();
- if (who == (id_t)tid || who == 0xff)
- {
- return tid->current_priority;
- }
- }
- return 0xff;
- }
- /* syscall: "setpriority" ret: "int" args: "int" "id_t" "int" */
- int sys_setpriority(int which, id_t who, int prio)
- {
- if (which == PRIO_PROCESS)
- {
- rt_thread_t tid;
- tid = rt_thread_self();
- if ((who == (id_t)tid || who == 0xff) && (prio >= 0 && prio < RT_THREAD_PRIORITY_MAX))
- {
- rt_thread_control(tid, RT_THREAD_CTRL_CHANGE_PRIORITY, &prio);
- return 0;
- }
- }
- return -1;
- }
- rt_sem_t sys_sem_create(const char *name, rt_uint32_t value, rt_uint8_t flag)
- {
- return rt_sem_create(name, value, flag);
- }
- rt_err_t sys_sem_delete(rt_sem_t sem)
- {
- return rt_sem_delete(sem);
- }
- rt_err_t sys_sem_take(rt_sem_t sem, rt_int32_t time)
- {
- return rt_sem_take_interruptible(sem, time);
- }
- rt_err_t sys_sem_release(rt_sem_t sem)
- {
- return rt_sem_release(sem);
- }
- rt_mutex_t sys_mutex_create(const char *name, rt_uint8_t flag)
- {
- return rt_mutex_create(name, flag);
- }
- rt_err_t sys_mutex_delete(rt_mutex_t mutex)
- {
- return rt_mutex_delete(mutex);
- }
- rt_err_t sys_mutex_take(rt_mutex_t mutex, rt_int32_t time)
- {
- return rt_mutex_take_interruptible(mutex, time);
- }
- rt_err_t sys_mutex_release(rt_mutex_t mutex)
- {
- return rt_mutex_release(mutex);
- }
- #ifdef RT_USING_USERSPACE
- /* memory allocation */
- extern int lwp_brk(void *addr);
- int sys_brk(void *addr)
- {
- return lwp_brk(addr);
- }
- extern void *lwp_mmap2(void *addr, size_t length, int prot,
- int flags, int fd, off_t pgoffset);
- void *sys_mmap2(void *addr, size_t length, int prot,
- int flags, int fd, off_t pgoffset)
- {
- return lwp_mmap2(addr, length, prot, flags, fd, pgoffset);
- }
- extern int lwp_munmap(void *addr, size_t length);
- int sys_munmap(void *addr, size_t length)
- {
- return lwp_munmap(addr, length);
- }
- #endif
- rt_event_t sys_event_create(const char *name, rt_uint8_t flag)
- {
- return rt_event_create(name, flag);
- }
- rt_err_t sys_event_delete(rt_event_t event)
- {
- return rt_event_delete(event);
- }
- rt_err_t sys_event_send(rt_event_t event, rt_uint32_t set)
- {
- return rt_event_send(event, set);
- }
- rt_err_t sys_event_recv(rt_event_t event,
- rt_uint32_t set,
- rt_uint8_t opt,
- rt_int32_t timeout,
- rt_uint32_t *recved)
- {
- return rt_event_recv(event, set, opt, timeout, recved);
- }
- rt_mailbox_t sys_mb_create(const char *name, rt_size_t size, rt_uint8_t flag)
- {
- return rt_mb_create(name, size, flag);
- }
- rt_err_t sys_mb_delete(rt_mailbox_t mb)
- {
- return rt_mb_delete(mb);
- }
- rt_err_t sys_mb_send(rt_mailbox_t mb, rt_uint32_t value)
- {
- return rt_mb_send(mb, value);
- }
- rt_err_t sys_mb_send_wait(rt_mailbox_t mb,
- rt_uint32_t value,
- rt_int32_t timeout)
- {
- return rt_mb_send_wait(mb, value, timeout);
- }
- rt_err_t sys_mb_recv(rt_mailbox_t mb, rt_uint32_t *value, rt_int32_t timeout)
- {
- return rt_mb_recv(mb, (rt_ubase_t*)value, timeout);
- }
- rt_mq_t sys_mq_create(const char *name,
- rt_size_t msg_size,
- rt_size_t max_msgs,
- rt_uint8_t flag)
- {
- return rt_mq_create(name, msg_size, max_msgs, flag);
- }
- rt_err_t sys_mq_delete(rt_mq_t mq)
- {
- return rt_mq_delete(mq);
- }
- rt_err_t sys_mq_send(rt_mq_t mq, void *buffer, rt_size_t size)
- {
- return rt_mq_send(mq, buffer, size);
- }
- rt_err_t sys_mq_urgent(rt_mq_t mq, void *buffer, rt_size_t size)
- {
- return rt_mq_urgent(mq, buffer, size);
- }
- rt_err_t sys_mq_recv(rt_mq_t mq,
- void *buffer,
- rt_size_t size,
- rt_int32_t timeout)
- {
- return rt_mq_recv(mq, buffer, size, timeout);
- }
- static void timer_timeout_callback(void *parameter)
- {
- rt_sem_t sem = (rt_sem_t)parameter;
- rt_sem_release(sem);
- }
- rt_timer_t sys_timer_create(const char *name,
- void *data,
- rt_tick_t time,
- rt_uint8_t flag)
- {
- return rt_timer_create(name, timer_timeout_callback, (void*)data, time, flag);
- }
- rt_err_t sys_timer_delete(rt_timer_t timer)
- {
- return rt_timer_delete(timer);
- }
- rt_err_t sys_timer_start(rt_timer_t timer)
- {
- return rt_timer_start(timer);
- }
- rt_err_t sys_timer_stop(rt_timer_t timer)
- {
- return rt_timer_stop(timer);
- }
- rt_err_t sys_timer_control(rt_timer_t timer, int cmd, void *arg)
- {
- return rt_timer_control(timer, cmd, arg);
- }
- #ifdef RT_USING_USERSPACE
- void *lwp_map_user(struct rt_lwp *lwp, void *map_va, size_t map_size);
- #endif
- rt_thread_t sys_thread_create(void *arg[])
- {
- rt_base_t level;
- void *user_stack = 0;
- struct rt_lwp *lwp = 0;
- rt_thread_t tid;
- lwp = rt_thread_self()->lwp;
- lwp_ref_inc(lwp);
- #ifdef RT_USING_USERSPACE
- user_stack = lwp_map_user(lwp, 0, (size_t)arg[3]);
- #else
- user_stack = (void *)RT_KERNEL_MALLOC((uint32_t)arg[3]);
- #endif
- if (!user_stack)
- {
- return RT_NULL;
- }
- tid = rt_thread_create((const char*)arg[0], lwp_user_thread, (void*)arg[2], ALLOC_KERNEL_STACK_SIZE, (rt_uint8_t)(size_t)arg[4], (rt_uint32_t)arg[5]);
- if (!tid)
- {
- goto fail;
- }
- tid->cleanup = lwp_cleanup;
- tid->user_entry = (void (*)(void *))arg[1];
- tid->user_stack = (void *)user_stack;
- tid->user_stack_size = (uint32_t)arg[3];
- tid->lwp = (void*)lwp;
- level = rt_hw_interrupt_disable();
- rt_list_insert_after(&lwp->t_grp, &tid->sibling);
- rt_hw_interrupt_enable(level);
- return tid;
- fail:
- #ifndef RT_USING_USERSPACE
- if (user_stack)
- {
- RT_KERNEL_FREE(user_stack);
- }
- #endif
- if (lwp)
- {
- lwp_ref_dec(lwp);
- }
- return RT_NULL;
- }
- rt_err_t sys_thread_delete(rt_thread_t thread)
- {
- return rt_thread_delete(thread);
- }
- rt_err_t sys_thread_startup(rt_thread_t thread)
- {
- return rt_thread_startup(thread);
- }
- rt_thread_t sys_thread_self(void)
- {
- return rt_thread_self();
- }
- /* sys channel */
- int sys_channel_open(const char *name, int flags)
- {
- return lwp_channel_open(FDT_TYPE_LWP, name, flags);
- }
- rt_err_t sys_channel_close(int fd)
- {
- return lwp_channel_close(FDT_TYPE_LWP, fd);
- }
- rt_err_t sys_channel_send(int fd, rt_channel_msg_t data)
- {
- return lwp_channel_send(FDT_TYPE_LWP, fd, data);
- }
- 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)
- {
- return lwp_channel_send_recv_timeout(FDT_TYPE_LWP, fd, data, data_ret, time);
- }
- rt_err_t sys_channel_reply(int fd, rt_channel_msg_t data)
- {
- return lwp_channel_reply(FDT_TYPE_LWP, fd, data);
- }
- rt_err_t sys_channel_recv_timeout(int fd, rt_channel_msg_t data, rt_int32_t time)
- {
- return lwp_channel_recv_timeout(FDT_TYPE_LWP, fd, data, time);
- }
- /*****/
- static struct rt_semaphore critical_lock;
- static int critical_init(void)
- {
- rt_sem_init(&critical_lock, "ct_lock", 1, RT_IPC_FLAG_FIFO);
- return 0;
- }
- INIT_DEVICE_EXPORT(critical_init);
- void sys_enter_critical(void)
- {
- rt_sem_take(&critical_lock, RT_WAITING_FOREVER);
- }
- void sys_exit_critical(void)
- {
- rt_sem_release(&critical_lock);
- }
- /* syscall: "sys_log" ret: "int" args: "const char*" "size" */
- static int __sys_log_enable = 0;
- static int sys_log_enable(int argc, char** argv)
- {
- if (argc == 1)
- {
- rt_kprintf("sys_log = %d\n", __sys_log_enable);
- return 0;
- }
- else
- {
- __sys_log_enable = atoi(argv[1]);
- }
- return 0;
- }
- MSH_CMD_EXPORT_ALIAS(sys_log_enable, sys_log, sys_log 1(enable)/0(disable));
- int sys_log(const char* log, int size)
- {
- rt_device_t console = rt_console_get_device();
- if (console && __sys_log_enable) rt_device_write(console, -1, log, size);
- return 0;
- }
- int sys_stat(const char *file, struct stat *buf)
- {
- return stat(file, buf);
- }
- int sys_notimpl(void)
- {
- return -ENOSYS;
- }
- uint32_t sys_hw_interrupt_disable(void)
- {
- return rt_hw_interrupt_disable();
- }
- void sys_hw_interrupt_enable(uint32_t level)
- {
- rt_hw_interrupt_enable(level);
- }
- #ifdef RT_USING_USERSPACE
- int sys_shmget(size_t key, size_t size, int create)
- {
- return lwp_shmget(key, size, create);
- }
- int sys_shmrm(int id)
- {
- return lwp_shmrm(id);
- }
- void* sys_shmat(int id, void* shm_vaddr)
- {
- return lwp_shmat(id, shm_vaddr);
- }
- int sys_shmdt(void* shm_vaddr)
- {
- return lwp_shmdt(shm_vaddr);
- }
- #endif
- /* device interfaces */
- rt_err_t sys_device_init(rt_device_t dev)
- {
- return rt_device_init(dev);
- }
- rt_err_t sys_device_register(rt_device_t dev, const char *name, rt_uint16_t flags)
- {
- return rt_device_register(dev, name, flags);
- }
- rt_err_t sys_device_control(rt_device_t dev, int cmd, void *arg)
- {
- return rt_device_control(dev, cmd, arg);
- }
- rt_device_t sys_device_find(const char* name)
- {
- return rt_device_find(name);
- }
- rt_err_t sys_device_open(rt_device_t dev, rt_uint16_t oflag)
- {
- return rt_device_open(dev, oflag);
- }
- rt_err_t sys_device_close(rt_device_t dev)
- {
- return rt_device_close(dev);
- }
- rt_size_t sys_device_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
- {
- return rt_device_read(dev, pos, buffer, size);
- }
- rt_size_t sys_device_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
- {
- return rt_device_write(dev, pos, buffer, size);
- }
- /* network interfaces */
- int sys_accept(int socket, struct musl_sockaddr *addr, socklen_t *addrlen)
- {
- int ret;
- struct sockaddr ksa;
- struct musl_sockaddr kmusladdr;
- socklen_t uaddrlen;
- socklen_t kaddrlen;
- if (!lwp_user_accessable(addrlen, sizeof (socklen_t *)))
- {
- return -1;
- }
- lwp_get_from_user(&uaddrlen, addrlen, sizeof (socklen_t *));
- if (!uaddrlen)
- {
- return -1;
- }
- if (!lwp_user_accessable(addr, uaddrlen))
- {
- return -1;
- }
- kaddrlen = sizeof(struct sockaddr);
- ret = accept(socket, &ksa, &kaddrlen);
- if (ret >= 0)
- {
- sockaddr_tomusl(&ksa, &kmusladdr);
- if (uaddrlen > sizeof(struct musl_sockaddr))
- {
- uaddrlen = sizeof(struct musl_sockaddr);
- }
- lwp_put_to_user(addr, &kmusladdr, uaddrlen);
- lwp_put_to_user(addrlen, &uaddrlen, sizeof (socklen_t *));
- }
- return ret;
- }
- int sys_bind(int socket, const struct musl_sockaddr *name, socklen_t namelen)
- {
- struct sockaddr sa;
- struct musl_sockaddr kname;
- if (!lwp_user_accessable((void*)name, namelen))
- {
- return -1;
- }
- lwp_get_from_user(&kname, (void*)name, namelen);
- sockaddr_tolwip(&kname, &sa);
- return bind(socket, &sa, namelen);
- }
- int sys_shutdown(int socket, int how)
- {
- return shutdown(socket, how);
- }
- int sys_getpeername (int socket, struct musl_sockaddr *name, socklen_t *namelen)
- {
- int ret;
- struct sockaddr sa;
- struct musl_sockaddr kname;
- socklen_t unamelen;
- socklen_t knamelen;
- if (!lwp_user_accessable(namelen, sizeof (socklen_t *)))
- {
- return -1;
- }
- lwp_get_from_user(&unamelen, namelen, sizeof (socklen_t *));
- if (!unamelen)
- {
- return -1;
- }
- if (!lwp_user_accessable(name, unamelen))
- {
- return -1;
- }
- knamelen = sizeof(struct sockaddr);
- ret = getpeername (socket, &sa, &knamelen);
- if (ret == 0)
- {
- sockaddr_tomusl(&sa, &kname);
- if (unamelen > sizeof(struct musl_sockaddr))
- {
- unamelen = sizeof(struct musl_sockaddr);
- }
- lwp_put_to_user(name, &kname, unamelen);
- lwp_put_to_user(namelen, &unamelen, sizeof (socklen_t *));
- }
- return ret;
- }
- int sys_getsockname (int socket, struct musl_sockaddr *name, socklen_t *namelen)
- {
- int ret;
- struct sockaddr sa;
- struct musl_sockaddr kname;
- socklen_t unamelen;
- socklen_t knamelen;
- if (!lwp_user_accessable(namelen, sizeof (socklen_t *)))
- {
- return -1;
- }
- lwp_get_from_user(&unamelen, namelen, sizeof (socklen_t *));
- if (!unamelen)
- {
- return -1;
- }
- if (!lwp_user_accessable(name, unamelen))
- {
- return -1;
- }
- knamelen = sizeof(struct sockaddr);
- ret = getsockname (socket, &sa, &knamelen);
- if (ret == 0)
- {
- sockaddr_tomusl(&sa, &kname);
- if (unamelen > sizeof(struct musl_sockaddr))
- {
- unamelen = sizeof(struct musl_sockaddr);
- }
- lwp_put_to_user(name, &kname, unamelen);
- lwp_put_to_user(namelen, &unamelen, sizeof (socklen_t *));
- }
- return ret;
- }
- int sys_getsockopt (int socket, int level, int optname, void *optval, socklen_t *optlen)
- {
- LOG_I("syscall: getsockopt");
- convert_sockopt(&level, &optname);
- return getsockopt (socket, level, optname, optval, optlen);
- }
- int sys_setsockopt (int socket, int level, int optname, const void *optval, socklen_t optlen)
- {
- LOG_I("syscall: setsockopt");
- convert_sockopt(&level, &optname);
- return setsockopt (socket, level, optname, optval, optlen);
- }
- int sys_connect(int socket, const struct musl_sockaddr *name, socklen_t namelen)
- {
- struct sockaddr sa;
- struct musl_sockaddr kname;
- if (!lwp_user_accessable((void*)name, namelen))
- {
- return -1;
- }
- lwp_get_from_user(&kname, (void*)name, namelen);
- sockaddr_tolwip(&kname, &sa);
- return connect(socket, &sa, namelen);
- }
- int sys_listen(int socket, int backlog)
- {
- return listen(socket, backlog);
- }
- #define MUSLC_MSG_OOB 0x0001
- #define MUSLC_MSG_PEEK 0x0002
- #define MUSLC_MSG_DONTWAIT 0x0040
- #define MUSLC_MSG_WAITALL 0x0100
- #define MUSLC_MSG_MORE 0x8000
- static int netflags_muslc_2_lwip(int flags)
- {
- int flgs = 0;
- if (flags & MUSLC_MSG_PEEK)
- flgs |= MSG_PEEK;
- if (flags & MUSLC_MSG_WAITALL)
- flgs |= MSG_WAITALL;
- if (flags & MUSLC_MSG_OOB)
- flgs |= MSG_OOB;
- if (flags & MUSLC_MSG_DONTWAIT)
- flgs |= MSG_DONTWAIT;
- if (flags & MUSLC_MSG_MORE)
- flgs |= MSG_MORE;
- return flgs;
- }
- int sys_recvfrom(int socket, void *mem, size_t len, int flags,
- struct musl_sockaddr *from, socklen_t *fromlen)
- {
- int flgs = 0;
- #ifdef RT_USING_USERSPACE
- int ret = -1;
- void *kmem = RT_NULL;
- #endif
- flgs = netflags_muslc_2_lwip(flags);
- #ifdef RT_USING_USERSPACE
- if (!len)
- return -1;
- if (!lwp_user_accessable((void*)mem, len))
- return -1;
- kmem = kmem_get(len);
- if (!kmem)
- return -1;
- if (flags == 0x2) {
- flags = 0x1;
- }
- if (from)
- {
- struct sockaddr sa;
- ret = recvfrom(socket, kmem, len, flgs, &sa, fromlen);
- sockaddr_tomusl(&sa, from);
- } else
- ret = recvfrom(socket, kmem, len, flgs, NULL, NULL);
- if (ret > 0)
- lwp_put_to_user(mem, kmem, len);
- kmem_put(kmem);
- return ret;
- #else
- if (from)
- {
- int ret = -1;
- struct sockaddr sa = {0};
- ret = recvfrom(socket, mem, len, flgs, &sa, fromlen);
- sockaddr_tomusl(&sa, from);
- return ret;
- }
- return recvfrom(socket, mem, len, flags, NULL, NULL);
- #endif
- }
- int sys_recv(int socket, void *mem, size_t len, int flags)
- {
- int flgs = 0;
- flgs = netflags_muslc_2_lwip(flags);
- return recvfrom(socket, mem, len, flgs, NULL, NULL);
- }
- int sys_sendto(int socket, const void *dataptr, size_t size, int flags,
- const struct musl_sockaddr *to, socklen_t tolen)
- {
- int flgs = 0;
- #ifdef RT_USING_USERSPACE
- int ret = -1;
- void *kmem = RT_NULL;
- #endif
- flgs = netflags_muslc_2_lwip(flags);
- #ifdef RT_USING_USERSPACE
- if (!size)
- return -1;
- if (!lwp_user_accessable((void*)dataptr, size))
- return -1;
- kmem = kmem_get(size);
- if (!kmem)
- return -1;
- lwp_get_from_user(kmem, (void *)dataptr, size);
- if (to)
- {
- struct sockaddr sa;
- sockaddr_tolwip(to, &sa);
- ret = sendto(socket, kmem, size, flgs, &sa, tolen);
- }
- else
- ret = sendto(socket, kmem, size, flgs, NULL, tolen);
- kmem_put(kmem);
- return ret;
- #else
- if (to)
- {
- struct sockaddr sa;
- sockaddr_tolwip(to, &sa);
- return sendto(socket, dataptr, size, flgs, &sa, tolen);
- }
- return sendto(socket, dataptr, size, flgs, NULL, tolen);
- #endif
- }
- int sys_send(int socket, const void *dataptr, size_t size, int flags)
- {
- int flgs = 0;
- flgs = netflags_muslc_2_lwip(flags);
- return sendto(socket, dataptr, size, flgs, NULL, 0);
- }
- int sys_socket(int domain, int type, int protocol)
- {
- int fd = -1;
- int nonblock = 0;
- /* not support SOCK_CLOEXEC type */
- if (type & SOCK_CLOEXEC) type &= ~SOCK_CLOEXEC;
- if (type & SOCK_NONBLOCK)
- {
- nonblock = 1;
- type &= ~SOCK_NONBLOCK;
- }
- fd = socket(domain, type, protocol);
- if (fd < 0)
- {
- goto out;
- }
- if (nonblock)
- {
- fcntl(fd, F_SETFL, O_NONBLOCK);
- }
- out:
- return fd;
- }
- int sys_closesocket(int socket)
- {
- return closesocket(socket);
- }
- rt_thread_t sys_thread_find(char *name)
- {
- return rt_thread_find(name);
- }
- rt_tick_t sys_tick_get(void)
- {
- return rt_tick_get();
- }
- rt_err_t sys_thread_mdelay(rt_int32_t ms)
- {
- return rt_thread_mdelay(ms);
- }
- void sys_sighandler_set(int sig, lwp_sighandler_t func)
- {
- lwp_sighandler_set(sig, func);
- }
- int sys_sigprocmask(const lwp_sigset_t *sigset, lwp_sigset_t *oset)
- {
- return lwp_sigprocmask(sigset, oset);
- }
- int sys_thread_kill(rt_thread_t thread, int sig)
- {
- return lwp_thread_kill(thread, sig);
- }
- void sys_thread_sighandler_set(int sig, lwp_sighandler_t func)
- {
- lwp_thread_sighandler_set(sig, func);
- }
- int sys_thread_sigprocmask(const lwp_sigset_t *sigset, lwp_sigset_t *oset)
- {
- return lwp_thread_sigprocmask(sigset, oset);
- }
- int32_t sys_waitpid(int32_t pid, int *status, int options)
- {
- return waitpid(pid, status, options);
- }
- #if defined(RT_USING_SAL) && defined(SAL_USING_POSIX)
- struct musl_addrinfo
- {
- int ai_flags;
- int ai_family;
- int ai_socktype;
- int ai_protocol;
- socklen_t ai_addrlen;
- struct musl_sockaddr *ai_addr;
- char *ai_canonname;
- struct musl_addrinfo *ai_next;
- };
- int sys_getaddrinfo(const char *nodename, const char *servname, const struct musl_addrinfo *hints, struct musl_addrinfo *res)
- {
- int ret = -1;
- struct addrinfo *k_res = NULL;
- char *k_nodename = NULL;
- char *k_servname = NULL;
- struct addrinfo *k_hints = NULL;
- LOG_I("syscall: getaddrinfo");
- if (nodename)
- {
- k_nodename = rt_strdup(nodename);
- if (!k_nodename) goto exit;
- }
- if (servname)
- {
- k_servname = rt_strdup(servname);
- if (!k_servname)
- {
- goto exit;
- }
- }
- if (hints)
- {
- k_hints = (struct addrinfo*) rt_malloc(sizeof *hints);
- if (!k_hints)
- {
- goto exit;
- }
- rt_memset(k_hints, 0x0, sizeof(struct addrinfo));
- k_hints->ai_flags = hints->ai_flags;
- k_hints->ai_family = hints->ai_family;
- k_hints->ai_socktype = hints->ai_socktype;
- k_hints->ai_protocol = hints->ai_protocol;
- k_hints->ai_addrlen = hints->ai_addrlen;
- }
- ret = sal_getaddrinfo(k_nodename, k_servname, k_hints, &k_res);
- if (ret == 0)
- {
- /* set sockaddr */
- sockaddr_tomusl(k_res->ai_addr, res->ai_addr);
- res->ai_addrlen = k_res->ai_addrlen;
- /* set up addrinfo */
- res->ai_family = k_res->ai_family;
- res->ai_flags = k_res->ai_flags;
- res->ai_next = NULL;
- if (hints != NULL)
- {
- /* copy socktype & protocol from hints if specified */
- res->ai_socktype = hints->ai_socktype;
- res->ai_protocol = hints->ai_protocol;
- }
- sal_freeaddrinfo(k_res);
- k_res = NULL;
- }
- exit:
- if (k_nodename)
- {
- rt_free(k_nodename);
- }
- if (k_servname)
- {
- rt_free(k_servname);
- }
- if (k_hints)
- {
- rt_free(k_hints);
- }
- return ret;
- }
- #define HOSTENT_BUFSZ 512
- int sys_gethostbyname2_r(const char *name, int af, struct hostent *ret,
- char *buf, size_t buflen,
- struct hostent **result, int *err)
- {
- int sal_ret, sal_err;
- struct hostent sal_he;
- struct hostent *sal_result = NULL;
- char *sal_buf = NULL;
- char *k_name = NULL;
- if (result == NULL)
- {
- /* not all arguments given */
- *err = EINVAL;
- return -1;
- }
- if ((name == NULL) || (ret == NULL) || (buf == NULL))
- {
- /* not all arguments given */
- *err = EINVAL;
- return -1;
- }
- *result = ret;
- sal_buf = (char *)malloc (HOSTENT_BUFSZ);
- if (sal_buf == NULL)
- {
- goto __exit;
- }
- k_name = rt_strdup(name);
- if (k_name == NULL)
- {
- goto __exit;
- }
- /* get host by name in SAL */
- sal_ret = sal_gethostbyname_r(k_name, &sal_he, sal_buf, HOSTENT_BUFSZ, &sal_result, &sal_err);
- if (sal_ret == 0)
- {
- int index, cnt;
- char *ptr = buf;
- /* get counter */
- index = 0;
- while (sal_he.h_addr_list[index] != NULL) index ++;
- cnt = index + 1;
- /* update user space hostent */
- ret->h_addrtype = sal_he.h_addrtype;
- ret->h_length = sal_he.h_length;
- rt_strncpy(ptr, k_name, buflen - (ptr - buf));
- ret->h_name = ptr;
- ptr += rt_strlen(k_name);
- ret->h_addr_list = (char**)ptr;
- ptr += cnt * sizeof(char*);
- index = 0;
- while (sal_he.h_addr_list[index] != NULL)
- {
- ret->h_addr_list[index] = ptr;
- rt_memcpy(ptr, sal_he.h_addr_list[index], sal_he.h_length);
- ptr += sal_he.h_length;
- index ++;
- }
- ret->h_addr_list[index] = NULL;
- }
- __exit:
- /* release buffer */
- if (sal_buf) free(sal_buf);
- if (k_name) free(k_name);
- return 0;
- }
- #endif
- char *sys_getcwd(char *buf, size_t size)
- {
- return getcwd(buf, size);
- }
- int sys_chdir(const char *path)
- {
- return chdir(path);
- }
- int sys_mkdir(const char *path, mode_t mode)
- {
- return mkdir(path, mode);
- }
- int sys_rmdir(const char *path)
- {
- return unlink(path);
- }
- typedef uint64_t ino_t;
- struct libc_dirent {
- ino_t d_ino;
- off_t d_off;
- unsigned short d_reclen;
- unsigned char d_type;
- char d_name[256];
- };
- int sys_getdents(int fd, struct libc_dirent *dirp, size_t nbytes)
- {
- int ret;
- struct dfs_fd *dfs_fd;
- size_t cnt = (nbytes / sizeof(struct libc_dirent));
- size_t rtt_nbytes;
- struct dirent *rtt_dirp;
- if (cnt == 0)
- {
- return 0;
- }
- rtt_nbytes = cnt * sizeof(struct dirent);
- rtt_dirp = (struct dirent*)rt_malloc(rtt_nbytes);
- if (!rtt_dirp)
- {
- return 0;
- }
- dfs_fd = fd_get(fd);
- ret = dfs_file_getdents(dfs_fd, rtt_dirp, nbytes);
- fd_put(dfs_fd);
- if (ret)
- {
- size_t i;
- cnt = ret / sizeof(struct dirent);
- for (i = 0; i < cnt; i++)
- {
- dirp[i].d_ino = 0;
- dirp[i].d_off = 0;
- dirp[i].d_type = rtt_dirp[i].d_type;
- dirp[i].d_reclen = sizeof(struct libc_dirent);
- strcpy(dirp[i].d_name, rtt_dirp[i].d_name);
- }
- ret = cnt * sizeof(struct libc_dirent);
- }
- rt_free(rtt_dirp);
- return ret;
- }
- rt_err_t sys_get_errno(void)
- {
- return rt_get_errno();
- }
- void sys_set_thread_area(void *p)
- {
- lwp_set_thread_area(p);
- }
- long sys_set_tid_address(int *tidptr)
- {
- return 0;
- }
- int sys_access(const char *filename, int mode)
- {
- int ret;
- #ifdef RT_USING_USERSPACE
- rt_size_t len;
- char *kname;
- if (!lwp_user_accessable((void*)filename, 1))
- return -1;
- len = rt_strlen(filename);
- if (!len)
- return -1;
- kname = (char *)kmem_get(len + 1);
- if (!kname)
- return -1;
- lwp_get_from_user(kname, (void *)filename, len + 1);
- ret = open(kname, mode, 0);
- kmem_put(kname);
- #else
- ret = open(filename, mode, 0);
- #endif
- if (ret >= 0)
- {
- close(ret);
- }
- return (ret >= 0)? 0: ret;
- }
- int sys_pipe(int fd[2])
- {
- /* not implemented */
- return -1;
- }
- const static void* func_table[] =
- {
- (void*)sys_exit, /* 01 */
- (void*)sys_read,
- (void*)sys_write,
- (void*)sys_lseek,
- (void*)sys_open, /* 05 */
- (void*)sys_close,
- (void*)sys_ioctl,
- (void*)sys_fstat,
- (void*)sys_poll,
- (void*)sys_nanosleep, /* 10 */
- (void*)sys_gettimeofday,
- (void*)sys_settimeofday,
- (void*)sys_exec,
- (void*)sys_kill,
- (void*)sys_getpid, /* 15 */
- (void*)sys_getpriority,
- (void*)sys_setpriority,
- (void*)sys_sem_create,
- (void*)sys_sem_delete,
- (void*)sys_sem_take, /* 20 */
- (void*)sys_sem_release,
- (void*)sys_mutex_create,
- (void*)sys_mutex_delete,
- (void*)sys_mutex_take,
- (void*)sys_mutex_release, /* 25 */
- (void*)sys_event_create,
- (void*)sys_event_delete,
- (void*)sys_event_send,
- (void*)sys_event_recv,
- (void*)sys_mb_create, /* 30 */
- (void*)sys_mb_delete,
- (void*)sys_mb_send,
- (void*)sys_mb_send_wait,
- (void*)sys_mb_recv,
- (void*)sys_mq_create, /* 35 */
- (void*)sys_mq_delete,
- (void*)sys_mq_send,
- (void*)sys_mq_urgent,
- (void*)sys_mq_recv,
- (void*)sys_thread_create, /* 40 */
- (void*)sys_thread_delete,
- (void*)sys_thread_startup,
- (void*)sys_thread_self,
- (void*)sys_channel_open,
- (void*)sys_channel_close, /* 45 */
- (void*)sys_channel_send,
- (void*)sys_channel_send_recv_timeout,
- (void*)sys_channel_reply,
- (void*)sys_channel_recv_timeout,
- (void*)sys_enter_critical, /* 50 */
- (void*)sys_exit_critical,
- SYSCALL_USPACE(sys_brk),
- SYSCALL_USPACE(sys_mmap2),
- SYSCALL_USPACE(sys_munmap),
- SYSCALL_USPACE(sys_shmget),
- SYSCALL_USPACE(sys_shmrm),
- SYSCALL_USPACE(sys_shmat),
- SYSCALL_USPACE(sys_shmdt),
- (void *)sys_device_init,
- (void *)sys_device_register,
- (void *)sys_device_control,
- (void *)sys_device_find,
- (void *)sys_device_open,
- (void *)sys_device_close,
- (void *)sys_device_read,
- (void *)sys_device_write,
- (void *)sys_stat,
- (void *)sys_thread_find,
- SYSCALL_NET(sys_accept),
- SYSCALL_NET(sys_bind),
- SYSCALL_NET(sys_shutdown),
- SYSCALL_NET(sys_getpeername),
- SYSCALL_NET(sys_getsockname),
- SYSCALL_NET(sys_getsockopt),
- SYSCALL_NET(sys_setsockopt),
- SYSCALL_NET(sys_connect),
- SYSCALL_NET(sys_listen),
- SYSCALL_NET(sys_recv),
- SYSCALL_NET(sys_recvfrom),
- SYSCALL_NET(sys_send),
- SYSCALL_NET(sys_sendto),
- SYSCALL_NET(sys_socket),
- SYSCALL_NET(sys_closesocket),
- SYSCALL_NET(sys_getaddrinfo),
- SYSCALL_NET(sys_gethostbyname2_r),
- (void *)sys_notimpl, //(void *)network,
- (void *)sys_notimpl, //(void *)network,
- (void *)sys_notimpl, //(void *)network,
- (void *)sys_notimpl, //(void *)network,
- (void *)sys_notimpl, //(void *)network,
- (void *)sys_notimpl, //(void *)network,
- (void *)sys_notimpl, //(void *)network,
- (void *)sys_notimpl, //(void *)network,
- #ifdef RT_USING_DFS
- (void *)sys_select,
- #else
- (void *)sys_notimpl,
- #endif
- (void *)sys_notimpl, //(void *)sys_hw_interrupt_disable,
- (void *)sys_notimpl, //(void *)sys_hw_interrupt_enable,
- (void *)sys_tick_get,
- (void *)sys_exit_group,
- (void *)sys_notimpl, //(void *)rt_delayed_work_init,
- (void *)sys_notimpl, //(void *)rt_work_submit,
- (void *)sys_notimpl, //(void *)rt_wqueue_wakeup,
- (void *)sys_thread_mdelay,
- (void*)sys_sighandler_set,
- (void*)sys_sigprocmask,
- (void*)sys_thread_kill,
- (void*)sys_thread_sighandler_set,
- (void*)sys_thread_sigprocmask,
- (void*)sys_notimpl,
- (void*)sys_notimpl,
- (void*)sys_waitpid,
- (void *)sys_timer_create,
- (void *)sys_timer_delete,
- (void *)sys_timer_start,
- (void *)sys_timer_stop,
- (void *)sys_timer_control,
- (void *)sys_getcwd,
- (void *)sys_chdir,
- (void *)sys_unlink,
- (void *)sys_mkdir,
- (void *)sys_rmdir,
- (void *)sys_getdents,
- (void *)sys_get_errno,
- (void *)sys_set_thread_area,
- (void *)sys_set_tid_address,
- (void *)sys_access,
- (void *)sys_pipe,
- };
- const void *lwp_get_sys_api(rt_uint32_t number)
- {
- const void *func = (const void*)sys_notimpl;
- if (number == 0xff)
- {
- func = (void *)sys_log;
- }
- else
- {
- number -= 1;
- if (number < sizeof(func_table)/sizeof(func_table[0]))
- {
- func = func_table[number];
- }
- }
- return func;
- }
|