Implemented most cpu instructions
This commit is contained in:
332
lib/cpu_proc.c
332
lib/cpu_proc.c
@ -20,6 +20,10 @@ void cpu_set_flags(cpu_context *ctx, u8 z, u8 n, u8 h, u8 c){
|
||||
}
|
||||
}
|
||||
|
||||
static bool is_16_bit(reg_type rt){
|
||||
return rt >= RT_AF;
|
||||
}
|
||||
|
||||
static void proc_none(cpu_context *ctx) {
|
||||
printf("INVALID INSTRUCTION!\n");
|
||||
exit(-7);
|
||||
@ -29,8 +33,304 @@ static void proc_nop(cpu_context *ctx) {
|
||||
|
||||
}
|
||||
|
||||
static void proc_rlca(cpu_context *ctx) {
|
||||
u8 u = ctx->regs.a;
|
||||
bool c = (u >> 7) & 1;
|
||||
u = (u << 1) | c;
|
||||
ctx->regs.a = u;
|
||||
|
||||
cpu_set_flags(ctx, 0, 0, 0, c);
|
||||
}
|
||||
|
||||
static void proc_rrca(cpu_context *ctx) {
|
||||
u8 b = ctx->regs.a & 1;
|
||||
ctx->regs.a >>= 1;
|
||||
ctx->regs.a |= (b << 7);
|
||||
|
||||
cpu_set_flags(ctx, 0, 0, 0, b);
|
||||
}
|
||||
|
||||
static void proc_rla(cpu_context *ctx) {
|
||||
|
||||
}
|
||||
|
||||
static void proc_rra(cpu_context *ctx) {
|
||||
|
||||
}
|
||||
|
||||
static void proc_cb(cpu_context *ctx) {
|
||||
u8 op = ctx->fetched_data;
|
||||
reg_type reg = decode_reg(op & 0b111);
|
||||
u8 bit = (op >> 3) & 0xb111;
|
||||
u8 bit_op = (op >> 6) & 0b11;
|
||||
u8 reg_val = cpu_read_reg8(reg);
|
||||
emu_cycles(1);
|
||||
|
||||
if(reg == RT_HL) {
|
||||
emu_cycles(2);
|
||||
}
|
||||
|
||||
switch(bit_op) {
|
||||
case 1:
|
||||
//BIT
|
||||
cpu_set_flags(ctx, !(reg_val & (1 << bit)), 0, 1, -1);
|
||||
return;
|
||||
|
||||
case 2:
|
||||
//RST
|
||||
reg_val &= ~(1 << bit);
|
||||
cpu_set_reg8(reg, reg_val);
|
||||
return;
|
||||
|
||||
case 3:
|
||||
//set
|
||||
reg_val |= (1 << bit);
|
||||
cpu_set_reg8(reg, reg_val);
|
||||
return;
|
||||
}
|
||||
|
||||
bool flagC = CPU_FLAG_C;
|
||||
|
||||
switch(bit) {
|
||||
case 0: {
|
||||
//RLC
|
||||
bool setC = false;
|
||||
u8 result = (reg_val << 1) & 0xFF;
|
||||
|
||||
if(reg_val & (1 << 7) != 0) {
|
||||
result |= 1;
|
||||
setC = true;
|
||||
}
|
||||
|
||||
cpu_set_reg8(reg, result);
|
||||
cpu_set_flags(ctx, result == 0, 0, 0, setC);
|
||||
} return;
|
||||
|
||||
case 1: {
|
||||
//RRC
|
||||
u8 old = reg_val;
|
||||
reg_val >>= 1;
|
||||
reg_val |= (old << 7);
|
||||
|
||||
cpu_set_reg8(reg, reg_val);
|
||||
cpu_set_flags(ctx, !reg_val, 0, 0, old & 1);
|
||||
} return;
|
||||
|
||||
case 2: {
|
||||
//RL
|
||||
u8 old = reg_val;
|
||||
reg_val <<= 1;
|
||||
reg_val |= flagC;
|
||||
|
||||
cpu_set_reg8(reg, reg_val);
|
||||
cpu_set_flags(ctx, !reg_val, 0, 0, !!(old & 0x80));
|
||||
} return;
|
||||
|
||||
case 3: {
|
||||
//RR
|
||||
u8 old = reg_val;
|
||||
reg_val >>= 1;
|
||||
|
||||
reg_val |= (flagC << 7);
|
||||
cpu_set_reg8(reg, reg_val);
|
||||
cpu_set_flags(ctx, !reg_val, 0, 0, old & 1);
|
||||
} return;
|
||||
|
||||
case 4: {
|
||||
//SLA
|
||||
u8 old = reg_val;
|
||||
reg_val <<= 1;
|
||||
|
||||
cpu_set_reg8(reg, reg_val);
|
||||
cpu_set_flags(ctx, !reg_val, 0, 0, old & 0x80);
|
||||
} return;
|
||||
|
||||
case 5: {
|
||||
//SRA
|
||||
u8 u = (int8_t)reg_val >> 1;
|
||||
cpu_set_reg8(reg, u);
|
||||
cpu_set_flags(ctx, !u, 0, 0, reg_val & 1);
|
||||
} return;
|
||||
|
||||
case 6: {
|
||||
//SWAP
|
||||
reg_val = ((reg_val & 0xF0) >> 4) | ((reg_val & 0xF) << 4);
|
||||
cpu_set_reg8(reg, reg_val);
|
||||
cpu_set_flags(ctx, reg_val == 0, 0, 0, 0);
|
||||
} return;
|
||||
|
||||
case 7: {
|
||||
//SRL
|
||||
u8 u = reg_val >> 1;
|
||||
cpu_set_reg8(reg, u);
|
||||
cpu_set_flags(ctx, !u, 0, 0, reg_val & 1);
|
||||
} return;
|
||||
}
|
||||
|
||||
fprintf(stderr, "ERROR: INVALID CB: %02X\n", op);
|
||||
NO_IMPL
|
||||
}
|
||||
|
||||
reg_type rt_lookup[] = {
|
||||
RT_B,
|
||||
RT_C,
|
||||
RT_D,
|
||||
RT_E,
|
||||
RT_H,
|
||||
RT_L,
|
||||
RT_HL,
|
||||
RT_A
|
||||
};
|
||||
|
||||
reg_type decode_reg(u8 reg) {
|
||||
if (reg > 0b111) {
|
||||
return RT_NONE;
|
||||
}
|
||||
return rt_lookup[reg];
|
||||
}
|
||||
|
||||
static void proc_and(cpu_context *ctx) {
|
||||
ctx->regs.a &= ctx->fetched_data;
|
||||
cpu_set_flags(ctx, ctx->regs.a == 0, 0, 1, 0);
|
||||
}
|
||||
|
||||
static void proc_xor(cpu_context *ctx) {
|
||||
ctx->regs.a ^= ctx->fetched_data & 0xFF;
|
||||
cpu_set_flags(ctx, ctx->regs.a == 0, 0, 0, 0);
|
||||
}
|
||||
|
||||
static void proc_or(cpu_context *ctx) {
|
||||
ctx->regs.a |= ctx->fetched_data & 0xFF;
|
||||
cpu_set_flags(ctx, ctx->regs.a == 0, 0, 0, 0);
|
||||
}
|
||||
|
||||
static void proc_cp(cpu_context *ctx) {
|
||||
int n = (int)ctx->regs.a - (int)ctx->fetched_data;
|
||||
|
||||
cpu_set_flags(ctx, n == 0, 1, ((int)ctx->regs.a & 0x0F) - ((int)ctx->fetched_data & 0x0f) < 0, n < 0);
|
||||
}
|
||||
|
||||
static void proc_sub(cpu_context *ctx) {
|
||||
u16 val = cpu_read_reg(ctx->cur_inst->reg_1) - ctx->fetched_data;
|
||||
|
||||
int z = val == 0;
|
||||
int h = ((int)cpu_read_reg(ctx->cur_inst->reg_1) & 0xF) - ((int)ctx->fetched_data & 0xF) < 0;
|
||||
int c = ((int)cpu_read_reg(ctx->cur_inst->reg_1)) - ((int)ctx->fetched_data) < 0;
|
||||
|
||||
cpu_set_reg(ctx->cur_inst->reg_1, val);
|
||||
cpu_set_flags(ctx, z, 1, h, c);
|
||||
}
|
||||
|
||||
static void proc_sbc(cpu_context *ctx) {
|
||||
u8 val = ctx->fetched_data + CPU_FLAG_C;
|
||||
|
||||
int z = cpu_read_reg(ctx->cur_inst->reg_1) - val == 0;
|
||||
int h = ((int)cpu_read_reg(ctx->cur_inst->reg_1) & 0xF)
|
||||
- ((int)ctx->fetched_data & 0xF) - ((int)CPU_FLAG_C) < 0;
|
||||
int c = ((int)cpu_read_reg(ctx->cur_inst->reg_1))
|
||||
- ((int)ctx->fetched_data) - ((int)CPU_FLAG_C) < 0;
|
||||
|
||||
cpu_set_reg(ctx->cur_inst->reg_1, cpu_read_reg(ctx->cur_inst->reg_1) - val);
|
||||
cpu_set_flags(ctx, z, 1, h, c);
|
||||
}
|
||||
|
||||
static void proc_adc(cpu_context *ctx) {
|
||||
u16 u = ctx->fetched_data;
|
||||
u16 a = ctx->regs.a;
|
||||
u16 c = CPU_FLAG_C;
|
||||
|
||||
ctx->regs.a = (a + u + c) & 0xFF;
|
||||
|
||||
cpu_set_flags(ctx, ctx->regs.a == 0, 0, (a & 0xF) + (u & 0xF) + c > 0xF, a + u + c > 0xFF);
|
||||
}
|
||||
|
||||
static void proc_add(cpu_context *ctx) {
|
||||
u32 val = cpu_read_reg(ctx->cur_inst->reg_1) + ctx->fetched_data;
|
||||
|
||||
bool is_16bit = is_16_bit(ctx->cur_inst->reg_1);
|
||||
|
||||
if(is_16bit) {
|
||||
emu_cycles(1);
|
||||
}
|
||||
|
||||
if(ctx->cur_inst->reg_1 == RT_SP) {
|
||||
val = cpu_read_reg(ctx->cur_inst->reg_1) + (char)ctx->fetched_data;
|
||||
}
|
||||
|
||||
int z = (val & 0xFF) == 0;
|
||||
int h = (cpu_read_reg(ctx->cur_inst->reg_1) & 0xF) + (ctx->fetched_data & 0xF) >= 0x10;
|
||||
int c = (int)(cpu_read_reg(ctx->cur_inst->reg_1) & 0xFF) + (int)(ctx->fetched_data & 0xFF) >= 0x100;
|
||||
|
||||
if (is_16bit) {
|
||||
z = -1;
|
||||
h = (cpu_read_reg(ctx->cur_inst->reg_1) & 0xFFF) + (ctx->fetched_data & 0xFFF) >= 0x1000;
|
||||
u32 n = ((u32)cpu_read_reg(ctx->cur_inst->reg_1)) + ((u32)ctx->fetched_data);
|
||||
c = n >= 0x10000;
|
||||
}
|
||||
|
||||
if(ctx->cur_inst->reg_1 == RT_SP) {
|
||||
z = 0;
|
||||
h = (cpu_read_reg(ctx->cur_inst->reg_1) & 0xF) + (ctx->fetched_data & 0xF) >= 0x10;
|
||||
c = (int)(cpu_read_reg(ctx->cur_inst->reg_1) & 0xFF) + (int)(ctx->fetched_data & 0xFF) > 0x100;
|
||||
}
|
||||
|
||||
cpu_set_reg(ctx->cur_inst->reg_1, val & 0xFFFF);
|
||||
cpu_set_flags(ctx, z, 0, h, c);
|
||||
}
|
||||
|
||||
static void proc_inc(cpu_context *ctx) {
|
||||
u16 val = cpu_read_reg(ctx->cur_inst->reg_1) + 1;
|
||||
|
||||
if(is_16_bit(ctx->cur_inst->reg_1)) {
|
||||
emu_cycles(1);
|
||||
}
|
||||
|
||||
if (ctx->cur_inst->reg_1 == RT_HL && ctx->dest_is_mem) {
|
||||
val = bus_read(cpu_read_reg(RT_HL)) + 1;
|
||||
val &= 0xFF;
|
||||
bus_write(cpu_read_reg(RT_HL), val);
|
||||
} else {
|
||||
cpu_set_reg(ctx->cur_inst->reg_1, val);
|
||||
val = cpu_read_reg(ctx->cur_inst->reg_1);
|
||||
}
|
||||
|
||||
if((ctx->cur_opcode & 0x03) == 0x03) {
|
||||
return;
|
||||
}
|
||||
|
||||
cpu_set_flags(ctx, val == 0, 0, (val & 0x0F), -1);
|
||||
}
|
||||
|
||||
static void proc_dec(cpu_context *ctx) {
|
||||
u16 val = cpu_read_reg(ctx->cur_inst->reg_1) - 1;
|
||||
|
||||
if(is_16_bit(ctx->cur_inst->reg_1)) {
|
||||
emu_cycles(1);
|
||||
}
|
||||
|
||||
if (ctx->cur_inst->reg_1 == RT_HL && ctx->dest_is_mem) {
|
||||
val = bus_read(cpu_read_reg(RT_HL)) - 1;
|
||||
val &= 0xFF;
|
||||
bus_write(cpu_read_reg(RT_HL), val);
|
||||
} else {
|
||||
cpu_set_reg(ctx->cur_inst->reg_1, val);
|
||||
val = cpu_read_reg(ctx->cur_inst->reg_1);
|
||||
}
|
||||
|
||||
if((ctx->cur_opcode & 0x0B) == 0x0B) {
|
||||
return;
|
||||
}
|
||||
|
||||
cpu_set_flags(ctx, val == 0, 1, (val & 0x0F) == 0x0F, -1);
|
||||
}
|
||||
|
||||
static void proc_pop(cpu_context *ctx) {
|
||||
u16 n = stack_pop16();
|
||||
u16 lo = stack_pop();
|
||||
emu_cycles(1);
|
||||
u16 hi = stack_pop();
|
||||
emu_cycles(1);
|
||||
|
||||
u16 n = (hi << 8) | lo;
|
||||
cpu_set_reg(ctx->cur_inst->reg_1, n);
|
||||
emu_cycles(2);
|
||||
|
||||
@ -40,8 +340,11 @@ static void proc_pop(cpu_context *ctx) {
|
||||
}
|
||||
|
||||
static void proc_push(cpu_context *ctx) {
|
||||
stack_push16(cpu_read_reg(ctx->cur_inst->reg_1));
|
||||
emu_cycles(2);
|
||||
u16 val = cpu_read_reg(ctx->cur_inst->reg_1);
|
||||
stack_push((val >> 8) & 0xFF);
|
||||
emu_cycles(1);
|
||||
stack_push((val & 0xFF));
|
||||
emu_cycles(1);
|
||||
}
|
||||
|
||||
static void proc_ldh(cpu_context *ctx) {
|
||||
@ -53,18 +356,13 @@ static void proc_ldh(cpu_context *ctx) {
|
||||
emu_cycles(1);
|
||||
}
|
||||
|
||||
static void proc_xor(cpu_context *ctx) {
|
||||
ctx->regs.a ^= ctx->fetched_data & 0XFF;
|
||||
cpu_set_flags(ctx, ctx->regs.a == 0, 0, 0, 0);
|
||||
}
|
||||
|
||||
static void proc_di(cpu_context *ctx) {
|
||||
ctx->int_master_enabled = false;
|
||||
}
|
||||
|
||||
static void proc_ld(cpu_context *ctx) {
|
||||
if(ctx->dest_is_mem) {
|
||||
if(ctx->cur_inst->reg_2 >= RT_AF) {
|
||||
if(is_16_bit(ctx->cur_inst->reg_2)) {
|
||||
bus_write16(ctx->mem_dest, ctx->fetched_data);
|
||||
emu_cycles(1);
|
||||
} else {
|
||||
@ -144,7 +442,7 @@ static void proc_reti(cpu_context *ctx) {
|
||||
}
|
||||
|
||||
static void proc_jr(cpu_context *ctx) {
|
||||
char rel = (char)(ctx->fetched_data & 0XFF);
|
||||
int8_t rel = (int8_t)(ctx->fetched_data & 0XFF);
|
||||
u16 addr = ctx->regs.pc + rel;
|
||||
goto_addr(ctx, addr, false);
|
||||
}
|
||||
@ -155,7 +453,6 @@ IN_PROC processors[] = {
|
||||
[IN_LD] = proc_ld,
|
||||
[IN_JP] = proc_jp,
|
||||
[IN_DI] = proc_di,
|
||||
[IN_XOR] = proc_xor,
|
||||
[IN_LDH] = proc_ldh,
|
||||
[IN_POP] = proc_pop,
|
||||
[IN_PUSH] = proc_push,
|
||||
@ -163,7 +460,18 @@ IN_PROC processors[] = {
|
||||
[IN_JR] = proc_jr,
|
||||
[IN_RET] = proc_ret,
|
||||
[IN_RETI] = proc_reti,
|
||||
[IN_RST] = proc_rst
|
||||
[IN_RST] = proc_rst,
|
||||
[IN_INC] = proc_inc,
|
||||
[IN_DEC] = proc_dec,
|
||||
[IN_ADD] = proc_add,
|
||||
[IN_ADC] = proc_adc,
|
||||
[IN_SBC] = proc_sbc,
|
||||
[IN_SUB] = proc_sub,
|
||||
[IN_AND] = proc_and,
|
||||
[IN_XOR] = proc_xor,
|
||||
[IN_OR] = proc_or,
|
||||
[IN_CP] = proc_cp,
|
||||
[IN_CB] = proc_cb
|
||||
};
|
||||
|
||||
IN_PROC inst_get_processor(in_type type) {
|
||||
|
||||
Reference in New Issue
Block a user