rt-thread/components/lwp/lwp_syscall.c

/*
 * 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

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_data_access_ok(&lwp_self()->mmu_info, (void*)buf, nbyte))
        return 0;

    kmem = kmem_get(nbyte);
    if (!kmem)
        return 0;

    ret = read(fd, kmem, nbyte);
    if (ret)
        lwp_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (void*)buf, nbyte))
        return 0;

    kmem = kmem_get(nbyte);
    if (!kmem)
        return 0;

    lwp_data_get(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (void*)name, 1))
        return -1;

    len = rt_strlen(name);
    if (!len)
        return -1;

    kname = (char *)kmem_get(len + 1);
    if (!kname)
        return -1;

    lwp_data_get(&lwp_self()->mmu_info, 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_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (void*)fds, nfds * sizeof *fds))
        return -1;

    kfds = (struct pollfd *)kmem_get(nfds * sizeof *kfds);
    if (!kfds)
        return -1;

    lwp_data_get(&lwp_self()->mmu_info, kfds, fds, nfds * sizeof *kfds);
    ret = poll(kfds, nfds, timeout);
    lwp_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (void*)readfds, nfds * sizeof *readfds))
            return -1;
        kreadfds = (fd_set *)kmem_get(nfds * sizeof *kreadfds);
        if (!kreadfds)
            goto quit;
        lwp_data_get(&lwp_self()->mmu_info, kreadfds, readfds, nfds * sizeof *kreadfds);
    }
    if (writefds)
    {
        if (!lwp_data_access_ok(&lwp_self()->mmu_info, (void*)writefds, nfds * sizeof *writefds))
            return -1;
        kwritefds = (fd_set *)kmem_get(nfds * sizeof *kwritefds);
        if (!kwritefds)
            goto quit;
        lwp_data_get(&lwp_self()->mmu_info, kwritefds, writefds, nfds * sizeof *kwritefds);
    }
    if (exceptfds)
    {
        if (!lwp_data_access_ok(&lwp_self()->mmu_info, (void*)exceptfds, nfds * sizeof *exceptfds))
            return -1;
        kexceptfds = (fd_set *)kmem_get(nfds * sizeof *kexceptfds);
        if (!kexceptfds)
            goto quit;
        lwp_data_get(&lwp_self()->mmu_info, kexceptfds, exceptfds, nfds * sizeof *kexceptfds);
    }

    ret = select(nfds, kreadfds, kwritefds, kexceptfds, timeout);
    if (kreadfds)
        lwp_data_put(&lwp_self()->mmu_info, readfds, kreadfds, nfds * sizeof *kreadfds);
    if (kwritefds)
        lwp_data_put(&lwp_self()->mmu_info, writefds, kwritefds, nfds * sizeof *kwritefds);
    if (kexceptfds)
        lwp_data_put(&lwp_self()->mmu_info, exceptfds, kexceptfds, nfds * 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_data_access_ok(&lwp_self()->mmu_info, (void*)pathname, 1))
        return -1;

    len = rt_strlen(pathname);
    if (!len)
        return -1;

    kname = (char *)kmem_get(len + 1);
    if (!kname)
        return -1;

    lwp_data_get(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (void*)rqtp, sizeof *rqtp))
        return -1;

    lwp_data_get(&lwp_self()->mmu_info, &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_data_access_ok(&lwp_self()->mmu_info, (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_data_put(&lwp_self()->mmu_info, 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_data_access_ok(&lwp_self()->mmu_info, (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_data_put(&lwp_self()->mmu_info, 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(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(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)
{
    struct sockaddr sa;
    sockaddr_tolwip(addr, &sa);

    return accept(socket, &sa, addrlen);
}

int sys_bind(int socket, const struct musl_sockaddr *name, socklen_t namelen)
{
    struct sockaddr sa;
    sockaddr_tolwip(name, &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;
    sockaddr_tolwip(name, &sa);

    ret = getpeername (socket, &sa, namelen);
    if (name) sockaddr_tomusl(&sa, name);

    return ret;
}

int sys_getsockname (int socket, struct musl_sockaddr *name, socklen_t *namelen)
{
    int ret;
    struct sockaddr sa;
    sockaddr_tolwip(name, &sa);

    ret = getsockname (socket, &sa, namelen);
    if (name) sockaddr_tomusl(&sa, name);

    return ret;
}

int sys_getsockopt (int socket, int level, int optname, void *optval, socklen_t *optlen)
{
    LOG_I("syscall: getsockopt");

    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");

    return setsockopt (socket, level, optname, optval, optlen);
}

int sys_connect(int socket, const struct musl_sockaddr *name, socklen_t namelen)
{
    struct sockaddr sa;
    sockaddr_tolwip(name, &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_data_access_ok(&lwp_self()->mmu_info, (void*)mem, len))
        return -1;

    kmem = kmem_get(len);
    if (!kmem)
        return -1;

    if (flags == 0x2) {
        flags = 0x1;
    }

    if (from)
    {
        struct sockaddr sa;
        sockaddr_tolwip(from, &sa);

        ret = recvfrom(socket, kmem, len, flgs, &sa, fromlen);
    } else
        ret = recvfrom(socket, kmem, len, flgs, NULL, NULL);

    if (ret > 0)
        lwp_data_put(&lwp_self()->mmu_info, mem, kmem, len);

    kmem_put(kmem);
    return ret;
#else
    if (from)
    {
        struct sockaddr sa;
        sockaddr_tolwip(from, &sa);

        return recvfrom(socket, mem, len, flgs, &sa, fromlen);
    }

    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_data_access_ok(&lwp_self()->mmu_info, (void*)dataptr, size))
        return -1;

    kmem = kmem_get(size);
    if (!kmem)
        return -1;

    lwp_data_get(&lwp_self()->mmu_info, 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)
{
    /* not support SOCK_CLOEXEC type */
    if (type & SOCK_CLOEXEC) type &= ~SOCK_CLOEXEC;

    return socket(domain, type, protocol);
}

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;

        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_data_access_ok(&lwp_self()->mmu_info, (void*)filename, 1))
        return -1;

    len = rt_strlen(filename);
    if (!len)
        return -1;

    kname = (char *)kmem_get(len + 1);
    if (!kname)
        return -1;

    lwp_data_get(&lwp_self()->mmu_info, 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;
}