12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913 |
- /*
- * 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;
- }
- 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,
- };
- 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;
- }
|