79 lines
1.6 KiB
C
79 lines
1.6 KiB
C
#include <stdint.h>
|
|
#include <stddef.h>
|
|
#include "kprintf.h"
|
|
#include "syscall.h"
|
|
#include "errors.h"
|
|
#include "spinlock/spinlock.h"
|
|
#include "proc/proc.h"
|
|
#include "sysdefs/devctl.h"
|
|
#include "dev/termdev.h"
|
|
#include "dev/ps2kbdev.h"
|
|
#include "util/util.h"
|
|
|
|
Dev *DEVS = NULL;
|
|
|
|
int32_t SYSCALL5(sys_devctl, devh1, cmd1, buffer1, len1, extra1) {
|
|
uint64_t *devh = (uint64_t *)devh1;
|
|
uint64_t cmd = cmd1;
|
|
int32_t ret = E_OK;
|
|
|
|
spinlock_acquire(&PROCS.spinlock);
|
|
Proc *proc = PROCS.current;
|
|
spinlock_release(&PROCS.spinlock);
|
|
|
|
switch (cmd) {
|
|
case DEVCTL_GET_HANDLE: {
|
|
Dev *founddev = NULL;
|
|
size_t i = 0;
|
|
Dev *dev, *devtmp;
|
|
LL_FOREACH_SAFE_IDX(DEVS, dev, devtmp, i) {
|
|
if (i == buffer1) {
|
|
founddev = dev;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (founddev == NULL) {
|
|
ret = E_NOENTRY;
|
|
goto done;
|
|
}
|
|
|
|
bool found = false;
|
|
for (size_t i = 0; i < PROC_DEVHANDLES_MAX; i++) {
|
|
if (proc->devs[i] == NULL) {
|
|
found = true;
|
|
proc->devs[i] = founddev;
|
|
*devh = i;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (!found) {
|
|
ret = E_NOMEMORY;
|
|
goto done;
|
|
}
|
|
} break;
|
|
default: {
|
|
if (devh == NULL) {
|
|
ret = E_INVALIDARGUMENT;
|
|
goto done;
|
|
}
|
|
|
|
if (cmd >= DEV_FNS_MAX) {
|
|
ret = E_INVALIDARGUMENT;
|
|
goto done;
|
|
}
|
|
|
|
Dev *dev = proc->devs[*devh];
|
|
if (dev == NULL) {
|
|
ret = E_NOENTRY;
|
|
goto done;
|
|
}
|
|
ret = dev->fns[cmd]((uint8_t *)buffer1, (size_t)len1, (void *)extra1);
|
|
} break;
|
|
}
|
|
|
|
done:
|
|
return ret;
|
|
}
|