Compare commits
2 Commits
8886ca2e61
...
2f3213f693
Author | SHA1 | Date |
---|---|---|
Rekai Nyangadzayi Musuka | 2f3213f693 | |
Rekai Nyangadzayi Musuka | a62cd9aa40 |
|
@ -139,7 +139,7 @@ pub fn arithmeticRight(comptime S: bool, cpsr: *CPSR, rm: u32, total_amount: u8)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
std.debug.panic("[BarrelShifter] implement arithmetic shift right", .{});
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn rotateRight(comptime S: bool, cpsr: *CPSR, rm: u32, total_amount: u8) u32 {
|
pub fn rotateRight(comptime S: bool, cpsr: *CPSR, rm: u32, total_amount: u8) u32 {
|
||||||
|
|
|
@ -10,6 +10,7 @@ pub fn dataProcessing(comptime I: bool, comptime S: bool, comptime instrKind: u4
|
||||||
fn inner(cpu: *Arm7tdmi, _: *Bus, opcode: u32) void {
|
fn inner(cpu: *Arm7tdmi, _: *Bus, opcode: u32) void {
|
||||||
const rd = opcode >> 12 & 0xF;
|
const rd = opcode >> 12 & 0xF;
|
||||||
const rn = opcode >> 16 & 0xF;
|
const rn = opcode >> 16 & 0xF;
|
||||||
|
const old_carry = @boolToInt(cpu.cpsr.c.read());
|
||||||
|
|
||||||
const op1 = if (rn == 0xF) cpu.fakePC() else cpu.r[rn];
|
const op1 = if (rn == 0xF) cpu.fakePC() else cpu.r[rn];
|
||||||
|
|
||||||
|
@ -49,11 +50,10 @@ pub fn dataProcessing(comptime I: bool, comptime S: bool, comptime instrKind: u4
|
||||||
},
|
},
|
||||||
0x5 => {
|
0x5 => {
|
||||||
// ADC
|
// ADC
|
||||||
const carry = @boolToInt(cpu.cpsr.c.read());
|
|
||||||
var result: u32 = undefined;
|
var result: u32 = undefined;
|
||||||
|
|
||||||
const did = @addWithOverflow(u32, op1, op2, &result);
|
const did = @addWithOverflow(u32, op1, op2, &result);
|
||||||
const overflow = @addWithOverflow(u32, result, carry, &result);
|
const overflow = @addWithOverflow(u32, result, old_carry, &result);
|
||||||
cpu.r[rd] = result;
|
cpu.r[rd] = result;
|
||||||
|
|
||||||
if (S and rd != 0xF) {
|
if (S and rd != 0xF) {
|
||||||
|
@ -63,6 +63,20 @@ pub fn dataProcessing(comptime I: bool, comptime S: bool, comptime instrKind: u4
|
||||||
cpu.cpsr.v.write(((op1 ^ result) & (op2 ^ result)) >> 31 & 1 == 1);
|
cpu.cpsr.v.write(((op1 ^ result) & (op2 ^ result)) >> 31 & 1 == 1);
|
||||||
}
|
}
|
||||||
},
|
},
|
||||||
|
0x6 => {
|
||||||
|
// SBC
|
||||||
|
// TODO: Make your own
|
||||||
|
const subtrahend = @as(u64, op2) - old_carry + 1;
|
||||||
|
const result = @truncate(u32, op1 -% subtrahend);
|
||||||
|
cpu.r[rd] = result;
|
||||||
|
|
||||||
|
if (S and rd != 0xF) {
|
||||||
|
cpu.cpsr.n.write(result >> 31 & 1 == 1);
|
||||||
|
cpu.cpsr.z.write(result == 0);
|
||||||
|
cpu.cpsr.c.write(subtrahend <= op1);
|
||||||
|
cpu.cpsr.v.write(((op1 ^ result) & (~op2 ^ result)) >> 31 & 1 == 1);
|
||||||
|
}
|
||||||
|
},
|
||||||
0x8 => {
|
0x8 => {
|
||||||
// TST
|
// TST
|
||||||
const result = op1 & op2;
|
const result = op1 & op2;
|
||||||
|
|
Loading…
Reference in New Issue