KirkOS/user/include/mlibc/sysdeps/kirkos/sysdeps.cpp

#include <abi-bits/fcntl.h>
#include <asm/ioctls.h>
#include <bits/ensure.h>
#include <dirent.h>
#include <errno.h>
#include <fcntl.h>
#include <frg/hash.hpp>
#include <frg/hash_map.hpp>
#include <limits.h>
#include <mlibc/all-sysdeps.hpp>
#include <mlibc/allocator.hpp>
#include <mlibc/debug.hpp>
#include <bits/syscall.h>
#include <stdlib.h>

#include "syscall.h"
#define STUB()                                                                                     \
    ({                                                                                             \
        __ensure(!"STUB function was called");                                                     \
        __builtin_unreachable();                                                                   \
    })

extern "C" void __mlibc_sigreturn_trampoline(void);
__asm__ (
    ".global __mlibc_sigreturn_trampoline\n"
    "__mlibc_sigreturn_trampoline:\n"
    "    mov $15, %rax\n"     /* SYS_sigreturn */
    "    syscall\n"
    "    ud2\n"               /* should never reach here */
);

namespace mlibc {


int fcntl_helper(int fd, int request, int *result, ...) {
	va_list args;
	va_start(args, result);
	if (!mlibc::sys_fcntl) {
		return ENOSYS;
	}
	int ret = mlibc::sys_fcntl(fd, request, args, result);
	va_end(args);
	return ret;
}

void sys_libc_log(const char *message) {
	syscall(SYS_puts, message);
	syscall(SYS_puts, "\n");
}

void sys_exit(int status) {
	syscall(SYS_exit, status);
	__builtin_unreachable();
}

void sys_libc_panic() {
	sys_libc_log("\nmlibc: panic!\n");
	sys_exit(1);
	__builtin_unreachable();
}

int sys_tcb_set(void *pointer) {
	// ARCH_SET_FS
	syscall(SYS_prctl, 0x1002, pointer);
	return 0;
}

int sys_futex_wait(int *pointer, int expected, const struct timespec *time) {
	(void)time;
	return -(syscall(SYS_futex, pointer, 0, expected));
}

int sys_futex_wake(int *pointer) { return -(syscall(SYS_futex, pointer, 1, 0)); }

int sys_ioctl(int fd, unsigned long request, void *arg, int *result) {
	int ret = syscall(SYS_ioctl, fd, request, arg);
	if (ret < 0) {
		return -ret;
	}
	*result = ret;
	return 0;
}

int sys_isatty(int fd) {
	struct winsize ws;
	int ret;

	if (!sys_ioctl(fd, TIOCGWINSZ, &ws, &ret))
		return 0;

	return ENOTTY;
}

int sys_getcwd(char *buffer, size_t size) {
	syscall(SYS_getcwd, buffer, size);
	return 0;
}

int sys_openat(int dirfd, const char *path, int flags, mode_t mode, int *fd) {
	int ret = syscall(SYS_openat, dirfd, path, flags, mode);
	if (ret < 0) {
		*fd = -1;
		return -ret;
	}
	*fd = (int)ret;
	return 0;
}

int sys_open(const char *path, int flags, mode_t mode, int *fd) {
	return sys_openat(AT_FDCWD, path, flags, mode, fd);
}

#ifndef MLIBC_BUILDING_RTLD

void sys_thread_exit() {
	syscall(SYS_threadexit);
	__builtin_unreachable();
}

extern "C" void __mlibc_thread_entry();

int sys_clone(void *tcb, pid_t *pid_out, void *stack) {
	(void)tcb;

	int ret = syscall(SYS_threadnew, (uintptr_t)__mlibc_thread_entry, (uintptr_t)stack);
	if (ret < 0) {
		return -ret;
	}

	*pid_out = ret;
	return 0;
}

int sys_tcgetattr(int fd, struct termios *attr) {
	int ret;
	if (int r = sys_ioctl(fd, TCGETS, attr, &ret) != 0) {
		return r;
	}
	return ret;
}

int sys_tcsetattr(int fd, int optional_action, const struct termios *attr) {
	int ret;
	switch (optional_action) {
		case TCSANOW:
			optional_action = TCSETS;
			break;
		case TCSADRAIN:
			optional_action = TCSETSW;
			break;
		case TCSAFLUSH:
			optional_action = TCSETSF;
			break;
		default:
			__ensure(!"Unsupported tcsetattr");
	}

	if (int r = sys_ioctl(fd, optional_action, (void *)attr, &ret) != 0) {
		return r;
	}

	return ret;
}

int sys_open_dir(const char *path, int *handle) {
	return sys_openat(AT_FDCWD, path, O_DIRECTORY, 0, handle);
}

struct ReadDirState {
	size_t offset;
	size_t capacity;
	void *buffer;
};

static frg::hash_map<int, ReadDirState *, frg::hash<int>, MemoryAllocator> open_dirs{
    frg::hash<int>{}, getAllocator()
};

static ReadDirState *get_dir_state(int fdnum) {
	ReadDirState *result;
	if (auto value = open_dirs.get(fdnum)) {
		result = *value;
	} else {
		result = (ReadDirState *)malloc(sizeof(ReadDirState));
		result->offset = 0;
		result->capacity = 1024;
		result->buffer = malloc(result->capacity);
		open_dirs.insert(fdnum, result);
	}
	return result;
}

int sys_read_entries(int fdnum, void *buffer, size_t max_size, size_t *bytes_read) {
	ReadDirState *state = get_dir_state(fdnum);

retry:
	uint64_t ret = syscall(SYS_readdir, fdnum, state->buffer, &state->capacity);
	int ret_but_int = (int)ret;
	if (ret_but_int < 0) {
		if (-ret_but_int == ENOBUFS) {
			state->buffer = realloc(state->buffer, state->capacity);
			goto retry;
		} else {
			return -ret_but_int;
		}
	}

	size_t offset = 0;
	while (offset < max_size) {
		struct dirent *ent = (struct dirent *)((char *)state->buffer + state->offset);
		if (ent->d_reclen == 0) {
			break;
		}

		if (offset + ent->d_reclen >= max_size) {
			break;
		}

		memcpy((char *)buffer + offset, ent, ent->d_reclen);
		offset += ent->d_reclen;
		state->offset += ent->d_reclen;
	}

	*bytes_read = offset;
	return ret;
}

#endif

int sys_close(int fd) {
	syscall(SYS_close, fd);
#ifndef MLIBC_BUILDING_RTLD
	open_dirs.remove(fd);
#endif
	return 0;
}

int sys_seek(int fd, off_t offset, int whence, off_t *new_offset) {
	uint64_t ret = syscall(SYS_seek, fd, offset, whence);

	int ret_but_int = (int)ret;
	if (ret_but_int < 0) {
		*new_offset = -1;
		return -ret_but_int;
	}

	*new_offset = (off_t)ret;
	return 0;
}

int sys_read(int fd, void *buf, size_t count, ssize_t *bytes_read) {
	*bytes_read = (ssize_t)syscall(SYS_read, fd, buf, count);
	int ret = *bytes_read;
	if (ret < 0) {
		*bytes_read = -1;
		return -ret;
	}
	return 0;
}

int sys_write(int fd, const void *buf, size_t count, ssize_t *bytes_written) {
	*bytes_written = (ssize_t)syscall(SYS_write, fd, buf, count);
	int ret = *bytes_written;
	if (ret < 0) {
		*bytes_written = -1;
		return -ret;
	}
	return 0;
}

int sys_readlink(const char *path, void *data, size_t max_size, ssize_t *length) {
	*length = (ssize_t)syscall(SYS_readlinkat, AT_FDCWD, path, data, max_size);
	int ret = *length;
	if (ret < 0) {
		*length = -1;
		return -ret;
	}
	return 0;
}

int sys_linkat(int olddirfd, const char *old_path, int newdirfd, const char *new_path, int flags) {
	int ret = syscall(SYS_linkat, olddirfd, old_path, newdirfd, new_path, flags);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_link(const char *old_path, const char *new_path) {
	return sys_linkat(AT_FDCWD, old_path, AT_FDCWD, new_path, 0);
}

int sys_unlinkat(int fd, const char *path, int flags) {
	int ret = syscall(SYS_unlinkat, fd, path, flags);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_fchmodat(int fd, const char *pathname, mode_t mode, int flags) {
	int ret = syscall(SYS_fchmodat, fd, pathname, mode, flags);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_fchmod(int fd, mode_t mode) { return sys_fchmodat(fd, "", mode, AT_EMPTY_PATH); }

int sys_chmod(const char *pathname, mode_t mode) {
	int ret = sys_fchmodat(AT_FDCWD, pathname, mode, 0);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_vm_map(void *hint, size_t size, int prot, int flags, int fd, off_t offset, void **window) {
	uint64_t ret = syscall(SYS_mmap, hint, size, prot, flags, fd, offset);
	int64_t ret_but_int = (int64_t)ret;
	if ((ret_but_int < 0) && (ret_but_int > -4096)) {
		*window = ((void *)-1);
		return -ret_but_int;
	}
	*window = (void *)ret;
	return 0;
}

int sys_vm_protect(void *pointer, size_t size, int prot) {
	return -(syscall(SYS_mprotect, pointer, size, prot));
}

int sys_vm_unmap(void *pointer, size_t size) { return -(syscall(SYS_munmap, pointer, size)); }

int sys_anon_allocate(size_t size, void **pointer) {
	return sys_vm_map(NULL, size, PROT_READ | PROT_WRITE, MAP_ANONYMOUS, -1, 0, pointer);
}

int sys_anon_free(void *pointer, size_t size) { return sys_vm_unmap(pointer, size); }

#ifndef MLIBC_BUILDING_RTLD

pid_t sys_getpid() { return (pid_t)syscall(SYS_getpid); }

pid_t sys_getppid() { return (pid_t)syscall(SYS_getppid); }

uid_t sys_getuid() { return 0; }

uid_t sys_geteuid() { return 0; }

gid_t sys_getgid() { return 0; }

int sys_setgid(gid_t) { return 0; }

int sys_getpgid(pid_t pid, pid_t *out) {
	int ret = (int)syscall(SYS_getpgid, pid);
	if (ret < 0) return -ret;
	*out = (pid_t)ret;
	return 0;
}

gid_t sys_getegid() { return 0; }

int sys_setpgid(pid_t pid, pid_t pgid) {
	int ret = (int)syscall(SYS_setpgid, pid, pgid);
	if (ret < 0) return -ret;
	return 0;
}

int sys_kill(pid_t p, int sig) {
	int ret = (int)syscall(SYS_kill, p, sig);
	if (ret < 0) return -ret;
	return 0;
}

int sys_clock_get(int clock, time_t *secs, long *nanos) {
	struct timespec buf;
	syscall(SYS_getclock, clock, &buf);
	*secs = buf.tv_sec;
	*nanos = buf.tv_nsec;
	return 0;
}

int sys_sleep(time_t *secs, long *nanos) {
	struct timespec req = {.tv_sec = *secs, .tv_nsec = *nanos};
	struct timespec rem = {0, 0};

	int ret = syscall(0x23, &req, &rem);

	if (ret < 0) {
		return -ret;
	}

	*secs = rem.tv_sec;
	*nanos = rem.tv_nsec;
	return 0;
}

int sys_stat(fsfd_target fsfdt, int fd, const char *path, int flags, struct stat *statbuf) {
	int ret = 0;
	switch (fsfdt) {
		case fsfd_target::fd:
			ret = syscall(SYS_fstatat, fd, "", statbuf, flags | AT_EMPTY_PATH);
			break;
		case fsfd_target::path:
			ret = syscall(SYS_fstatat, AT_FDCWD, path, statbuf, flags);
			break;
		case fsfd_target::fd_path:
			ret = syscall(SYS_fstatat, fd, path, statbuf, flags);
			break;
		default:
			__ensure(!"sys_stat: Invalid fsfdt");
			__builtin_unreachable();
	}
	return -ret;
}

int sys_faccessat(int dirfd, const char *pathname, int mode, int flags) {
	(void)flags;
	struct stat buf;
	if (int r = sys_stat(fsfd_target::fd_path, dirfd, pathname, mode & AT_SYMLINK_FOLLOW, &buf)) {
		return r;
	}
	return 0;
}

int sys_access(const char *path, int mode) { return sys_faccessat(AT_FDCWD, path, mode, 0); }

int sys_pipe(int *fds, int flags) {
	int ret = syscall(SYS_pipe, fds, flags);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_chdir(const char *path) {
	int ret = syscall(SYS_chdir, path);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_mkdirat(int dirfd, const char *path, mode_t mode) {
	int ret = syscall(SYS_mkdirat, dirfd, path, mode);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_mkdir(const char *path, mode_t mode) { return sys_mkdirat(AT_FDCWD, path, mode); }

int sys_inotify_create(int, int *) {
	mlibc::infoLogger() << "mlibc: sys_inotify_create() is unimplemented" << frg::endlog;
	return ENOSYS;
}

int sys_fork(pid_t *child) {
	*child = (pid_t)syscall(SYS_fork);
	return 0;
}

int sys_execve(const char *path, char *const argv[], char *const envp[]) {
	int ret = syscall(SYS_execve, path, argv, envp);
	ret = ret < 0 ? -ret : 0;
	return ret;
}

int sys_fcntl(int fd, int request, va_list args, int *result) {
	*result = (int)syscall(SYS_fcntl, fd, request, va_arg(args, uint64_t));
	int ret = *result;
	if (ret < 0) {
		*result = ret;
		return -ret;
	}
	return 0;
}

int sys_dup(int fd, int flags, int *newfd) {
	(void)flags;
	*newfd = (int)syscall(SYS_fcntl, fd, F_DUPFD, 0);
	int ret = *newfd;
	if (ret < 0) {
		*newfd = -1;
		return -ret;
	}
	return 0;
}

int sys_dup2(int fd, int flags, int newfd) {
	int ret = syscall(SYS_dup3, fd, newfd, flags);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_rmdir(const char *path) {
	int ret = syscall(SYS_rmdir, path);
	ret = ret < 0 ? -ret : ret;
	return ret;
}

int sys_setsid(pid_t *out) {
	int ret = (int)syscall(SYS_setsid);
	if (ret < 0) return -ret;
	*out = (pid_t)ret;
	return 0;
}

int sys_sigprocmask(int how, const sigset_t *__restrict set, sigset_t *__restrict oldset) {
	int ret = (int)syscall(SYS_sigprocmask, how, set, oldset);
	if (ret < 0) return -ret;
	return 0;
}

int sys_sigaction(int how, const struct sigaction *act, struct sigaction *oldact) {
	struct sigaction kact;
	const struct sigaction *act_to_pass = act;
	if (act) {
		kact = *act;
		/* Always set SA_RESTORER + sa_restorer; the kernel requires this
		 * to know where to return after the handler. If userspace already
		 * provided one (e.g. for sigaltstack tricks), honor it. */
		if (!(kact.sa_flags & SA_RESTORER) || kact.sa_restorer == nullptr) {
			kact.sa_flags |= SA_RESTORER;
			kact.sa_restorer = __mlibc_sigreturn_trampoline;
		}
		act_to_pass = &kact;
	}
	int ret = (int)syscall(SYS_sigaction, how, act_to_pass, oldact);
	if (ret < 0) return -ret;
	return 0;
}

int sys_pause(void) {
	int ret = (int)syscall(SYS_pause);
	/* pause always returns -EINTR per POSIX */
	if (ret < 0) return -ret;
	return -1;
}

int sys_sigsuspend(const sigset_t *mask) {
	int ret = (int)syscall(SYS_sigsuspend, mask);
	if (ret < 0) return -ret;
	return -1;  /* never returns success */
}

int sys_sigpending(sigset_t *set) {
	int ret = (int)syscall(SYS_sigpending, set);
	if (ret < 0) return -ret;
	return 0;
}

int sys_getsid(pid_t pid, pid_t *out) {
	int ret = (int)syscall(SYS_getsid, pid);
	if (ret < 0) return -ret;
	*out = (pid_t)ret;
	return 0;
}

int sys_tcgetpgrp(int fd, pid_t *out) {
	int pgrp;
	int ret_val;
	if (int r = sys_ioctl(fd, TIOCGPGRP, &pgrp, &ret_val); r != 0)
		return r;
	*out = (pid_t)pgrp;
	return 0;
}

int sys_tcsetpgrp(int fd, pid_t pgrp) {
	int ret_val;
	int pg = (int)pgrp;
	return sys_ioctl(fd, TIOCSPGRP, &pg, &ret_val);
}

int sys_waitpid(pid_t pid, int *status, int flags, struct rusage *ru, pid_t *ret_pid) {
	if (ru) {
		mlibc::infoLogger() << "mlibc: struct rusage in sys_waitpid is unsupported\n"
		                    << frg::endlog;
		return ENOSYS;
	}

	int ret = syscall(SYS_waitpid, pid, status, flags);
	if (ret < 0) {
		*ret_pid = -1;
		return -ret;
	}

	*ret_pid = ret;
	return 0;
}

int sys_getgroups(size_t, const gid_t *, int *) {
	mlibc::infoLogger() << "mlibc: sys_getgroups() is unimplemented" << frg::endlog;
	return ENOSYS;
}

int sys_gethostname(char *buffer, size_t bufsize) {
	struct utsname utsname;
	if (int err = sys_uname(&utsname)) {
		return err;
	}
	if (strlen(utsname.nodename) >= bufsize) {
		return ENAMETOOLONG;
	}
	strncpy(buffer, utsname.nodename, bufsize);
	return 0;
}

int sys_getitimer(int, struct itimerval *) {
	mlibc::infoLogger() << "mlibc: sys_getitimer() is unimplemented" << frg::endlog;
	return ENOSYS;
}

int sys_setitimer(int, const struct itimerval *, struct itimerval *) {
	mlibc::infoLogger() << "mlibc: sys_setitimer() is unimplemented" << frg::endlog;
	return ENOSYS;
}

int sys_umask(mode_t mode, mode_t *old) {
	int ret = syscall(0x5f, mode);
	if (ret < 0) {
		return -ret;
	}
	*old = ret;
	return 0;
}

int sys_uname(struct utsname *buf) { return syscall(0x3f, buf); }

int sys_fsync(int) {
	mlibc::infoLogger() << "sys_fsync is a stub" << frg::endlog;
	return 0;
}

int sys_ppoll(
    struct pollfd *fds,
    int nfds,
    const struct timespec *timeout,
    const sigset_t *sigmask,
    int *num_events
) {
	int ret = syscall(SYS_ppoll, fds, nfds, timeout, sigmask);

	if (ret < 0)
		return -ret;

	*num_events = ret;
	return 0;
}

int sys_poll(struct pollfd *fds, nfds_t count, int timeout, int *num_events) {
	struct timespec ts;
	ts.tv_sec = timeout / 1000;
	ts.tv_nsec = (timeout % 1000) * 1000000;
	return sys_ppoll(fds, count, timeout < 0 ? NULL : &ts, NULL, num_events);
}

int sys_pselect(
    int nfds,
    fd_set *read_set,
    fd_set *write_set,
    fd_set *except_set,
    const struct timespec *timeout,
    const sigset_t *sigmask,
    int *num_events
) {
	struct pollfd *fds = (struct pollfd *)calloc(nfds, sizeof(struct pollfd));
	if (fds == NULL) {
		return ENOMEM;
	}

	for (int i = 0; i < nfds; i++) {
		struct pollfd *fd = &fds[i];

		if (read_set && FD_ISSET(i, read_set)) {
			fd->events |= POLLIN;
		}
		if (write_set && FD_ISSET(i, write_set)) {
			fd->events |= POLLOUT;
		}
		if (except_set && FD_ISSET(i, except_set)) {
			fd->events |= POLLPRI;
		}

		if (!fd->events) {
			fd->fd = -1;
			continue;
		}
		fd->fd = i;
	}

	int ret = sys_ppoll(fds, nfds, timeout, sigmask, num_events);
	if (ret < 0) {
		free(fds);
		return -ret;
	}

	fd_set res_read_set, res_write_set, res_except_set;
	FD_ZERO(&res_read_set);
	FD_ZERO(&res_write_set);
	FD_ZERO(&res_except_set);

	for (int i = 0; i < nfds; i++) {
		struct pollfd *fd = &fds[i];

		if (read_set && FD_ISSET(i, read_set)
		    && (fd->revents & (POLLIN | POLLERR | POLLHUP)) != 0) {
			FD_SET(i, &res_read_set);
		}
		if (write_set && FD_ISSET(i, write_set)
		    && (fd->revents & (POLLOUT | POLLERR | POLLHUP)) != 0) {
			FD_SET(i, &res_write_set);
		}
		if (except_set && FD_ISSET(i, except_set) && (fd->revents & POLLPRI) != 0) {
			FD_SET(i, &res_except_set);
		}
	}

	free(fds);
	if (read_set) {
		*read_set = res_read_set;
	}
	if (write_set) {
		*write_set = res_write_set;
	}
	if (except_set) {
		*except_set = res_except_set;
	}

	return 0;
}

#endif

} // namespace mlibc