mirror of
https://github.com/Mathewnd/Astral.git
synced 2026-10-27 12:48:22 +00:00
syscall: multiple syscalls related to sockets
This commit is contained in:
@@ -32,6 +32,8 @@
|
||||
#include <kernel/cmdline.h>
|
||||
#include <arch/smp.h>
|
||||
#include <kernel/virtio.h>
|
||||
#include <kernel/net.h>
|
||||
#include <kernel/sock.h>
|
||||
|
||||
static cpu_t bsp_cpu;
|
||||
|
||||
@@ -63,8 +65,14 @@ void kernel_entry() {
|
||||
tmpfs_init();
|
||||
devfs_init();
|
||||
pipefs_init();
|
||||
sockfs_init();
|
||||
ext2_init();
|
||||
|
||||
netdev_init();
|
||||
arp_init();
|
||||
ipv4_init();
|
||||
udp_init();
|
||||
|
||||
block_init();
|
||||
pseudodevices_init();
|
||||
arch_e9_initdev();
|
||||
|
||||
@@ -40,6 +40,11 @@ extern syscall_mount
|
||||
extern syscall_fchownat
|
||||
extern syscall_utimensat
|
||||
extern syscall_renameat
|
||||
extern syscall_socket
|
||||
extern syscall_bind
|
||||
extern syscall_sendmsg
|
||||
extern syscall_setsockopt
|
||||
extern syscall_recvmsg
|
||||
syscalltab:
|
||||
dq syscall_print
|
||||
dq syscall_mmap
|
||||
@@ -82,7 +87,12 @@ dq syscall_mount
|
||||
dq syscall_fchownat
|
||||
dq syscall_utimensat
|
||||
dq syscall_renameat
|
||||
syscallcount equ 41
|
||||
dq syscall_socket
|
||||
dq syscall_bind
|
||||
dq syscall_sendmsg
|
||||
dq syscall_setsockopt
|
||||
dq syscall_recvmsg
|
||||
syscallcount equ 46
|
||||
section .text
|
||||
global arch_syscall_entry
|
||||
; on entry:
|
||||
|
||||
@@ -4,7 +4,7 @@
|
||||
|
||||
#ifdef SYSCALL_LOGGING
|
||||
|
||||
#define SYSCALL_COUNT 41
|
||||
#define SYSCALL_COUNT 46
|
||||
#define LOGSTR(x) arch_e9_puts(x)
|
||||
|
||||
static char *name[] = {
|
||||
@@ -48,7 +48,12 @@ static char *name[] = {
|
||||
"mount",
|
||||
"fchownat",
|
||||
"utimensat",
|
||||
"renameat"
|
||||
"renameat",
|
||||
"socket",
|
||||
"bind",
|
||||
"sendmsg",
|
||||
"setsockopt",
|
||||
"recvmsg"
|
||||
};
|
||||
|
||||
static char *args[] = {
|
||||
@@ -92,7 +97,12 @@ static char *args[] = {
|
||||
"backing %p mountpoint %s fs %s flags %d data %p", // mount
|
||||
"fd %d path %s owner %d group %d flags %x", // fchownat
|
||||
"dirfd %d path %p times %p flags %x", // utimensat
|
||||
"olddirfd %d oldpath %s newdirfd %d newpath %s flags %d" // renameat
|
||||
"olddirfd %d oldpath %s newdirfd %d newpath %s flags %d", // renameat
|
||||
"domain %d type %d protocol %d\n", // socket
|
||||
"fd %d addr %p len %d\n", // bind
|
||||
"fd %d msghdr %p flags %d", // sendmsg
|
||||
"fd %d level %d optname %d optval %p optlen %lu", // setsockopt
|
||||
"fd %d msghdr %p flags %d", // recvmsg
|
||||
};
|
||||
|
||||
#endif
|
||||
|
||||
@@ -0,0 +1,56 @@
|
||||
#include <kernel/syscalls.h>
|
||||
#include <errno.h>
|
||||
#include <string.h>
|
||||
#include <kernel/alloc.h>
|
||||
#include <kernel/sock.h>
|
||||
#include <kernel/file.h>
|
||||
#include <kernel/vfs.h>
|
||||
#include <kernel/net.h>
|
||||
#include <logging.h>
|
||||
|
||||
syscallret_t syscall_bind(context_t *, int fd, void *uaddr, size_t addrlen) {
|
||||
syscallret_t ret = {
|
||||
.ret = -1
|
||||
};
|
||||
|
||||
if (addrlen > 1024) {
|
||||
ret.errno = EINVAL;
|
||||
return ret;
|
||||
}
|
||||
|
||||
abisockaddr_t *addr = alloc(addrlen);
|
||||
if (addr == NULL) {
|
||||
ret.errno = ENOMEM;
|
||||
return ret;
|
||||
}
|
||||
|
||||
file_t *file = fd_get(fd);
|
||||
if (file == NULL) {
|
||||
ret.errno = EBADF;
|
||||
goto cleanup;
|
||||
}
|
||||
|
||||
if (file->vnode->type != V_TYPE_SOCKET) {
|
||||
ret.errno = ENOTSOCK;
|
||||
goto cleanup;
|
||||
}
|
||||
|
||||
memcpy(addr, uaddr, addrlen);
|
||||
|
||||
sockaddr_t sockaddr;
|
||||
ret.errno = sock_convertaddress(&sockaddr, addr);
|
||||
if (ret.errno)
|
||||
goto cleanup;
|
||||
|
||||
socket_t *socket = SOCKFS_SOCKET_FROM_NODE(file->vnode);
|
||||
|
||||
ret.errno = socket->ops->bind(socket, &sockaddr);
|
||||
ret.ret = ret.errno ? -1 : 0;
|
||||
|
||||
cleanup:
|
||||
if (file)
|
||||
fd_release(file);
|
||||
|
||||
free(addr);
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,59 @@
|
||||
#include <kernel/syscalls.h>
|
||||
#include <kernel/net.h>
|
||||
#include <kernel/abi.h>
|
||||
#include <kernel/vfs.h>
|
||||
#include <kernel/sock.h>
|
||||
#include <kernel/file.h>
|
||||
#include <kernel/alloc.h>
|
||||
|
||||
syscallret_t syscall_recvmsg(context_t *, int fd, msghdr_t *umsghdr, int flags) {
|
||||
__assert(flags == 0);
|
||||
syscallret_t ret;
|
||||
|
||||
msghdr_t msghdr;
|
||||
ret.errno = sock_copymsghdr(&msghdr, umsghdr);
|
||||
if (ret.errno)
|
||||
return ret;
|
||||
|
||||
file_t *file = NULL;
|
||||
size_t buffersize = iovec_size(msghdr.iov, msghdr.iovcount);
|
||||
void *buffer = vmm_map(NULL, buffersize, VMM_FLAGS_ALLOCATE, ARCH_MMU_FLAGS_READ | ARCH_MMU_FLAGS_WRITE | ARCH_MMU_FLAGS_NOEXEC, NULL);
|
||||
if (buffer == NULL) {
|
||||
ret.errno = ENOMEM;
|
||||
goto cleanup;
|
||||
}
|
||||
|
||||
file = fd_get(fd);
|
||||
if (file == NULL) {
|
||||
ret.errno = EBADF;
|
||||
goto cleanup;
|
||||
}
|
||||
|
||||
sockaddr_t sockaddr;
|
||||
socket_t *socket = SOCKFS_SOCKET_FROM_NODE(file->vnode);
|
||||
size_t recvcount;
|
||||
ret.errno = socket->ops->recv(socket, &sockaddr, buffer, buffersize, 0, &recvcount);
|
||||
ret.ret = ret.errno ? -1 : recvcount;
|
||||
|
||||
uintmax_t iovoffset = 0;
|
||||
for (int i = 0; i < msghdr.iovcount; ++i) {
|
||||
memcpy(msghdr.iov[i].addr, (void *)((uintptr_t)buffer + iovoffset), msghdr.iov[i].len);
|
||||
iovoffset += msghdr.iov[i].len;
|
||||
}
|
||||
|
||||
if (umsghdr->addr) {
|
||||
ret.errno = sock_addrtoabiaddr(socket->type, &sockaddr, umsghdr->addr);
|
||||
if (ret.errno)
|
||||
goto cleanup;
|
||||
}
|
||||
|
||||
cleanup:
|
||||
if (file)
|
||||
fd_release(file);
|
||||
|
||||
if (buffer)
|
||||
vmm_unmap(buffer, buffersize, 0);
|
||||
|
||||
sock_freemsghdr(&msghdr);
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,59 @@
|
||||
#include <kernel/syscalls.h>
|
||||
#include <kernel/vfs.h>
|
||||
#include <kernel/sock.h>
|
||||
#include <kernel/file.h>
|
||||
#include <kernel/net.h>
|
||||
#include <kernel/alloc.h>
|
||||
|
||||
syscallret_t syscall_sendmsg(context_t *, int fd, msghdr_t *umsghdr, int flags) {
|
||||
__assert(flags == 0);
|
||||
syscallret_t ret;
|
||||
|
||||
msghdr_t msghdr;
|
||||
ret.errno = sock_copymsghdr(&msghdr, umsghdr);
|
||||
if (ret.errno)
|
||||
return ret;
|
||||
|
||||
file_t *file = NULL;
|
||||
size_t buffersize = iovec_size(msghdr.iov, msghdr.iovcount);
|
||||
void *buffer = vmm_map(NULL, buffersize, VMM_FLAGS_ALLOCATE, ARCH_MMU_FLAGS_READ | ARCH_MMU_FLAGS_WRITE | ARCH_MMU_FLAGS_NOEXEC, NULL);
|
||||
if (buffer == NULL) {
|
||||
ret.errno = ENOMEM;
|
||||
goto cleanup;
|
||||
}
|
||||
|
||||
uintmax_t iovoffset = 0;
|
||||
|
||||
for (int i = 0; i < msghdr.iovcount; ++i) {
|
||||
memcpy((void *)((uintptr_t)buffer + iovoffset), msghdr.iov[i].addr, msghdr.iov[i].len);
|
||||
iovoffset += msghdr.iov[i].len;
|
||||
}
|
||||
|
||||
file = fd_get(fd);
|
||||
if (file == NULL) {
|
||||
ret.errno = EBADF;
|
||||
goto cleanup;
|
||||
}
|
||||
|
||||
sockaddr_t sockaddr;
|
||||
if (msghdr.addr) {
|
||||
ret.errno = sock_convertaddress(&sockaddr, msghdr.addr);
|
||||
if (ret.errno)
|
||||
goto cleanup;
|
||||
}
|
||||
|
||||
socket_t *socket = SOCKFS_SOCKET_FROM_NODE(file->vnode);
|
||||
size_t sendcount;
|
||||
ret.errno = socket->ops->send(socket, msghdr.addr ? &sockaddr : NULL, buffer, buffersize, 0, &sendcount);
|
||||
ret.ret = ret.errno ? -1 : sendcount;
|
||||
|
||||
cleanup:
|
||||
if (file)
|
||||
fd_release(file);
|
||||
|
||||
if (buffer)
|
||||
vmm_unmap(buffer, buffersize, 0);
|
||||
|
||||
sock_freemsghdr(&msghdr);
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,69 @@
|
||||
#include <kernel/syscalls.h>
|
||||
#include <kernel/sock.h>
|
||||
#include <kernel/abi.h>
|
||||
#include <kernel/file.h>
|
||||
#include <errno.h>
|
||||
|
||||
syscallret_t syscall_setsockopt(context_t *, int fd, int level, int optname, void *val, size_t len) {
|
||||
syscallret_t ret = {
|
||||
.ret = -1
|
||||
};
|
||||
|
||||
if (level != SOL_SOCKET) {
|
||||
ret.errno = ENOPROTOOPT;
|
||||
return ret;
|
||||
}
|
||||
|
||||
void *buffer = NULL;
|
||||
if (val) {
|
||||
buffer = alloc(len);
|
||||
if (buffer == NULL) {
|
||||
ret.errno = ENOMEM;
|
||||
return ret;
|
||||
}
|
||||
memcpy(buffer, val, len);
|
||||
}
|
||||
|
||||
file_t *file = fd_get(fd);
|
||||
if (file == NULL) {
|
||||
free(buffer);
|
||||
ret.errno = EBADF;
|
||||
return ret;
|
||||
}
|
||||
|
||||
socket_t *socket = SOCKFS_SOCKET_FROM_NODE(file->vnode);
|
||||
|
||||
|
||||
MUTEX_ACQUIRE(&socket->mutex, false);
|
||||
switch (optname) {
|
||||
case SO_BINDTODEVICE:
|
||||
if (val) {
|
||||
socket->netdev = netdev_getdev(val);
|
||||
ret.errno = socket->netdev ? 0 : ENODEV;
|
||||
} else {
|
||||
socket->netdev = NULL;
|
||||
}
|
||||
break;
|
||||
case SO_BROADCAST:
|
||||
if (val == NULL) {
|
||||
ret.errno = EFAULT;
|
||||
} else {
|
||||
socket->broadcast = *((int *)buffer);
|
||||
ret.errno = 0;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
ret.errno = ENOPROTOOPT;
|
||||
}
|
||||
|
||||
MUTEX_RELEASE(&socket->mutex);
|
||||
|
||||
ret.ret = ret.errno ? -1 : 0;
|
||||
|
||||
fd_release(file);
|
||||
|
||||
if (val)
|
||||
free(buffer);
|
||||
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,58 @@
|
||||
#include <kernel/syscalls.h>
|
||||
#include <kernel/abi.h>
|
||||
#include <kernel/sock.h>
|
||||
#include <errno.h>
|
||||
|
||||
syscallret_t syscall_socket(context_t *, int domain, int type, int protocol) {
|
||||
syscallret_t ret = {
|
||||
.ret = -1
|
||||
};
|
||||
|
||||
int socktype = -1;
|
||||
|
||||
switch (domain) {
|
||||
case AF_INET:
|
||||
if (type != SOCK_DGRAM)
|
||||
break;
|
||||
|
||||
socktype = SOCKET_TYPE_UDP;
|
||||
break;
|
||||
}
|
||||
|
||||
if (socktype == -1) {
|
||||
ret.errno = EAFNOSUPPORT;
|
||||
return ret;
|
||||
}
|
||||
|
||||
socket_t *socket = socket_create(socktype);
|
||||
if (socket == NULL) {
|
||||
ret.errno = ENOMEM;
|
||||
return ret;
|
||||
}
|
||||
|
||||
vnode_t *vnode;
|
||||
ret.errno = sockfs_newsocket(&vnode, socket);
|
||||
if (ret.errno) {
|
||||
// TODO delete socket
|
||||
return ret;
|
||||
}
|
||||
|
||||
file_t *file;
|
||||
int fd;
|
||||
|
||||
ret.errno = fd_new(0, &file, &fd);
|
||||
if (ret.errno) {
|
||||
// socket gets deleted by node cleanup
|
||||
VOP_RELEASE(vnode);
|
||||
return ret;
|
||||
}
|
||||
|
||||
file->vnode = vnode;
|
||||
file->flags = FILE_READ | FILE_WRITE;
|
||||
file->offset = 0;
|
||||
file->mode = 0777;
|
||||
|
||||
ret.ret = fd;
|
||||
|
||||
return ret;
|
||||
}
|
||||
Reference in New Issue
Block a user