329 lines
6.8 KiB
C
329 lines
6.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 <pc/device.h>
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#define MAX_RFRAME_IDX 255
|
|
|
|
//
|
|
// Register frames
|
|
//
|
|
ulong **rfs = NULL;
|
|
|
|
size_t rfs_used = 0;
|
|
size_t rfs_current_idx = 0;
|
|
|
|
#define CHK_INDEX(idx) \
|
|
if ((size_t)idx > MAX_RFRAME_IDX) \
|
|
_except(ctx, E_UDF, "cpudev: invalid rframe index: #%u", idx);
|
|
|
|
#define CHK_FRAME(idx) \
|
|
CHK_INDEX(idx); \
|
|
if (rfs[idx] == NULL) \
|
|
_except(ctx, E_UDF, \
|
|
"cpudev: operation on inactive reframe #%u", idx);
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
long cpudev_getmaxidx(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
rax = MAX_RFRAME_IDX;
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_getrfusage(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
rax = rfs_used;
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_getcuridx(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
rax = rfs_current_idx;
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_leastavail(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
size_t it;
|
|
|
|
for (it = 0; it <= MAX_RFRAME_IDX; it++)
|
|
{
|
|
if (rfs[it] == NULL)
|
|
{
|
|
rax = it;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
rax = -1;
|
|
return 0;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
long cpudev_isactive(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_INDEX(ax0);
|
|
|
|
rax = (rfs[ax0] != NULL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_activate(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_INDEX(ax0);
|
|
|
|
if (rfs[ax0] != NULL)
|
|
_except(ctx, E_UDF,
|
|
"cpudev: activating already activated rframe: #%u", ax0);
|
|
|
|
rfs[ax0] = calloc(NREGS, sizeof(ulong));
|
|
|
|
if (rfs[ax0] == 0)
|
|
return -1;
|
|
|
|
rfs_used++;
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_deactivate(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_FRAME(ax0);
|
|
|
|
if (ax0 == 0)
|
|
_except(ctx, E_UDF, "cpudev: deactivating rframe #0");
|
|
|
|
free(rfs[ax0]);
|
|
rfs[ax0] = NULL;
|
|
|
|
rfs_used--;
|
|
assert(rfs_used > 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
long cpudev_copyframe(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_FRAME(ax0);
|
|
CHK_FRAME(ax1);
|
|
|
|
if (ax0 == ax1)
|
|
return -1;
|
|
|
|
memcpy(rfs[ax0], rfs[ax1], NREGS * sizeof(ulong));
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_moveframe(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_INDEX(ax0);
|
|
CHK_FRAME(ax1);
|
|
|
|
if (ax1 == 0)
|
|
_except(ctx, E_UDF, "cpudev: trying to move frame #0");
|
|
|
|
if (rfs[ax0] != NULL)
|
|
_except(ctx, E_UDF, "cpudev: trying to move frame #%u "
|
|
"active frame #%u", ax1, ax0);
|
|
|
|
rfs[ax0] = rfs[ax1];
|
|
rfs[ax1] = NULL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_switchframe(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_FRAME(ax0);
|
|
|
|
rfs_current_idx = ax0;
|
|
ctx->rf = rfs[ax0];
|
|
|
|
return 0;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
long cpudev_loadargs(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_FRAME(ax0);
|
|
|
|
R(AX5) = rfs[ax0][AX5];
|
|
R(AX4) = rfs[ax0][AX4];
|
|
R(AX3) = rfs[ax0][AX3];
|
|
R(AX2) = rfs[ax0][AX2];
|
|
R(AX1) = rfs[ax0][AX1];
|
|
R(AX0) = rfs[ax0][AX0];
|
|
|
|
return 0;
|
|
|
|
}
|
|
long cpudev_loadreg(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_FRAME(ax0);
|
|
|
|
if ((ushort)ax1 >= NREGS || ax1 == RZX)
|
|
_except(ctx, E_UDF,
|
|
"cpudev: register invalid or index out of range: #%u", ax1);
|
|
|
|
R(RAX) = rfs[ax0][ax1];
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_storereg(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_FRAME(ax0);
|
|
|
|
if ((ushort)ax1 >= NREGS)
|
|
_except(ctx, E_UDF, "cpudev: register index out of range: #%u", ax1);
|
|
|
|
rfs[ax0][ax1] = R(AX2);
|
|
|
|
return 0;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#define CHK_IDT_INDEX(idx) \
|
|
if ((ulong)idx >= IDT_SLOTS) \
|
|
_except(ctx, E_UDF, "cpudev: invalid IDT slot index: #%u", idx);
|
|
|
|
/* except.h */
|
|
ulong idt[IDT_SLOTS] = { 0 };
|
|
bool idt_masked[IDT_SLOTS] = { 0 }; // deliberately masked by software
|
|
bool idt_handling[IDT_SLOTS] = { 0 }; // a handler is already running
|
|
|
|
long cpudev_idtadd(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_FRAME(ax1);
|
|
CHK_IDT_INDEX(ax0);
|
|
|
|
if (idt[ax0] != 0)
|
|
_except(ctx, E_UDF, "cpudev: IDT slot index already in use: #%u", ax0);
|
|
|
|
assert(idt_handling[ax0] == 0);
|
|
|
|
idt[ax0] = ax1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_idtdel(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_IDT_INDEX(ax0);
|
|
|
|
if (idt[ax0] == 0)
|
|
_except(ctx, E_UDF, "cpudev: IDT slot index not in use: #%u", ax0);
|
|
|
|
idt[ax0] = 0;
|
|
idt_handling[ax0] = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_idtquery(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
if (ax0 >= IDT_SLOTS || idt[ax0] == 0)
|
|
rax = rdx = 0;
|
|
|
|
else {
|
|
rax = 1;
|
|
rdx = idt[ax0];
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_idtdone(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
CHK_IDT_INDEX(ax0);
|
|
|
|
if (idt_handling[ax0] == 0)
|
|
_except(ctx, E_UDF, "cpudev: idtdone, not handling E/I #%u", ax0);
|
|
|
|
idt_handling[ax0]--;
|
|
|
|
return 0;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
long cpudev_poweron(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
rfs = calloc(MAX_RFRAME_IDX + 2, sizeof(reg_t *));
|
|
|
|
if (rfs == NULL)
|
|
return -1;
|
|
|
|
rfs[0] = ctx->rf;
|
|
rfs_used = 1;
|
|
|
|
dev->state = DEVGOOD;
|
|
|
|
dev->fslots[16] = cpudev_getmaxidx;
|
|
dev->fslots[17] = cpudev_getrfusage;
|
|
dev->fslots[18] = cpudev_getcuridx;
|
|
dev->fslots[19] = cpudev_leastavail;
|
|
dev->fslots[20] = cpudev_isactive;
|
|
dev->fslots[21] = cpudev_activate;
|
|
dev->fslots[22] = cpudev_deactivate;
|
|
dev->fslots[23] = cpudev_copyframe;
|
|
dev->fslots[24] = cpudev_moveframe;
|
|
dev->fslots[25] = cpudev_switchframe;
|
|
|
|
dev->fslots[32] = cpudev_loadargs;
|
|
dev->fslots[33] = cpudev_loadreg;
|
|
dev->fslots[48] = cpudev_storereg;
|
|
|
|
dev->fslots[64] = cpudev_idtadd;
|
|
dev->fslots[65] = cpudev_idtdel;
|
|
dev->fslots[66] = cpudev_idtquery;
|
|
dev->fslots[67] = cpudev_idtdone;
|
|
|
|
return 0;
|
|
}
|
|
|
|
long cpudev_poweroff(ctx_t *ctx, dev_t *dev)
|
|
{
|
|
size_t i;
|
|
|
|
if (rfs)
|
|
{
|
|
for (i = 0; i <= MAX_RFRAME_IDX; i++)
|
|
free(rfs[i]);
|
|
|
|
free(rfs);
|
|
}
|
|
|
|
dev->state = DEVPWOF;
|
|
|
|
return 0;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
dev_t cpudev =
|
|
{
|
|
.type = "cpu",
|
|
.name = "K-CPU",
|
|
.modl = "Prisma 1",
|
|
.vend = "The OS/K Team",
|
|
|
|
.major = KARCH_MAJOR,
|
|
.minor = KARCH_MINOR,
|
|
.revis = KARCH_REVIS,
|
|
|
|
.fpwon = cpudev_poweron,
|
|
.fpwoff = cpudev_poweroff,
|
|
};
|
|
|