kvisc/vm/pc/main.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 <sys/time.h>

#define FWPROGSIZE (1024 * 1024 * 1024)
static ssize_t fwsize;
static ushort *fwprog;

ushort bget(ctx_t *ctx)
{
    if (rip % 2) {
        _except(ctx, E_ALI, "Misaligned RIP register: 0x%016lX",
            rip);
    }

    if (addr2real(rip) >= ctx->mz) {
        _except(ctx, E_ACC, "Executing out of memory: 0x%016lX",
            rip);
    }

    ushort c = ctx->mp[addr2real(rip)];

    rip += 2;

    return c;
}

ushort dget(ctx_t *ctx)
{
    static int i = 0;

    if (i >= fwsize) {
        log("Finished disassembling\n");
        fclose(ctx->disf);
        exit(0);
    }

    rip += 2;
    return fwprog[i++];
}

ctx_t main_ctx;

int main(int argc, char **argv)
{
    FILE *fwfile;

    struct timeval time;

    gettimeofday(&time, NULL);
    srandom((time.tv_sec * 1000) + (time.tv_usec / 1000));

    main_ctx.r = arch_r;
    main_ctx.i = arch_i;

    if (argc < 2) {
        log("Not enough arguments\n");
        exit(-3);
    }

    fwprog = malloc(FWPROGSIZE);
    fwfile = fopen(argv[1], "rb");

    if (!fwprog) {
        log("Couldn't allocate firmware buffer\n");
        exit(-1);
    }

    if (!fwfile) {
        log("Couldn't open program file\n");
        exit(-2);
    }

    fwsize = fread(fwprog, 1, FWPROGSIZE, fwfile);

    //log("Loaded %lu bytes

    if (fwsize < 2) {
        log("Program file too small or empty\n");
        exit(-3);
    }

    if (!(argc > 2 && !strcmp(argv[2], "-d"))) {
        main_ctx.mp = malloc(MEMSIZE + 16);
        main_ctx.mz = MEMSIZE;

        main_ctx.get = bget;
        main_ctx.disf = NULL;

        main_ctx.r[RIP].val = MEMOFF;

        if (main_ctx.mp == 0) {
            log("Couldn't allocate RAM\n");
            exit(-1);
        }

        memcpy(&main_ctx.mp[addr2real(main_ctx.r[RIP].val)], fwprog, fwsize);

        main_ctx.dh = 0;
        if (devinitall(&main_ctx) < 0) {
            log("Couldn't initialize devices\n");
            exit(-10);
        }

        while (1) {
            decode(&main_ctx);
        }
    }

    // Disassembly
    else {
        main_ctx.disf = fopen("fwprog.dis", "w");

        if (main_ctx.disf == NULL) {
            log("Couldn't open fwprog.dis\n");
            exit(-2);
        }

        main_ctx.mp = NULL;
        main_ctx.mz = 0;

        main_ctx.get = dget;

        while (1) {
            disasm(&main_ctx);
        }
    }


    return 0;
}