程序代码：
#include <assert.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
typedef unsigned char uint8_t;
typedef unsigned short uint16_t;
typedef unsigned int uint32_t;
typedef uint8_t machine_size;
typedef machine_size m_size_t;
typedef uint32_t size_t;
#define _MOV 0x0001
#define _ADD 0x0010
#define _SUB 0x0011
#define _LEA 0x0101
#define _JZ 0x0110
#define _JNZ 0x0111
#define _DUMP 0x1000
#define _EXIT 0x11110000
#define SRC2DST 0x01
#define DST2SRC 0x00
#define UNIT_PER_BYTE 8
#define LOHALF(b) (b & 0x0F)
#define HIHALF(b) (b >> 4)
#define MAKEBYTE(l, h) (((h << 4) & 0xF0) | (l & 0x0F))
#define MAKEWORD(a, b) ((uint16_t)(((uint8_t)((uint32_t)(a) & 0xff)) | \
((uint16_t)((uint8_t)((uint32_t)(b) & 0xff))) << 8))
#define MAKELONG(a, b) ((uint32_t)(((uint16_t)((uint32_t)(a) & 0xffff)) | \
((uint32_t)((uint32_t)((uint32_t)(b) & 0xffff))) << 16))
#define LOBYTE(w) ((uint8_t)(w))
#define HIBYTE(w) ((uint8_t)(((uint16_t)(w) >> 8) & 0xFF))
#define LOWORD(l) ((uint16_t)(l))
#define HIWORD(l) ((uint16_t)(((uint32_t)(l) >> 16) & 0xFFFF))
#define raise_bits(i, bits) ((i) |= (bits))
#define _ARCH intel
#define FAKE2REAL(index) _ARCH[index]
#define _BV(bit) (1 << (bit))
#define BV(i, bit) ((i) << (bit))
#define BUG_ON(expr) assert(!(expr))
static void bus_recv(void *, uint8_t*, size_t);
static void ins_decode(m_size_t);
#define STUB 0
#define DECLARE_CPU(name) \
struct cpu_context name = { \
STUB, \
bus_recv, \
ins_decode, \
STUB, \
STUB \
};
#ifdef CONFIG_B2B_LMODE
#define B2B(out, in) \
do { \
uint16_t i; \
for (i = 0; i < UNIT_PER_BYTE; i++) \
raise_bits(out, _BV(7-i) & in[i]); \
} while (0);
#else
#define B2B(out, in) \
do { \
uint16_t i, j; \
for (i = 0, j = 0; i < UNIT_PER_BYTE; i+=2, j++) \
out[j] = MAKEBYTE(((in >> (7-i-1)) & 0x01), \
((in >> (7-i)) & 0x01)); \
} while (0);
#endif
const uint16_t opcode[] = {
_MOV, _ADD,
_SUB, _LEA,
_JZ, _JNZ,
_DUMP, HIWORD(_EXIT), LOWORD(_EXIT)
};
const uint8_t *intel[] = {
"MOV", "ADD",
"SUB", "LEA",
"JZ", "JNZ",
"PRINT", "EXIT"
};
uint8_t *cmd_request;
#ifdef CONFIG_DEFAULT_CMD
#define SIGNHEX(n) (0x##n)
#ifdef CONFIG_LSB_ENDIAN
#define HEX2BIN(hex) \
BV((0x01 & (hex >> 28)), 7) | \
BV((0x01 & (hex >> 24)), 6) | \
BV((0x01 & (hex >> 20)), 5) | \
BV((0x01 & (hex >> 16)), 4) | \
BV((0x01 & (hex >> 12)), 3) | \
BV((0x01 & (hex >> 8)), 2) | \
BV((0x01 & (hex >> 4)), 1) | \
BV((0x01 & (hex >> 0)), 0)
#endif
uint8_t sysfifo[] = {
#if 0
HEX2BIN(SIGNHEX(01000001)),
HEX2BIN(SIGNHEX(00000011)),
HEX2BIN(SIGNHEX(01000010)),
HEX2BIN(SIGNHEX(00000010)),
HEX2BIN(SIGNHEX(00100011)),
HEX2BIN(SIGNHEX(01000100)),
HEX2BIN(SIGNHEX(00000000)),
HEX2BIN(SIGNHEX(01011110)),
HEX2BIN(SIGNHEX(10000100)),
HEX2BIN(SIGNHEX(11110000))
#else
HEX2BIN(HIWORD(_EXIT)),
HEX2BIN(LOWORD(_EXIT))
#endif
};
#else
#endif
struct cpu_context {
machine_size *pc;
void(*recv)(void*, uint8_t*, size_t);
void(*decode)(m_size_t);
uint8_t *memmap;
uint8_t priv[1];
};
DECLARE_CPU(cpu);
static void bus_recv(void *mem, uint8_t *fifo, size_t szfifo)
{
/* BUG_ON(mem == 0); */
memcpy(mem, fifo, szfifo);
}
static void __entry4_decode(m_size_t opcode)
{
uint8_t op[4];
B2B(op, opcode);
switch (MAKELONG(MAKEWORD(op[3], op[2]), MAKEWORD(op[1], op[0]))) {
case MAKELONG(_MOV, 0x0000):
sprintf(cmd_request, "%s", FAKE2REAL(0));
break;
case MAKELONG(_ADD, 0x0000):
sprintf(cmd_request, "%s", FAKE2REAL(1));
break;
case MAKELONG(_SUB, 0x0000):
sprintf(cmd_request, "%s", FAKE2REAL(2));
break;
case MAKELONG(_DUMP, 0x0000):
sprintf(cmd_request, "%s", FAKE2REAL(6));
break;
}
}
static void __entry8_decode(m_size_t opcode)
{
uint8_t op[4];
B2B(op, opcode);
switch (MAKELONG(MAKEWORD(op[3], op[2]), MAKEWORD(op[1], op[0]))) {
case _EXIT:
sprintf(cmd_request, "%s", FAKE2REAL(7));
break;
}
}
static void ins_decode(m_size_t opcode)
{
uint8_t op8;
/* SAVE_REG(cpu.pc); */
#define READ_CACHE(idx) *((m_size_t*)cpu.pc + 1)
op8 = MAKEBYTE(LOHALF(READ_CACHE(idx)),LOHALF(opcode));
__entry8_decode(op8);
/* RESOTRE(cpu.pc); */
/* cpu.pc += size_handled;
/* __entry4_decode(opcode); */
}
void InitFakeCpu(struct cpu_context *cpu)
{
#define PAGE_SIZE 256
#define CPU_CACHE 2
#define PRIV_SIZE CPU_CACHE + 64
cpu->memmap = malloc(PAGE_SIZE + PRIV_SIZE);
BUG_ON(cpu->memmap == 0);
cpu->pc = cpu->memmap;
}
void FreeAll(void *obj)
{
/* if (obj) free(obj); */
}
int main(int argc, char *argv[])
{
/* if (argc < 2) do sth. */
InitFakeCpu(&cpu);
cmd_request = cpu.memmap + (PAGE_SIZE + PRIV_SIZE);
(&cpu)->recv(cpu.memmap, sysfifo, sizeof(sysfifo));
(&cpu)->decode(*(m_size_t*)cpu.pc);
fprintf(stdout, "req cmd analysis:%s\r\n", cmd_request);
FreeAll(cpu.memmap);
return 0;
}一步步来
vm.rar
2进制码可不能笔误呀
