Subversion Repositories igor

#include <sys/mman.h>

#include <sys/stat.h>

#include <fcntl.h>

#include <stdio.h>

#include <stdlib.h>

#include <unistd.h>

#include <err.h>

#include "types.h"

#include "microcode.h"

#define INSTR_SZ 6 // byte

static int microcodefd;

static uint8_t *microcodebuffer;

static size_t microcodesize;

int

microcode_init(const char *path)

{

        int fd;

        struct stat sb;

        if ((fd = open(path, O_RDONLY)) == -1)

                return 0;

        if (fstat(fd, &sb) == -1) {

                close(fd);

                return 0;

        }

        microcodebuffer = mmap(NULL, sb.st_size, PROT_READ, MAP_PRIVATE, fd, 0);

        if (microcodebuffer == MAP_FAILED) {

                close(fd);

                return 0;

        }

        microcodesize = sb.st_size;

        if ((microcodesize % INSTR_SZ) != 0) {

                close(fd);

                warnx("microcode size not dividable by INSTR_SZ (%d)", INSTR_SZ);

                return 0;

        }

        printf("Microcode size: %d\n", (int)microcodesize/INSTR_SZ);

        /*

        for (int i = 0; i < microcodesize/4; i++) {

                printf("inst: 0x%x\n", microcode_fetch_instr(i));

        }

        */

        microcodefd = fd;

        return 1;

}

uint64_t

microcode_fetch_instr(reg_t place)

{

        int byteplace, i;

        uint64_t val;

        if (place < 0 || place >= (microcodesize/INSTR_SZ))

                errx(1, "Trying to access out of bounds microcode: 0x%x", place);

        byteplace = place*INSTR_SZ;

        //printf("place: %d, byteplace: %d\n", place, byteplace);

        val = 0;

        for (i = 0; i < INSTR_SZ; i++) {

                val = (val << 8) | (microcodebuffer[byteplace+i]&0xFF);

        }

        return val;

}

size_t

microcode_size(void)

{

        return microcodesize/INSTR_SZ;

}