Sync to tower
This commit is contained in:
123
cpu/core.c
123
cpu/core.c
@@ -47,55 +47,64 @@ void step(CPU *cpu) {
|
||||
|
||||
case INC_RN:
|
||||
//Increment register
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
temp = read_reg(cpu, reg1);
|
||||
write_reg(cpu, reg1, temp + 1);
|
||||
cpu->regs[reg1]++;
|
||||
|
||||
case INC_ADDR:
|
||||
//Increment address
|
||||
addrTemp = read_addr(cpu);
|
||||
write_mem(cpu, read_addr(cpu), read_mem(cpu, addrTemp) + 1);
|
||||
addrTemp = read_address(cpu);
|
||||
temp = read_mem(cpu, addrTemp);
|
||||
write_mem(cpu, addrTemp, temp + 1);
|
||||
|
||||
case DEC_RN:
|
||||
//Decrement register
|
||||
reg1 = read_reg(cpu);
|
||||
cpu->regs[reg1]--;
|
||||
reg1 = read_reg_number(cpu);
|
||||
temp = read_reg(cpu, reg1);
|
||||
write_reg(cpu, reg1, temp - 1);
|
||||
cpu->regs[reg1]++;
|
||||
|
||||
case DEC_ADDR:
|
||||
//Decrement address
|
||||
addrTemp = read_addr(cpu);
|
||||
write_mem(cpu, addrTemp, read_mem(cpu, addrTemp) - 1);
|
||||
addrTemp = read_address(cpu);
|
||||
temp = read_mem(cpu, addrTemp);
|
||||
write_mem(cpu, addrTemp, temp - 1);
|
||||
|
||||
case MOV_RN_IMM:
|
||||
//Load from immediate to register
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] = imm;
|
||||
break;
|
||||
|
||||
case MOV_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
cpu->regs[reg1] = cpu->regs[reg2];
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
temp = read_reg(cpu, reg1);
|
||||
write_reg(cpu, reg2, temp);
|
||||
break;
|
||||
|
||||
case MOV_RN_ADDR:
|
||||
// Load from memory into register.
|
||||
reg1 = read_reg(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] = read_mem(cpu, imm);
|
||||
// Store register to memory
|
||||
reg1 = read_reg_number(cpu);
|
||||
addrTemp = read_address(cpu);
|
||||
temp = read_reg(cpu, reg1);
|
||||
write_mem(cpu, addrTemp, temp);
|
||||
break;
|
||||
|
||||
case MOV_ADDR_RN:
|
||||
// Store from register into memory.
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
reg1 = read_reg(cpu);
|
||||
write_mem(cpu, imm, cpu->regs[reg1]);
|
||||
// Load memory to register
|
||||
addrTemp = read_address(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
temp = read
|
||||
write_mem(cpu, addrTemp, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case SWAP: {
|
||||
// Swap contents of two registers.
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
temp = cpu->regs[reg1];
|
||||
cpu->regs[reg1] = cpu->regs[reg2];
|
||||
cpu->regs[reg2] = temp;
|
||||
@@ -104,57 +113,57 @@ void step(CPU *cpu) {
|
||||
|
||||
case SWAPN: {
|
||||
// Swap the nibbles of a register.
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
uint8_t val = (uint8_t) cpu->regs[reg1];
|
||||
cpu->regs[reg1] = ((val & 0x0F) << 4) | ((val & 0xF0) >> 4);
|
||||
break;
|
||||
}
|
||||
|
||||
case ADD_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] += cpu->regs[reg2];
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case ADD_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] += imm;
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case SUB_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] -= cpu->regs[reg2];
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case SUB_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] -= imm;
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case MUL_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] *= cpu->regs[reg2];
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case MUL_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] *= imm;
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case DIV_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
if (cpu->regs[reg2] == 0) {
|
||||
printf("Error: Division by zero!\n");
|
||||
cpu->mode = Error;
|
||||
@@ -165,7 +174,7 @@ void step(CPU *cpu) {
|
||||
break;
|
||||
|
||||
case DIV_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
if (imm == 0) {
|
||||
printf("Error: Division by zero!\n");
|
||||
@@ -177,8 +186,8 @@ void step(CPU *cpu) {
|
||||
break;
|
||||
|
||||
case MOD_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
if (cpu->regs[reg2] == 0) {
|
||||
printf("Error: Modulo by zero!\n");
|
||||
cpu->mode = Error;
|
||||
@@ -189,7 +198,7 @@ void step(CPU *cpu) {
|
||||
break;
|
||||
|
||||
case MOD_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
if (imm == 0) {
|
||||
printf("Error: Modulo by zero!\n");
|
||||
@@ -201,75 +210,75 @@ void step(CPU *cpu) {
|
||||
break;
|
||||
|
||||
case NEG_RN:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] = -((int32_t) cpu->regs[reg1]);
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case AND_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] &= cpu->regs[reg2];
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case AND_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] &= imm;
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case OR_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] |= cpu->regs[reg2];
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case OR_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] |= imm;
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case XOR_RN_RM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] ^= cpu->regs[reg2];
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case XOR_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] ^= imm;
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case NOT_RN:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] = ~cpu->regs[reg1];
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case SHL_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] <<= imm;
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case SHR_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
cpu->regs[reg1] >>= imm; // Logical right shift (assuming unsigned value)
|
||||
set_flags(cpu, cpu->regs[reg1]);
|
||||
break;
|
||||
|
||||
case SAR_RN_IMM:
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
imm = read_mem(cpu, cpu->pc++);
|
||||
// Arithmetic right shift; cast to signed before shifting.
|
||||
cpu->regs[reg1] = ((int32_t) cpu->regs[reg1]) >> imm;
|
||||
@@ -289,8 +298,8 @@ void step(CPU *cpu) {
|
||||
|
||||
case CMP: {
|
||||
// Compare two registers: set flags (Zero, Negative)
|
||||
reg1 = read_reg(cpu);
|
||||
reg2 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
reg2 = read_reg_number(cpu);
|
||||
cmpResult = (int32_t) cpu->regs[reg1] - (int32_t) cpu->regs[reg2];
|
||||
set_flags(cpu, cmpResult);
|
||||
break;
|
||||
@@ -298,7 +307,7 @@ void step(CPU *cpu) {
|
||||
|
||||
case JE_BIT_RN: {
|
||||
// Jump if bit in register set
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
if (reg1 >= REG_COUNT) {
|
||||
reg1 = REG_COUNT - 1;
|
||||
}
|
||||
@@ -342,7 +351,7 @@ void step(CPU *cpu) {
|
||||
|
||||
case JNE_BIT_RN: {
|
||||
// Jump if bit in register set
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
if (reg1 >= REG_COUNT) {
|
||||
reg1 = REG_COUNT - 1;
|
||||
}
|
||||
@@ -437,14 +446,14 @@ void step(CPU *cpu) {
|
||||
|
||||
case PUSH: {
|
||||
// Push register value onto the stack.
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
write_mem(cpu, cpu->sp--, (uint8_t) cpu->regs[reg1]);
|
||||
break;
|
||||
}
|
||||
|
||||
case POP: {
|
||||
// Pop a value from the stack into a register.
|
||||
reg1 = read_reg(cpu);
|
||||
reg1 = read_reg_number(cpu);
|
||||
cpu->regs[reg1] = read_mem(cpu, ++cpu->sp);
|
||||
break;
|
||||
}
|
||||
|
Reference in New Issue
Block a user