mirror of
https://gitlab.os-k.eu/os-k-team/kvisc.git
synced 2023-08-25 14:05:46 +02:00
107 lines
1.8 KiB
C
107 lines
1.8 KiB
C
// The OS/K Team licenses this file to you under the MIT license.
|
|
// See the LICENSE file in the project root for more information.
|
|
|
|
#include <dv/dev.h>
|
|
#include <in/instrs.h>
|
|
|
|
//
|
|
// code common to devctl and iocall
|
|
//
|
|
dev_t *devctl_common(ctx_t *ctx, ulong v1, ulong v2)
|
|
{
|
|
dev_t *dev = devget(ctx, v1);
|
|
|
|
if (!dev)
|
|
rax = -2;
|
|
|
|
else if (dev->state == DEVPWOF)
|
|
rax = -3;
|
|
|
|
else if (dev->state == DEVFERR)
|
|
rax = -4;
|
|
|
|
else if (dev->state == DEVPLUG)
|
|
rax = -5;
|
|
|
|
else
|
|
return dev;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
void copystr(ctx_t *ctx, ulong addr, ulong maxn, char *str)
|
|
{
|
|
for (; *str && maxn > 0; str++, addr++, maxn--) {
|
|
writemem(ctx, *str, addr, 1);
|
|
}
|
|
|
|
writemem(ctx, 0, addr, 1);
|
|
}
|
|
|
|
IMPL_START_2(devctl)
|
|
{
|
|
CHK_SUPERV();
|
|
|
|
dev_t *dev = devctl_common(ctx, v1, v2);
|
|
|
|
if (dev == NULL)
|
|
return 0;
|
|
|
|
switch (v2) {
|
|
case 0:
|
|
copystr(ctx, ax0, DEVLEN, dev->type);
|
|
break;
|
|
|
|
case 1:
|
|
copystr(ctx, ax0, DEVLEN, dev->name);
|
|
break;
|
|
|
|
case 2:
|
|
copystr(ctx, ax0, DEVLEN, dev->modl);
|
|
break;
|
|
|
|
case 3:
|
|
copystr(ctx, ax0, DEVLEN, dev->vend);
|
|
break;
|
|
|
|
case 4:
|
|
rax = dev->major;
|
|
rdx = dev->minor;
|
|
break;
|
|
|
|
case 5:
|
|
rax = dev->feats;
|
|
rdx = dev->revis;
|
|
break;
|
|
|
|
default:
|
|
rax = -6;
|
|
break;
|
|
}
|
|
}
|
|
IMPL_END;
|
|
|
|
IMPL_START_2(iocall)
|
|
{
|
|
CHK_SUPERV();
|
|
|
|
long rc;
|
|
dev_t *dev = devctl_common(ctx, v1, v2);
|
|
|
|
if (dev == NULL)
|
|
return 0;
|
|
|
|
if (v2 >= DEVSLOTS)
|
|
rax = -6;
|
|
|
|
else if (dev->fslots[v2] == NULL)
|
|
rax = -6;
|
|
|
|
else {
|
|
rc = dev->fslots[v2](ctx, dev);
|
|
if (rc < 0) rax = rc;
|
|
}
|
|
}
|
|
IMPL_END;
|
|
|