2018-12-10 16:31:33 +08:00
|
|
|
/*
|
2023-01-07 15:41:52 +08:00
|
|
|
* Copyright (c) 2006-2023, RT-Thread Development Team
|
2018-12-10 16:31:33 +08:00
|
|
|
*
|
2018-12-10 18:23:21 +08:00
|
|
|
* SPDX-License-Identifier: Apache-2.0
|
2018-12-10 16:31:33 +08:00
|
|
|
*
|
|
|
|
* Change Logs:
|
|
|
|
* Date Author Notes
|
2018-12-10 18:23:21 +08:00
|
|
|
* 2018-06-10 Bernard first version
|
2022-12-03 12:07:44 +08:00
|
|
|
* 2021-02-03 lizhirui add limit condition for network syscall and add 64-bit arch support
|
|
|
|
* 2021-02-06 lizhirui fix some bugs
|
|
|
|
* 2021-02-12 lizhirui add 64-bit support for sys_brk
|
|
|
|
* 2021-02-20 lizhirui fix some warnings
|
2023-03-13 19:09:34 +08:00
|
|
|
* 2023-03-13 WangXiaoyao Format & fix syscall return value
|
2023-07-20 00:02:41 +08:00
|
|
|
* 2023-07-06 Shell adapt the signal API, and clone, fork to new implementation of lwp signal
|
2023-10-25 20:31:25 +08:00
|
|
|
* 2023-07-27 Shell Move tid_put() from lwp_free() to sys_exit()
|
2024-03-28 23:42:56 +08:00
|
|
|
* 2023-11-16 xqyjlj fix some syscalls (about sched_*, get/setpriority)
|
|
|
|
* 2023-11-17 xqyjlj add process group and session support
|
|
|
|
* 2023-11-30 Shell Fix sys_setitimer() and exit(status)
|
2018-12-10 16:31:33 +08:00
|
|
|
*/
|
2024-02-23 17:49:15 +08:00
|
|
|
#define __RT_IPC_SOURCE__
|
2022-12-03 12:07:44 +08:00
|
|
|
#define _GNU_SOURCE
|
2023-07-20 00:02:41 +08:00
|
|
|
|
2018-12-10 16:31:33 +08:00
|
|
|
/* RT-Thread System call */
|
2023-01-09 10:08:55 +08:00
|
|
|
#include <rtthread.h>
|
2022-12-03 12:07:44 +08:00
|
|
|
#include <rthw.h>
|
|
|
|
#include <board.h>
|
2023-10-25 20:31:25 +08:00
|
|
|
|
2023-01-09 10:08:55 +08:00
|
|
|
#include <string.h>
|
2023-02-28 10:45:05 +08:00
|
|
|
#include <stdint.h>
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
#define DBG_TAG "lwp.syscall"
|
2023-03-13 19:09:34 +08:00
|
|
|
#define DBG_LVL DBG_INFO
|
|
|
|
#include <rtdbg.h>
|
|
|
|
|
|
|
|
#include "syscall_generic.h"
|
|
|
|
|
2023-10-14 13:07:45 +08:00
|
|
|
#include "libc_musl.h"
|
|
|
|
#include "lwp_internal.h"
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-10-25 20:31:25 +08:00
|
|
|
#include <mm_aspace.h>
|
2022-12-03 12:07:44 +08:00
|
|
|
#include <lwp_user_mm.h>
|
|
|
|
#include <lwp_arch.h>
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#include <fcntl.h>
|
2023-03-27 17:09:37 +08:00
|
|
|
#include <sys/utsname.h>
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
#ifdef RT_USING_DFS
|
2023-07-27 17:24:56 +08:00
|
|
|
#include <eventfd.h>
|
2021-09-11 23:48:14 +08:00
|
|
|
#include <poll.h>
|
2023-08-01 17:15:41 +08:00
|
|
|
#include <sys/epoll.h>
|
2021-09-23 04:45:21 +08:00
|
|
|
#include <sys/select.h>
|
2022-12-03 12:07:44 +08:00
|
|
|
#include <dfs_file.h>
|
2023-06-10 21:35:25 +08:00
|
|
|
#ifdef RT_USING_DFS_V2
|
|
|
|
#include <dfs_dentry.h>
|
|
|
|
#endif
|
2022-12-03 12:07:44 +08:00
|
|
|
#include <unistd.h>
|
|
|
|
#include <stdio.h> /* rename() */
|
|
|
|
#include <sys/stat.h>
|
|
|
|
#include <sys/statfs.h> /* statfs() */
|
2023-09-11 14:06:08 +08:00
|
|
|
#include <sys/timerfd.h>
|
2024-03-28 23:42:56 +08:00
|
|
|
#include <sys/ioctl.h>
|
2023-09-11 14:06:08 +08:00
|
|
|
#ifdef RT_USING_MUSLLIBC
|
|
|
|
#include <sys/signalfd.h>
|
|
|
|
#endif
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif
|
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
#include "mqueue.h"
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
#ifdef RT_USING_SAL
|
|
|
|
#include <netdev_ipaddr.h>
|
|
|
|
#include <netdev.h>
|
|
|
|
|
|
|
|
#include <sal_netdb.h>
|
|
|
|
#include <sal_socket.h>
|
|
|
|
#include <sys/socket.h>
|
|
|
|
|
|
|
|
#endif /* RT_USING_SAL */
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
#if (defined(RT_USING_SAL) && defined(SAL_USING_POSIX))
|
2023-03-13 19:09:34 +08:00
|
|
|
#include <sys/socket.h>
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
#define SYSCALL_NET(f) f
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
2023-03-13 19:09:34 +08:00
|
|
|
#define SYSCALL_NET(f) SYSCALL_SIGN(sys_notimpl)
|
|
|
|
#endif /* (defined(RT_USING_SAL) && defined(SAL_USING_POSIX)) */
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#if defined(RT_USING_DFS) && defined(ARCH_MM_MMU)
|
2023-03-13 19:09:34 +08:00
|
|
|
#define SYSCALL_USPACE(f) f
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
2023-03-13 19:09:34 +08:00
|
|
|
#define SYSCALL_USPACE(f) SYSCALL_SIGN(sys_notimpl)
|
|
|
|
#endif /* defined(RT_USING_DFS) && defined(ARCH_MM_MMU) */
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
#include "lwp_ipc_internal.h"
|
|
|
|
#include <sched.h>
|
2023-03-13 19:09:34 +08:00
|
|
|
|
2023-05-23 22:43:38 +08:00
|
|
|
#include <sys/sysinfo.h>
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
#ifndef GRND_NONBLOCK
|
2023-01-07 15:41:52 +08:00
|
|
|
#define GRND_NONBLOCK 0x0001
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif /* GRND_NONBLOCK */
|
|
|
|
|
|
|
|
#ifndef GRND_RANDOM
|
2023-01-07 15:41:52 +08:00
|
|
|
#define GRND_RANDOM 0x0002
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif /*GRND_RANDOM */
|
|
|
|
|
2023-02-28 09:36:03 +08:00
|
|
|
#ifndef RT_USING_POSIX_TIMER
|
|
|
|
#error "No definition RT_USING_POSIX_TIMER"
|
2023-03-13 19:09:34 +08:00
|
|
|
#endif /* RT_USING_POSIX_TIMER */
|
|
|
|
|
2023-02-28 09:36:03 +08:00
|
|
|
#ifndef RT_USING_POSIX_CLOCK
|
|
|
|
#error "No definition RT_USING_POSIX_CLOCK"
|
2023-03-13 19:09:34 +08:00
|
|
|
#endif /* RT_USING_POSIX_CLOCK */
|
2023-02-28 09:36:03 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
void lwp_cleanup(struct rt_thread *tid);
|
|
|
|
|
|
|
|
#ifdef ARCH_MM_MMU
|
2023-03-13 19:09:34 +08:00
|
|
|
#define ALLOC_KERNEL_STACK_SIZE 5120
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
static void *kmem_get(size_t size)
|
|
|
|
{
|
|
|
|
return rt_malloc(size);
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
static void kmem_put(void *kptr)
|
|
|
|
{
|
|
|
|
rt_free(kptr);
|
|
|
|
}
|
|
|
|
#else /* ARCH_MM_MMU */
|
|
|
|
#define ALLOC_KERNEL_STACK_SIZE 1536
|
|
|
|
#define ALLOC_KERNEL_STACK_SIZE_MIN 1024
|
|
|
|
#define ALLOC_KERNEL_STACK_SIZE_MAX 4096
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
extern void set_user_context(void *stack);
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
|
|
|
|
#ifdef RT_USING_SAL
|
2023-03-13 19:09:34 +08:00
|
|
|
/* The same socket option is defined differently in the user interfaces and the
|
|
|
|
* implementation. The options should be converted in the kernel. */
|
|
|
|
#include "lwp_sys_socket.h"
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
static void convert_sockopt(int *level, int *optname)
|
|
|
|
{
|
|
|
|
if (*level == INTF_SOL_SOCKET)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-03-13 19:09:34 +08:00
|
|
|
*level = IMPL_SOL_SOCKET;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
return;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
if (*level == INTF_IPPROTO_IP)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-03-13 19:09:34 +08:00
|
|
|
*level = IMPL_IPPROTO_IP;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
switch (*optname)
|
|
|
|
{
|
|
|
|
case INTF_IP_TTL:
|
|
|
|
*optname = IMPL_IP_TTL;
|
|
|
|
break;
|
|
|
|
case INTF_IP_TOS:
|
|
|
|
*optname = IMPL_IP_TOS;
|
|
|
|
break;
|
|
|
|
case INTF_IP_MULTICAST_TTL:
|
|
|
|
*optname = IMPL_IP_MULTICAST_TTL;
|
|
|
|
break;
|
|
|
|
case INTF_IP_MULTICAST_IF:
|
|
|
|
*optname = IMPL_IP_MULTICAST_IF;
|
|
|
|
break;
|
|
|
|
case INTF_IP_MULTICAST_LOOP:
|
|
|
|
*optname = IMPL_IP_MULTICAST_LOOP;
|
|
|
|
break;
|
|
|
|
case INTF_IP_ADD_MEMBERSHIP:
|
|
|
|
*optname = IMPL_IP_ADD_MEMBERSHIP;
|
|
|
|
break;
|
|
|
|
case INTF_IP_DROP_MEMBERSHIP:
|
|
|
|
*optname = IMPL_IP_DROP_MEMBERSHIP;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
if (*level == INTF_IPPROTO_TCP)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-03-13 19:09:34 +08:00
|
|
|
*level = IMPL_IPPROTO_TCP;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
switch (*optname)
|
|
|
|
{
|
|
|
|
case INTF_TCP_NODELAY:
|
|
|
|
*optname = IMPL_TCP_NODELAY;
|
|
|
|
break;
|
|
|
|
case INTF_TCP_KEEPALIVE:
|
|
|
|
*optname = IMPL_TCP_KEEPALIVE;
|
|
|
|
break;
|
|
|
|
case INTF_TCP_KEEPIDLE:
|
|
|
|
*optname = IMPL_TCP_KEEPIDLE;
|
|
|
|
break;
|
|
|
|
case INTF_TCP_KEEPINTVL:
|
|
|
|
*optname = IMPL_TCP_KEEPINTVL;
|
|
|
|
break;
|
|
|
|
case INTF_TCP_KEEPCNT:
|
|
|
|
*optname = IMPL_TCP_KEEPCNT;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
return;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
if (*level == INTF_IPPROTO_IPV6)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-03-13 19:09:34 +08:00
|
|
|
*level = IMPL_IPPROTO_IPV6;
|
|
|
|
|
|
|
|
switch (*optname)
|
|
|
|
{
|
|
|
|
case INTF_IPV6_V6ONLY:
|
|
|
|
*optname = IMPL_IPV6_V6ONLY;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
return;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif /* RT_USING_SAL */
|
|
|
|
|
|
|
|
#if defined(RT_USING_LWIP) || defined(SAL_USING_UNET)
|
|
|
|
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));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
static void _crt_thread_entry(void *parameter)
|
|
|
|
{
|
|
|
|
rt_thread_t tid;
|
|
|
|
rt_size_t user_stack;
|
|
|
|
|
|
|
|
tid = rt_thread_self();
|
|
|
|
|
|
|
|
user_stack = (rt_size_t)tid->user_stack + tid->user_stack_size;
|
|
|
|
user_stack &= ~7; //align 8
|
|
|
|
|
|
|
|
#ifdef ARCH_MM_MMU
|
2023-04-22 23:59:11 +08:00
|
|
|
arch_crt_start_umode(parameter, tid->user_entry, (void *)user_stack, (char *)tid->stack_addr + tid->stack_size);
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
set_user_context((void*)user_stack);
|
|
|
|
arch_start_umode(parameter, tid->user_entry, ((struct rt_lwp *)tid->lwp)->data_entry, (void*)user_stack);
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
}
|
|
|
|
|
2023-09-09 09:35:56 +08:00
|
|
|
/* exit group */
|
|
|
|
sysret_t sys_exit_group(int value)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
sysret_t rc = 0;
|
2024-03-28 23:42:56 +08:00
|
|
|
lwp_status_t lwp_status;
|
2023-11-02 20:23:11 +08:00
|
|
|
struct rt_lwp *lwp = lwp_self();
|
2023-08-03 20:25:13 +08:00
|
|
|
|
2023-11-02 20:23:11 +08:00
|
|
|
if (lwp)
|
2024-03-28 23:42:56 +08:00
|
|
|
{
|
|
|
|
lwp_status = LWP_CREATE_STAT_EXIT(value);
|
|
|
|
lwp_exit(lwp, lwp_status);
|
|
|
|
}
|
2023-11-02 20:23:11 +08:00
|
|
|
else
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
LOG_E("Can't find matching process of current thread");
|
|
|
|
rc = -EINVAL;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-11-02 20:23:11 +08:00
|
|
|
return rc;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-09-09 09:35:56 +08:00
|
|
|
/* thread exit */
|
2023-11-02 20:23:11 +08:00
|
|
|
sysret_t sys_exit(int status)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
sysret_t rc = 0;
|
|
|
|
rt_thread_t tid;
|
2023-09-09 09:35:56 +08:00
|
|
|
|
|
|
|
tid = rt_thread_self();
|
2023-11-02 20:23:11 +08:00
|
|
|
if (tid && tid->lwp)
|
2024-03-28 23:42:56 +08:00
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
lwp_thread_exit(tid, status);
|
2024-03-28 23:42:56 +08:00
|
|
|
}
|
|
|
|
else
|
2023-09-09 09:35:56 +08:00
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
LOG_E("Can't find matching process of current thread");
|
|
|
|
rc = -EINVAL;
|
2023-09-09 09:35:56 +08:00
|
|
|
}
|
|
|
|
|
2023-11-02 20:23:11 +08:00
|
|
|
return rc;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* syscall: "read" ret: "ssize_t" args: "int" "void *" "size_t" */
|
|
|
|
ssize_t sys_read(int fd, void *buf, size_t nbyte)
|
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
void *kmem = RT_NULL;
|
|
|
|
ssize_t ret = -1;
|
|
|
|
|
|
|
|
if (!nbyte)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, nbyte))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem = kmem_get(nbyte);
|
|
|
|
if (!kmem)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = read(fd, kmem, nbyte);
|
|
|
|
if (ret > 0)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
if (ret != lwp_put_to_user(buf, kmem, ret))
|
|
|
|
return -EFAULT;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
kmem_put(kmem);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)buf, nbyte))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
ssize_t ret = read(fd, buf, nbyte);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/* syscall: "write" ret: "ssize_t" args: "int" "const void *" "size_t" */
|
|
|
|
ssize_t sys_write(int fd, const void *buf, size_t nbyte)
|
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
void *kmem = RT_NULL;
|
|
|
|
ssize_t ret = -1;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
if (nbyte)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
if (!lwp_user_accessable((void *)buf, nbyte))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
kmem = kmem_get(nbyte);
|
|
|
|
if (!kmem)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
lwp_get_from_user(kmem, (void *)buf, nbyte);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
ret = write(fd, kmem, nbyte);
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
kmem_put(kmem);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)buf, nbyte))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
ssize_t ret = write(fd, buf, nbyte);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/* syscall: "lseek" ret: "off_t" args: "int" "off_t" "int" */
|
2023-10-14 13:09:17 +08:00
|
|
|
size_t sys_lseek(int fd, size_t offset, int whence)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-10-14 13:09:17 +08:00
|
|
|
size_t ret = lseek(fd, offset, whence);
|
2022-12-03 12:07:44 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* syscall: "open" ret: "int" args: "const char *" "int" "..." */
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_open(const char *name, int flag, ...)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
|
|
|
rt_size_t len = 0;
|
|
|
|
char *kname = RT_NULL;
|
2023-06-10 21:35:25 +08:00
|
|
|
mode_t mode = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)name, 1))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(name);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!len)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2023-06-10 21:35:25 +08:00
|
|
|
if ((flag & O_CREAT) || (flag & O_TMPFILE) == O_TMPFILE)
|
|
|
|
{
|
|
|
|
va_list ap;
|
|
|
|
va_start(ap, flag);
|
|
|
|
mode = va_arg(ap, mode_t);
|
|
|
|
va_end(ap);
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2023-06-10 21:35:25 +08:00
|
|
|
ret = open(kname, flag, mode);
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
kmem_put(kname);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
2023-06-10 21:35:25 +08:00
|
|
|
int ret;
|
|
|
|
mode_t mode = 0;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)name, 1))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-06-10 21:35:25 +08:00
|
|
|
|
|
|
|
if ((flag & O_CREAT) || (flag & O_TMPFILE) == O_TMPFILE)
|
|
|
|
{
|
|
|
|
va_list ap;
|
|
|
|
va_start(ap, flag);
|
|
|
|
mode = va_arg(ap, mode_t);
|
|
|
|
va_end(ap);
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = open(name, flag, mode);
|
2022-12-03 12:07:44 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-08-08 00:22:14 +08:00
|
|
|
/* syscall: "openat" ret: "int" args: "const char *" "mode_t" "mode" */
|
2023-05-15 20:40:27 +08:00
|
|
|
sysret_t sys_openat(int dirfd, const char *name, int flag, mode_t mode)
|
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
int ret = -1;
|
|
|
|
rt_size_t len = 0;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
2023-05-15 20:40:27 +08:00
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_get_from_user(kname, (void *)name, len + 1);
|
|
|
|
ret = openat(dirfd, kname, flag, mode);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)name, 1))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
int ret = openat(dirfd, name, flag, mode);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
/* syscall: "close" ret: "int" args: "int" */
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_close(int fd)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = close(fd);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* syscall: "ioctl" ret: "int" args: "int" "u_long" "..." */
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_ioctl(int fd, unsigned long cmd, void* data)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = ioctl(fd, cmd, data);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_fstat(int file, struct stat *buf)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
2023-02-24 21:00:54 +08:00
|
|
|
struct stat statbuff = {0};
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, sizeof(struct stat)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = fstat(file, &statbuff);
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(buf, &statbuff, sizeof statbuff);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)buf, sizeof(struct stat)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
int ret = fstat(file, buf);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_poll(struct pollfd *fds, nfds_t nfds, int timeout)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = -1;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
struct pollfd *kfds = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)fds, nfds * sizeof *fds))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kfds = (struct pollfd *)kmem_get(nfds * sizeof *kfds);
|
|
|
|
if (!kfds)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_get_from_user(kfds, fds, nfds * sizeof *kfds);
|
|
|
|
|
|
|
|
ret = poll(kfds, nfds, timeout);
|
|
|
|
if (ret > 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(fds, kfds, nfds * sizeof *kfds);
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem_put(kfds);
|
|
|
|
return ret;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)fds, nfds * sizeof *fds))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
ret = poll(fds, nfds, timeout);
|
|
|
|
return ret;
|
2022-12-16 18:38:28 +08:00
|
|
|
#endif /* ARCH_MM_MMU */
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_select(int nfds, fd_set *readfds, fd_set *writefds, fd_set *exceptfds, struct timeval *timeout)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
|
|
|
fd_set *kreadfds = RT_NULL, *kwritefds = RT_NULL, *kexceptfds = RT_NULL;
|
|
|
|
|
|
|
|
if (readfds)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)readfds, sizeof *readfds))
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto quit;
|
|
|
|
}
|
|
|
|
kreadfds = (fd_set *)kmem_get(sizeof *kreadfds);
|
|
|
|
if (!kreadfds)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto quit;
|
|
|
|
}
|
|
|
|
lwp_get_from_user(kreadfds, readfds, sizeof *kreadfds);
|
|
|
|
}
|
|
|
|
if (writefds)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)writefds, sizeof *writefds))
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto quit;
|
|
|
|
}
|
|
|
|
kwritefds = (fd_set *)kmem_get(sizeof *kwritefds);
|
|
|
|
if (!kwritefds)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto quit;
|
|
|
|
}
|
|
|
|
lwp_get_from_user(kwritefds, writefds, sizeof *kwritefds);
|
|
|
|
}
|
|
|
|
if (exceptfds)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)exceptfds, sizeof *exceptfds))
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto quit;
|
|
|
|
}
|
|
|
|
kexceptfds = (fd_set *)kmem_get(sizeof *kexceptfds);
|
|
|
|
if (!kexceptfds)
|
|
|
|
{
|
|
|
|
SET_ERRNO(EINVAL);
|
|
|
|
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:
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (kreadfds)
|
|
|
|
{
|
|
|
|
kmem_put(kreadfds);
|
|
|
|
}
|
|
|
|
if (kwritefds)
|
|
|
|
{
|
|
|
|
kmem_put(kwritefds);
|
|
|
|
}
|
|
|
|
if (kexceptfds)
|
|
|
|
{
|
|
|
|
kmem_put(kexceptfds);
|
|
|
|
}
|
2023-02-07 18:53:05 +08:00
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)readfds, sizeof *readfds))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
if (!lwp_user_accessable((void *)writefds, sizeof *writefds))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
if (!lwp_user_accessable((void *)exceptfds, sizeof *exceptfds))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
ret = select(nfds, readfds, writefds, exceptfds, timeout);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_unlink(const char *pathname)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
|
|
|
rt_size_t len = 0;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(pathname);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!len)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
if (lwp_get_from_user(kname, (void *)pathname, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
ret = unlink(kname);
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
kmem_put(kname);
|
2023-02-07 18:53:05 +08:00
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
int ret = 0;
|
|
|
|
ret = unlink(pathname);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/* syscall: "nanosleep" ret: "int" args: "const struct timespec *" "struct timespec *" */
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_nanosleep(const struct timespec *rqtp, struct timespec *rmtp)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
dbg_log(DBG_LOG, "sys_nanosleep\n");
|
|
|
|
if (!lwp_user_accessable((void *)rqtp, sizeof *rqtp))
|
|
|
|
return -EFAULT;
|
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
struct timespec rqtp_k;
|
|
|
|
struct timespec rmtp_k;
|
2022-12-16 18:38:28 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
lwp_get_from_user(&rqtp_k, (void *)rqtp, sizeof rqtp_k);
|
|
|
|
ret = nanosleep(&rqtp_k, &rmtp_k);
|
|
|
|
if ((ret != -1 || rt_get_errno() == EINTR) && rmtp && lwp_user_accessable((void *)rmtp, sizeof *rmtp))
|
|
|
|
{
|
|
|
|
lwp_put_to_user(rmtp, (void *)&rmtp_k, sizeof rmtp_k);
|
2022-12-08 23:02:40 +08:00
|
|
|
if(ret != 0)
|
|
|
|
return -EINTR;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
#else
|
|
|
|
if (rmtp)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)rmtp, sizeof *rmtp))
|
|
|
|
return -EFAULT;
|
|
|
|
ret = nanosleep(rqtp, rmtp);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* syscall: "gettimeofday" ret: "int" args: "struct timeval *" "struct timezone *" */
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_gettimeofday(struct timeval *tp, struct timezone *tzp)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
struct timeval t_k;
|
|
|
|
|
|
|
|
if (tp)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)tp, sizeof *tp))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
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)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)tp, sizeof *tp))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_settimeofday(const struct timeval *tv, const struct timezone *tzp)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_exec(char *filename, int argc, char **argv, char **envp)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
int len = 0;
|
|
|
|
char *kfilename = RT_NULL;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(filename);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kfilename = (char *)kmem_get(len + 1);
|
|
|
|
if (!kfilename)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kfilename, (void *)filename, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kfilename);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = lwp_execve(kfilename, 0, argc, argv, envp);
|
|
|
|
|
|
|
|
kmem_put(kfilename);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-07-20 00:02:41 +08:00
|
|
|
sysret_t sys_kill(int pid, int signo)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
rt_err_t kret = 0;
|
2023-07-20 00:02:41 +08:00
|
|
|
sysret_t sysret;
|
2024-03-28 23:42:56 +08:00
|
|
|
struct rt_lwp *lwp = RT_NULL;
|
2023-07-20 00:02:41 +08:00
|
|
|
|
|
|
|
/* handling the semantics of sys_kill */
|
|
|
|
if (pid > 0)
|
|
|
|
{
|
2023-10-25 20:31:25 +08:00
|
|
|
/**
|
|
|
|
* Brief: Match the pid and send signal to the lwp if found
|
|
|
|
* Note: Critical Section
|
|
|
|
* - pid tree (READ. since the lwp is fetch from the pid tree, it must stay there)
|
|
|
|
*/
|
|
|
|
lwp_pid_lock_take();
|
2024-03-28 23:42:56 +08:00
|
|
|
lwp = lwp_from_pid_raw_locked(pid);
|
2023-07-20 00:02:41 +08:00
|
|
|
if (lwp)
|
2023-10-25 20:31:25 +08:00
|
|
|
{
|
|
|
|
lwp_ref_inc(lwp);
|
|
|
|
lwp_pid_lock_release();
|
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
else
|
2023-10-25 20:31:25 +08:00
|
|
|
{
|
|
|
|
lwp_pid_lock_release();
|
2023-07-20 00:02:41 +08:00
|
|
|
kret = -RT_ENOENT;
|
2023-10-25 20:31:25 +08:00
|
|
|
}
|
2024-03-28 23:42:56 +08:00
|
|
|
|
|
|
|
if (lwp)
|
|
|
|
{
|
|
|
|
kret = lwp_signal_kill(lwp, signo, SI_USER, 0);
|
|
|
|
lwp_ref_dec(lwp);
|
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
}
|
2024-03-28 23:42:56 +08:00
|
|
|
else if (pid < -1 || pid == 0)
|
2023-07-20 00:02:41 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
pid_t pgid = 0;
|
|
|
|
rt_processgroup_t group;
|
|
|
|
|
|
|
|
if (pid == 0)
|
|
|
|
{
|
|
|
|
/**
|
|
|
|
* sig shall be sent to all processes (excluding an unspecified set
|
|
|
|
* of system processes) whose process group ID is equal to the process
|
|
|
|
* group ID of the sender, and for which the process has permission to
|
|
|
|
* send a signal.
|
|
|
|
*/
|
|
|
|
pgid = lwp_pgid_get_byprocess(lwp_self());
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
/**
|
|
|
|
* sig shall be sent to all processes (excluding an unspecified set
|
|
|
|
* of system processes) whose process group ID is equal to the absolute
|
|
|
|
* value of pid, and for which the process has permission to send a signal.
|
|
|
|
*/
|
|
|
|
pgid = -pid;
|
|
|
|
}
|
|
|
|
|
|
|
|
group = lwp_pgrp_find(pgid);
|
|
|
|
if (group != RT_NULL)
|
|
|
|
{
|
|
|
|
PGRP_LOCK(group);
|
|
|
|
kret = lwp_pgrp_signal_kill(group, signo, SI_USER, 0);
|
|
|
|
PGRP_UNLOCK(group);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
kret = -ECHILD;
|
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
}
|
|
|
|
else if (pid == -1)
|
|
|
|
{
|
|
|
|
/**
|
|
|
|
* sig shall be sent to all processes (excluding an unspecified set
|
|
|
|
* of system processes) for which the process has permission to send
|
|
|
|
* that signal.
|
|
|
|
*/
|
|
|
|
kret = -RT_ENOSYS;
|
|
|
|
}
|
|
|
|
|
|
|
|
switch (kret)
|
|
|
|
{
|
|
|
|
case -RT_ENOENT:
|
|
|
|
sysret = -ESRCH;
|
|
|
|
break;
|
|
|
|
case -RT_EINVAL:
|
|
|
|
sysret = -EINVAL;
|
|
|
|
break;
|
|
|
|
case -RT_ENOSYS:
|
|
|
|
sysret = -ENOSYS;
|
|
|
|
break;
|
|
|
|
|
|
|
|
/**
|
|
|
|
* kill() never returns ENOMEM, so return normally to caller.
|
|
|
|
* IEEE Std 1003.1-2017 says the kill() function is successful
|
|
|
|
* if the process has permission to send sig to any of the
|
|
|
|
* processes specified by pid.
|
|
|
|
*/
|
|
|
|
case -RT_ENOMEM:
|
|
|
|
default:
|
|
|
|
sysret = 0;
|
|
|
|
}
|
|
|
|
return sysret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_getpid(void)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_getpid();
|
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
sysret_t sys_getppid(void)
|
|
|
|
{
|
|
|
|
rt_lwp_t process;
|
|
|
|
|
|
|
|
process = lwp_self();
|
|
|
|
if (process->parent == RT_NULL)
|
|
|
|
{
|
|
|
|
LOG_E("%s: process %d has no parent process", __func__, lwp_to_pid(process));
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
return lwp_to_pid(process->parent);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
/* syscall: "getpriority" ret: "int" args: "int" "id_t" */
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_getpriority(int which, id_t who)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
long prio = 0xff;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (which == PRIO_PROCESS)
|
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
struct rt_lwp *lwp = RT_NULL;
|
|
|
|
|
|
|
|
lwp_pid_lock_take();
|
2024-03-28 23:42:56 +08:00
|
|
|
lwp = lwp_from_pid_locked(who);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-11-02 20:23:11 +08:00
|
|
|
if (lwp)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
rt_thread_t thread = rt_list_entry(lwp->t_grp.prev, struct rt_thread, sibling);
|
2024-02-23 17:49:15 +08:00
|
|
|
prio = RT_SCHED_PRIV(thread).current_priority;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2023-11-02 20:23:11 +08:00
|
|
|
|
|
|
|
lwp_pid_lock_release();
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-11-02 20:23:11 +08:00
|
|
|
return prio;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* syscall: "setpriority" ret: "int" args: "int" "id_t" "int" */
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_setpriority(int which, id_t who, int prio)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
if (which == PRIO_PROCESS)
|
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
struct rt_lwp *lwp = RT_NULL;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-11-02 20:23:11 +08:00
|
|
|
lwp_pid_lock_take();
|
2024-03-28 23:42:56 +08:00
|
|
|
lwp = lwp_from_pid_locked(who);
|
2023-11-02 20:23:11 +08:00
|
|
|
|
|
|
|
if (lwp && prio >= 0 && prio < RT_THREAD_PRIORITY_MAX)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-11-02 20:23:11 +08:00
|
|
|
rt_list_t *list;
|
|
|
|
rt_thread_t thread;
|
|
|
|
for (list = lwp->t_grp.next; list != &lwp->t_grp; list = list->next)
|
|
|
|
{
|
|
|
|
thread = rt_list_entry(list, struct rt_thread, sibling);
|
|
|
|
rt_thread_control(thread, RT_THREAD_CTRL_CHANGE_PRIORITY, &prio);
|
|
|
|
}
|
|
|
|
lwp_pid_lock_release();
|
2022-12-03 12:07:44 +08:00
|
|
|
return 0;
|
|
|
|
}
|
2023-11-02 20:23:11 +08:00
|
|
|
else
|
|
|
|
{
|
|
|
|
lwp_pid_lock_release();
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_sem_t sys_sem_create(const char *name, rt_uint32_t value, rt_uint8_t flag)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_sem_t sem = rt_sem_create(kname, value, flag);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp_user_object_add(lwp_self(), (rt_object_t)sem) != 0)
|
|
|
|
{
|
|
|
|
rt_sem_delete(sem);
|
|
|
|
sem = NULL;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return sem;
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_sem_delete(rt_sem_t sem)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_user_object_delete(lwp_self(), (rt_object_t)sem);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_sem_take(rt_sem_t sem, rt_int32_t time)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_sem_take_interruptible(sem, time);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_sem_release(rt_sem_t sem)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_sem_release(sem);
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_mutex_t sys_mutex_create(const char *name, rt_uint8_t flag)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
rt_mutex_t mutex = RT_NULL;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
mutex = rt_mutex_create(kname, flag);
|
|
|
|
if(mutex == RT_NULL)
|
|
|
|
return RT_NULL;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp_user_object_add(lwp_self(), (rt_object_t)mutex) != 0)
|
|
|
|
{
|
|
|
|
rt_mutex_delete(mutex);
|
2023-09-23 14:06:00 +08:00
|
|
|
mutex = RT_NULL;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return mutex;
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mutex_delete(rt_mutex_t mutex)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_user_object_delete(lwp_self(), (rt_object_t)mutex);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mutex_take(rt_mutex_t mutex, rt_int32_t time)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_mutex_take_interruptible(mutex, time);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mutex_release(rt_mutex_t mutex)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_mutex_release(mutex);
|
|
|
|
}
|
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
/* memory allocation */
|
|
|
|
rt_base_t sys_brk(void *addr)
|
|
|
|
{
|
|
|
|
return lwp_brk(addr);
|
|
|
|
}
|
|
|
|
|
|
|
|
void *sys_mmap2(void *addr, size_t length, int prot,
|
2023-10-14 13:09:17 +08:00
|
|
|
int flags, int fd, size_t pgoffset)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-10-17 13:07:59 +08:00
|
|
|
sysret_t rc = 0;
|
|
|
|
long offset = 0;
|
|
|
|
|
|
|
|
/* aligned for user addr */
|
|
|
|
if ((rt_base_t)addr & ARCH_PAGE_MASK)
|
|
|
|
{
|
|
|
|
if (flags & MAP_FIXED)
|
|
|
|
rc = -EINVAL;
|
|
|
|
else
|
|
|
|
{
|
|
|
|
offset = (char *)addr - (char *)RT_ALIGN_DOWN((rt_base_t)addr, ARCH_PAGE_SIZE);
|
|
|
|
length += offset;
|
|
|
|
addr = (void *)RT_ALIGN_DOWN((rt_base_t)addr, ARCH_PAGE_SIZE);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (rc == 0)
|
|
|
|
{
|
|
|
|
/* fix parameter passing (both along have same effect) */
|
|
|
|
if (fd == -1 || flags & MAP_ANONYMOUS)
|
|
|
|
{
|
|
|
|
fd = -1;
|
|
|
|
/* MAP_SHARED has no effect and treated as nothing */
|
|
|
|
flags &= ~MAP_SHARED;
|
|
|
|
flags |= MAP_PRIVATE | MAP_ANONYMOUS;
|
|
|
|
}
|
|
|
|
rc = (sysret_t)lwp_mmap2(lwp_self(), addr, length, prot, flags, fd, pgoffset);
|
|
|
|
}
|
|
|
|
|
|
|
|
return (char *)rc + offset;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_munmap(void *addr, size_t length)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-10-17 13:07:59 +08:00
|
|
|
return lwp_munmap(lwp_self(), addr, length);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
void *sys_mremap(void *old_address, size_t old_size,
|
|
|
|
size_t new_size, int flags, void *new_address)
|
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
return lwp_mremap(lwp_self(), old_address, old_size, new_size, flags, new_address);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_madvise(void *addr, size_t len, int behav)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return -ENOSYS;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
rt_event_t sys_event_create(const char *name, rt_uint8_t flag)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
rt_event_t event = RT_NULL;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
event = rt_event_create(kname, flag);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp_user_object_add(lwp_self(), (rt_object_t)event) != 0)
|
|
|
|
{
|
|
|
|
rt_event_delete(event);
|
|
|
|
event = NULL;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return event;
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_event_delete(rt_event_t event)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_user_object_delete(lwp_self(), (rt_object_t)event);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_event_send(rt_event_t event, rt_uint32_t set)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_event_send(event, set);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_event_recv(rt_event_t event,
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_uint32_t set,
|
|
|
|
rt_uint8_t opt,
|
|
|
|
rt_int32_t timeout,
|
|
|
|
rt_uint32_t *recved)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
rt_uint32_t krecved;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if ((recved != NULL) && !lwp_user_accessable((void *)recved, sizeof(rt_uint32_t *)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
ret = rt_event_recv(event, set, opt, timeout, &krecved);
|
|
|
|
if ((ret == RT_EOK) && recved)
|
|
|
|
{
|
|
|
|
lwp_put_to_user((void *)recved, &krecved, sizeof(rt_uint32_t *));
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
rt_mailbox_t sys_mb_create(const char *name, rt_size_t size, rt_uint8_t flag)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
rt_mailbox_t mb = RT_NULL;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
mb = rt_mb_create(kname, size, flag);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp_user_object_add(lwp_self(), (rt_object_t)mb) != 0)
|
|
|
|
{
|
|
|
|
rt_mb_delete(mb);
|
|
|
|
mb = NULL;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return mb;
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mb_delete(rt_mailbox_t mb)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_user_object_delete(lwp_self(), (rt_object_t)mb);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mb_send(rt_mailbox_t mb, rt_ubase_t value)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_mb_send(mb, value);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mb_send_wait(rt_mailbox_t mb,
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_ubase_t value,
|
|
|
|
rt_int32_t timeout)
|
|
|
|
{
|
|
|
|
return rt_mb_send_wait(mb, value, timeout);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mb_recv(rt_mailbox_t mb, rt_ubase_t *value, rt_int32_t timeout)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
rt_ubase_t *kvalue;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)value, sizeof(rt_ubase_t *)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kvalue = kmem_get(sizeof(rt_ubase_t *));
|
|
|
|
if (kvalue == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = rt_mb_recv(mb, (rt_ubase_t *)kvalue, timeout);
|
|
|
|
if (ret == RT_EOK)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(value, kvalue, sizeof(rt_ubase_t *));
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem_put(kvalue);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
rt_weak int syslog_ctrl(int type, char *buf, int len)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_syslog(int type, char *buf, int len)
|
|
|
|
{
|
|
|
|
char *tmp;
|
|
|
|
int ret = -1;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, len))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
tmp = (char *)rt_malloc(len);
|
|
|
|
if (!tmp)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = syslog_ctrl(type, tmp, len);
|
|
|
|
lwp_put_to_user(buf, tmp, len);
|
|
|
|
rt_free(tmp);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_mq_t sys_mq_create(const char *name,
|
|
|
|
rt_size_t msg_size,
|
|
|
|
rt_size_t max_msgs,
|
|
|
|
rt_uint8_t flag)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
rt_mq_t mq = RT_NULL;
|
|
|
|
|
|
|
|
int len = 0;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
mq = rt_mq_create(kname, msg_size, max_msgs, flag);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp_user_object_add(lwp_self(), (rt_object_t)mq) != 0)
|
|
|
|
{
|
|
|
|
rt_mq_delete(mq);
|
|
|
|
mq = NULL;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return mq;
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mq_delete(rt_mq_t mq)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_user_object_delete(lwp_self(), (rt_object_t)mq);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mq_send(rt_mq_t mq, void *buffer, rt_size_t size)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
void *kbuffer = RT_NULL;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)buffer, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kbuffer = kmem_get(size);
|
|
|
|
if (kbuffer == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kbuffer, buffer, size) != size)
|
|
|
|
{
|
|
|
|
kmem_put(kbuffer);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = rt_mq_send(mq, kbuffer, size);
|
|
|
|
|
|
|
|
kmem_put(kbuffer);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mq_urgent(rt_mq_t mq, void *buffer, rt_size_t size)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
void *kbuffer = RT_NULL;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)buffer, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kbuffer = kmem_get(size);
|
|
|
|
if (kbuffer == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kbuffer, buffer, size) != size)
|
|
|
|
{
|
|
|
|
kmem_put(kbuffer);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = rt_mq_urgent(mq, kbuffer, size);
|
|
|
|
|
|
|
|
kmem_put(kbuffer);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_mq_recv(rt_mq_t mq,
|
2022-12-03 12:07:44 +08:00
|
|
|
void *buffer,
|
|
|
|
rt_size_t size,
|
|
|
|
rt_int32_t timeout)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
void *kbuffer = RT_NULL;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)buffer, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kbuffer = kmem_get(size);
|
|
|
|
if (kbuffer == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = rt_mq_recv(mq, kbuffer, size, timeout);
|
|
|
|
if (ret > 0)
|
|
|
|
lwp_put_to_user((void *)buffer, (void *)kbuffer, ret);
|
|
|
|
|
|
|
|
kmem_put(kbuffer);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static void timer_timeout_callback(void *parameter)
|
|
|
|
{
|
|
|
|
rt_sem_t sem = (rt_sem_t)parameter;
|
|
|
|
rt_sem_release(sem);
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_timer_t sys_rt_timer_create(const char *name,
|
|
|
|
void *data,
|
|
|
|
rt_tick_t time,
|
|
|
|
rt_uint8_t flag)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
rt_timer_t timer = RT_NULL;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
timer = rt_timer_create(kname, timer_timeout_callback, (void *)data, time, flag);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp_user_object_add(lwp_self(), (rt_object_t)timer) != 0)
|
|
|
|
{
|
|
|
|
rt_timer_delete(timer);
|
|
|
|
timer = NULL;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return timer;
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_rt_timer_delete(rt_timer_t timer)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_user_object_delete(lwp_self(), (rt_object_t)timer);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_rt_timer_start(rt_timer_t timer)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_timer_start(timer);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_rt_timer_stop(rt_timer_t timer)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_timer_stop(timer);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_rt_timer_control(rt_timer_t timer, int cmd, void *arg)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_timer_control(timer, cmd, arg);
|
|
|
|
}
|
|
|
|
|
2023-02-28 10:45:05 +08:00
|
|
|
/* MUSL compatible */
|
|
|
|
struct ksigevent
|
|
|
|
{
|
|
|
|
union sigval sigev_value;
|
|
|
|
int sigev_signo;
|
|
|
|
int sigev_notify;
|
|
|
|
int sigev_tid;
|
|
|
|
};
|
|
|
|
|
2023-03-17 15:11:38 +08:00
|
|
|
/* to protect unsafe implementation in current rt-smart toolchain */
|
2023-09-05 02:17:11 +08:00
|
|
|
RT_STATIC_ASSERT(sigevent_compatible, offsetof(struct ksigevent, sigev_tid) == offsetof(struct sigevent, sigev_notify_function));
|
2023-03-17 15:11:38 +08:00
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_timer_create(clockid_t clockid, struct sigevent *restrict sevp, timer_t *restrict timerid)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
struct sigevent sevp_k;
|
|
|
|
timer_t timerid_k;
|
2023-02-28 10:45:05 +08:00
|
|
|
int utimer;
|
2023-01-09 10:08:55 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (sevp == NULL)
|
|
|
|
{
|
|
|
|
sevp_k.sigev_notify = SIGEV_SIGNAL;
|
|
|
|
sevp_k.sigev_signo = SIGALRM;
|
|
|
|
sevp = &sevp_k;
|
|
|
|
}
|
|
|
|
else
|
2023-02-28 10:45:05 +08:00
|
|
|
{
|
|
|
|
/* clear extra bytes if any */
|
|
|
|
if (sizeof(struct ksigevent) < sizeof(struct sigevent))
|
|
|
|
memset(&sevp_k, 0, sizeof(sevp_k));
|
|
|
|
|
|
|
|
/* musl passes `struct ksigevent` to kernel, we shoule only get size of that bytes */
|
2023-03-13 19:09:34 +08:00
|
|
|
if (!lwp_get_from_user(&sevp_k, (void *)sevp, sizeof(struct ksigevent)))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2023-02-28 10:45:05 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
ret = _SYS_WRAP(timer_create(clockid, &sevp_k, &timerid_k));
|
2023-02-28 10:45:05 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
if (ret != -RT_ERROR)
|
|
|
|
{
|
2023-03-17 15:11:38 +08:00
|
|
|
utimer = (rt_ubase_t)timerid_k;
|
2023-03-13 19:09:34 +08:00
|
|
|
if (!lwp_put_to_user(sevp, (void *)&sevp_k, sizeof(struct ksigevent)) ||
|
|
|
|
!lwp_put_to_user(timerid, (void *)&utimer, sizeof(utimer)))
|
|
|
|
ret = -EINVAL;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
#else
|
2023-03-13 19:09:34 +08:00
|
|
|
ret = _SYS_WRAP(timer_create(clockid, sevp, timerid));
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif
|
2023-03-13 19:09:34 +08:00
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_timer_delete(timer_t timerid)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = timer_delete(timerid);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_timer_settime(timer_t timerid, int flags,
|
2022-12-03 12:07:44 +08:00
|
|
|
const struct itimerspec *restrict new_value,
|
|
|
|
struct itimerspec *restrict old_value)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
struct itimerspec new_value_k;
|
|
|
|
struct itimerspec old_value_k;
|
|
|
|
|
2023-02-28 10:45:05 +08:00
|
|
|
if (!lwp_get_from_user(&new_value_k, (void *)new_value, sizeof(*new_value)) ||
|
|
|
|
(old_value && !lwp_get_from_user(&old_value_k, (void *)old_value, sizeof(*old_value))))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
ret = timer_settime(timerid, flags, &new_value_k, &old_value_k);
|
|
|
|
lwp_put_to_user(old_value, (void *)&old_value_k, sizeof old_value_k);
|
|
|
|
|
|
|
|
#else
|
|
|
|
ret = timer_settime(timerid, flags, new_value, old_value);
|
|
|
|
#endif
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_timer_gettime(timer_t timerid, struct itimerspec *curr_value)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
struct itimerspec curr_value_k;
|
|
|
|
lwp_get_from_user(&curr_value_k, (void *)curr_value, sizeof curr_value_k);
|
|
|
|
ret = timer_gettime(timerid, &curr_value_k);
|
|
|
|
lwp_put_to_user(curr_value, (void *)&curr_value_k, sizeof curr_value_k);
|
|
|
|
#else
|
|
|
|
ret = timer_gettime(timerid, curr_value);
|
|
|
|
#endif
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_timer_getoverrun(timer_t timerid)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
ret = timer_getoverrun(timerid);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_thread_t sys_thread_create(void *arg[])
|
|
|
|
{
|
|
|
|
void *user_stack = 0;
|
|
|
|
struct rt_lwp *lwp = 0;
|
|
|
|
rt_thread_t thread = RT_NULL;
|
|
|
|
int tid = 0;
|
|
|
|
|
|
|
|
lwp = rt_thread_self()->lwp;
|
|
|
|
lwp_ref_inc(lwp);
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-01-09 10:08:55 +08:00
|
|
|
user_stack = lwp_map_user(lwp, 0, (size_t)arg[3], 0);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!user_stack)
|
|
|
|
{
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
if ((tid = lwp_tid_get()) == 0)
|
|
|
|
{
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
thread = rt_thread_create((const char *)arg[0],
|
|
|
|
_crt_thread_entry,
|
|
|
|
(void *)arg[2],
|
|
|
|
ALLOC_KERNEL_STACK_SIZE,
|
|
|
|
(rt_uint8_t)(size_t)arg[4],
|
|
|
|
(rt_uint32_t)(rt_size_t)arg[5]);
|
|
|
|
if (!thread)
|
|
|
|
{
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef RT_USING_SMP
|
2024-02-23 17:49:15 +08:00
|
|
|
RT_SCHED_CTX(thread).bind_cpu = lwp->bind_cpu;
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif
|
|
|
|
thread->cleanup = lwp_cleanup;
|
|
|
|
thread->user_entry = (void (*)(void *))arg[1];
|
|
|
|
thread->user_stack = (void *)user_stack;
|
|
|
|
thread->user_stack_size = (rt_size_t)arg[3];
|
|
|
|
#else
|
|
|
|
rt_uint32_t kstack_size = (rt_uint32_t)arg[7];
|
|
|
|
if (kstack_size < ALLOC_KERNEL_STACK_SIZE_MIN)
|
|
|
|
{
|
|
|
|
/* When kstack size is 0, the default size of the kernel stack is used */
|
|
|
|
kstack_size = kstack_size ? ALLOC_KERNEL_STACK_SIZE_MIN : ALLOC_KERNEL_STACK_SIZE;
|
|
|
|
}
|
|
|
|
else if (kstack_size > ALLOC_KERNEL_STACK_SIZE_MAX)
|
|
|
|
{
|
|
|
|
kstack_size = ALLOC_KERNEL_STACK_SIZE_MAX;
|
|
|
|
}
|
|
|
|
|
|
|
|
user_stack = (void *)arg[3];
|
|
|
|
if ((!user_stack) || ((rt_uint32_t)arg[6] == RT_NULL))
|
|
|
|
{
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((tid = lwp_tid_get()) == 0)
|
|
|
|
{
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
thread = rt_thread_create((const char *)arg[0], _crt_thread_entry, (void *)arg[2], kstack_size, (rt_uint8_t)(size_t)arg[5], (rt_uint32_t)arg[6]);
|
|
|
|
if (!thread)
|
|
|
|
{
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
thread->cleanup = lwp_cleanup;
|
|
|
|
thread->user_entry = (void (*)(void *))arg[1];
|
|
|
|
thread->user_stack = (void *)user_stack;
|
|
|
|
thread->user_stack_size = (uint32_t)arg[4];
|
|
|
|
rt_memset(thread->user_stack, '#', thread->user_stack_size);
|
2022-12-16 18:38:28 +08:00
|
|
|
#endif /* ARCH_MM_MMU */
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
thread->lwp = (void*)lwp;
|
|
|
|
thread->tid = tid;
|
|
|
|
lwp_tid_set_thread(tid, thread);
|
|
|
|
|
|
|
|
if (lwp->debug)
|
|
|
|
{
|
|
|
|
rt_thread_control(thread, RT_THREAD_CTRL_BIND_CPU, (void*)0);
|
|
|
|
}
|
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
LWP_LOCK(lwp);
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_list_insert_after(&lwp->t_grp, &thread->sibling);
|
2023-10-25 20:31:25 +08:00
|
|
|
LWP_UNLOCK(lwp);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
return thread;
|
|
|
|
|
|
|
|
fail:
|
|
|
|
lwp_tid_put(tid);
|
|
|
|
if (lwp)
|
|
|
|
{
|
|
|
|
lwp_ref_dec(lwp);
|
|
|
|
}
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
|
|
|
|
long _sys_clone(void *arg[])
|
|
|
|
{
|
|
|
|
struct rt_lwp *lwp = 0;
|
|
|
|
rt_thread_t thread = RT_NULL;
|
|
|
|
rt_thread_t self = RT_NULL;
|
|
|
|
int tid = 0;
|
|
|
|
|
|
|
|
unsigned long flags = 0;
|
|
|
|
void *user_stack = RT_NULL;
|
|
|
|
int *new_tid = RT_NULL;
|
|
|
|
void *tls = RT_NULL;
|
|
|
|
/*
|
|
|
|
musl call flags (CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND
|
|
|
|
| CLONE_THREAD | CLONE_SYSVSEM | CLONE_SETTLS
|
|
|
|
| CLONE_PARENT_SETTID | CLONE_CHILD_CLEARTID | CLONE_DETACHED);
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* check args */
|
|
|
|
if (!lwp_user_accessable(arg, sizeof(void *[SYS_CLONE_ARGS_NR])))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
flags = (unsigned long)(size_t)arg[0];
|
|
|
|
if ((flags & (CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_THREAD | CLONE_SYSVSEM))
|
|
|
|
!= (CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_THREAD | CLONE_SYSVSEM))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
user_stack = arg[1];
|
|
|
|
new_tid = (int *)arg[2];
|
|
|
|
tls = (void *)arg[3];
|
|
|
|
|
|
|
|
if ((flags & CLONE_PARENT_SETTID) == CLONE_PARENT_SETTID)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable(new_tid, sizeof(int)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
self = rt_thread_self();
|
|
|
|
lwp = self->lwp;
|
|
|
|
lwp_ref_inc(lwp);
|
|
|
|
if (!user_stack)
|
|
|
|
{
|
|
|
|
SET_ERRNO(EINVAL);
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
if ((tid = lwp_tid_get()) == 0)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
2023-04-04 21:06:27 +08:00
|
|
|
thread = rt_thread_create(self->parent.name,
|
2022-12-03 12:07:44 +08:00
|
|
|
RT_NULL,
|
|
|
|
RT_NULL,
|
|
|
|
self->stack_size,
|
2024-02-23 17:49:15 +08:00
|
|
|
RT_SCHED_PRIV(self).init_priority,
|
|
|
|
RT_SCHED_PRIV(self).init_tick);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!thread)
|
|
|
|
{
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef RT_USING_SMP
|
2024-02-23 17:49:15 +08:00
|
|
|
RT_SCHED_CTX(self).bind_cpu = lwp->bind_cpu;
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif
|
|
|
|
thread->cleanup = lwp_cleanup;
|
|
|
|
thread->user_entry = RT_NULL;
|
|
|
|
thread->user_stack = RT_NULL;
|
|
|
|
thread->user_stack_size = 0;
|
|
|
|
thread->lwp = (void *)lwp;
|
|
|
|
thread->tid = tid;
|
|
|
|
|
|
|
|
if ((flags & CLONE_SETTLS) == CLONE_SETTLS)
|
|
|
|
{
|
|
|
|
thread->thread_idr = tls;
|
|
|
|
}
|
|
|
|
if ((flags & CLONE_PARENT_SETTID) == CLONE_PARENT_SETTID)
|
|
|
|
{
|
|
|
|
*new_tid = (int)(tid);
|
|
|
|
}
|
|
|
|
if ((flags & CLONE_CHILD_CLEARTID) == CLONE_CHILD_CLEARTID)
|
|
|
|
{
|
|
|
|
thread->clear_child_tid = (int *)arg[4];
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp->debug)
|
|
|
|
{
|
|
|
|
rt_thread_control(thread, RT_THREAD_CTRL_BIND_CPU, (void*)0);
|
|
|
|
}
|
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
LWP_LOCK(lwp);
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_list_insert_after(&lwp->t_grp, &thread->sibling);
|
2023-10-25 20:31:25 +08:00
|
|
|
LWP_UNLOCK(lwp);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
/* copy origin stack */
|
2023-09-15 15:57:08 +08:00
|
|
|
lwp_memcpy(thread->stack_addr, self->stack_addr, thread->stack_size);
|
2022-12-03 12:07:44 +08:00
|
|
|
lwp_tid_set_thread(tid, thread);
|
|
|
|
arch_set_thread_context(arch_clone_exit,
|
|
|
|
(void *)((char *)thread->stack_addr + thread->stack_size),
|
|
|
|
user_stack, &thread->sp);
|
|
|
|
/* new thread never reach there */
|
|
|
|
rt_thread_startup(thread);
|
|
|
|
return (long)tid;
|
|
|
|
fail:
|
|
|
|
lwp_tid_put(tid);
|
2023-10-25 20:31:25 +08:00
|
|
|
if (thread)
|
|
|
|
{
|
|
|
|
rt_thread_delete(thread);
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp)
|
|
|
|
{
|
|
|
|
lwp_ref_dec(lwp);
|
|
|
|
}
|
|
|
|
return GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-12 02:12:03 +08:00
|
|
|
rt_weak long sys_clone(void *arg[])
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return _sys_clone(arg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void lwp_struct_copy(struct rt_lwp *dst, struct rt_lwp *src)
|
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
dst->end_heap = src->end_heap;
|
|
|
|
#endif
|
|
|
|
dst->lwp_type = src->lwp_type;
|
|
|
|
dst->text_entry = src->text_entry;
|
|
|
|
dst->text_size = src->text_size;
|
|
|
|
dst->data_entry = src->data_entry;
|
|
|
|
dst->data_size = src->data_size;
|
|
|
|
dst->args = src->args;
|
2023-08-23 13:58:09 +08:00
|
|
|
dst->background = src->background;
|
2022-12-03 12:07:44 +08:00
|
|
|
dst->tty = src->tty;
|
2024-03-28 23:42:56 +08:00
|
|
|
|
|
|
|
/* terminal API */
|
|
|
|
dst->term_ctrlterm = src->term_ctrlterm;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_memcpy(dst->cmd, src->cmd, RT_NAME_MAX);
|
2024-03-28 23:42:56 +08:00
|
|
|
if (src->exe_file)
|
|
|
|
{
|
|
|
|
if (dst->exe_file)
|
|
|
|
{
|
|
|
|
rt_free(dst->exe_file);
|
|
|
|
}
|
|
|
|
dst->exe_file = strndup(src->exe_file, DFS_PATH_MAX);
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-07-20 00:02:41 +08:00
|
|
|
rt_memcpy(&dst->signal.sig_action, &src->signal.sig_action, sizeof(dst->signal.sig_action));
|
|
|
|
rt_memcpy(&dst->signal.sig_action_mask, &src->signal.sig_action_mask, sizeof(dst->signal.sig_action_mask));
|
|
|
|
rt_memcpy(&dst->signal.sig_action_nodefer, &src->signal.sig_action_nodefer, sizeof(dst->signal.sig_action_nodefer));
|
|
|
|
rt_memcpy(&dst->signal.sig_action_onstack, &src->signal.sig_action_onstack, sizeof(dst->signal.sig_action_onstack));
|
|
|
|
rt_memcpy(&dst->signal.sig_action_restart, &dst->signal.sig_action_restart, sizeof(dst->signal.sig_action_restart));
|
|
|
|
rt_memcpy(&dst->signal.sig_action_siginfo, &dst->signal.sig_action_siginfo, sizeof(dst->signal.sig_action_siginfo));
|
2024-03-28 23:42:56 +08:00
|
|
|
rt_memcpy(&dst->signal.sig_action_nocldstop, &dst->signal.sig_action_nocldstop, sizeof(dst->signal.sig_action_nocldstop));
|
|
|
|
rt_memcpy(&dst->signal.sig_action_nocldwait, &dst->signal.sig_action_nocldwait, sizeof(dst->signal.sig_action_nocldwait));
|
2023-04-26 17:21:00 +08:00
|
|
|
rt_strcpy(dst->working_directory, src->working_directory);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static int lwp_copy_files(struct rt_lwp *dst, struct rt_lwp *src)
|
|
|
|
{
|
|
|
|
struct dfs_fdtable *dst_fdt;
|
|
|
|
struct dfs_fdtable *src_fdt;
|
|
|
|
|
|
|
|
src_fdt = &src->fdt;
|
|
|
|
dst_fdt = &dst->fdt;
|
|
|
|
/* init fds */
|
|
|
|
dst_fdt->fds = rt_calloc(src_fdt->maxfd, sizeof(void *));
|
|
|
|
if (dst_fdt->fds)
|
|
|
|
{
|
2023-04-08 22:25:51 +08:00
|
|
|
struct dfs_file *d_s;
|
2022-12-03 12:07:44 +08:00
|
|
|
int i;
|
|
|
|
|
|
|
|
dst_fdt->maxfd = src_fdt->maxfd;
|
|
|
|
|
2023-04-08 22:25:51 +08:00
|
|
|
dfs_file_lock();
|
2022-12-03 12:07:44 +08:00
|
|
|
/* dup files */
|
|
|
|
for (i = 0; i < src_fdt->maxfd; i++)
|
|
|
|
{
|
2023-12-16 18:06:47 +08:00
|
|
|
d_s = fdt_get_file(src_fdt, i);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (d_s)
|
|
|
|
{
|
|
|
|
dst_fdt->fds[i] = d_s;
|
|
|
|
d_s->ref_count++;
|
|
|
|
}
|
|
|
|
}
|
2023-04-08 22:25:51 +08:00
|
|
|
dfs_file_unlock();
|
2022-12-03 12:07:44 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
return -RT_ERROR;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t _sys_fork(void)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int tid = 0;
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t falival = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
struct rt_lwp *lwp = RT_NULL;
|
|
|
|
struct rt_lwp *self_lwp = RT_NULL;
|
|
|
|
rt_thread_t thread = RT_NULL;
|
|
|
|
rt_thread_t self_thread = RT_NULL;
|
|
|
|
void *user_stack = RT_NULL;
|
2024-03-28 23:42:56 +08:00
|
|
|
rt_processgroup_t group;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
/* new lwp */
|
2023-09-25 16:12:49 +08:00
|
|
|
lwp = lwp_create(LWP_CREATE_FLAG_ALLOC_PID);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* new tid */
|
|
|
|
if ((tid = lwp_tid_get()) == 0)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* user space init */
|
2023-01-09 10:08:55 +08:00
|
|
|
if (lwp_user_space_init(lwp, 1) != 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
self_lwp = lwp_self();
|
|
|
|
|
2023-10-17 13:07:59 +08:00
|
|
|
/* copy address space of process from this proc to forked one */
|
|
|
|
if (lwp_fork_aspace(lwp, self_lwp) != 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* copy lwp struct data */
|
|
|
|
lwp_struct_copy(lwp, self_lwp);
|
|
|
|
|
|
|
|
/* copy files */
|
|
|
|
if (lwp_copy_files(lwp, self_lwp) != 0)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* create thread */
|
|
|
|
self_thread = rt_thread_self();
|
|
|
|
|
2023-04-04 21:06:27 +08:00
|
|
|
thread = rt_thread_create(self_thread->parent.name,
|
2022-12-03 12:07:44 +08:00
|
|
|
RT_NULL,
|
|
|
|
RT_NULL,
|
|
|
|
self_thread->stack_size,
|
2024-02-23 17:49:15 +08:00
|
|
|
RT_SCHED_PRIV(self_thread).init_priority,
|
|
|
|
RT_SCHED_PRIV(self_thread).init_tick);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!thread)
|
|
|
|
{
|
2023-02-07 18:53:05 +08:00
|
|
|
SET_ERRNO(ENOMEM);
|
2022-12-03 12:07:44 +08:00
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
|
|
|
|
thread->cleanup = self_thread->cleanup;
|
|
|
|
thread->user_entry = self_thread->user_entry;
|
|
|
|
thread->user_stack = self_thread->user_stack;
|
|
|
|
thread->user_stack_size = self_thread->user_stack_size;
|
2023-07-20 00:02:41 +08:00
|
|
|
thread->signal.sigset_mask = self_thread->signal.sigset_mask;
|
2022-12-03 12:07:44 +08:00
|
|
|
thread->thread_idr = self_thread->thread_idr;
|
2023-09-09 09:35:56 +08:00
|
|
|
thread->clear_child_tid = self_thread->clear_child_tid;
|
2022-12-03 12:07:44 +08:00
|
|
|
thread->lwp = (void *)lwp;
|
|
|
|
thread->tid = tid;
|
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
LWP_LOCK(self_lwp);
|
2022-12-03 12:07:44 +08:00
|
|
|
/* add thread to lwp process */
|
|
|
|
rt_list_insert_after(&lwp->t_grp, &thread->sibling);
|
2023-10-25 20:31:25 +08:00
|
|
|
LWP_UNLOCK(self_lwp);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
lwp_children_register(self_lwp, lwp);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
/* set pgid and sid */
|
|
|
|
group = lwp_pgrp_find(lwp_pgid_get_byprocess(self_lwp));
|
|
|
|
if (group)
|
|
|
|
{
|
|
|
|
lwp_pgrp_insert(group, lwp);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
LOG_W("the process group of pid: %d cannot be found", lwp_pgid_get_byprocess(self_lwp));
|
|
|
|
}
|
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
/* copy kernel stack context from self thread */
|
2023-09-15 15:57:08 +08:00
|
|
|
lwp_memcpy(thread->stack_addr, self_thread->stack_addr, self_thread->stack_size);
|
2022-12-03 12:07:44 +08:00
|
|
|
lwp_tid_set_thread(tid, thread);
|
|
|
|
|
|
|
|
/* duplicate user objects */
|
|
|
|
lwp_user_object_dup(lwp, self_lwp);
|
|
|
|
|
|
|
|
user_stack = arch_get_user_sp();
|
|
|
|
arch_set_thread_context(arch_fork_exit,
|
|
|
|
(void *)((char *)thread->stack_addr + thread->stack_size),
|
|
|
|
user_stack, &thread->sp);
|
2023-10-25 20:31:25 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_thread_startup(thread);
|
|
|
|
return lwp_to_pid(lwp);
|
|
|
|
fail:
|
2023-02-07 18:53:05 +08:00
|
|
|
falival = GET_ERRNO();
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (tid != 0)
|
|
|
|
{
|
|
|
|
lwp_tid_put(tid);
|
|
|
|
}
|
2023-10-25 20:31:25 +08:00
|
|
|
if (thread)
|
|
|
|
{
|
|
|
|
rt_thread_delete(thread);
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp)
|
|
|
|
{
|
|
|
|
lwp_ref_dec(lwp);
|
|
|
|
}
|
2023-02-07 18:53:05 +08:00
|
|
|
return falival;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* arm needs to wrap fork/clone call to preserved lr & caller saved regs */
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
rt_weak sysret_t sys_fork(void)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return _sys_fork();
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
rt_weak sysret_t sys_vfork(void)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return sys_fork();
|
|
|
|
}
|
|
|
|
|
|
|
|
#define _swap_lwp_data(lwp_used, lwp_new, type, member) \
|
|
|
|
do {\
|
|
|
|
type tmp;\
|
|
|
|
tmp = lwp_used->member;\
|
|
|
|
lwp_used->member = lwp_new->member;\
|
|
|
|
lwp_new->member = tmp;\
|
|
|
|
} while (0)
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_execve(const char *path, char *const argv[], char *const envp[])
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
int error = -1;
|
2022-12-03 12:07:44 +08:00
|
|
|
size_t len;
|
|
|
|
struct rt_lwp *new_lwp = NULL;
|
|
|
|
struct rt_lwp *lwp;
|
|
|
|
int uni_thread;
|
|
|
|
rt_thread_t thread;
|
|
|
|
struct process_aux *aux;
|
|
|
|
struct lwp_args_info args_info;
|
2024-05-31 17:32:19 +08:00
|
|
|
char *kpath = RT_NULL;
|
2023-07-03 19:25:59 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
lwp = lwp_self();
|
|
|
|
thread = rt_thread_self();
|
|
|
|
uni_thread = 1;
|
2023-10-25 20:31:25 +08:00
|
|
|
|
|
|
|
LWP_LOCK(lwp);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (lwp->t_grp.prev != &thread->sibling)
|
|
|
|
{
|
|
|
|
uni_thread = 0;
|
|
|
|
}
|
|
|
|
if (lwp->t_grp.next != &thread->sibling)
|
|
|
|
{
|
|
|
|
uni_thread = 0;
|
|
|
|
}
|
2023-10-25 20:31:25 +08:00
|
|
|
LWP_UNLOCK(lwp);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!uni_thread)
|
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
return -EINVAL;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(path);
|
|
|
|
if (len <= 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
return -EFAULT;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2024-05-31 17:32:19 +08:00
|
|
|
kpath = rt_malloc(len + 1);
|
|
|
|
if (!kpath)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
return -ENOMEM;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
|
|
|
|
if (lwp_get_from_user(kpath, (void *)path, len) != len)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
rt_free(kpath);
|
|
|
|
return -EFAULT;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
kpath[len] = '\0';
|
|
|
|
|
|
|
|
if (access(kpath, X_OK) != 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
rt_free(kpath);
|
|
|
|
return -EACCES;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
|
|
|
|
/* setup args */
|
|
|
|
error = lwp_args_init(&args_info);
|
|
|
|
if (error)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
rt_free(kpath);
|
|
|
|
return -ENOMEM;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (argv)
|
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
error = lwp_args_put_argv(&args_info, (void *)argv);
|
|
|
|
if (error)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
error = -EFAULT;
|
|
|
|
goto quit;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (envp)
|
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
error = lwp_args_put_envp(&args_info, (void *)envp);
|
|
|
|
if (error)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
error = -EFAULT;
|
|
|
|
goto quit;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* alloc new lwp to operation */
|
2023-09-25 16:12:49 +08:00
|
|
|
new_lwp = lwp_create(LWP_CREATE_FLAG_NONE);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!new_lwp)
|
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
error = -ENOMEM;
|
2022-12-03 12:07:44 +08:00
|
|
|
goto quit;
|
|
|
|
}
|
2023-09-25 16:12:49 +08:00
|
|
|
|
2024-05-31 17:32:19 +08:00
|
|
|
error = lwp_user_space_init(new_lwp, 0);
|
|
|
|
if (error != 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
error = -ENOMEM;
|
2022-12-03 12:07:44 +08:00
|
|
|
goto quit;
|
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
/* file is a script ? */
|
2024-05-31 17:32:19 +08:00
|
|
|
path = kpath;
|
2022-12-03 12:07:44 +08:00
|
|
|
while (1)
|
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
error = lwp_args_load_script(&args_info, path);
|
|
|
|
if (error != 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
break;
|
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
path = lwp_args_get_argv_0(&args_info);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* now load elf */
|
2024-05-31 17:32:19 +08:00
|
|
|
if ((aux = lwp_argscopy(new_lwp, &args_info)) == NULL)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
error = -ENOMEM;
|
2022-12-03 12:07:44 +08:00
|
|
|
goto quit;
|
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
error = lwp_load(path, new_lwp, RT_NULL, 0, aux);
|
|
|
|
if (error == RT_EOK)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int off = 0;
|
|
|
|
int last_backslash = 0;
|
|
|
|
|
|
|
|
/* clear all user objects */
|
|
|
|
lwp_user_object_clear(lwp);
|
|
|
|
|
2024-05-31 17:32:19 +08:00
|
|
|
/* find last \ or / to get base name */
|
2022-12-03 12:07:44 +08:00
|
|
|
while (1)
|
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
char c = path[off++];
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
if (c == '\0')
|
|
|
|
{
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (c == '\\' || c == '/')
|
|
|
|
{
|
|
|
|
last_backslash = off;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
/**
|
|
|
|
* Set thread name and swap the data of lwp and new_lwp.
|
|
|
|
* Since no other threads can access the lwp field, it't uneccessary to
|
|
|
|
* take a lock here
|
|
|
|
*/
|
2023-11-02 20:23:11 +08:00
|
|
|
RT_ASSERT(rt_list_entry(lwp->t_grp.prev, struct rt_thread, sibling) == thread);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2024-05-31 17:32:19 +08:00
|
|
|
strncpy(thread->parent.name, path + last_backslash, RT_NAME_MAX - 1);
|
2023-10-25 20:31:25 +08:00
|
|
|
strncpy(lwp->cmd, new_lwp->cmd, RT_NAME_MAX);
|
2024-03-28 23:42:56 +08:00
|
|
|
rt_free(lwp->exe_file);
|
|
|
|
lwp->exe_file = strndup(new_lwp->exe_file, DFS_PATH_MAX);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-01-09 10:08:55 +08:00
|
|
|
_swap_lwp_data(lwp, new_lwp, struct rt_aspace *, aspace);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
_swap_lwp_data(lwp, new_lwp, size_t, end_heap);
|
|
|
|
#endif
|
|
|
|
_swap_lwp_data(lwp, new_lwp, uint8_t, lwp_type);
|
|
|
|
_swap_lwp_data(lwp, new_lwp, void *, text_entry);
|
|
|
|
_swap_lwp_data(lwp, new_lwp, uint32_t, text_size);
|
|
|
|
_swap_lwp_data(lwp, new_lwp, void *, data_entry);
|
|
|
|
_swap_lwp_data(lwp, new_lwp, uint32_t, data_size);
|
|
|
|
|
|
|
|
_swap_lwp_data(lwp, new_lwp, void *, args);
|
|
|
|
|
2023-07-20 00:02:41 +08:00
|
|
|
lwp_thread_signal_detach(&thread->signal);
|
|
|
|
rt_memset(&thread->signal.sigset_mask, 0, sizeof(thread->signal.sigset_mask));
|
|
|
|
|
|
|
|
lwp_signal_detach(&lwp->signal);
|
|
|
|
lwp_signal_init(&lwp->signal);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
/* to do: clsoe files with flag CLOEXEC, recy sub-thread */
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-01-09 10:08:55 +08:00
|
|
|
lwp_aspace_switch(thread);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
lwp_ref_dec(new_lwp);
|
|
|
|
arch_start_umode(lwp->args,
|
|
|
|
lwp->text_entry,
|
|
|
|
(void*)USER_STACK_VEND,
|
2023-04-22 23:59:11 +08:00
|
|
|
(char *)thread->stack_addr + thread->stack_size);
|
2022-12-03 12:07:44 +08:00
|
|
|
/* never reach here */
|
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
error = -EINVAL;
|
2022-12-03 12:07:44 +08:00
|
|
|
quit:
|
2024-05-31 17:32:19 +08:00
|
|
|
if (kpath)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-05-31 17:32:19 +08:00
|
|
|
rt_free(kpath);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
lwp_args_detach(&args_info);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (new_lwp)
|
|
|
|
{
|
|
|
|
lwp_ref_dec(new_lwp);
|
|
|
|
}
|
2024-05-31 17:32:19 +08:00
|
|
|
return error;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_thread_delete(rt_thread_t thread)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
return rt_thread_delete(thread);
|
|
|
|
#else
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t ret = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-04-04 21:06:27 +08:00
|
|
|
if(thread->parent.type != RT_Object_Class_Thread)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto __exit;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = rt_thread_delete(thread);
|
|
|
|
|
|
|
|
if (rt_thread_self() == thread)
|
|
|
|
{
|
|
|
|
rt_schedule();
|
|
|
|
}
|
|
|
|
|
|
|
|
__exit:
|
|
|
|
return ret;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_thread_startup(rt_thread_t thread)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_thread_startup(thread);
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_thread_t sys_thread_self(void)
|
|
|
|
{
|
|
|
|
return rt_thread_self();
|
|
|
|
}
|
|
|
|
|
|
|
|
/* sys channel */
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_channel_open(const char *name, int flags)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
rt_size_t ret = 0;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
int len = 0;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = lwp_channel_open(FDT_TYPE_LWP, kname, flags);
|
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_channel_close(int fd)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_channel_close(FDT_TYPE_LWP, fd);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_channel_send(int fd, rt_channel_msg_t data)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
rt_size_t ret = 0;
|
|
|
|
rt_channel_msg_t kdata = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)data, sizeof(*data)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kdata = kmem_get(sizeof(*data));
|
|
|
|
if (kdata == RT_NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kdata, data, sizeof(*kdata)) != sizeof(*kdata))
|
|
|
|
{
|
|
|
|
kmem_put(kdata);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = lwp_channel_send(FDT_TYPE_LWP, fd, kdata);
|
|
|
|
|
|
|
|
kmem_put(kdata);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_channel_send_recv_timeout(int fd, rt_channel_msg_t data, rt_channel_msg_t data_ret, rt_int32_t time)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
rt_size_t ret = 0;
|
|
|
|
rt_channel_msg_t kdata = RT_NULL;
|
|
|
|
rt_channel_msg_t kdata_ret = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)data, sizeof(*data)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kdata = kmem_get(sizeof(*data));
|
|
|
|
if (kdata == RT_NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kdata, data, sizeof(*kdata)) != sizeof(*kdata))
|
|
|
|
{
|
|
|
|
kmem_put(kdata);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kdata_ret = kmem_get(sizeof(*data_ret));
|
|
|
|
if (kdata_ret == RT_NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
ret = lwp_channel_send_recv_timeout(FDT_TYPE_LWP, fd, kdata, kdata_ret, time);
|
|
|
|
|
|
|
|
lwp_put_to_user(data_ret, kdata_ret, sizeof(*kdata_ret));
|
|
|
|
kmem_put(kdata);
|
|
|
|
kmem_put(kdata_ret);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_channel_reply(int fd, rt_channel_msg_t data)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
rt_size_t ret = 0;
|
|
|
|
rt_channel_msg_t kdata = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)data, sizeof(*data)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kdata = kmem_get(sizeof(*data));
|
|
|
|
if (kdata == RT_NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kdata, data, sizeof(*kdata)) != sizeof(*data))
|
|
|
|
{
|
|
|
|
kmem_put(kdata);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = lwp_channel_reply(FDT_TYPE_LWP, fd, kdata);
|
|
|
|
|
|
|
|
kmem_put(kdata);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_channel_recv_timeout(int fd, rt_channel_msg_t data, rt_int32_t time)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
rt_size_t ret = 0;
|
|
|
|
rt_channel_msg_t kdata = RT_NULL;
|
|
|
|
|
|
|
|
kdata = kmem_get(sizeof(*data));
|
|
|
|
if (kdata == RT_NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
ret = lwp_channel_recv_timeout(FDT_TYPE_LWP, fd, kdata, time);
|
|
|
|
|
|
|
|
lwp_put_to_user(data, kdata, sizeof(*kdata));
|
|
|
|
kmem_put(kdata);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
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));
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_log(const char* log, int size)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
char *klog = RT_NULL;
|
|
|
|
rt_device_t console = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)log, size))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
klog = kmem_get(size);
|
|
|
|
if (klog == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user((void *)klog, (void *)log, size) != size)
|
|
|
|
{
|
|
|
|
kmem_put(klog);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
console = rt_console_get_device();
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
if (console && __sys_log_enable)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
rt_device_write(console, -1, klog, size);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
kmem_put(klog);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_stat(const char *file, struct stat *buf)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
2023-02-24 21:00:54 +08:00
|
|
|
size_t len;
|
|
|
|
size_t copy_len;
|
|
|
|
char *copy_path;
|
|
|
|
struct stat statbuff = {0};
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, sizeof(struct stat)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(file);
|
|
|
|
if (len <= 0)
|
2023-02-24 21:00:54 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_path = (char*)rt_malloc(len + 1);
|
|
|
|
if (!copy_path)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_len = lwp_get_from_user(copy_path, (void*)file, len);
|
|
|
|
if (copy_len == 0)
|
|
|
|
{
|
|
|
|
rt_free(copy_path);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
copy_path[copy_len] = '\0';
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
ret = _SYS_WRAP(stat(copy_path, &statbuff));
|
2023-02-24 21:00:54 +08:00
|
|
|
rt_free(copy_path);
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(buf, &statbuff, sizeof statbuff);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-05-23 22:43:38 +08:00
|
|
|
sysret_t sys_lstat(const char *file, struct stat *buf)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
size_t len;
|
|
|
|
size_t copy_len;
|
|
|
|
char *copy_path;
|
|
|
|
struct stat statbuff = {0};
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, sizeof(struct stat)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(file);
|
|
|
|
if (len <= 0)
|
2023-05-23 22:43:38 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_path = (char*)rt_malloc(len + 1);
|
|
|
|
if (!copy_path)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_len = lwp_get_from_user(copy_path, (void*)file, len);
|
|
|
|
if (copy_len == 0)
|
|
|
|
{
|
|
|
|
rt_free(copy_path);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
copy_path[copy_len] = '\0';
|
|
|
|
#ifdef RT_USING_DFS_V2
|
|
|
|
ret = _SYS_WRAP(dfs_file_lstat(copy_path, &statbuff));
|
|
|
|
#else
|
|
|
|
ret = _SYS_WRAP(stat(copy_path, &statbuff));
|
|
|
|
#endif
|
|
|
|
rt_free(copy_path);
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(buf, &statbuff, sizeof statbuff);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_notimpl(void)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_shmget(size_t key, size_t size, int create)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_shmget(key, size, create);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_shmrm(int id)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_shmrm(id);
|
|
|
|
}
|
|
|
|
|
|
|
|
void* sys_shmat(int id, void* shm_vaddr)
|
|
|
|
{
|
|
|
|
return lwp_shmat(id, shm_vaddr);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_shmdt(void* shm_vaddr)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return lwp_shmdt(shm_vaddr);
|
|
|
|
}
|
|
|
|
#elif defined RT_LWP_USING_SHM
|
|
|
|
void *sys_shm_alloc(int size)
|
|
|
|
{
|
|
|
|
if (size < 0)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
return lwp_shm_alloc((rt_size_t)size);
|
|
|
|
}
|
|
|
|
|
|
|
|
void *sys_shm_retain(void *mem)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable(mem, sizeof (void *)))
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
return lwp_shm_retain(mem);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_shm_free(void *mem)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
if (!lwp_user_accessable(mem, sizeof (void *)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
lwp_shm_free(mem);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* device interfaces */
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_device_init(rt_device_t dev)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_device_init(dev);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_device_register(rt_device_t dev, const char *name, rt_uint16_t flags)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_device_register(dev, name, flags);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_device_control(rt_device_t dev, int cmd, void *arg)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_device_control(dev, cmd, arg);
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_device_t sys_device_find(const char* name)
|
|
|
|
{
|
|
|
|
return rt_device_find(name);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_device_open(rt_device_t dev, rt_uint16_t oflag)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_device_open(dev, oflag);
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_device_close(rt_device_t dev)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_device_close(dev);
|
|
|
|
}
|
|
|
|
|
2023-02-06 07:35:33 +08:00
|
|
|
rt_ssize_t sys_device_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_device_read(dev, pos, buffer, size);
|
|
|
|
}
|
|
|
|
|
2023-02-06 07:35:33 +08:00
|
|
|
rt_ssize_t sys_device_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_device_write(dev, pos, buffer, size);
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef RT_USING_SAL
|
|
|
|
/* network interfaces */
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_accept(int socket, struct musl_sockaddr *addr, socklen_t *addrlen)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = -1;
|
|
|
|
struct sockaddr ksa;
|
|
|
|
struct musl_sockaddr kmusladdr;
|
|
|
|
socklen_t uaddrlen;
|
|
|
|
socklen_t kaddrlen;
|
|
|
|
|
|
|
|
if (addr)
|
|
|
|
{
|
2023-07-27 17:24:26 +08:00
|
|
|
if (!lwp_user_accessable(addrlen, sizeof(socklen_t)))
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-07-27 17:24:26 +08:00
|
|
|
lwp_get_from_user(&uaddrlen, addrlen, sizeof(socklen_t));
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!uaddrlen)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable(addr, uaddrlen))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
kaddrlen = sizeof(struct sockaddr);
|
|
|
|
ret = accept(socket, &ksa, &kaddrlen);
|
|
|
|
if (ret >= 0)
|
|
|
|
{
|
|
|
|
if (addr)
|
|
|
|
{
|
|
|
|
sockaddr_tomusl(&ksa, &kmusladdr);
|
|
|
|
if (uaddrlen > sizeof(struct musl_sockaddr))
|
|
|
|
{
|
|
|
|
uaddrlen = sizeof(struct musl_sockaddr);
|
|
|
|
}
|
|
|
|
lwp_put_to_user(addr, &kmusladdr, uaddrlen);
|
2023-07-27 17:24:26 +08:00
|
|
|
lwp_put_to_user(addrlen, &uaddrlen, sizeof(socklen_t));
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_bind(int socket, const struct musl_sockaddr *name, socklen_t namelen)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-12-02 12:11:01 +08:00
|
|
|
rt_err_t ret = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
struct sockaddr sa;
|
2024-01-26 22:14:02 +08:00
|
|
|
struct sockaddr_un un_addr;
|
2022-12-03 12:07:44 +08:00
|
|
|
struct musl_sockaddr kname;
|
2023-12-02 12:11:01 +08:00
|
|
|
rt_uint16_t family = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)name, namelen))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-12-02 12:11:01 +08:00
|
|
|
lwp_get_from_user(&family, (void *)name, 2);
|
2024-01-26 22:14:02 +08:00
|
|
|
if (family == AF_UNIX)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-01-26 22:14:02 +08:00
|
|
|
if (!lwp_user_accessable((void *)name, sizeof(struct sockaddr_un)))
|
2023-12-02 12:11:01 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2024-01-26 22:14:02 +08:00
|
|
|
lwp_get_from_user(&un_addr, (void *)name, sizeof(struct sockaddr_un));
|
|
|
|
ret = bind(socket, (struct sockaddr *)&un_addr, namelen);
|
|
|
|
}
|
|
|
|
else if (family == AF_NETLINK)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)name, namelen))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_get_from_user(&sa, (void *)name, namelen);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-12-06 13:51:13 +08:00
|
|
|
ret = bind(socket, &sa, namelen);
|
2023-12-02 12:11:01 +08:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
lwp_get_from_user(&kname, (void *)name, namelen);
|
|
|
|
sockaddr_tolwip(&kname, &sa);
|
|
|
|
ret = bind(socket, &sa, namelen);
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-12-02 12:11:01 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_shutdown(int socket, int how)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return shutdown(socket, how);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_getpeername(int socket, struct musl_sockaddr *name, socklen_t *namelen)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = -1;
|
|
|
|
struct sockaddr sa;
|
|
|
|
struct musl_sockaddr kname;
|
|
|
|
socklen_t unamelen;
|
|
|
|
socklen_t knamelen;
|
|
|
|
|
2023-07-27 17:24:26 +08:00
|
|
|
if (!lwp_user_accessable(namelen, sizeof(socklen_t)))
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-07-27 17:24:26 +08:00
|
|
|
lwp_get_from_user(&unamelen, namelen, sizeof(socklen_t));
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!unamelen)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable(name, unamelen))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
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);
|
2023-07-27 17:24:26 +08:00
|
|
|
lwp_put_to_user(namelen, &unamelen, sizeof(socklen_t));
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_getsockname(int socket, struct musl_sockaddr *name, socklen_t *namelen)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = -1;
|
|
|
|
struct sockaddr sa;
|
|
|
|
struct musl_sockaddr kname;
|
|
|
|
socklen_t unamelen;
|
|
|
|
socklen_t knamelen;
|
|
|
|
|
2023-07-27 17:24:26 +08:00
|
|
|
if (!lwp_user_accessable(namelen, sizeof (socklen_t)))
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-07-27 17:24:26 +08:00
|
|
|
lwp_get_from_user(&unamelen, namelen, sizeof (socklen_t));
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!unamelen)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable(name, unamelen))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
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);
|
2023-07-27 17:24:26 +08:00
|
|
|
lwp_put_to_user(namelen, &unamelen, sizeof(socklen_t));
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_getsockopt(int socket, int level, int optname, void *optval, socklen_t *optlen)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
socklen_t koptlen = 0;
|
|
|
|
void *koptval = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)optlen, sizeof(uint32_t)))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
if (lwp_get_from_user(&koptlen, optlen, sizeof(uint32_t)) != sizeof(uint32_t))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)optval, koptlen))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
koptval = kmem_get(koptlen);
|
|
|
|
if (koptval == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(koptval, optval, koptlen) != koptlen)
|
|
|
|
{
|
|
|
|
kmem_put(koptval);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
convert_sockopt(&level, &optname);
|
2023-09-23 14:06:00 +08:00
|
|
|
ret = getsockopt(socket, level, optname, koptval, &koptlen);
|
|
|
|
|
|
|
|
lwp_put_to_user((void *)optval, koptval, koptlen);
|
|
|
|
lwp_put_to_user((void *)optlen, &koptlen, sizeof(uint32_t));
|
|
|
|
|
|
|
|
kmem_put(koptval);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_setsockopt(int socket, int level, int optname, const void *optval, socklen_t optlen)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret;
|
2023-09-23 14:06:00 +08:00
|
|
|
void *koptval = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)optval, optlen))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
koptval = kmem_get(optlen);
|
|
|
|
if (koptval == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(koptval, (void *)optval, optlen) != optlen)
|
|
|
|
{
|
|
|
|
kmem_put(koptval);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
convert_sockopt(&level, &optname);
|
2023-09-23 14:06:00 +08:00
|
|
|
ret = setsockopt(socket, level, optname, koptval, optlen);
|
|
|
|
|
|
|
|
kmem_put(koptval);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_connect(int socket, const struct musl_sockaddr *name, socklen_t namelen)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-12-02 12:11:01 +08:00
|
|
|
int ret = 0;
|
|
|
|
rt_uint16_t family = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
struct sockaddr sa;
|
|
|
|
struct musl_sockaddr kname;
|
2023-12-02 12:11:01 +08:00
|
|
|
struct sockaddr_un addr_un;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)name, namelen))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-12-02 12:11:01 +08:00
|
|
|
lwp_get_from_user(&family, (void *)name, 2);
|
|
|
|
if (family == AF_UNIX)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-12-02 12:11:01 +08:00
|
|
|
if (!lwp_user_accessable((void *)name, sizeof(struct sockaddr_un)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-12-02 12:11:01 +08:00
|
|
|
lwp_get_from_user(&addr_un, (void *)name, sizeof(struct sockaddr_un));
|
|
|
|
ret = connect(socket, (struct sockaddr *)(&addr_un), namelen);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
lwp_get_from_user(&kname, (void *)name, namelen);
|
|
|
|
sockaddr_tolwip(&kname, &sa);
|
|
|
|
ret = connect(socket, &sa, namelen);
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-12-02 12:11:01 +08:00
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_listen(int socket, int backlog)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2023-11-28 13:56:06 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
static int copy_msghdr_from_user(struct msghdr *kmsg, struct msghdr *umsg,
|
|
|
|
struct iovec **out_iov, void **out_msg_control)
|
|
|
|
{
|
|
|
|
size_t iovs_size;
|
|
|
|
struct iovec *uiov, *kiov;
|
|
|
|
size_t iovs_buffer_size = 0;
|
|
|
|
void *iovs_buffer;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable(umsg, sizeof(*umsg)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_get_from_user(kmsg, umsg, sizeof(*kmsg));
|
|
|
|
|
|
|
|
iovs_size = sizeof(*kmsg->msg_iov) * kmsg->msg_iovlen;
|
|
|
|
if (!lwp_user_accessable(kmsg->msg_iov, iovs_size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* user and kernel */
|
|
|
|
kiov = kmem_get(iovs_size * 2);
|
|
|
|
if (!kiov)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
uiov = (void *)kiov + iovs_size;
|
|
|
|
lwp_get_from_user(uiov, kmsg->msg_iov, iovs_size);
|
|
|
|
|
|
|
|
if (out_iov)
|
|
|
|
{
|
|
|
|
*out_iov = uiov;
|
|
|
|
}
|
|
|
|
kmsg->msg_iov = kiov;
|
|
|
|
|
|
|
|
for (int i = 0; i < kmsg->msg_iovlen; ++i)
|
|
|
|
{
|
|
|
|
/*
|
|
|
|
* We MUST check we can copy data to user after socket done in uiov
|
|
|
|
* otherwise we will be lost the messages from the network!
|
|
|
|
*/
|
|
|
|
if (!lwp_user_accessable(uiov->iov_base, uiov->iov_len))
|
|
|
|
{
|
|
|
|
kmem_put(kmsg->msg_iov);
|
|
|
|
|
|
|
|
return -EPERM;
|
|
|
|
}
|
|
|
|
|
|
|
|
iovs_buffer_size += uiov->iov_len;
|
|
|
|
kiov->iov_len = uiov->iov_len;
|
|
|
|
|
|
|
|
++kiov;
|
|
|
|
++uiov;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* msg_iov and msg_control */
|
|
|
|
iovs_buffer = kmem_get(iovs_buffer_size + kmsg->msg_controllen);
|
|
|
|
|
|
|
|
if (!iovs_buffer)
|
|
|
|
{
|
|
|
|
kmem_put(kmsg->msg_iov);
|
|
|
|
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
kiov = kmsg->msg_iov;
|
|
|
|
|
|
|
|
for (int i = 0; i < kmsg->msg_iovlen; ++i)
|
|
|
|
{
|
|
|
|
kiov->iov_base = iovs_buffer;
|
|
|
|
iovs_buffer += kiov->iov_len;
|
|
|
|
++kiov;
|
|
|
|
}
|
|
|
|
|
|
|
|
*out_msg_control = kmsg->msg_control;
|
|
|
|
/* msg_control is the end of the iovs_buffer */
|
|
|
|
kmsg->msg_control = iovs_buffer;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
|
|
|
|
sysret_t sys_recvmsg(int socket, struct msghdr *msg, int flags)
|
|
|
|
{
|
|
|
|
int flgs, ret = -1;
|
|
|
|
struct msghdr kmsg;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
void *msg_control;
|
|
|
|
struct iovec *uiov, *kiov;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
if (!msg)
|
|
|
|
{
|
|
|
|
return -EPERM;
|
|
|
|
}
|
|
|
|
|
|
|
|
flgs = netflags_muslc_2_lwip(flags);
|
|
|
|
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
ret = copy_msghdr_from_user(&kmsg, msg, &uiov, &msg_control);
|
|
|
|
|
|
|
|
if (!ret)
|
|
|
|
{
|
|
|
|
ret = recvmsg(socket, &kmsg, flgs);
|
|
|
|
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
goto _free_res;
|
|
|
|
}
|
|
|
|
|
|
|
|
kiov = kmsg.msg_iov;
|
|
|
|
|
|
|
|
for (int i = 0; i < kmsg.msg_iovlen; ++i)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(uiov->iov_base, kiov->iov_base, kiov->iov_len);
|
|
|
|
|
|
|
|
++kiov;
|
|
|
|
++uiov;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_put_to_user(msg_control, kmsg.msg_control, kmsg.msg_controllen);
|
|
|
|
lwp_put_to_user(&msg->msg_flags, &kmsg.msg_flags, sizeof(kmsg.msg_flags));
|
|
|
|
|
|
|
|
_free_res:
|
|
|
|
kmem_put(kmsg.msg_iov->iov_base);
|
|
|
|
kmem_put(kmsg.msg_iov);
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
rt_memcpy(&kmsg, msg, sizeof(kmsg));
|
|
|
|
|
|
|
|
ret = recvmsg(socket, &kmsg, flgs);
|
|
|
|
|
|
|
|
if (!ret)
|
|
|
|
{
|
|
|
|
msg->msg_flags = kmsg.msg_flags;
|
|
|
|
}
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_recvfrom(int socket, void *mem, size_t len, int flags,
|
2022-12-03 12:07:44 +08:00
|
|
|
struct musl_sockaddr *from, socklen_t *fromlen)
|
|
|
|
{
|
|
|
|
int flgs = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
|
|
|
void *kmem = RT_NULL;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
flgs = netflags_muslc_2_lwip(flags);
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!len)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)mem, len))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem = kmem_get(len);
|
|
|
|
if (!kmem)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
kmem_put(kmem);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
int ret = -1;
|
|
|
|
if (from)
|
|
|
|
{
|
|
|
|
struct sockaddr sa = {0};
|
|
|
|
|
|
|
|
ret = recvfrom(socket, mem, len, flgs, &sa, fromlen);
|
|
|
|
sockaddr_tomusl(&sa, from);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = recvfrom(socket, mem, len, flags, NULL, NULL);
|
|
|
|
}
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_recv(int socket, void *mem, size_t len, int flags)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int flgs = 0;
|
|
|
|
int ret;
|
2023-09-23 14:06:00 +08:00
|
|
|
void *kmem = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)mem, len))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
kmem = kmem_get(sizeof(*kmem));
|
|
|
|
if (kmem == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
flgs = netflags_muslc_2_lwip(flags);
|
2023-09-23 14:06:00 +08:00
|
|
|
ret = recvfrom(socket, kmem, len, flgs, NULL, NULL);
|
|
|
|
|
|
|
|
lwp_put_to_user((void *)mem, kmem, len);
|
|
|
|
kmem_put(kmem);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-11-28 13:56:06 +08:00
|
|
|
sysret_t sys_sendmsg(int socket, const struct msghdr *msg, int flags)
|
|
|
|
{
|
|
|
|
int flgs, ret = -1;
|
|
|
|
struct msghdr kmsg;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
void *msg_control;
|
|
|
|
struct iovec *uiov, *kiov;
|
|
|
|
#endif
|
|
|
|
if (!msg)
|
|
|
|
{
|
|
|
|
return -EPERM;
|
|
|
|
}
|
|
|
|
|
|
|
|
flgs = netflags_muslc_2_lwip(flags);
|
|
|
|
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
ret = copy_msghdr_from_user(&kmsg, (struct msghdr *)msg, &uiov, &msg_control);
|
|
|
|
|
|
|
|
if (!ret)
|
|
|
|
{
|
|
|
|
kiov = kmsg.msg_iov;
|
|
|
|
|
|
|
|
for (int i = 0; i < kmsg.msg_iovlen; ++i)
|
|
|
|
{
|
|
|
|
lwp_get_from_user(kiov->iov_base, uiov->iov_base, kiov->iov_len);
|
|
|
|
|
|
|
|
++kiov;
|
|
|
|
++uiov;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_get_from_user(kmsg.msg_control, msg_control, kmsg.msg_controllen);
|
|
|
|
|
|
|
|
ret = sendmsg(socket, &kmsg, flgs);
|
|
|
|
|
|
|
|
kmem_put(kmsg.msg_iov->iov_base);
|
|
|
|
kmem_put(kmsg.msg_iov);
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
rt_memcpy(&kmsg, msg, sizeof(kmsg));
|
|
|
|
|
|
|
|
ret = sendmsg(socket, &kmsg, flgs);
|
|
|
|
|
|
|
|
if (!ret)
|
|
|
|
{
|
|
|
|
msg->msg_flags = kmsg.msg_flags;
|
|
|
|
}
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_sendto(int socket, const void *dataptr, size_t size, int flags,
|
2022-12-03 12:07:44 +08:00
|
|
|
const struct musl_sockaddr *to, socklen_t tolen)
|
|
|
|
{
|
|
|
|
int flgs = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
|
|
|
void *kmem = RT_NULL;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
flgs = netflags_muslc_2_lwip(flags);
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!size)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)dataptr, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem = kmem_get(size);
|
|
|
|
if (!kmem)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
kmem_put(kmem);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
int ret;
|
|
|
|
if (to)
|
|
|
|
{
|
|
|
|
struct sockaddr sa;
|
|
|
|
sockaddr_tolwip(to, &sa);
|
|
|
|
|
|
|
|
ret = sendto(socket, dataptr, size, flgs, &sa, tolen);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = sendto(socket, dataptr, size, flgs, NULL, tolen);
|
|
|
|
}
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_send(int socket, const void *dataptr, size_t size, int flags)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int flgs = 0;
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
void *kdataptr = RT_NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)dataptr, size))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
kdataptr = kmem_get(size);
|
|
|
|
if (kdataptr == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kdataptr, (void *)dataptr, size) != size)
|
|
|
|
{
|
|
|
|
kmem_put(kdataptr);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
flgs = netflags_muslc_2_lwip(flags);
|
2023-09-23 14:06:00 +08:00
|
|
|
ret = sendto(socket, kdataptr, size, flgs, NULL, 0);
|
|
|
|
|
|
|
|
kmem_put(kdataptr);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_socket(int domain, int type, int protocol)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
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 < 0 ? GET_ERRNO() : fd);
|
|
|
|
}
|
|
|
|
|
2023-11-28 13:56:06 +08:00
|
|
|
sysret_t sys_socketpair(int domain, int type, int protocol, int fd[2])
|
2023-11-29 14:08:47 +08:00
|
|
|
{
|
2023-11-28 13:56:06 +08:00
|
|
|
#ifdef RT_USING_SAL
|
|
|
|
int ret = 0;
|
|
|
|
int k_fd[2];
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)fd, sizeof(int [2])))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = socketpair(domain, type, protocol, k_fd);
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(fd, k_fd, sizeof(int [2]));
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
#else
|
|
|
|
return -ELIBACC;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_closesocket(int socket)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return closesocket(socket);
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
rt_thread_t sys_thread_find(char *name)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
rt_thread_t thread;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
{
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kname, (void *)name, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kname);
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
thread = rt_thread_find(name);
|
|
|
|
|
|
|
|
kmem_put(kname);
|
|
|
|
|
|
|
|
return thread;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
rt_tick_t sys_tick_get(void)
|
|
|
|
{
|
|
|
|
return rt_tick_get();
|
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_thread_mdelay(rt_int32_t ms)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return rt_thread_mdelay(ms);
|
|
|
|
}
|
|
|
|
|
|
|
|
struct k_sigaction {
|
|
|
|
void (*handler)(int);
|
|
|
|
unsigned long flags;
|
|
|
|
void (*restorer)(void);
|
|
|
|
unsigned mask[2];
|
|
|
|
};
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_sigaction(int sig, const struct k_sigaction *act,
|
2023-07-20 00:02:41 +08:00
|
|
|
struct k_sigaction *oact, size_t sigsetsize)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = -RT_EINVAL;
|
2023-07-20 00:02:41 +08:00
|
|
|
struct rt_lwp *lwp;
|
2022-12-03 12:07:44 +08:00
|
|
|
struct lwp_sigaction kact, *pkact = RT_NULL;
|
|
|
|
struct lwp_sigaction koact, *pkoact = RT_NULL;
|
|
|
|
|
|
|
|
if (!sigsetsize)
|
|
|
|
{
|
|
|
|
SET_ERRNO(EINVAL);
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
if (sigsetsize > sizeof(lwp_sigset_t))
|
|
|
|
{
|
|
|
|
sigsetsize = sizeof(lwp_sigset_t);
|
|
|
|
}
|
|
|
|
if (!act && !oact)
|
|
|
|
{
|
|
|
|
SET_ERRNO(EINVAL);
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
if (oact)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)oact, sizeof(*oact)))
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
pkoact = &koact;
|
|
|
|
}
|
|
|
|
if (act)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)act, sizeof(*act)))
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
kact.sa_flags = act->flags;
|
|
|
|
kact.__sa_handler._sa_handler = act->handler;
|
2023-09-15 15:57:08 +08:00
|
|
|
lwp_memcpy(&kact.sa_mask, &act->mask, sigsetsize);
|
2022-12-03 12:07:44 +08:00
|
|
|
kact.sa_restorer = act->restorer;
|
|
|
|
pkact = &kact;
|
|
|
|
}
|
|
|
|
|
2023-07-20 00:02:41 +08:00
|
|
|
lwp = lwp_self();
|
|
|
|
RT_ASSERT(lwp);
|
|
|
|
ret = lwp_signal_action(lwp, sig, pkact, pkoact);
|
2022-12-03 12:07:44 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (ret == 0 && oact)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(&oact->handler, &pkoact->__sa_handler._sa_handler, sizeof(void (*)(int)));
|
|
|
|
lwp_put_to_user(&oact->mask, &pkoact->sa_mask, sigsetsize);
|
|
|
|
lwp_put_to_user(&oact->flags, &pkoact->sa_flags, sizeof(int));
|
|
|
|
lwp_put_to_user(&oact->restorer, &pkoact->sa_restorer, sizeof(void (*)(void)));
|
|
|
|
}
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
out:
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-07-20 00:02:41 +08:00
|
|
|
static int mask_command_u2k[] = {
|
|
|
|
[SIG_BLOCK] = LWP_SIG_MASK_CMD_BLOCK,
|
|
|
|
[SIG_UNBLOCK] = LWP_SIG_MASK_CMD_UNBLOCK,
|
|
|
|
[SIG_SETMASK] = LWP_SIG_MASK_CMD_SET_MASK,
|
|
|
|
};
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_sigprocmask(int how, const sigset_t *sigset, sigset_t *oset, size_t size)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = -1;
|
|
|
|
lwp_sigset_t *pnewset = RT_NULL, *poldset = RT_NULL;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
lwp_sigset_t newset, oldset;
|
|
|
|
#endif /* ARCH_MM_MMU*/
|
|
|
|
|
|
|
|
if (!size)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (!oset && !sigset)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (size > sizeof(lwp_sigset_t))
|
|
|
|
{
|
|
|
|
size = sizeof(lwp_sigset_t);
|
|
|
|
}
|
|
|
|
if (oset)
|
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (!lwp_user_accessable((void *)oset, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
poldset = &oldset;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)oset, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
poldset = (lwp_sigset_t *)oset;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
if (sigset)
|
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (!lwp_user_accessable((void *)sigset, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
lwp_get_from_user(&newset, (void *)sigset, size);
|
|
|
|
pnewset = &newset;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)sigset, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
pnewset = (lwp_sigset_t *)sigset;
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
ret = lwp_thread_signal_mask(rt_thread_self(), mask_command_u2k[how], pnewset, poldset);
|
2022-12-03 12:07:44 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
if (oset)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(oset, poldset, size);
|
|
|
|
}
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
return (ret < 0 ? -EFAULT: ret);
|
|
|
|
}
|
|
|
|
|
2023-07-20 00:02:41 +08:00
|
|
|
sysret_t sys_sigpending(sigset_t *sigset, size_t sigsize)
|
|
|
|
{
|
|
|
|
sysret_t ret = 0;
|
|
|
|
lwp_sigset_t lwpset;
|
|
|
|
|
|
|
|
/* Verify and Get sigset, timeout */
|
|
|
|
if (!sigset || !lwp_user_accessable((void *)sigset, sigsize))
|
|
|
|
{
|
|
|
|
ret = -EFAULT;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
/* Fit sigset size to lwp set */
|
|
|
|
if (sizeof(lwpset) < sigsize)
|
|
|
|
{
|
|
|
|
LOG_I("%s: sigsize (%lx) extends lwp sigset chunk\n", __func__, sigsize);
|
|
|
|
sigsize = sizeof(lwpset);
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_thread_signal_pending(rt_thread_self(), &lwpset);
|
|
|
|
|
|
|
|
if (!lwp_put_to_user(sigset, &lwpset, sigsize))
|
|
|
|
RT_ASSERT(0); /* should never happened */
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_sigtimedwait(const sigset_t *sigset, siginfo_t *info, const struct timespec *timeout, size_t sigsize)
|
|
|
|
{
|
|
|
|
int sig;
|
|
|
|
size_t ret;
|
|
|
|
lwp_sigset_t lwpset;
|
|
|
|
siginfo_t kinfo;
|
|
|
|
struct timespec ktimeout;
|
|
|
|
struct timespec *ptimeout;
|
|
|
|
|
2024-02-23 17:49:15 +08:00
|
|
|
/* for RT_ASSERT */
|
|
|
|
RT_UNUSED(ret);
|
|
|
|
|
2023-07-20 00:02:41 +08:00
|
|
|
/* Fit sigset size to lwp set */
|
|
|
|
if (sizeof(lwpset) < sigsize)
|
|
|
|
{
|
|
|
|
LOG_I("%s: sigsize (%lx) extends lwp sigset chunk\n", __func__, sigsize);
|
|
|
|
sigsize = sizeof(lwpset);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2023-08-03 20:25:13 +08:00
|
|
|
/* if sigset of user is smaller, clear extra space */
|
2023-07-20 00:02:41 +08:00
|
|
|
memset(&lwpset, 0, sizeof(lwpset));
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Verify and Get sigset, timeout */
|
|
|
|
if (!sigset || !lwp_user_accessable((void *)sigset, sigsize))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = lwp_get_from_user(&lwpset, (void *)sigset, sigsize);
|
|
|
|
RT_ASSERT(ret == sigsize);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (timeout)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)timeout, sizeof(*timeout)))
|
|
|
|
return -EFAULT;
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = lwp_get_from_user(&ktimeout, (void *)timeout, sizeof(*timeout));
|
|
|
|
ptimeout = &ktimeout;
|
|
|
|
RT_ASSERT(ret == sizeof(*timeout));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ptimeout = RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
sig = lwp_thread_signal_timedwait(rt_thread_self(), &lwpset, &kinfo, ptimeout);
|
|
|
|
|
2023-08-03 20:25:13 +08:00
|
|
|
if (sig > 0 && info)
|
2023-07-20 00:02:41 +08:00
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)info, sizeof(*info)))
|
|
|
|
return -EFAULT;
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = lwp_put_to_user(info, &kinfo, sizeof(*info));
|
|
|
|
RT_ASSERT(ret == sizeof(*info));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return sig;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_tkill(int tid, int sig)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
rt_thread_t thread;
|
2023-10-25 20:31:25 +08:00
|
|
|
sysret_t ret;
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Brief: Match a tid and do the kill
|
|
|
|
*
|
|
|
|
* Note: Critical Section
|
|
|
|
* - the thread (READ. may be released at the meantime; protected by locked)
|
|
|
|
*/
|
|
|
|
thread = lwp_tid_get_thread_and_inc_ref(tid);
|
2023-07-20 00:02:41 +08:00
|
|
|
ret = lwp_thread_signal_kill(thread, sig, SI_USER, 0);
|
2023-10-25 20:31:25 +08:00
|
|
|
lwp_tid_dec_ref(thread);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return ret;
|
|
|
|
#else
|
|
|
|
return lwp_thread_kill((rt_thread_t)tid, sig);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_thread_sigprocmask(int how, const lwp_sigset_t *sigset, lwp_sigset_t *oset, size_t size)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = -1;
|
|
|
|
lwp_sigset_t *pnewset = RT_NULL, *poldset = RT_NULL;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
lwp_sigset_t newset, oldset;
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
|
|
|
|
if (!size)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (!oset && !sigset)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (size != sizeof(lwp_sigset_t))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (oset)
|
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (!lwp_user_accessable((void *)oset, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
poldset = &oldset;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)oset, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
poldset = oset;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
if (sigset)
|
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (!lwp_user_accessable((void *)sigset, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
lwp_get_from_user(&newset, (void *)sigset, sizeof(lwp_sigset_t));
|
|
|
|
pnewset = &newset;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)sigset, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
pnewset = (lwp_sigset_t *)sigset;
|
|
|
|
#endif
|
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
ret = lwp_thread_signal_mask(rt_thread_self(), mask_command_u2k[how], pnewset, poldset);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (oset)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(oset, poldset, sizeof(lwp_sigset_t));
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
return (ret < 0 ? -EFAULT: ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifndef ARCH_MM_MMU
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_lwp_sighandler_set(int sig, lwp_sighandler_t func)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)func, sizeof(lwp_sighandler_t)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_sighandler_set(sig, func);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_thread_sighandler_set(int sig, lwp_sighandler_t func)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)func, sizeof(lwp_sighandler_t)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_thread_sighandler_set(sig, func);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
#endif /* not defined ARCH_MM_MMU */
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_waitpid(int32_t pid, int *status, int options)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = -1;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)status, sizeof(int)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
ret = lwp_waitpid(pid, status, options, RT_NULL);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)status, sizeof(int)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
ret = waitpid(pid, status, options);
|
|
|
|
#endif
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
#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;
|
|
|
|
};
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_getaddrinfo(const char *nodename,
|
2022-12-03 12:07:44 +08:00
|
|
|
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;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif
|
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)res, sizeof(*res)))
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
if (nodename)
|
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(nodename);
|
|
|
|
if (len <= 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto exit;
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
|
|
|
|
k_nodename = (char *)kmem_get(len + 1);
|
|
|
|
if (!k_nodename)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(k_nodename, (void *)nodename, len + 1) != len + 1)
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
#else
|
2022-12-03 12:07:44 +08:00
|
|
|
k_nodename = rt_strdup(nodename);
|
|
|
|
if (!k_nodename)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto exit;
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
#endif
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
if (servname)
|
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(servname);
|
|
|
|
if (len <= 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto exit;
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
|
|
|
|
k_servname = (char *)kmem_get(len + 1);
|
|
|
|
if (!k_servname)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(k_servname, (void *)servname, len + 1) < 0)
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
#else
|
2022-12-03 12:07:44 +08:00
|
|
|
k_servname = rt_strdup(servname);
|
|
|
|
if (!k_servname)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto exit;
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
#endif
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (hints)
|
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)hints, sizeof(*hints)))
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
k_hints = (struct addrinfo *) rt_malloc(sizeof *hints);
|
|
|
|
if (!k_hints)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
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:
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (k_nodename)
|
|
|
|
{
|
|
|
|
kmem_put(k_nodename);
|
|
|
|
}
|
|
|
|
#else
|
2022-12-03 12:07:44 +08:00
|
|
|
if (k_nodename)
|
|
|
|
{
|
|
|
|
rt_free(k_nodename);
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
#endif
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (k_servname)
|
|
|
|
{
|
|
|
|
kmem_put(k_servname);
|
|
|
|
}
|
|
|
|
#else
|
2022-12-03 12:07:44 +08:00
|
|
|
if (k_servname)
|
|
|
|
{
|
|
|
|
rt_free(k_servname);
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
#endif
|
2022-12-03 12:07:44 +08:00
|
|
|
if (k_hints)
|
|
|
|
{
|
|
|
|
rt_free(k_hints);
|
|
|
|
}
|
|
|
|
|
2023-02-07 18:53:05 +08:00
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
#define HOSTENT_BUFSZ 512
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_gethostbyname2_r(const char *name, int af, struct hostent *ret,
|
2022-12-03 12:07:44 +08:00
|
|
|
char *buf, size_t buflen,
|
|
|
|
struct hostent **result, int *err)
|
|
|
|
{
|
|
|
|
int ret_val = -1;
|
|
|
|
int sal_ret = -1 , sal_err = -1;
|
2023-10-17 13:07:59 +08:00
|
|
|
struct hostent sal_he, sal_tmp;
|
2022-12-03 12:07:44 +08:00
|
|
|
struct hostent *sal_result = NULL;
|
|
|
|
char *sal_buf = NULL;
|
|
|
|
char *k_name = NULL;
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)err, sizeof(*err)))
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto __exit;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)result, sizeof(*result))
|
|
|
|
|| !lwp_user_accessable((void *)ret, sizeof(*ret))
|
|
|
|
|| !lwp_user_accessable((void *)buf, buflen))
|
|
|
|
{
|
|
|
|
/* not all arguments given */
|
|
|
|
*err = EFAULT;
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto __exit;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(name);
|
|
|
|
if (len <= 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
*err = EFAULT;
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto __exit;
|
|
|
|
}
|
|
|
|
|
2023-10-17 13:07:59 +08:00
|
|
|
k_name = (char *)kmem_get(len + 1);
|
|
|
|
if (!k_name)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto __exit;
|
|
|
|
}
|
|
|
|
|
2023-10-17 13:07:59 +08:00
|
|
|
if (lwp_get_from_user(k_name, (void *)name, len + 1) < 0)
|
|
|
|
{
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
goto __exit;
|
|
|
|
}
|
|
|
|
#else
|
2022-12-03 12:07:44 +08:00
|
|
|
k_name = rt_strdup(name);
|
|
|
|
if (k_name == NULL)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto __exit;
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
#endif
|
|
|
|
|
|
|
|
*result = ret;
|
|
|
|
sal_buf = (char *)malloc(HOSTENT_BUFSZ);
|
|
|
|
if (sal_buf == NULL)
|
|
|
|
{
|
|
|
|
SET_ERRNO(ENOMEM);
|
|
|
|
goto __exit;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
/* 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 = 0, cnt = 0;
|
|
|
|
char *ptr = buf;
|
|
|
|
|
|
|
|
/* get counter */
|
|
|
|
index = 0;
|
|
|
|
while (sal_he.h_addr_list[index] != NULL)
|
|
|
|
{
|
|
|
|
index++;
|
|
|
|
}
|
|
|
|
cnt = index + 1;
|
|
|
|
|
2023-10-17 13:07:59 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
/* update user space hostent */
|
|
|
|
lwp_put_to_user(buf, k_name, buflen - (ptr - buf));
|
|
|
|
lwp_memcpy(&sal_tmp, &sal_he, sizeof(sal_he));
|
|
|
|
sal_tmp.h_name = ptr;
|
|
|
|
ptr += rt_strlen(k_name);
|
|
|
|
|
|
|
|
sal_tmp.h_addr_list = (char**)ptr;
|
|
|
|
ptr += cnt * sizeof(char *);
|
|
|
|
|
|
|
|
index = 0;
|
|
|
|
while (sal_he.h_addr_list[index] != NULL)
|
|
|
|
{
|
|
|
|
sal_tmp.h_addr_list[index] = ptr;
|
|
|
|
lwp_memcpy(ptr, sal_he.h_addr_list[index], sal_he.h_length);
|
|
|
|
|
|
|
|
ptr += sal_he.h_length;
|
|
|
|
index++;
|
|
|
|
}
|
|
|
|
sal_tmp.h_addr_list[index] = NULL;
|
|
|
|
lwp_put_to_user(ret, &sal_tmp, sizeof(sal_tmp));
|
|
|
|
#else
|
2022-12-03 12:07:44 +08:00
|
|
|
/* 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;
|
2024-03-28 23:42:56 +08:00
|
|
|
ptr += strlen(k_name);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
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;
|
2023-09-15 15:57:08 +08:00
|
|
|
lwp_memcpy(ptr, sal_he.h_addr_list[index], sal_he.h_length);
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
ptr += sal_he.h_length;
|
|
|
|
index++;
|
|
|
|
}
|
|
|
|
ret->h_addr_list[index] = NULL;
|
2023-10-17 13:07:59 +08:00
|
|
|
#endif
|
|
|
|
ret_val = 0;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2024-03-28 23:42:56 +08:00
|
|
|
else
|
|
|
|
{
|
|
|
|
SET_ERRNO(EINVAL);
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
__exit:
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret_val < 0)
|
|
|
|
{
|
|
|
|
ret_val = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
/* release buffer */
|
|
|
|
if (sal_buf)
|
|
|
|
{
|
|
|
|
free(sal_buf);
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
if (k_name)
|
|
|
|
{
|
|
|
|
kmem_put(k_name);
|
|
|
|
}
|
|
|
|
#else
|
2022-12-03 12:07:44 +08:00
|
|
|
if (k_name)
|
|
|
|
{
|
|
|
|
free(k_name);
|
|
|
|
}
|
2023-10-17 13:07:59 +08:00
|
|
|
#endif
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-02-07 18:53:05 +08:00
|
|
|
return ret_val;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2024-04-25 18:28:53 +08:00
|
|
|
long sys_getcwd(char *buf, size_t size)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-04-25 18:28:53 +08:00
|
|
|
char *tmp = RT_NULL;
|
|
|
|
long ret = -1;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)buf, size))
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
tmp = (char *)rt_malloc(size);
|
|
|
|
if (!tmp)
|
|
|
|
{
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (getcwd(tmp, size) != RT_NULL)
|
|
|
|
{
|
|
|
|
if (lwp_put_to_user(buf, tmp, size) > 0)
|
|
|
|
{
|
2024-04-25 18:28:53 +08:00
|
|
|
if (buf != RT_NULL)
|
|
|
|
ret = strlen(buf);
|
|
|
|
else
|
|
|
|
ret = -EFAULT;
|
2023-09-23 14:06:00 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_free(tmp);
|
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_chdir(const char *path)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int err = 0;
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
2024-03-28 23:42:56 +08:00
|
|
|
int errcode;
|
2023-09-23 14:06:00 +08:00
|
|
|
char *kpath = RT_NULL;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(path);
|
|
|
|
if (len <= 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kpath = (char *)kmem_get(len + 1);
|
|
|
|
if (!kpath)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kpath, (void *)path, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kpath);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = chdir(kpath);
|
2024-03-28 23:42:56 +08:00
|
|
|
errcode = err != 0 ? GET_ERRNO() : 0;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kpath);
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
return errcode;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
int ret = chdir(path);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
sysret_t sys_fchdir(int fd)
|
|
|
|
{
|
|
|
|
int errcode = -ENOSYS;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
#ifdef RT_USING_DFS_V2
|
|
|
|
int err = -1;
|
|
|
|
struct dfs_file *d;
|
|
|
|
char *kpath;
|
|
|
|
|
|
|
|
d = fd_get(fd);
|
|
|
|
if (!d || !d->vnode)
|
|
|
|
{
|
|
|
|
return -EBADF;
|
|
|
|
}
|
|
|
|
kpath = dfs_dentry_full_path(d->dentry);
|
|
|
|
if (!kpath)
|
|
|
|
{
|
|
|
|
return -EACCES;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = chdir(kpath);
|
|
|
|
errcode = err != 0 ? GET_ERRNO() : 0;
|
|
|
|
|
|
|
|
kmem_put(kpath);
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
return errcode;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_mkdir(const char *path, mode_t mode)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int err = 0;
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
char *kpath = RT_NULL;
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(path);
|
|
|
|
if (len <= 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kpath = (char *)kmem_get(len + 1);
|
|
|
|
if (!kpath)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kpath, (void *)path, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kpath);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2024-05-29 18:06:54 +08:00
|
|
|
err = _SYS_WRAP(mkdir(kpath, mode));
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kpath);
|
|
|
|
|
2024-05-29 18:06:54 +08:00
|
|
|
return err;
|
2018-12-10 16:31:33 +08:00
|
|
|
#else
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = mkdir(path, mode);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2018-12-10 16:31:33 +08:00
|
|
|
#endif
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_rmdir(const char *path)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int err = 0;
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
char *kpath = RT_NULL;
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(path);
|
|
|
|
if (len <= 0)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
return -EFAULT;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kpath = (char *)kmem_get(len + 1);
|
|
|
|
if (!kpath)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kpath, (void *)path, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(kpath);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = rmdir(kpath);
|
|
|
|
|
|
|
|
kmem_put(kpath);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return (err < 0 ? GET_ERRNO() : err);
|
|
|
|
#else
|
2023-06-10 21:35:25 +08:00
|
|
|
int ret = rmdir(path);
|
2022-12-03 12:07:44 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-08-16 15:38:59 +08:00
|
|
|
#ifdef RT_USING_MUSLLIBC
|
2022-12-03 12:07:44 +08:00
|
|
|
typedef uint64_t ino_t;
|
|
|
|
#endif
|
2023-03-13 19:09:34 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
struct libc_dirent {
|
|
|
|
ino_t d_ino;
|
|
|
|
off_t d_off;
|
|
|
|
unsigned short d_reclen;
|
|
|
|
unsigned char d_type;
|
2023-11-28 17:16:21 +08:00
|
|
|
char d_name[DIRENT_NAME_MAX];
|
2022-12-03 12:07:44 +08:00
|
|
|
};
|
2023-03-13 19:09:34 +08:00
|
|
|
|
|
|
|
sysret_t sys_getdents(int fd, struct libc_dirent *dirp, size_t nbytes)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
2023-04-08 22:25:51 +08:00
|
|
|
struct dfs_file *file;
|
2022-12-03 12:07:44 +08:00
|
|
|
size_t cnt = (nbytes / sizeof(struct libc_dirent));
|
|
|
|
size_t rtt_nbytes = 0;
|
|
|
|
struct dirent *rtt_dirp;
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)dirp, sizeof(struct libc_dirent)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
#endif
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (cnt == 0)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
rtt_nbytes = cnt * sizeof(struct dirent);
|
|
|
|
rtt_dirp = (struct dirent *)rt_malloc(rtt_nbytes);
|
|
|
|
if (!rtt_dirp)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2023-04-08 22:25:51 +08:00
|
|
|
file = fd_get(fd);
|
|
|
|
ret = dfs_file_getdents(file, rtt_dirp, rtt_nbytes);
|
2022-12-03 12:07:44 +08:00
|
|
|
if (ret > 0)
|
|
|
|
{
|
|
|
|
size_t i = 0;
|
|
|
|
cnt = ret / sizeof(struct dirent);
|
|
|
|
for (i = 0; i < cnt; i++)
|
|
|
|
{
|
|
|
|
dirp[i].d_ino = 0;
|
|
|
|
dirp[i].d_off = i*sizeof(struct libc_dirent);
|
|
|
|
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);
|
|
|
|
}
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_free(rtt_dirp);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t sys_get_errno(void)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
return rt_get_errno();
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
2023-03-13 19:09:34 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_set_thread_area(void *p)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
rt_thread_t thread;
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
thread = rt_thread_self();
|
|
|
|
thread->thread_idr = p;
|
|
|
|
arch_set_thread_area(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_set_tid_address(int *tidptr)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_thread_t thread;
|
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)tidptr, sizeof(int)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
thread = rt_thread_self();
|
|
|
|
thread->clear_child_tid = tidptr;
|
|
|
|
return thread->tid;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif /* ARCH_MM_MMU */
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_gettid(void)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
return rt_thread_self()->tid;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_access(const char *filename, int mode)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
rt_size_t len = 0;
|
2023-09-23 14:06:00 +08:00
|
|
|
char *kfilename = RT_NULL;
|
2022-12-03 12:07:44 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(filename);
|
|
|
|
if (len <= 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
return -EINVAL;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
kfilename = (char *)kmem_get(len + 1);
|
|
|
|
if (!kfilename)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
return -ENOMEM;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
if (lwp_get_from_user(kfilename, (void *)filename, len + 1) != (len + 1))
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
kmem_put(kfilename);
|
|
|
|
return -EFAULT;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
ret = access(kfilename, mode);
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-02-07 18:53:05 +08:00
|
|
|
ret = GET_ERRNO();
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2023-02-07 18:53:05 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
kmem_put(kfilename);
|
2023-02-07 18:53:05 +08:00
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
ret = access(filename, mode);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-02-07 18:53:05 +08:00
|
|
|
#endif
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_pipe(int fd[2])
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret;
|
2023-09-23 14:06:00 +08:00
|
|
|
int kfd[2] = {0, 0};
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)fd, sizeof(int[2])))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
ret = pipe(kfd);
|
|
|
|
|
|
|
|
lwp_put_to_user((void *)fd, kfd, sizeof(int[2]));
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
sysret_t sys_wait4(pid_t pid, int *status, int options, struct rusage *ru)
|
|
|
|
{
|
|
|
|
return lwp_waitpid(pid, status, options, ru);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_clock_settime(clockid_t clk, const struct timespec *ts)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
size_t size = sizeof(struct timespec);
|
|
|
|
struct timespec *kts = NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)ts, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kts = kmem_get(size);
|
|
|
|
if (!kts)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_get_from_user(kts, (void *)ts, size);
|
|
|
|
ret = clock_settime(clk, kts);
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
kmem_put(kts);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)ts, sizeof(struct timespec)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
ret = clock_settime(clk, ts);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-02-07 18:53:05 +08:00
|
|
|
#endif
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_clock_gettime(clockid_t clk, struct timespec *ts)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
size_t size = sizeof(struct timespec);
|
|
|
|
struct timespec *kts = NULL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)ts, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kts = kmem_get(size);
|
|
|
|
if (!kts)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
ret = clock_gettime(clk, kts);
|
|
|
|
if (ret != -1)
|
|
|
|
lwp_put_to_user(ts, kts, size);
|
|
|
|
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
kmem_put(kts);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2022-12-03 12:07:44 +08:00
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)ts, sizeof(struct timespec)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
ret = clock_gettime(clk, ts);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-02-07 18:53:05 +08:00
|
|
|
#endif
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_clock_nanosleep(clockid_t clk, int flags, const struct timespec *rqtp, struct timespec *rmtp)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
2018-12-10 16:31:33 +08:00
|
|
|
dbg_log(DBG_LOG, "sys_nanosleep\n");
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)rqtp, sizeof *rqtp))
|
|
|
|
return -EFAULT;
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
struct timespec rqtp_k;
|
|
|
|
struct timespec rmtp_k;
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
lwp_get_from_user(&rqtp_k, (void *)rqtp, sizeof rqtp_k);
|
|
|
|
ret = clock_nanosleep(clk, flags, &rqtp_k, &rmtp_k);
|
|
|
|
if ((ret != -1 || rt_get_errno() == EINTR) && rmtp && lwp_user_accessable((void *)rmtp, sizeof *rmtp))
|
|
|
|
{
|
|
|
|
lwp_put_to_user(rmtp, (void *)&rmtp_k, sizeof rmtp_k);
|
2022-12-08 23:02:40 +08:00
|
|
|
if(ret != 0)
|
|
|
|
return -EINTR;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
#else
|
2018-12-10 16:31:33 +08:00
|
|
|
if (rmtp)
|
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)rmtp, sizeof *rmtp))
|
|
|
|
return -EFAULT;
|
|
|
|
ret = clock_nanosleep(clk, flags, rqtp, rmtp);
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_clock_getres(clockid_t clk, struct timespec *ts)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = 0;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
struct timespec kts;
|
|
|
|
size_t size = sizeof(struct timespec);
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable((void *)ts, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
ret = clock_getres(clk, &kts);
|
|
|
|
|
|
|
|
if (ret != -1)
|
|
|
|
lwp_put_to_user(ts, &kts, size);
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)ts, sizeof(struct timespec)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
ret = clock_getres(clk, ts);
|
|
|
|
#endif
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_rename(const char *oldpath, const char *newpath)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
int err;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
err = lwp_user_strlen(oldpath);
|
|
|
|
if (err <= 0)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
return -EFAULT;
|
|
|
|
}
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
err = lwp_user_strlen(newpath);
|
|
|
|
if (err <= 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
#endif
|
|
|
|
ret = rename(oldpath, newpath);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
typedef unsigned long long rlim_t;
|
|
|
|
|
|
|
|
struct rlimit {
|
|
|
|
rlim_t rlim_cur;
|
|
|
|
rlim_t rlim_max;
|
|
|
|
};
|
|
|
|
|
|
|
|
#define RLIMIT_CPU 0
|
|
|
|
#define RLIMIT_FSIZE 1
|
|
|
|
#define RLIMIT_DATA 2
|
|
|
|
#define RLIMIT_STACK 3
|
|
|
|
#define RLIMIT_CORE 4
|
|
|
|
#define RLIMIT_RSS 5
|
|
|
|
#define RLIMIT_NPROC 6
|
|
|
|
#define RLIMIT_NOFILE 7
|
|
|
|
#define RLIMIT_MEMLOCK 8
|
|
|
|
#define RLIMIT_AS 9
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_prlimit64(pid_t pid,
|
2022-12-03 12:07:44 +08:00
|
|
|
unsigned int resource,
|
|
|
|
const struct rlimit *new_rlim,
|
|
|
|
struct rlimit *old_rlim)
|
|
|
|
{
|
|
|
|
return -ENOSYS;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_getrlimit(unsigned int resource, unsigned long rlim[2])
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
2023-09-23 14:06:00 +08:00
|
|
|
unsigned long krlim[2] = {0, 0};
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)rlim, sizeof(unsigned long [2])))
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
return -EFAULT;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
if (lwp_get_from_user(krlim, rlim, sizeof(unsigned long [2])) != sizeof(unsigned long [2]))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
switch (resource)
|
|
|
|
{
|
|
|
|
case RLIMIT_NOFILE:
|
|
|
|
{
|
|
|
|
struct dfs_fdtable *fdt = dfs_fdtable_get();
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2023-04-08 22:25:51 +08:00
|
|
|
dfs_file_lock();
|
2023-09-23 14:06:00 +08:00
|
|
|
krlim[0] = fdt->maxfd;
|
2023-04-08 22:25:51 +08:00
|
|
|
dfs_file_unlock();
|
2023-09-23 14:06:00 +08:00
|
|
|
krlim[1] = DFS_FD_MAX;
|
2022-12-03 12:07:44 +08:00
|
|
|
ret = 0;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
break;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
lwp_put_to_user((void *)rlim, krlim, sizeof(unsigned long [2]));
|
2024-03-28 23:42:56 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_setrlimit(unsigned int resource, struct rlimit *rlim)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
return -ENOSYS;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_getrandom(void *buf, size_t buflen, unsigned int flags)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
|
|
|
int count = 0;
|
|
|
|
void *kmem = RT_NULL;
|
|
|
|
rt_device_t rd_dev = RT_NULL;
|
|
|
|
|
|
|
|
if (flags & GRND_RANDOM)
|
|
|
|
rd_dev = rt_device_find("random");
|
|
|
|
else
|
|
|
|
rd_dev = rt_device_find("urandom");
|
|
|
|
|
|
|
|
if (rd_dev == RT_NULL)
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (rt_device_open(rd_dev, RT_DEVICE_OFLAG_RDONLY) != RT_EOK)
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable(buf, buflen))
|
|
|
|
{
|
|
|
|
rt_device_close(rd_dev);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2022-12-16 18:38:28 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2022-12-03 12:07:44 +08:00
|
|
|
kmem = kmem_get(buflen);
|
|
|
|
if (!kmem)
|
|
|
|
{
|
|
|
|
rt_device_close(rd_dev);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (count < buflen)
|
|
|
|
{
|
|
|
|
ret = rt_device_read(rd_dev, count, (char *)kmem + count, buflen - count);
|
|
|
|
if (ret <= 0)
|
|
|
|
break;
|
|
|
|
count += ret;
|
|
|
|
}
|
|
|
|
rt_device_close(rd_dev);
|
|
|
|
|
|
|
|
ret = count;
|
|
|
|
if (count > 0)
|
|
|
|
{
|
|
|
|
ret = lwp_put_to_user(buf, kmem, count);
|
|
|
|
}
|
|
|
|
kmem_put(kmem);
|
|
|
|
#else
|
|
|
|
while (count < buflen)
|
|
|
|
{
|
|
|
|
ret = rt_device_read(rd_dev, count, (char *)kmem + count, buflen - count);
|
|
|
|
if (ret <= 0)
|
|
|
|
break;
|
|
|
|
count += ret;
|
|
|
|
}
|
|
|
|
rt_device_close(rd_dev);
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
ret = count;
|
|
|
|
#endif
|
|
|
|
return ret;
|
|
|
|
}
|
2023-02-24 21:00:54 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
/**
|
|
|
|
* readlink() places the contents of the symbolic link pathname in the buffer buf, which has size bufsiz.
|
|
|
|
* readlink() does not append a null byte to buf.
|
|
|
|
* It will (silently) truncate the contents(to a length of bufsiz characters),
|
|
|
|
* in case the buffer is too small to hold all of the contents.
|
|
|
|
*/
|
2023-02-24 21:00:54 +08:00
|
|
|
ssize_t sys_readlink(char* path, char *buf, size_t bufsz)
|
|
|
|
{
|
|
|
|
size_t len, copy_len;
|
2023-03-28 11:18:06 +08:00
|
|
|
int err, rtn;
|
2023-02-24 21:00:54 +08:00
|
|
|
char *copy_path;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(path);
|
|
|
|
if (len <= 0)
|
2023-02-24 21:00:54 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable(buf, bufsz))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_path = (char*)rt_malloc(len + 1);
|
|
|
|
if (!copy_path)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_len = lwp_get_from_user(copy_path, path, len);
|
|
|
|
copy_path[copy_len] = '\0';
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
char *link_fn = (char *)rt_malloc(DFS_PATH_MAX);
|
|
|
|
if (link_fn)
|
2023-02-24 21:00:54 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
err = dfs_file_readlink(copy_path, link_fn, DFS_PATH_MAX);
|
|
|
|
if (err > 0)
|
2023-03-28 11:18:06 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
rtn = lwp_put_to_user(buf, link_fn, bufsz > err ? err : bufsz - 1);
|
2023-03-28 11:18:06 +08:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
rtn = -EIO;
|
2023-03-28 11:18:06 +08:00
|
|
|
}
|
2024-03-28 23:42:56 +08:00
|
|
|
rt_free(link_fn);
|
2023-03-28 11:18:06 +08:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
rtn = -ENOMEM;
|
2023-02-24 21:00:54 +08:00
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
rt_free(copy_path);
|
|
|
|
return rtn;
|
2023-02-24 21:00:54 +08:00
|
|
|
}
|
|
|
|
|
2023-11-02 23:12:44 +08:00
|
|
|
sysret_t sys_sched_setaffinity(pid_t pid, size_t size, void *set)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
void *kset = RT_NULL;
|
|
|
|
|
2023-11-02 23:12:44 +08:00
|
|
|
if (size <= 0 || size > sizeof(cpu_set_t))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (!lwp_user_accessable((void *)set, size))
|
2022-12-03 12:07:44 +08:00
|
|
|
return -EFAULT;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2023-11-02 23:12:44 +08:00
|
|
|
kset = kmem_get(size);
|
2023-09-23 14:06:00 +08:00
|
|
|
if (kset == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2023-11-02 23:12:44 +08:00
|
|
|
if (lwp_get_from_user(kset, set, size) != size)
|
2023-09-23 14:06:00 +08:00
|
|
|
{
|
|
|
|
kmem_put(kset);
|
|
|
|
return -EINVAL;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
for (int i = 0;i < size * 8; i++)
|
|
|
|
{
|
2023-11-02 23:12:44 +08:00
|
|
|
if (CPU_ISSET_S(i, size, kset))
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
kmem_put(kset);
|
[smart] update sched_setaffinity() to use thread(task) ID (#9004)
Correct `sched_setaffinity()` to use the thread IDs (TIDs) instead of
process IDs (PIDs). The previous implementation used PIDs, which
caused issues since affinity settings need to be applied at the
thread level.
As the manual documented, the signature is:
> int sched_setaffinity(pid_t pid, size_t cpusetsize,
> const cpu_set_t *mask);
Yes, it's tricky, the identification passing in is called **'PID'**.
But when we talk about 'pid' from GNU libc, it's the **'task-id'**,
aka, `thread->tid` known in kernel.
Changes were made by updating the function signatures and logic in
`lwp.h`, `lwp_pid.c`, and `lwp_syscall.c` to accept TIDs. Specifically,
the `lwp_setaffinity` function and related internal functions now
operate using thread IDs and adjust thread affinity settings accordingly
Signed-off-by: Shell <smokewood@qq.com>
2024-05-29 06:53:22 +08:00
|
|
|
|
|
|
|
/**
|
|
|
|
* yes it's tricky.
|
|
|
|
* But when we talk about 'pid' from GNU libc, it's the 'task-id'
|
|
|
|
* aka 'thread->tid' known in kernel.
|
|
|
|
*/
|
2022-12-03 12:07:44 +08:00
|
|
|
return lwp_setaffinity(pid, i);
|
|
|
|
}
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(kset);
|
|
|
|
|
2018-12-10 16:31:33 +08:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2023-11-02 23:12:44 +08:00
|
|
|
sysret_t sys_sched_getaffinity(const pid_t pid, size_t size, void *set)
|
2023-05-23 22:43:38 +08:00
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
2024-02-23 17:49:15 +08:00
|
|
|
LWP_DEF_RETURN_CODE(rc);
|
2023-11-02 23:12:44 +08:00
|
|
|
void *mask;
|
2023-05-23 22:43:38 +08:00
|
|
|
struct rt_lwp *lwp;
|
|
|
|
|
|
|
|
if (size <= 0 || size > sizeof(cpu_set_t))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (!lwp_user_accessable(set, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-11-02 23:12:44 +08:00
|
|
|
mask = kmem_get(size);
|
|
|
|
if (!mask)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
CPU_ZERO_S(size, mask);
|
2023-05-23 22:43:38 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
lwp_pid_lock_take();
|
|
|
|
lwp = lwp_from_pid_locked(pid);
|
2023-10-25 20:31:25 +08:00
|
|
|
|
|
|
|
if (!lwp)
|
2023-05-23 22:43:38 +08:00
|
|
|
{
|
2023-10-25 20:31:25 +08:00
|
|
|
rc = -ESRCH;
|
2023-05-23 22:43:38 +08:00
|
|
|
}
|
2023-10-25 20:31:25 +08:00
|
|
|
else
|
2023-05-23 22:43:38 +08:00
|
|
|
{
|
2023-11-02 23:12:44 +08:00
|
|
|
#ifdef RT_USING_SMP
|
2023-10-25 20:31:25 +08:00
|
|
|
if (lwp->bind_cpu == RT_CPUS_NR) /* not bind */
|
|
|
|
{
|
2023-11-02 23:12:44 +08:00
|
|
|
for(int i = 0; i < RT_CPUS_NR; i++)
|
|
|
|
{
|
|
|
|
CPU_SET_S(i, size, mask);
|
|
|
|
}
|
2023-10-25 20:31:25 +08:00
|
|
|
}
|
|
|
|
else /* set bind cpu */
|
|
|
|
{
|
|
|
|
/* TODO: only single-core bindings are now supported of rt-smart */
|
2023-11-02 23:12:44 +08:00
|
|
|
CPU_SET_S(lwp->bind_cpu, size, mask);
|
2023-10-25 20:31:25 +08:00
|
|
|
}
|
2023-11-02 23:12:44 +08:00
|
|
|
#else
|
|
|
|
CPU_SET_S(0, size, mask);
|
|
|
|
#endif
|
2023-10-25 20:31:25 +08:00
|
|
|
|
2023-11-02 23:12:44 +08:00
|
|
|
if (lwp_put_to_user(set, mask, size) != size)
|
2023-10-25 20:31:25 +08:00
|
|
|
rc = -EFAULT;
|
|
|
|
else
|
2023-11-02 23:12:44 +08:00
|
|
|
rc = size;
|
2023-05-23 22:43:38 +08:00
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
lwp_pid_lock_release();
|
2023-10-25 20:31:25 +08:00
|
|
|
|
2023-11-02 23:12:44 +08:00
|
|
|
kmem_put(mask);
|
|
|
|
|
2024-02-23 17:49:15 +08:00
|
|
|
LWP_RETURN(rc);
|
2023-05-23 22:43:38 +08:00
|
|
|
#else
|
|
|
|
return -1;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_sysinfo(void *info)
|
|
|
|
{
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
struct sysinfo kinfo = {0};
|
|
|
|
rt_size_t total_pages = 0, free_pages = 0;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable(info, sizeof(struct sysinfo)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kinfo.uptime = rt_tick_get_millisecond() / 1000;
|
|
|
|
/* TODO: 1, 5, and 15 minute load averages */
|
|
|
|
kinfo.loads[0] = kinfo.loads[1] = kinfo.loads[2] = rt_object_get_length(RT_Object_Class_Thread);
|
|
|
|
rt_page_get_info(&total_pages, &free_pages);
|
|
|
|
kinfo.totalram = total_pages;
|
|
|
|
kinfo.freeram = free_pages;
|
|
|
|
|
|
|
|
/* TODO: implementation procfs, here is counter the lwp number */
|
|
|
|
struct lwp_avl_struct *pids = lwp_get_pid_ary();
|
|
|
|
for (int index = 0; index < RT_LWP_MAX_NR; index++)
|
|
|
|
{
|
|
|
|
struct rt_lwp *lwp = (struct rt_lwp *)pids[index].data;
|
|
|
|
|
|
|
|
if (lwp)
|
|
|
|
{
|
|
|
|
kinfo.procs++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
rt_page_high_get_info(&total_pages, &free_pages);
|
|
|
|
kinfo.totalhigh = total_pages;
|
|
|
|
kinfo.freehigh = free_pages;
|
|
|
|
kinfo.mem_unit = ARCH_PAGE_SIZE;
|
|
|
|
|
|
|
|
if (lwp_put_to_user(info, &kinfo, sizeof(struct sysinfo)) != sizeof(struct sysinfo))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
#else
|
|
|
|
return -1;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
sysret_t sys_sched_setparam(pid_t tid, void *param)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
struct sched_param *sched_param = RT_NULL;
|
2024-03-28 23:42:56 +08:00
|
|
|
rt_thread_t thread;
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable(param, sizeof(struct sched_param)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
sched_param = kmem_get(sizeof(struct sched_param));
|
|
|
|
if (sched_param == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(sched_param, param, sizeof(struct sched_param)) != sizeof(struct sched_param))
|
|
|
|
{
|
|
|
|
kmem_put(sched_param);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
thread = lwp_tid_get_thread_and_inc_ref(tid);
|
2023-10-25 20:31:25 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
if (thread)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
ret = rt_thread_control(thread, RT_THREAD_CTRL_CHANGE_PRIORITY, (void *)&sched_param->sched_priority);
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
lwp_tid_dec_ref(thread);
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
kmem_put(sched_param);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return ret;
|
|
|
|
}
|
2018-12-10 16:31:33 +08:00
|
|
|
|
2023-08-08 00:22:14 +08:00
|
|
|
sysret_t sys_sched_yield(void)
|
|
|
|
{
|
|
|
|
rt_thread_yield();
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2024-02-23 17:49:15 +08:00
|
|
|
sysret_t sys_sched_getparam(const pid_t tid, void *param)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
struct sched_param *sched_param = RT_NULL;
|
2024-02-23 17:49:15 +08:00
|
|
|
rt_thread_t thread;
|
2022-12-03 12:07:44 +08:00
|
|
|
int ret = -1;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable(param, sizeof(struct sched_param)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
sched_param = kmem_get(sizeof(struct sched_param));
|
|
|
|
if (sched_param == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2024-02-23 17:49:15 +08:00
|
|
|
thread = lwp_tid_get_thread_and_inc_ref(tid);
|
2023-10-25 20:31:25 +08:00
|
|
|
|
2024-02-23 17:49:15 +08:00
|
|
|
if (thread)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2024-02-23 17:49:15 +08:00
|
|
|
sched_param->sched_priority = RT_SCHED_PRIV(thread).current_priority;
|
2022-12-03 12:07:44 +08:00
|
|
|
ret = 0;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2024-02-23 17:49:15 +08:00
|
|
|
lwp_tid_dec_ref(thread);
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
lwp_put_to_user((void *)param, sched_param, sizeof(struct sched_param));
|
|
|
|
kmem_put(sched_param);
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
return ret;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_sched_get_priority_max(int policy)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
if(policy < 0)
|
|
|
|
{
|
2023-03-13 19:09:34 +08:00
|
|
|
SET_ERRNO(EINVAL);
|
2022-12-03 12:07:44 +08:00
|
|
|
return -rt_get_errno();
|
2022-12-16 18:38:28 +08:00
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
return RT_THREAD_PRIORITY_MAX;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_sched_get_priority_min(int policy)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
if(policy < 0)
|
|
|
|
{
|
2023-03-13 19:09:34 +08:00
|
|
|
SET_ERRNO(EINVAL);
|
2022-12-03 12:07:44 +08:00
|
|
|
return -rt_get_errno();
|
|
|
|
}
|
|
|
|
return 0;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_sched_setscheduler(int tid, int policy, void *param)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2023-10-25 20:31:25 +08:00
|
|
|
sysret_t ret;
|
2023-09-23 14:06:00 +08:00
|
|
|
struct sched_param *sched_param = RT_NULL;
|
|
|
|
rt_thread_t thread = RT_NULL;
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
if (!lwp_user_accessable(param, sizeof(struct sched_param)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
sched_param = kmem_get(sizeof(struct sched_param));
|
|
|
|
if (sched_param == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(sched_param, param, sizeof(struct sched_param)) != sizeof(struct sched_param))
|
|
|
|
{
|
|
|
|
kmem_put(sched_param);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2023-10-25 20:31:25 +08:00
|
|
|
thread = lwp_tid_get_thread_and_inc_ref(tid);
|
2023-09-23 14:06:00 +08:00
|
|
|
ret = rt_thread_control(thread, RT_THREAD_CTRL_CHANGE_PRIORITY, (void *)&sched_param->sched_priority);
|
2023-10-25 20:31:25 +08:00
|
|
|
lwp_tid_dec_ref(thread);
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kmem_put(sched_param);
|
|
|
|
|
|
|
|
return ret;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
sysret_t sys_sched_getscheduler(int tid)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
rt_thread_t thread = RT_NULL;
|
2024-03-28 23:42:56 +08:00
|
|
|
int rtn;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
thread = lwp_tid_get_thread_and_inc_ref(tid);
|
|
|
|
lwp_tid_dec_ref(thread);
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
if (thread)
|
2023-09-23 14:06:00 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
rtn = SCHED_RR;
|
2023-09-23 14:06:00 +08:00
|
|
|
}
|
2024-03-28 23:42:56 +08:00
|
|
|
else
|
2023-09-23 14:06:00 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
rtn = -ESRCH;
|
2023-09-23 14:06:00 +08:00
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
return rtn;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_fsync(int fd)
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
int res = fsync(fd);
|
|
|
|
if (res < 0)
|
|
|
|
res = rt_get_errno();
|
|
|
|
return res;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
mqd_t sys_mq_open(const char *name, int flags, mode_t mode, struct mq_attr *attr)
|
|
|
|
{
|
|
|
|
mqd_t mqdes;
|
2023-04-26 19:12:30 +08:00
|
|
|
sysret_t ret = 0;
|
2023-01-07 10:19:08 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
rt_size_t len = 0;
|
|
|
|
struct mq_attr attr_k;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(name);
|
2023-01-07 10:19:08 +08:00
|
|
|
if (!len)
|
2023-01-09 12:44:45 +08:00
|
|
|
return (mqd_t)-EINVAL;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
2023-01-09 12:44:45 +08:00
|
|
|
return (mqd_t)-ENOMEM;
|
2023-01-07 10:19:08 +08:00
|
|
|
|
2023-05-05 18:14:07 +08:00
|
|
|
if (attr == NULL)
|
|
|
|
{
|
|
|
|
attr_k.mq_maxmsg = 10;
|
|
|
|
attr_k.mq_msgsize = 8192;
|
|
|
|
attr_k.mq_flags = 0;
|
|
|
|
attr = &attr_k;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
if (!lwp_get_from_user(&attr_k, (void *)attr, sizeof(struct mq_attr)))
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
lwp_get_from_user(kname, (void *)name, len + 1);
|
|
|
|
mqdes = mq_open(kname, flags, mode, &attr_k);
|
2023-05-05 18:14:07 +08:00
|
|
|
if (mqdes == -1)
|
2023-02-07 18:53:05 +08:00
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
2023-01-07 10:19:08 +08:00
|
|
|
lwp_put_to_user(attr, &attr_k, sizeof(struct mq_attr));
|
|
|
|
kmem_put(kname);
|
|
|
|
#else
|
|
|
|
mqdes = mq_open(name, flags, mode, attr);
|
|
|
|
#endif
|
2023-05-05 18:14:07 +08:00
|
|
|
if (mqdes == -1)
|
2023-02-07 18:53:05 +08:00
|
|
|
return (mqd_t)ret;
|
2023-01-07 10:19:08 +08:00
|
|
|
else
|
|
|
|
return mqdes;
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_mq_unlink(const char *name)
|
2023-01-07 10:19:08 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
char *kname = RT_NULL;
|
|
|
|
rt_size_t len = 0;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(name);
|
2023-01-07 10:19:08 +08:00
|
|
|
if (!len)
|
|
|
|
return -EINVAL;
|
|
|
|
kname = (char *)kmem_get(len + 1);
|
|
|
|
if (!kname)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
lwp_get_from_user(kname, (void *)name, len + 1);
|
|
|
|
ret = mq_unlink(kname);
|
2023-02-09 14:43:46 +08:00
|
|
|
if (ret < 0)
|
2023-02-07 18:53:05 +08:00
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
2023-01-07 10:19:08 +08:00
|
|
|
kmem_put(kname);
|
2023-02-07 18:53:05 +08:00
|
|
|
return ret;
|
2023-01-07 10:19:08 +08:00
|
|
|
#else
|
|
|
|
ret = mq_unlink(name);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-02-07 18:53:05 +08:00
|
|
|
#endif
|
2023-01-07 10:19:08 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_mq_timedsend(mqd_t mqd, const char *msg, size_t len, unsigned prio, const struct timespec *at)
|
2023-01-07 10:19:08 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
char *kmsg = RT_NULL;
|
|
|
|
struct timespec at_k;
|
|
|
|
|
|
|
|
kmsg = (char *)kmem_get(len + 1);
|
|
|
|
if (!kmsg)
|
|
|
|
return -ENOMEM;
|
2023-01-07 15:41:52 +08:00
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
lwp_get_from_user(&at_k, (void *)at, sizeof(struct timespec));
|
|
|
|
lwp_get_from_user(kmsg, (void *)msg, len + 1);
|
|
|
|
ret = mq_timedsend(mqd, kmsg, len, prio, &at_k);
|
2023-02-07 18:53:05 +08:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
kmem_put(kmsg);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2023-01-07 10:19:08 +08:00
|
|
|
#else
|
|
|
|
ret = mq_timedsend(mqd, msg, len, prio, at);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-02-07 18:53:05 +08:00
|
|
|
#endif
|
2023-01-07 10:19:08 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_mq_timedreceive(mqd_t mqd, char *restrict msg, size_t len, unsigned *restrict prio, const struct timespec *restrict at)
|
2023-01-07 10:19:08 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
char *restrict kmsg = RT_NULL;
|
|
|
|
|
|
|
|
struct timespec at_k;
|
|
|
|
|
|
|
|
kmsg = (char *restrict)kmem_get(len + 1);
|
|
|
|
if (!kmsg)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
lwp_get_from_user(kmsg, (void *)msg, len + 1);
|
2023-05-05 18:14:07 +08:00
|
|
|
if (at == RT_NULL)
|
|
|
|
{
|
|
|
|
ret = mq_timedreceive(mqd, kmsg, len, prio, RT_NULL);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
if (!lwp_get_from_user(&at_k, (void *)at, sizeof(struct timespec)))
|
|
|
|
return -EINVAL;
|
|
|
|
ret = mq_timedreceive(mqd, kmsg, len, prio, &at_k);
|
|
|
|
}
|
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
if (ret > 0)
|
|
|
|
lwp_put_to_user(msg, kmsg, len + 1);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
kmem_put(kmsg);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2023-01-07 10:19:08 +08:00
|
|
|
#else
|
|
|
|
ret = mq_timedreceive(mqd, msg, len, prio, at);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-02-07 18:53:05 +08:00
|
|
|
#endif
|
2023-01-07 10:19:08 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_mq_notify(mqd_t mqd, const struct sigevent *sev)
|
2023-01-07 10:19:08 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
struct sigevent sev_k;
|
|
|
|
lwp_get_from_user(&sev_k, (void *)sev, sizeof(struct timespec));
|
|
|
|
ret = mq_notify(mqd, &sev_k);
|
|
|
|
#else
|
|
|
|
ret = mq_notify(mqd, sev);
|
|
|
|
#endif
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_mq_getsetattr(mqd_t mqd, const struct mq_attr *restrict new, struct mq_attr *restrict old)
|
2023-01-07 10:19:08 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
size_t size = sizeof(struct mq_attr);
|
|
|
|
struct mq_attr *restrict knew = NULL;
|
|
|
|
struct mq_attr *restrict kold = NULL;
|
|
|
|
|
|
|
|
if (new != RT_NULL)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)new, size))
|
|
|
|
return -EFAULT;
|
|
|
|
knew = kmem_get(size);
|
|
|
|
if (!knew)
|
|
|
|
return -ENOMEM;
|
|
|
|
lwp_get_from_user(knew, (void *)new, size);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)old, size))
|
|
|
|
return -EFAULT;
|
|
|
|
kold = kmem_get(size);
|
|
|
|
if (!kold)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
lwp_get_from_user(kold, (void *)old, size);
|
|
|
|
ret = mq_setattr(mqd, knew, kold);
|
|
|
|
if (ret != -1)
|
|
|
|
lwp_put_to_user(old, kold, size);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
2023-01-07 10:19:08 +08:00
|
|
|
kmem_put(kold);
|
|
|
|
if (new != RT_NULL)
|
|
|
|
kmem_put(knew);
|
2023-02-07 18:53:05 +08:00
|
|
|
|
|
|
|
return ret;
|
2023-01-07 10:19:08 +08:00
|
|
|
#else
|
|
|
|
ret = mq_setattr(mqd, new, old);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-02-07 18:53:05 +08:00
|
|
|
#endif
|
2023-01-07 10:19:08 +08:00
|
|
|
}
|
|
|
|
|
2023-03-13 19:09:34 +08:00
|
|
|
sysret_t sys_mq_close(mqd_t mqd)
|
2023-01-07 15:08:01 +08:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
ret = mq_close(mqd);
|
|
|
|
#else
|
|
|
|
ret = mq_close(mqd);
|
|
|
|
#endif
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-03-17 15:11:38 +08:00
|
|
|
#define ICACHE (1<<0)
|
|
|
|
#define DCACHE (1<<1)
|
|
|
|
#define BCACHE (ICACHE|DCACHE)
|
|
|
|
|
|
|
|
rt_weak sysret_t sys_cacheflush(void *addr, int size, int cache)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
if (!lwp_user_accessable(addr, size))
|
|
|
|
return -EFAULT;
|
|
|
|
|
2023-04-08 22:25:51 +08:00
|
|
|
if (((size_t)addr < (size_t)addr + size) &&
|
|
|
|
((size_t)addr >= USER_VADDR_START) &&
|
|
|
|
((size_t)addr + size < USER_VADDR_TOP))
|
2023-03-17 15:11:38 +08:00
|
|
|
{
|
|
|
|
if ((cache & DCACHE))
|
|
|
|
{
|
|
|
|
rt_hw_cpu_dcache_clean_and_invalidate(addr, size);
|
|
|
|
}
|
2023-04-08 22:25:51 +08:00
|
|
|
|
2023-03-17 15:11:38 +08:00
|
|
|
if ((cache & ICACHE))
|
|
|
|
{
|
|
|
|
rt_hw_cpu_icache_invalidate(addr, size);
|
|
|
|
}
|
2023-04-08 22:25:51 +08:00
|
|
|
|
2023-03-17 15:11:38 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-03-27 17:09:37 +08:00
|
|
|
sysret_t sys_uname(struct utsname *uts)
|
|
|
|
{
|
|
|
|
struct utsname utsbuff = {0};
|
|
|
|
int ret = 0;
|
2023-03-28 15:53:15 +08:00
|
|
|
const char *machine;
|
2023-03-27 17:09:37 +08:00
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)uts, sizeof(struct utsname)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
rt_strncpy(utsbuff.sysname, "RT-Thread", sizeof(utsbuff.sysname));
|
|
|
|
utsbuff.nodename[0] = '\0';
|
|
|
|
ret = rt_snprintf(utsbuff.release, sizeof(utsbuff.release), "%u.%u.%u",
|
|
|
|
RT_VERSION_MAJOR, RT_VERSION_MINOR, RT_VERSION_PATCH);
|
|
|
|
if (ret < 0) {
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
ret = rt_snprintf(utsbuff.version, sizeof(utsbuff.version), "RT-Thread %u.%u.%u %s %s",
|
|
|
|
RT_VERSION_MAJOR, RT_VERSION_MINOR, RT_VERSION_PATCH, __DATE__, __TIME__);
|
|
|
|
if (ret < 0) {
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
machine = rt_hw_cpu_arch();
|
|
|
|
rt_strncpy(utsbuff.machine, machine, sizeof(utsbuff.machine));
|
|
|
|
|
|
|
|
utsbuff.domainname[0] = '\0';
|
|
|
|
lwp_put_to_user(uts, &utsbuff, sizeof utsbuff);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-03-29 11:54:25 +08:00
|
|
|
sysret_t sys_statfs(const char *path, struct statfs *buf)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
size_t len;
|
|
|
|
size_t copy_len;
|
|
|
|
char *copy_path;
|
|
|
|
struct statfs statfsbuff = {0};
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, sizeof(struct statfs)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(path);
|
|
|
|
if (len <= 0)
|
2023-03-29 11:54:25 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_path = (char*)rt_malloc(len + 1);
|
|
|
|
if (!copy_path)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_len = lwp_get_from_user(copy_path, (void*)path, len);
|
|
|
|
if (copy_len == 0)
|
|
|
|
{
|
|
|
|
rt_free(copy_path);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
copy_path[copy_len] = '\0';
|
|
|
|
|
|
|
|
ret = _SYS_WRAP(statfs(copy_path, &statfsbuff));
|
|
|
|
rt_free(copy_path);
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(buf, &statfsbuff, sizeof statfsbuff);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_statfs64(const char *path, size_t sz, struct statfs *buf)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
size_t len;
|
|
|
|
size_t copy_len;
|
|
|
|
char *copy_path;
|
|
|
|
struct statfs statfsbuff = {0};
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, sizeof(struct statfs)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (sz != sizeof(struct statfs)) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(path);
|
|
|
|
if (len <= 0)
|
2023-03-29 11:54:25 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_path = (char*)rt_malloc(len + 1);
|
|
|
|
if (!copy_path)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_len = lwp_get_from_user(copy_path, (void*)path, len);
|
|
|
|
if (copy_len == 0)
|
|
|
|
{
|
|
|
|
rt_free(copy_path);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
copy_path[copy_len] = '\0';
|
|
|
|
|
|
|
|
ret = _SYS_WRAP(statfs(copy_path, &statfsbuff));
|
|
|
|
rt_free(copy_path);
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(buf, &statfsbuff, sizeof statfsbuff);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_fstatfs(int fd, struct statfs *buf)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
struct statfs statfsbuff = {0};
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, sizeof(struct statfs)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = _SYS_WRAP(fstatfs(fd, &statfsbuff));
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(buf, &statfsbuff, sizeof statfsbuff);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_fstatfs64(int fd, size_t sz, struct statfs *buf)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
struct statfs statfsbuff = {0};
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, sizeof(struct statfs)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (sz != sizeof(struct statfs)) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = _SYS_WRAP(fstatfs(fd, &statfsbuff));
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(buf, &statfsbuff, sizeof statfsbuff);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-05-17 16:30:05 +08:00
|
|
|
sysret_t sys_mount(char *source, char *target,
|
|
|
|
char *filesystemtype,
|
|
|
|
unsigned long mountflags, void *data)
|
|
|
|
{
|
|
|
|
char *copy_source;
|
|
|
|
char *copy_target;
|
|
|
|
char *copy_filesystemtype;
|
|
|
|
size_t len_source, copy_len_source;
|
|
|
|
size_t len_target, copy_len_target;
|
|
|
|
size_t len_filesystemtype, copy_len_filesystemtype;
|
|
|
|
char *tmp = NULL;
|
|
|
|
int ret = 0;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len_source = lwp_user_strlen(source);
|
|
|
|
if (len_source <= 0)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
len_target = lwp_user_strlen(target);
|
|
|
|
if (len_target <= 0)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
len_filesystemtype = lwp_user_strlen(filesystemtype);
|
|
|
|
if (len_filesystemtype <= 0)
|
|
|
|
return -EINVAL;
|
2023-05-17 16:30:05 +08:00
|
|
|
|
|
|
|
copy_source = (char*)rt_malloc(len_source + 1 + len_target + 1 + len_filesystemtype + 1);
|
|
|
|
if (!copy_source)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
copy_target = copy_source + len_source + 1;
|
|
|
|
copy_filesystemtype = copy_target + len_target + 1;
|
|
|
|
|
|
|
|
copy_len_source = lwp_get_from_user(copy_source, source, len_source);
|
|
|
|
copy_source[copy_len_source] = '\0';
|
|
|
|
copy_len_target = lwp_get_from_user(copy_target, target, len_target);
|
|
|
|
copy_target[copy_len_target] = '\0';
|
|
|
|
copy_len_filesystemtype = lwp_get_from_user(copy_filesystemtype, filesystemtype, len_filesystemtype);
|
|
|
|
copy_filesystemtype[copy_len_filesystemtype] = '\0';
|
|
|
|
|
|
|
|
if (strcmp(copy_filesystemtype, "nfs") == 0)
|
|
|
|
{
|
|
|
|
tmp = copy_source;
|
|
|
|
copy_source = NULL;
|
|
|
|
}
|
|
|
|
if (strcmp(copy_filesystemtype, "tmp") == 0)
|
|
|
|
{
|
|
|
|
copy_source = NULL;
|
|
|
|
}
|
|
|
|
ret = dfs_mount(copy_source, copy_target, copy_filesystemtype, 0, tmp);
|
|
|
|
rt_free(copy_source);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_umount2(char *__special_file, int __flags)
|
|
|
|
{
|
|
|
|
char *copy_special_file;
|
|
|
|
size_t len_special_file, copy_len_special_file;
|
|
|
|
int ret = 0;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len_special_file = lwp_user_strlen(__special_file);
|
|
|
|
if (len_special_file <= 0)
|
2023-05-17 16:30:05 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_special_file = (char*)rt_malloc(len_special_file + 1);
|
|
|
|
if (!copy_special_file)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_len_special_file = lwp_get_from_user(copy_special_file, __special_file, len_special_file);
|
|
|
|
copy_special_file[copy_len_special_file] = '\0';
|
|
|
|
|
|
|
|
ret = dfs_unmount(copy_special_file);
|
|
|
|
rt_free(copy_special_file);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-05-23 22:43:38 +08:00
|
|
|
sysret_t sys_link(const char *existing, const char *new)
|
|
|
|
{
|
|
|
|
int ret = -1;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
#ifdef RT_USING_DFS_V2
|
2023-05-23 22:43:38 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
2023-09-23 14:06:00 +08:00
|
|
|
int len = 0;
|
|
|
|
char *kexisting = RT_NULL;
|
|
|
|
char *knew = RT_NULL;
|
2023-05-23 22:43:38 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
len = lwp_user_strlen(existing);
|
|
|
|
if (len <= 0)
|
2023-05-23 22:43:38 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
kexisting = (char *)kmem_get(len + 1);
|
|
|
|
if (!kexisting)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(kexisting, (void *)existing, len + 1) != (len + 1))
|
2023-05-23 22:43:38 +08:00
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
kmem_put(kexisting);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
len = lwp_user_strlen(new);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
kmem_put(kexisting);
|
2023-05-23 22:43:38 +08:00
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
knew = (char *)kmem_get(len + 1);
|
|
|
|
if (!knew)
|
|
|
|
{
|
|
|
|
kmem_put(kexisting);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(knew, (void *)new, len + 1) != (len + 1))
|
|
|
|
{
|
|
|
|
kmem_put(knew);
|
|
|
|
kmem_put(kexisting);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = dfs_file_link(kexisting, knew);
|
|
|
|
|
|
|
|
kmem_put(knew);
|
|
|
|
kmem_put(kexisting);
|
|
|
|
#else
|
2023-05-23 22:43:38 +08:00
|
|
|
ret = dfs_file_link(existing, new);
|
2023-09-23 14:06:00 +08:00
|
|
|
#endif
|
2023-05-23 22:43:38 +08:00
|
|
|
#else
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
#endif
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2023-05-23 22:43:38 +08:00
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_symlink(const char *existing, const char *new)
|
|
|
|
{
|
|
|
|
int ret = -1;
|
|
|
|
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
int err;
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
err = lwp_user_strlen(existing);
|
|
|
|
if (err <= 0)
|
2023-05-23 22:43:38 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
err = lwp_user_strlen(new);
|
|
|
|
if (err <= 0)
|
2023-05-23 22:43:38 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#ifdef RT_USING_DFS_V2
|
|
|
|
ret = dfs_file_symlink(existing, new);
|
|
|
|
#else
|
|
|
|
SET_ERRNO(EFAULT);
|
|
|
|
#endif
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-07-27 17:24:56 +08:00
|
|
|
sysret_t sys_eventfd2(unsigned int count, int flags)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = eventfd(count, flags);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
2023-08-01 17:15:41 +08:00
|
|
|
sysret_t sys_epoll_create1(int flags)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = epoll_create(flags);
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_epoll_ctl(int fd, int op, int fd2, struct epoll_event *ev)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
struct epoll_event *kev = RT_NULL;
|
2023-08-01 17:15:41 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
if (ev)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)ev, sizeof(struct epoll_event)))
|
2023-08-01 17:15:41 +08:00
|
|
|
return -EFAULT;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
kev = kmem_get(sizeof(struct epoll_event));
|
|
|
|
if (kev == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
if (lwp_get_from_user(kev, ev, sizeof(struct epoll_event)) != sizeof(struct epoll_event))
|
|
|
|
{
|
|
|
|
kmem_put(kev);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2023-08-01 17:15:41 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
ret = epoll_ctl(fd, op, fd2, kev);
|
2023-09-23 14:06:00 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
kmem_put(kev);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
ret = epoll_ctl(fd, op, fd2, RT_NULL);
|
|
|
|
}
|
2023-08-01 17:15:41 +08:00
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_epoll_pwait(int fd,
|
|
|
|
struct epoll_event *ev,
|
|
|
|
int cnt,
|
|
|
|
int to,
|
|
|
|
const sigset_t *sigs,
|
|
|
|
unsigned long sigsetsize)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
int ret = 0;
|
|
|
|
struct epoll_event *kev = RT_NULL;
|
|
|
|
sigset_t *ksigs = RT_NULL;
|
2023-08-01 17:15:41 +08:00
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
if (!lwp_user_accessable((void *)ev, cnt * sizeof(struct epoll_event)))
|
2023-08-01 17:15:41 +08:00
|
|
|
return -EFAULT;
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
kev = kmem_get(cnt * sizeof(struct epoll_event));
|
|
|
|
if (kev == RT_NULL)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
2023-08-01 17:15:41 +08:00
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
if (sigs != RT_NULL)
|
2023-08-01 17:15:41 +08:00
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)sigs, sizeof(sigset_t)))
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
kmem_put(kev);
|
2023-08-01 17:15:41 +08:00
|
|
|
return -EFAULT;
|
|
|
|
}
|
2023-09-23 14:06:00 +08:00
|
|
|
|
|
|
|
ksigs = kmem_get(sizeof(sigset_t));
|
|
|
|
if (ksigs == RT_NULL)
|
|
|
|
{
|
|
|
|
kmem_put(kev);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (lwp_get_from_user(ksigs, (void *)sigs, sizeof(sigset_t)) != sizeof(sigset_t))
|
|
|
|
{
|
|
|
|
kmem_put(kev);
|
|
|
|
kmem_put(ksigs);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = epoll_pwait(fd, kev, cnt, to, ksigs);
|
|
|
|
|
|
|
|
if (ret > 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user((void *)ev, kev, ret * sizeof(struct epoll_event));
|
2023-08-01 17:15:41 +08:00
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
if (sigs != RT_NULL)
|
|
|
|
kmem_put(ksigs);
|
|
|
|
|
|
|
|
kmem_put(kev);
|
2023-08-01 17:15:41 +08:00
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
2023-07-27 17:24:56 +08:00
|
|
|
|
2023-10-14 13:09:17 +08:00
|
|
|
sysret_t sys_ftruncate(int fd, size_t length)
|
2023-09-11 14:06:08 +08:00
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = ftruncate(fd, length);
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2023-10-13 19:21:49 +08:00
|
|
|
sysret_t sys_utimensat(int __fd, const char *__path, const struct timespec __times[2], int __flags)
|
|
|
|
{
|
|
|
|
#ifdef RT_USING_DFS_V2
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
int ret = -1;
|
|
|
|
rt_size_t len = 0;
|
|
|
|
char *kpath = RT_NULL;
|
|
|
|
|
|
|
|
len = lwp_user_strlen(__path);
|
|
|
|
if (len <= 0)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kpath = (char *)kmem_get(len + 1);
|
|
|
|
if (!kpath)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_get_from_user(kpath, (void *)__path, len + 1);
|
|
|
|
ret = utimensat(__fd, kpath, __times, __flags);
|
|
|
|
|
|
|
|
kmem_put(kpath);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)__path, 1))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
int ret = utimensat(__fd, __path, __times, __flags);
|
|
|
|
return ret;
|
|
|
|
#endif
|
|
|
|
#else
|
|
|
|
return -1;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
sysret_t sys_chmod(const char *pathname, mode_t mode)
|
2023-08-08 00:22:14 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
char *copy_file;
|
|
|
|
size_t len_file, copy_len_file;
|
|
|
|
struct dfs_attr attr = {0};
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
len_file = lwp_user_strlen(pathname);
|
|
|
|
if (len_file <= 0)
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_file = (char*)rt_malloc(len_file + 1);
|
|
|
|
if (!copy_file)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_len_file = lwp_get_from_user(copy_file, (void *)pathname, len_file);
|
|
|
|
|
2023-08-08 00:22:14 +08:00
|
|
|
attr.st_mode = mode;
|
2024-03-28 23:42:56 +08:00
|
|
|
attr.ia_valid |= ATTR_MODE_SET;
|
|
|
|
|
|
|
|
copy_file[copy_len_file] = '\0';
|
|
|
|
ret = dfs_file_setattr(copy_file, &attr);
|
|
|
|
rt_free(copy_file);
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_chown(const char *pathname, uid_t owner, gid_t group)
|
|
|
|
{
|
|
|
|
char *copy_file;
|
|
|
|
size_t len_file, copy_len_file;
|
|
|
|
struct dfs_attr attr = {0};
|
2023-08-08 00:22:14 +08:00
|
|
|
int ret = 0;
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
len_file = lwp_user_strlen(pathname);
|
|
|
|
if (len_file <= 0)
|
2023-08-08 00:22:14 +08:00
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
copy_file = (char*)rt_malloc(len_file + 1);
|
|
|
|
if (!copy_file)
|
2023-08-08 00:22:14 +08:00
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
copy_len_file = lwp_get_from_user(copy_file, (void *)pathname, len_file);
|
|
|
|
|
|
|
|
if(owner >= 0)
|
|
|
|
{
|
|
|
|
attr.st_uid = owner;
|
|
|
|
attr.ia_valid |= ATTR_UID_SET;
|
|
|
|
}
|
|
|
|
|
|
|
|
if(group >= 0)
|
|
|
|
{
|
|
|
|
attr.st_gid = group;
|
|
|
|
attr.ia_valid |= ATTR_GID_SET;
|
|
|
|
}
|
|
|
|
|
|
|
|
copy_file[copy_len_file] = '\0';
|
|
|
|
ret = dfs_file_setattr(copy_file, &attr);
|
|
|
|
rt_free(copy_file);
|
2023-08-08 00:22:14 +08:00
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
#include <sys/reboot.h>
|
|
|
|
sysret_t sys_reboot(int magic, int magic2, int type)
|
2023-08-08 00:22:14 +08:00
|
|
|
{
|
2024-03-28 23:42:56 +08:00
|
|
|
sysret_t rc;
|
|
|
|
switch (type)
|
|
|
|
{
|
|
|
|
/* TODO add software poweroff protocols */
|
|
|
|
case RB_AUTOBOOT:
|
|
|
|
case RB_POWER_OFF:
|
|
|
|
rt_hw_cpu_reset();
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
rc = -ENOSYS;
|
|
|
|
}
|
2023-08-08 00:22:14 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
return rc;
|
2023-08-08 00:22:14 +08:00
|
|
|
}
|
|
|
|
|
2023-10-14 13:09:17 +08:00
|
|
|
ssize_t sys_pread64(int fd, void *buf, int size, size_t offset)
|
2023-08-08 00:22:14 +08:00
|
|
|
#ifdef RT_USING_DFS_V2
|
|
|
|
{
|
2023-10-14 13:09:17 +08:00
|
|
|
ssize_t pread(int fd, void *buf, size_t len, size_t offset);
|
2023-08-08 00:22:14 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
ssize_t ret = -1;
|
|
|
|
void *kmem = RT_NULL;
|
|
|
|
|
|
|
|
if (!size)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
kmem = kmem_get(size);
|
|
|
|
if (!kmem)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = pread(fd, kmem, size, offset);
|
|
|
|
if (ret > 0)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(buf, kmem, ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem_put(kmem);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)buf, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ssize_t ret = pread(fd, kmem, size, offset);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
{
|
|
|
|
ssize_t ret = -ENOSYS;
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2023-10-14 13:09:17 +08:00
|
|
|
ssize_t sys_pwrite64(int fd, void *buf, int size, size_t offset)
|
2023-08-08 00:22:14 +08:00
|
|
|
#ifdef RT_USING_DFS_V2
|
|
|
|
{
|
2023-10-14 13:09:17 +08:00
|
|
|
ssize_t pwrite(int fd, const void *buf, size_t len, size_t offset);
|
2023-08-08 00:22:14 +08:00
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
ssize_t ret = -1;
|
|
|
|
void *kmem = RT_NULL;
|
|
|
|
|
|
|
|
if (!size)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)buf, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
kmem = kmem_get(size);
|
|
|
|
if (!kmem)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
lwp_get_from_user(kmem, (void *)buf, size);
|
|
|
|
|
|
|
|
ret = pwrite(fd, kmem, size, offset);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
ret = GET_ERRNO();
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem_put(kmem);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
#else
|
|
|
|
if (!lwp_user_accessable((void *)buf, size))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ssize_t ret = pwrite(fd, kmem, size, offset);
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
{
|
|
|
|
ssize_t ret = -ENOSYS;
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2023-09-11 14:06:08 +08:00
|
|
|
sysret_t sys_timerfd_create(int clockid, int flags)
|
|
|
|
{
|
2023-09-23 14:18:29 +08:00
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = timerfd_create(clockid, flags);
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-09-11 14:06:08 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_timerfd_settime(int fd, int flags, const struct itimerspec *new, struct itimerspec *old)
|
|
|
|
{
|
2023-09-23 14:18:29 +08:00
|
|
|
int ret = -1;
|
|
|
|
struct itimerspec *knew = RT_NULL;
|
|
|
|
struct itimerspec *kold = RT_NULL;
|
|
|
|
|
|
|
|
if (new == RT_NULL)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)new, sizeof(struct itimerspec)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
knew = kmem_get(sizeof(struct itimerspec));
|
|
|
|
|
|
|
|
if (knew)
|
|
|
|
{
|
|
|
|
lwp_get_from_user(knew, (void*)new, sizeof(struct itimerspec));
|
|
|
|
|
|
|
|
if (old)
|
|
|
|
{
|
|
|
|
if (!lwp_user_accessable((void *)old, sizeof(struct itimerspec)))
|
|
|
|
{
|
|
|
|
kmem_put(knew);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kold = kmem_get(sizeof(struct itimerspec));
|
|
|
|
if (kold == RT_NULL)
|
|
|
|
{
|
|
|
|
kmem_put(knew);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = timerfd_settime(fd, flags, knew, kold);
|
|
|
|
|
|
|
|
if (old)
|
|
|
|
{
|
|
|
|
lwp_put_to_user(old, kold, sizeof(*kold));
|
|
|
|
kmem_put(kold);
|
|
|
|
}
|
|
|
|
|
|
|
|
kmem_put(knew);
|
|
|
|
}
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-09-11 14:06:08 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_timerfd_gettime(int fd, struct itimerspec *cur)
|
|
|
|
{
|
2023-09-23 14:18:29 +08:00
|
|
|
int ret = -1;
|
|
|
|
struct itimerspec *kcur;
|
|
|
|
|
|
|
|
if (cur == RT_NULL)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)cur, sizeof(struct itimerspec)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
kcur = kmem_get(sizeof(struct itimerspec));
|
|
|
|
|
|
|
|
if (kcur)
|
|
|
|
{
|
|
|
|
lwp_get_from_user(kcur, cur, sizeof(struct itimerspec));
|
|
|
|
ret = timerfd_gettime(fd, kcur);
|
|
|
|
lwp_put_to_user(cur, kcur, sizeof(struct itimerspec));
|
|
|
|
kmem_put(kcur);
|
|
|
|
}
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
2023-09-11 14:06:08 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_signalfd(int fd, const sigset_t *mask, int flags)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
sigset_t *kmask = RT_NULL;
|
|
|
|
|
|
|
|
#ifdef RT_USING_MUSLLIBC
|
|
|
|
if (mask == RT_NULL)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)mask, sizeof(struct itimerspec)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-09-23 14:06:00 +08:00
|
|
|
kmask = kmem_get(sizeof(struct itimerspec));
|
2023-09-11 14:06:08 +08:00
|
|
|
|
|
|
|
if (kmask)
|
|
|
|
{
|
2023-09-23 14:06:00 +08:00
|
|
|
if (lwp_get_from_user(kmask, (void *)mask, sizeof(struct itimerspec)) != sizeof(struct itimerspec))
|
|
|
|
{
|
|
|
|
kmem_put(kmask);
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
2023-09-11 14:06:08 +08:00
|
|
|
ret = signalfd(fd, mask, flags);
|
|
|
|
kmem_put(kmask);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
return (ret < 0 ? GET_ERRNO() : ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_memfd_create()
|
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
2024-02-23 17:49:15 +08:00
|
|
|
|
2023-10-08 13:30:04 +08:00
|
|
|
sysret_t sys_setitimer(int which, const struct itimerspec *restrict new, struct itimerspec *restrict old)
|
|
|
|
{
|
2024-02-23 17:49:15 +08:00
|
|
|
sysret_t rc = 0;
|
|
|
|
rt_lwp_t lwp = lwp_self();
|
|
|
|
struct itimerspec new_value_k;
|
|
|
|
struct itimerspec old_value_k;
|
2023-10-08 13:30:04 +08:00
|
|
|
|
2024-02-23 17:49:15 +08:00
|
|
|
if (lwp_get_from_user(&new_value_k, (void *)new, sizeof(*new)) != sizeof(*new))
|
2023-10-08 13:30:04 +08:00
|
|
|
{
|
2024-02-23 17:49:15 +08:00
|
|
|
return -EFAULT;
|
2023-10-08 13:30:04 +08:00
|
|
|
}
|
2024-02-23 17:49:15 +08:00
|
|
|
|
|
|
|
rc = lwp_signal_setitimer(lwp, which, &new_value_k, &old_value_k);
|
|
|
|
if (old && lwp_put_to_user(old, (void *)&old_value_k, sizeof old_value_k) != sizeof old_value_k)
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
return rc;
|
2023-10-08 13:30:04 +08:00
|
|
|
}
|
2023-09-11 14:06:08 +08:00
|
|
|
|
2024-03-28 23:42:56 +08:00
|
|
|
sysret_t sys_set_robust_list(struct robust_list_head *head, size_t len)
|
|
|
|
{
|
|
|
|
if (len != sizeof(*head))
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
rt_thread_self()->robust_list = head;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
sysret_t sys_get_robust_list(int tid, struct robust_list_head **head_ptr, size_t *len_ptr)
|
|
|
|
{
|
|
|
|
rt_thread_t thread;
|
|
|
|
size_t len;
|
|
|
|
struct robust_list_head *head;
|
|
|
|
|
|
|
|
if (!lwp_user_accessable((void *)head_ptr, sizeof(struct robust_list_head *)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
if (!lwp_user_accessable((void *)len_ptr, sizeof(size_t)))
|
|
|
|
{
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (tid == 0)
|
|
|
|
{
|
|
|
|
thread = rt_thread_self();
|
|
|
|
head = thread->robust_list;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
thread = lwp_tid_get_thread_and_inc_ref(tid);
|
|
|
|
if (thread)
|
|
|
|
{
|
|
|
|
head = thread->robust_list;
|
|
|
|
lwp_tid_dec_ref(thread);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
return -ESRCH;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
len = sizeof(*(head));
|
|
|
|
|
|
|
|
if (!lwp_put_to_user(len_ptr, &len, sizeof(size_t)))
|
|
|
|
return -EFAULT;
|
|
|
|
if (!lwp_put_to_user(head_ptr, &head, sizeof(struct robust_list_head *)))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-08-08 00:22:14 +08:00
|
|
|
const static struct rt_syscall_def func_table[] =
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_SIGN(sys_exit), /* 01 */
|
|
|
|
SYSCALL_SIGN(sys_read),
|
|
|
|
SYSCALL_SIGN(sys_write),
|
|
|
|
SYSCALL_SIGN(sys_lseek),
|
|
|
|
SYSCALL_SIGN(sys_open), /* 05 */
|
|
|
|
SYSCALL_SIGN(sys_close),
|
|
|
|
SYSCALL_SIGN(sys_ioctl),
|
|
|
|
SYSCALL_SIGN(sys_fstat),
|
|
|
|
SYSCALL_SIGN(sys_poll),
|
|
|
|
SYSCALL_SIGN(sys_nanosleep), /* 10 */
|
|
|
|
SYSCALL_SIGN(sys_gettimeofday),
|
|
|
|
SYSCALL_SIGN(sys_settimeofday),
|
|
|
|
SYSCALL_SIGN(sys_exec),
|
|
|
|
SYSCALL_SIGN(sys_kill),
|
|
|
|
SYSCALL_SIGN(sys_getpid), /* 15 */
|
|
|
|
SYSCALL_SIGN(sys_getpriority),
|
|
|
|
SYSCALL_SIGN(sys_setpriority),
|
|
|
|
SYSCALL_SIGN(sys_sem_create),
|
|
|
|
SYSCALL_SIGN(sys_sem_delete),
|
|
|
|
SYSCALL_SIGN(sys_sem_take), /* 20 */
|
|
|
|
SYSCALL_SIGN(sys_sem_release),
|
|
|
|
SYSCALL_SIGN(sys_mutex_create),
|
|
|
|
SYSCALL_SIGN(sys_mutex_delete),
|
|
|
|
SYSCALL_SIGN(sys_mutex_take),
|
|
|
|
SYSCALL_SIGN(sys_mutex_release), /* 25 */
|
|
|
|
SYSCALL_SIGN(sys_event_create),
|
|
|
|
SYSCALL_SIGN(sys_event_delete),
|
|
|
|
SYSCALL_SIGN(sys_event_send),
|
|
|
|
SYSCALL_SIGN(sys_event_recv),
|
|
|
|
SYSCALL_SIGN(sys_mb_create), /* 30 */
|
|
|
|
SYSCALL_SIGN(sys_mb_delete),
|
|
|
|
SYSCALL_SIGN(sys_mb_send),
|
|
|
|
SYSCALL_SIGN(sys_mb_send_wait),
|
|
|
|
SYSCALL_SIGN(sys_mb_recv),
|
|
|
|
SYSCALL_SIGN(sys_mq_create), /* 35 */
|
|
|
|
SYSCALL_SIGN(sys_mq_delete),
|
|
|
|
SYSCALL_SIGN(sys_mq_send),
|
|
|
|
SYSCALL_SIGN(sys_mq_urgent),
|
|
|
|
SYSCALL_SIGN(sys_mq_recv),
|
|
|
|
SYSCALL_SIGN(sys_thread_create), /* 40 */
|
|
|
|
SYSCALL_SIGN(sys_thread_delete),
|
|
|
|
SYSCALL_SIGN(sys_thread_startup),
|
|
|
|
SYSCALL_SIGN(sys_thread_self),
|
|
|
|
SYSCALL_SIGN(sys_channel_open),
|
|
|
|
SYSCALL_SIGN(sys_channel_close), /* 45 */
|
|
|
|
SYSCALL_SIGN(sys_channel_send),
|
|
|
|
SYSCALL_SIGN(sys_channel_send_recv_timeout),
|
|
|
|
SYSCALL_SIGN(sys_channel_reply),
|
|
|
|
SYSCALL_SIGN(sys_channel_recv_timeout),
|
|
|
|
SYSCALL_SIGN(sys_enter_critical), /* 50 */
|
|
|
|
SYSCALL_SIGN(sys_exit_critical),
|
|
|
|
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_brk)),
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_mmap2)),
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_munmap)),
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_shmget)), /* 55 */
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_shmrm)),
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_shmat)),
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_shmdt)),
|
|
|
|
#else
|
|
|
|
#ifdef RT_LWP_USING_SHM
|
|
|
|
SYSCALL_SIGN(sys_shm_alloc), /* 55 */
|
|
|
|
SYSCALL_SIGN(sys_shm_free),
|
|
|
|
SYSCALL_SIGN(sys_shm_retain),
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
#else
|
|
|
|
SYSCALL_SIGN(sys_notimpl), /* 55 */
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
#endif /* RT_LWP_USING_SHM */
|
|
|
|
#endif /* ARCH_MM_MMU */
|
|
|
|
SYSCALL_SIGN(sys_device_init),
|
|
|
|
SYSCALL_SIGN(sys_device_register), /* 60 */
|
|
|
|
SYSCALL_SIGN(sys_device_control),
|
|
|
|
SYSCALL_SIGN(sys_device_find),
|
|
|
|
SYSCALL_SIGN(sys_device_open),
|
|
|
|
SYSCALL_SIGN(sys_device_close),
|
|
|
|
SYSCALL_SIGN(sys_device_read), /* 65 */
|
|
|
|
SYSCALL_SIGN(sys_device_write),
|
|
|
|
|
|
|
|
SYSCALL_SIGN(sys_stat),
|
|
|
|
SYSCALL_SIGN(sys_thread_find),
|
|
|
|
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_accept)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_bind)), /* 70 */
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_shutdown)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_getpeername)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_getsockname)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_getsockopt)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_setsockopt)), /* 75 */
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_connect)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_listen)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_recv)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_recvfrom)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_send)), /* 80 */
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_sendto)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_socket)),
|
|
|
|
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_closesocket)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_getaddrinfo)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_gethostbyname2_r)), /* 85 */
|
|
|
|
|
2023-11-28 13:56:06 +08:00
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_sendmsg)),
|
|
|
|
SYSCALL_NET(SYSCALL_SIGN(sys_recvmsg)),
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_SIGN(sys_notimpl), //network,
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //network,
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //network, /* 90 */
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //network,
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //network,
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //network,
|
|
|
|
|
|
|
|
#ifdef RT_USING_DFS
|
|
|
|
SYSCALL_SIGN(sys_select),
|
|
|
|
#else
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
#endif
|
|
|
|
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //SYSCALL_SIGN(sys_hw_interrupt_disable), /* 95 */
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //SYSCALL_SIGN(sys_hw_interrupt_enable),
|
|
|
|
|
|
|
|
SYSCALL_SIGN(sys_tick_get),
|
|
|
|
SYSCALL_SIGN(sys_exit_group),
|
|
|
|
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //rt_delayed_work_init,
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //rt_work_submit, /* 100 */
|
|
|
|
SYSCALL_SIGN(sys_notimpl), //rt_wqueue_wakeup,
|
|
|
|
SYSCALL_SIGN(sys_thread_mdelay),
|
|
|
|
SYSCALL_SIGN(sys_sigaction),
|
|
|
|
SYSCALL_SIGN(sys_sigprocmask),
|
|
|
|
SYSCALL_SIGN(sys_tkill), /* 105 */
|
|
|
|
SYSCALL_SIGN(sys_thread_sigprocmask),
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
SYSCALL_SIGN(sys_cacheflush),
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
#else
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
SYSCALL_SIGN(sys_lwp_sighandler_set),
|
|
|
|
SYSCALL_SIGN(sys_thread_sighandler_set),
|
|
|
|
#endif
|
|
|
|
SYSCALL_SIGN(sys_waitpid), /* 110 */
|
|
|
|
|
|
|
|
SYSCALL_SIGN(sys_rt_timer_create),
|
|
|
|
SYSCALL_SIGN(sys_rt_timer_delete),
|
|
|
|
SYSCALL_SIGN(sys_rt_timer_start),
|
|
|
|
SYSCALL_SIGN(sys_rt_timer_stop),
|
|
|
|
SYSCALL_SIGN(sys_rt_timer_control), /* 115 */
|
|
|
|
SYSCALL_SIGN(sys_getcwd),
|
|
|
|
SYSCALL_SIGN(sys_chdir),
|
|
|
|
SYSCALL_SIGN(sys_unlink),
|
|
|
|
SYSCALL_SIGN(sys_mkdir),
|
|
|
|
SYSCALL_SIGN(sys_rmdir), /* 120 */
|
|
|
|
SYSCALL_SIGN(sys_getdents),
|
|
|
|
SYSCALL_SIGN(sys_get_errno),
|
|
|
|
#ifdef ARCH_MM_MMU
|
|
|
|
SYSCALL_SIGN(sys_set_thread_area),
|
|
|
|
SYSCALL_SIGN(sys_set_tid_address),
|
|
|
|
#else
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
#endif
|
|
|
|
SYSCALL_SIGN(sys_access), /* 125 */
|
|
|
|
SYSCALL_SIGN(sys_pipe),
|
|
|
|
SYSCALL_SIGN(sys_clock_settime),
|
|
|
|
SYSCALL_SIGN(sys_clock_gettime),
|
|
|
|
SYSCALL_SIGN(sys_clock_getres),
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_clone)), /* 130 */
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_futex)),
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_SIGN(sys_notimpl), /* discarded: sys_pmutex */
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_SIGN(sys_dup),
|
|
|
|
SYSCALL_SIGN(sys_dup2),
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_SIGN(sys_rename), /* 135 */
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_fork)),
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_execve)),
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_vfork)),
|
|
|
|
SYSCALL_SIGN(sys_gettid),
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_SIGN(sys_prlimit64), /* 140 */
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_SIGN(sys_getrlimit),
|
|
|
|
SYSCALL_SIGN(sys_setrlimit),
|
|
|
|
SYSCALL_SIGN(sys_setsid),
|
|
|
|
SYSCALL_SIGN(sys_getrandom),
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_SIGN(sys_readlink), /* 145 */
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_mremap)),
|
|
|
|
SYSCALL_USPACE(SYSCALL_SIGN(sys_madvise)),
|
|
|
|
SYSCALL_SIGN(sys_sched_setparam),
|
|
|
|
SYSCALL_SIGN(sys_sched_getparam),
|
2023-01-09 10:08:55 +08:00
|
|
|
SYSCALL_SIGN(sys_sched_get_priority_max), /* 150 */
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_SIGN(sys_sched_get_priority_min),
|
|
|
|
SYSCALL_SIGN(sys_sched_setscheduler),
|
|
|
|
SYSCALL_SIGN(sys_sched_getscheduler),
|
2023-11-02 23:12:44 +08:00
|
|
|
SYSCALL_SIGN(sys_sched_setaffinity),
|
2023-01-09 10:08:55 +08:00
|
|
|
SYSCALL_SIGN(sys_fsync), /* 155 */
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_SIGN(sys_clock_nanosleep),
|
|
|
|
SYSCALL_SIGN(sys_timer_create),
|
|
|
|
SYSCALL_SIGN(sys_timer_delete),
|
|
|
|
SYSCALL_SIGN(sys_timer_settime),
|
2023-01-09 10:08:55 +08:00
|
|
|
SYSCALL_SIGN(sys_timer_gettime), /* 160 */
|
2022-12-03 12:07:44 +08:00
|
|
|
SYSCALL_SIGN(sys_timer_getoverrun),
|
2023-01-07 10:19:08 +08:00
|
|
|
SYSCALL_SIGN(sys_mq_open),
|
|
|
|
SYSCALL_SIGN(sys_mq_unlink),
|
|
|
|
SYSCALL_SIGN(sys_mq_timedsend),
|
2023-03-27 14:50:53 +08:00
|
|
|
SYSCALL_SIGN(sys_mq_timedreceive), /* 165 */
|
2023-01-07 10:19:08 +08:00
|
|
|
SYSCALL_SIGN(sys_mq_notify),
|
|
|
|
SYSCALL_SIGN(sys_mq_getsetattr),
|
2023-01-07 15:08:01 +08:00
|
|
|
SYSCALL_SIGN(sys_mq_close),
|
2023-05-23 22:43:38 +08:00
|
|
|
SYSCALL_SIGN(sys_lstat),
|
2023-03-27 17:09:37 +08:00
|
|
|
SYSCALL_SIGN(sys_uname), /* 170 */
|
2023-03-29 11:54:25 +08:00
|
|
|
SYSCALL_SIGN(sys_statfs),
|
|
|
|
SYSCALL_SIGN(sys_statfs64),
|
|
|
|
SYSCALL_SIGN(sys_fstatfs),
|
|
|
|
SYSCALL_SIGN(sys_fstatfs64),
|
2023-05-15 20:40:27 +08:00
|
|
|
SYSCALL_SIGN(sys_openat), /* 175 */
|
2023-05-17 16:30:05 +08:00
|
|
|
SYSCALL_SIGN(sys_mount),
|
|
|
|
SYSCALL_SIGN(sys_umount2),
|
2023-05-23 22:43:38 +08:00
|
|
|
SYSCALL_SIGN(sys_link),
|
|
|
|
SYSCALL_SIGN(sys_symlink),
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_SIGN(sys_sched_getaffinity), /* 180 */
|
2023-05-23 22:43:38 +08:00
|
|
|
SYSCALL_SIGN(sys_sysinfo),
|
2023-08-08 00:22:14 +08:00
|
|
|
SYSCALL_SIGN(sys_chmod),
|
|
|
|
SYSCALL_SIGN(sys_reboot),
|
|
|
|
SYSCALL_SIGN(sys_sched_yield),
|
|
|
|
SYSCALL_SIGN(sys_pread64), /* 185 */
|
|
|
|
SYSCALL_SIGN(sys_pwrite64),
|
2023-07-20 00:02:41 +08:00
|
|
|
SYSCALL_SIGN(sys_sigpending),
|
|
|
|
SYSCALL_SIGN(sys_sigtimedwait),
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
|
|
|
SYSCALL_SIGN(sys_notimpl), /* 190 */
|
2023-07-27 17:24:56 +08:00
|
|
|
SYSCALL_SIGN(sys_eventfd2),
|
2023-08-01 17:15:41 +08:00
|
|
|
SYSCALL_SIGN(sys_epoll_create1),
|
|
|
|
SYSCALL_SIGN(sys_epoll_ctl),
|
|
|
|
SYSCALL_SIGN(sys_epoll_pwait),
|
2023-09-11 14:06:08 +08:00
|
|
|
SYSCALL_SIGN(sys_notimpl), /* 195 */
|
|
|
|
SYSCALL_SIGN(sys_timerfd_create),
|
|
|
|
SYSCALL_SIGN(sys_timerfd_settime),
|
|
|
|
SYSCALL_SIGN(sys_timerfd_gettime),
|
|
|
|
SYSCALL_SIGN(sys_signalfd),
|
|
|
|
SYSCALL_SIGN(sys_memfd_create), /* 200 */
|
|
|
|
SYSCALL_SIGN(sys_ftruncate),
|
2023-10-08 13:30:04 +08:00
|
|
|
SYSCALL_SIGN(sys_setitimer),
|
2023-10-13 19:21:49 +08:00
|
|
|
SYSCALL_SIGN(sys_utimensat),
|
2023-11-29 14:08:47 +08:00
|
|
|
#ifdef RT_USING_POSIX_SOCKET
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_SIGN(sys_syslog),
|
|
|
|
SYSCALL_SIGN(sys_socketpair), /* 205 */
|
2023-11-29 14:08:47 +08:00
|
|
|
#else
|
|
|
|
SYSCALL_SIGN(sys_notimpl),
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_SIGN(sys_notimpl), /* 205 */
|
2023-11-29 14:08:47 +08:00
|
|
|
#endif
|
2024-03-28 23:42:56 +08:00
|
|
|
SYSCALL_SIGN(sys_wait4),
|
|
|
|
SYSCALL_SIGN(sys_set_robust_list),
|
|
|
|
SYSCALL_SIGN(sys_get_robust_list),
|
|
|
|
SYSCALL_SIGN(sys_setpgid),
|
|
|
|
SYSCALL_SIGN(sys_getpgid), /* 210 */
|
|
|
|
SYSCALL_SIGN(sys_getsid),
|
|
|
|
SYSCALL_SIGN(sys_getppid),
|
|
|
|
SYSCALL_SIGN(sys_fchdir),
|
|
|
|
SYSCALL_SIGN(sys_chown),
|
2018-12-10 16:31:33 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
const void *lwp_get_sys_api(rt_uint32_t number)
|
|
|
|
{
|
2022-12-03 12:07:44 +08:00
|
|
|
const void *func = (const void *)sys_notimpl;
|
2018-12-10 16:31:33 +08:00
|
|
|
|
|
|
|
if (number == 0xff)
|
|
|
|
{
|
|
|
|
func = (void *)sys_log;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
number -= 1;
|
2023-03-13 19:09:34 +08:00
|
|
|
if (number < sizeof(func_table) / sizeof(func_table[0]))
|
2018-12-10 16:31:33 +08:00
|
|
|
{
|
2023-03-13 19:09:34 +08:00
|
|
|
func = func_table[number].func;
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
else
|
|
|
|
{
|
2023-08-08 00:22:14 +08:00
|
|
|
if (__sys_log_enable)
|
|
|
|
{
|
|
|
|
LOG_I("Unimplement syscall %d", number);
|
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
}
|
2018-12-10 16:31:33 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return func;
|
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
|
|
|
|
const char *lwp_get_syscall_name(rt_uint32_t number)
|
|
|
|
{
|
|
|
|
const char *name = "sys_notimpl";
|
|
|
|
|
|
|
|
if (number == 0xff)
|
|
|
|
{
|
|
|
|
name = "sys_log";
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
number -= 1;
|
2023-03-13 19:09:34 +08:00
|
|
|
if (number < sizeof(func_table) / sizeof(func_table[0]))
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
2023-03-13 19:09:34 +08:00
|
|
|
name = (char*)func_table[number].name;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
else
|
|
|
|
{
|
2023-08-08 00:22:14 +08:00
|
|
|
if (__sys_log_enable)
|
|
|
|
{
|
|
|
|
LOG_I("Unimplement syscall %d", number);
|
|
|
|
}
|
2023-07-20 00:02:41 +08:00
|
|
|
}
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
// skip sys_
|
2023-03-13 19:09:34 +08:00
|
|
|
return name;
|
2022-12-03 12:07:44 +08:00
|
|
|
}
|