Move CPU around
This commit is contained in:
+479
@@ -0,0 +1,479 @@
|
||||
use crate::opcodes::Opcode;
|
||||
use crate::opcodes::InvalidOpcode;
|
||||
use crate::memory::Memory;
|
||||
use crate::address::Address;
|
||||
use crate::memory::PeekPoke;
|
||||
use std::convert::TryFrom;
|
||||
|
||||
struct CPU {
|
||||
memory: Memory, // Main memory, all of it
|
||||
pc: Address, // program counter, address of the low byte of the instruction
|
||||
dp: Address, // data pointer, address of the low byte of one cell above the data stack
|
||||
sp: Address, // stack pointer, address of the low byte of the return stack
|
||||
iv: Address, // interrupt vector
|
||||
int_enabled: bool, // interrupt enable bit
|
||||
halted: bool, // Whether the CPU is halted
|
||||
}
|
||||
|
||||
#[derive(Copy, Clone, Eq, PartialEq, Debug)]
|
||||
struct Instruction {
|
||||
opcode: Opcode,
|
||||
arg: Option<u32>,
|
||||
length: u8
|
||||
}
|
||||
|
||||
impl CPU {
|
||||
fn new(memory: Memory) -> Self {
|
||||
Self {
|
||||
memory,
|
||||
pc: 1024.into(),
|
||||
dp: 256.into(),
|
||||
sp: 1024.into(),
|
||||
iv: 1024.into(),
|
||||
int_enabled: false,
|
||||
halted: true,
|
||||
}
|
||||
}
|
||||
|
||||
fn reset(&mut self) {
|
||||
self.pc = 1024.into();
|
||||
self.dp = 256.into();
|
||||
self.sp = 1024.into();
|
||||
self.iv = 1024.into();
|
||||
self.int_enabled = false;
|
||||
self.halted = true;
|
||||
}
|
||||
|
||||
fn push_data<A: Into<u32>>(&mut self, word: A) {
|
||||
self.memory.poke24(self.dp, word.into());
|
||||
self.dp += 3;
|
||||
}
|
||||
|
||||
fn push_call<A: Into<u32>>(&mut self, word: A) {
|
||||
self.sp -= 3;
|
||||
self.memory.poke24(self.sp, word.into());
|
||||
}
|
||||
|
||||
fn pop_data(&mut self) -> u32 {
|
||||
self.dp -= 3;
|
||||
self.memory.peek24(self.dp)
|
||||
}
|
||||
|
||||
fn pop_call(&mut self) -> u32 {
|
||||
let val = self.memory.peek24(self.sp);
|
||||
self.sp += 3;
|
||||
val
|
||||
}
|
||||
|
||||
fn peek_call(&self) -> u32 {
|
||||
self.memory.peek24(self.sp)
|
||||
}
|
||||
|
||||
fn peek_data(&self) -> u32 {
|
||||
self.memory.peek24(self.dp - 3)
|
||||
}
|
||||
|
||||
fn fetch(&self) -> Result<Instruction, InvalidOpcode> {
|
||||
let instruction = self.memory.peek(self.pc);
|
||||
match Opcode::try_from(instruction >> 2) {
|
||||
Ok(opcode) => {
|
||||
let arg_length = instruction & 3;
|
||||
if arg_length == 0 {
|
||||
Ok(Instruction {
|
||||
opcode: opcode,
|
||||
arg: None,
|
||||
length: 1
|
||||
})
|
||||
} else {
|
||||
let mut arg = 0u32;
|
||||
for n in 0..arg_length {
|
||||
let mut b: u32 = self.memory.peek(self.pc + (n + 1) as i32) as u32;
|
||||
b = b << (8 * n);
|
||||
arg += b;
|
||||
}
|
||||
Ok(Instruction {
|
||||
opcode: opcode,
|
||||
arg: Some(arg),
|
||||
length: arg_length + 1
|
||||
})
|
||||
}
|
||||
},
|
||||
Err(e) => Err(e)
|
||||
}
|
||||
}
|
||||
|
||||
fn execute(&mut self, instruction: Instruction) -> Address {
|
||||
if let Some(arg) = instruction.arg {
|
||||
self.push_data(arg)
|
||||
}
|
||||
|
||||
if instruction.opcode.is_binary() {
|
||||
let x = self.pop_data();
|
||||
let y = self.pop_data();
|
||||
|
||||
match instruction.opcode {
|
||||
Opcode::Add => { self.push_data(x + y) }
|
||||
Opcode::Sub => { self.push_data(y - x) }
|
||||
Opcode::Mul => { self.push_data(y * x) }
|
||||
Opcode::Div => { self.push_data(y / x) }
|
||||
Opcode::Mod => { self.push_data(y % x) }
|
||||
Opcode::And => { self.push_data(y & x) }
|
||||
Opcode::Or => { self.push_data(y | x) }
|
||||
Opcode::Xor => { self.push_data(y ^ x) }
|
||||
Opcode::Gt => { self.push_data(bool_as_word(y > x)) }
|
||||
Opcode::Lt => { self.push_data(bool_as_word(y < x)) }
|
||||
Opcode::Agt => { self.push_data(bool_as_word(word_as_signed(y) > word_as_signed(x))) }
|
||||
Opcode::Alt => { self.push_data(bool_as_word(word_as_signed(y) < word_as_signed(x))) }
|
||||
Opcode::Lshift => { self.push_data(y << x) }
|
||||
Opcode::Rshift => { self.push_data(y >> x) }
|
||||
Opcode::Arshift => {
|
||||
if y & 0x800000 != 0 {
|
||||
let mut shifted = y;
|
||||
for _ in 0..x {
|
||||
shifted = shifted >> 1 | 0x800000;
|
||||
}
|
||||
self.push_data(shifted)
|
||||
} else {
|
||||
self.push_data(y >> x)
|
||||
}
|
||||
}
|
||||
Opcode::Swap => {
|
||||
self.push_data(x);
|
||||
self.push_data(y)
|
||||
}
|
||||
Opcode::Store => { self.memory.poke(x, y as u8) }
|
||||
Opcode::Storew => { self.memory.poke24(x, y) }
|
||||
Opcode::Setsdp => {
|
||||
self.dp = x.into();
|
||||
self.sp = y.into()
|
||||
}
|
||||
Opcode::Brz => { if y == 0 { return self.pc + word_as_signed(x) } }
|
||||
Opcode::Brnz => { if y != 0 { return self.pc + word_as_signed(x) } }
|
||||
_ => {} // This can never happen
|
||||
}
|
||||
self.pc + instruction.length as i32
|
||||
} else {
|
||||
match instruction.opcode {
|
||||
Opcode::Nop => { /* No action required */ }
|
||||
Opcode::Rand => {} // TODO remove this whole instruction
|
||||
Opcode::Not => {
|
||||
let x = self.pop_data();
|
||||
self.push_data(bool_as_word(x == 0))
|
||||
}
|
||||
Opcode::Pop => { self.pop_data(); }
|
||||
Opcode::Dup => { self.push_data(self.peek_data()) }
|
||||
Opcode::Pick => {
|
||||
let index = self.pop_data();
|
||||
let val = self.memory.peek24(self.dp - (index as i32 + 1) * 3);
|
||||
self.push_data(val)
|
||||
}
|
||||
Opcode::Rot => {
|
||||
let x = self.pop_data();
|
||||
let y = self.pop_data();
|
||||
let z = self.pop_data();
|
||||
self.push_data(y);
|
||||
self.push_data(x);
|
||||
self.push_data(z)
|
||||
}
|
||||
Opcode::Jmp => { return self.pop_data().into() }
|
||||
Opcode::Jmpr => {
|
||||
let x = word_as_signed(self.pop_data());
|
||||
return self.pc + x
|
||||
}
|
||||
Opcode::Call => {
|
||||
let x = self.pop_data();
|
||||
self.push_call(self.pc + instruction.length as i32);
|
||||
return x.into()
|
||||
}
|
||||
Opcode::Ret => { return self.pop_call().into() }
|
||||
Opcode::Hlt => { self.halted = true }
|
||||
Opcode::Load => {
|
||||
let x = self.pop_data();
|
||||
self.push_data(self.memory.peek(x) as u32)
|
||||
}
|
||||
Opcode::Loadw => {
|
||||
let x = self.pop_data();
|
||||
self.push_data(self.memory.peek24(x))
|
||||
}
|
||||
Opcode::Inton => { self.int_enabled = true }
|
||||
Opcode::Intoff => { self.int_enabled = false }
|
||||
Opcode::Setiv => { self.iv = self.pop_data().into() }
|
||||
Opcode::Sdp => {
|
||||
self.push_data(self.sp);
|
||||
self.push_data(self.dp + 3) // The +3 accounts for the word we're about to push
|
||||
}
|
||||
Opcode::Pushr => {
|
||||
let x = self.pop_data();
|
||||
self.push_call(x)
|
||||
}
|
||||
Opcode::Popr => {
|
||||
let r = self.pop_call();
|
||||
self.push_data(r)
|
||||
}
|
||||
Opcode::Peekr => {
|
||||
let r = self.peek_call();
|
||||
self.push_data(r)
|
||||
}
|
||||
Opcode::Debug => { /* TODO This should print the stack or something */ }
|
||||
_ => {} // This can never happen
|
||||
}
|
||||
self.pc + instruction.length as i32
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
impl Opcode {
|
||||
fn is_binary(self) -> bool {
|
||||
use Opcode::*;
|
||||
self != Nop && self != Not && self != Rand && self != Pop && self != Dup && self != Pick &&
|
||||
self != Rot && self != Jmp && self != Jmpr && self != Call && self != Ret &&
|
||||
self != Hlt && self != Load && self != Loadw && self != Inton && self != Intoff &&
|
||||
self != Setiv && self != Sdp && self != Pushr && self != Popr && self != Peekr &&
|
||||
self != Debug
|
||||
}
|
||||
}
|
||||
|
||||
fn word_as_signed(word: u32) -> i32 {
|
||||
if word & 0x800000 != 0 {
|
||||
-(((word ^ 0xffffff) + 1) as i32)
|
||||
} else {
|
||||
word as i32
|
||||
}
|
||||
}
|
||||
|
||||
fn bool_as_word(flag: bool) -> u32 { if flag { 1 } else { 0 } }
|
||||
|
||||
#[cfg(test)]
|
||||
mod tests {
|
||||
use super::*;
|
||||
use Opcode::*;
|
||||
|
||||
impl CPU {
|
||||
fn get_stack(&self) -> Vec<u32> {
|
||||
let mut v = Vec::new();
|
||||
let mut curr = Address::from(256);
|
||||
while curr < self.dp {
|
||||
v.push(self.memory.peek24(curr));
|
||||
curr += 3
|
||||
}
|
||||
v
|
||||
}
|
||||
|
||||
fn get_call(&self) -> Vec<u32> {
|
||||
let mut v = Vec::new();
|
||||
let mut curr = Address::from(1024);
|
||||
while curr > self.sp {
|
||||
curr -= 3;
|
||||
v.push(self.memory.peek24(curr));
|
||||
}
|
||||
v
|
||||
}
|
||||
}
|
||||
|
||||
fn predicate_opcode_test<P, Q>(opcode: Opcode, given: P, pred: Q) where P: FnOnce(&mut CPU), Q: FnOnce(&CPU)
|
||||
{
|
||||
let mut cpu = CPU::new(Memory::default());
|
||||
given(&mut cpu);
|
||||
let new_pc = cpu.execute(Instruction{ opcode: opcode, arg: None, length: 1 });
|
||||
cpu.pc = new_pc;
|
||||
pred(&mut cpu)
|
||||
}
|
||||
|
||||
fn simple_opcode_test(given: Vec<u32>, opcode: Opcode, expected: Vec<u32>) {
|
||||
predicate_opcode_test(opcode, |cpu| {
|
||||
for i in given.into_iter() { cpu.push_data(i) }
|
||||
}, |cpu| {
|
||||
assert_eq!(cpu.get_stack(), expected)
|
||||
})
|
||||
}
|
||||
|
||||
fn call_stack_opcode_test(given: Vec<u32>, given_r: Vec<u32>, opcode: Opcode, expected: Vec<u32>, expected_r: Vec<u32>, pc: Address) {
|
||||
predicate_opcode_test(opcode, |cpu| {
|
||||
for i in given.into_iter() { cpu.push_data(i) }
|
||||
for i in given_r.into_iter() { cpu.push_call(i) }
|
||||
}, |cpu| {
|
||||
assert_eq!(cpu.get_stack(), expected);
|
||||
assert_eq!(cpu.get_call(), expected_r);
|
||||
assert_eq!(pc, cpu.pc)
|
||||
})
|
||||
}
|
||||
|
||||
fn control_flow_opcode_test<A>(given: Vec<u32>, opcode: Opcode, expected_pc: A) where A: Into<Address> {
|
||||
predicate_opcode_test(opcode, |cpu| {
|
||||
for i in given.into_iter() { cpu.push_data(i) }
|
||||
}, |cpu| {
|
||||
assert_eq!(cpu.pc, expected_pc.into())
|
||||
})
|
||||
}
|
||||
|
||||
fn memory_opcode_test(given: Vec<u32>, given_memory: Vec<u8>, opcode: Opcode, expected: Vec<u32>, expected_memory: Option<Vec<u8>>) {
|
||||
predicate_opcode_test(opcode,
|
||||
|cpu| {
|
||||
for i in given.into_iter() { cpu.push_data(i) }
|
||||
for (offset, byte) in given_memory.into_iter().enumerate() {
|
||||
cpu.memory.poke(Address::from(2048 + offset as u32), byte)
|
||||
}
|
||||
},
|
||||
|cpu| {
|
||||
if let Some(expected_memory) = expected_memory {
|
||||
for (offset, byte) in expected_memory.into_iter().enumerate() {
|
||||
let actual = cpu.memory.peek(Address::from(2048 + offset as u32));
|
||||
assert_eq!(byte, actual, "At address 2048 + {}", offset)
|
||||
}
|
||||
assert_eq!(cpu.get_stack(), expected)
|
||||
}
|
||||
})
|
||||
}
|
||||
|
||||
fn to_word(val: i32) -> u32 {
|
||||
if val >= 0 {
|
||||
val as u32
|
||||
} else {
|
||||
((-val ^ 0xffffff) + 1) as u32
|
||||
}
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_arithmetic() {
|
||||
simple_opcode_test(vec![5, 3], Add, vec![8]);
|
||||
simple_opcode_test(vec![5, 3], Sub, vec![2]);
|
||||
simple_opcode_test(vec![5, 3], Mul, vec![15]);
|
||||
simple_opcode_test(vec![8, 3], Div, vec![2]);
|
||||
simple_opcode_test(vec![10, 3], Mod, vec![1]);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_stack_manipulation() {
|
||||
simple_opcode_test(vec![5], Dup, vec![5, 5]);
|
||||
simple_opcode_test(vec![5, 3], Swap, vec![3, 5]);
|
||||
simple_opcode_test(vec![10, 20, 30, 2], Pick, vec![10, 20, 30, 10]);
|
||||
simple_opcode_test(vec![1, 4, 9], Rot, vec![4, 9, 1]);
|
||||
simple_opcode_test(vec![1, 4, 9], Pop, vec![1, 4]);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_basic_ops() {
|
||||
control_flow_opcode_test(vec![], Nop, 1025);
|
||||
simple_opcode_test(vec![2], Nop, vec![2]);
|
||||
predicate_opcode_test(Hlt, |_| { }, |cpu| { assert!(cpu.halted) })
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_branching_jumping() {
|
||||
control_flow_opcode_test(vec![1234], Jmp, 1234);
|
||||
control_flow_opcode_test(vec![35], Jmpr, 1024 + 35);
|
||||
control_flow_opcode_test(vec![to_word(-3)], Jmpr, 1024 - 3);
|
||||
control_flow_opcode_test(vec![0, 35], Brnz, 1024 + 1);
|
||||
control_flow_opcode_test(vec![17, 35], Brnz, 1024 + 35);
|
||||
control_flow_opcode_test(vec![5, 35], Brz, 1024 + 1);
|
||||
control_flow_opcode_test(vec![0, 35], Brz, 1024 + 35);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_memory() {
|
||||
memory_opcode_test(vec![2048], vec![123], Load, vec![123], None);
|
||||
memory_opcode_test(vec![2048], vec![0x12, 0x34, 0x56], Loadw, vec![0x123456], None);
|
||||
memory_opcode_test(vec![100, 2048], vec![0x12, 0x34, 0x56], Store, vec![], Some(vec![100, 0x34, 0x56]));
|
||||
memory_opcode_test(vec![0x112233, 2048], vec![0x12, 0x34, 0x56], Storew, vec![], Some(vec![0x33, 0x22, 0x11]));
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_logic() {
|
||||
simple_opcode_test(vec![0b111100, 0b001111], And, vec![0b001100]);
|
||||
simple_opcode_test(vec![0b100, 0b001], Or, vec![0b101]);
|
||||
simple_opcode_test(vec![0b101, 0b011], Xor, vec![0b110]);
|
||||
simple_opcode_test(vec![5], Not, vec![0]);
|
||||
simple_opcode_test(vec![0], Not, vec![1]);
|
||||
simple_opcode_test(vec![5, 3], Gt, vec![1]);
|
||||
simple_opcode_test(vec![5, 7], Gt, vec![0]);
|
||||
simple_opcode_test(vec![5, 3], Lt, vec![0]);
|
||||
simple_opcode_test(vec![5, 7], Lt, vec![1]);
|
||||
simple_opcode_test(vec![5, to_word(-3)], Agt, vec![1]);
|
||||
simple_opcode_test(vec![5, 10], Agt, vec![0]);
|
||||
simple_opcode_test(vec![5, to_word(-3)], Alt, vec![0]);
|
||||
simple_opcode_test(vec![5, 10], Alt, vec![1]);
|
||||
simple_opcode_test(vec![0b1100, 2], Rshift, vec![3]);
|
||||
simple_opcode_test(vec![0b1100, 2], Lshift, vec![0b110000]);
|
||||
simple_opcode_test(vec![0x800010, 2], Arshift, vec![0xe00004]);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_call_stack() {
|
||||
call_stack_opcode_test(vec![5000], vec![], Call, vec![], vec![1025], 5000.into());
|
||||
call_stack_opcode_test(vec![], vec![5000], Ret, vec![], vec![], 5000.into());
|
||||
call_stack_opcode_test(vec![], vec![], Sdp, vec![1024, 256 + 6], vec![], 1025.into());
|
||||
predicate_opcode_test(Setsdp,
|
||||
|cpu| {
|
||||
cpu.push_data(1000u32);
|
||||
cpu.push_data(2000u32)
|
||||
},
|
||||
|cpu| {
|
||||
assert_eq!(cpu.sp, 1000.into());
|
||||
assert_eq!(cpu.dp, 2000.into())
|
||||
});
|
||||
call_stack_opcode_test(vec![123], vec![], Pushr, vec![], vec![123], 1025.into());
|
||||
call_stack_opcode_test(vec![], vec![123], Popr, vec![123], vec![], 1025.into());
|
||||
call_stack_opcode_test(vec![], vec![123], Peekr, vec![123], vec![123], 1025.into());
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_new() {
|
||||
let cpu = CPU::new(Memory::default());
|
||||
assert_eq!(cpu.pc, 1024.into());
|
||||
assert_eq!(cpu.halted, true);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_reset() {
|
||||
let mut cpu = CPU::new(Memory::default());
|
||||
cpu.iv = 12345.into();
|
||||
cpu.reset();
|
||||
assert_eq!(cpu.iv, 1024.into());
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_stacks() {
|
||||
let mut cpu = CPU::new(Memory::default());
|
||||
cpu.push_data(37u32);
|
||||
cpu.push_data(45u32);
|
||||
assert_eq!(cpu.memory.peek24(256), 37);
|
||||
assert_eq!(cpu.memory.peek24(259), 45);
|
||||
|
||||
cpu.push_call(12u32);
|
||||
cpu.push_call(34u32);
|
||||
assert_eq!(cpu.memory.peek24(cpu.sp), 34);
|
||||
assert_eq!(cpu.memory.peek24(cpu.sp + 3), 12);
|
||||
assert_eq!(cpu.sp, (1024 - 6).into());
|
||||
assert_eq!(cpu.dp, (256 + 6).into());
|
||||
|
||||
assert_eq!(cpu.pop_data(), 45);
|
||||
assert_eq!(cpu.pop_data(), 37);
|
||||
assert_eq!(cpu.dp, 256.into());
|
||||
|
||||
assert_eq!(cpu.pop_call(), 34);
|
||||
assert_eq!(cpu.pop_call(), 12);
|
||||
assert_eq!(cpu.sp, 1024.into());
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_fetch() {
|
||||
let mut cpu = CPU::new(Memory::default());
|
||||
cpu.memory.poke(0x400, 0x01); // nop 1 arg
|
||||
cpu.memory.poke(0x401, 0x02); // 2
|
||||
cpu.memory.poke(0x402, 0x07); // add 3 arg
|
||||
cpu.memory.poke24(0x403, 0x123456); // 3-byte arg
|
||||
cpu.memory.poke(0x406, 29 << 2); // hlt
|
||||
cpu.memory.poke(0x407, 0xfc); // gibberish
|
||||
|
||||
assert_eq!(cpu.fetch(), Ok(Instruction { opcode: Opcode::Nop, arg: Some(2), length: 2 }));
|
||||
|
||||
cpu.pc = 0x402.into();
|
||||
assert_eq!(cpu.fetch(), Ok(Instruction { opcode: Opcode::Add, arg: Some(0x123456), length: 4 }));
|
||||
|
||||
cpu.pc = 0x406.into();
|
||||
assert_eq!(cpu.fetch(), Ok(Instruction { opcode: Opcode::Hlt, arg: None, length: 1 }));
|
||||
|
||||
cpu.pc = 0x407.into();
|
||||
assert_eq!(cpu.fetch(), Err(InvalidOpcode(0x3f)));
|
||||
}
|
||||
}
|
||||
+1
-480
@@ -1,486 +1,7 @@
|
||||
mod memory;
|
||||
mod address;
|
||||
mod opcodes;
|
||||
|
||||
use memory::Memory;
|
||||
use memory::PeekPoke;
|
||||
use address::Address;
|
||||
use opcodes::Opcode;
|
||||
use crate::opcodes::InvalidOpcode;
|
||||
use std::convert::TryFrom;
|
||||
|
||||
struct CPU {
|
||||
memory: Memory, // Main memory, all of it
|
||||
pc: Address, // program counter, address of the low byte of the instruction
|
||||
dp: Address, // data pointer, address of the low byte of one cell above the data stack
|
||||
sp: Address, // stack pointer, address of the low byte of the return stack
|
||||
iv: Address, // interrupt vector
|
||||
int_enabled: bool, // interrupt enable bit
|
||||
halted: bool, // Whether the CPU is halted
|
||||
}
|
||||
|
||||
#[derive(Copy, Clone, Eq, PartialEq, Debug)]
|
||||
struct Instruction {
|
||||
opcode: Opcode,
|
||||
arg: Option<u32>,
|
||||
length: u8
|
||||
}
|
||||
|
||||
impl CPU {
|
||||
fn new(memory: Memory) -> Self {
|
||||
Self {
|
||||
memory,
|
||||
pc: 1024.into(),
|
||||
dp: 256.into(),
|
||||
sp: 1024.into(),
|
||||
iv: 1024.into(),
|
||||
int_enabled: false,
|
||||
halted: true,
|
||||
}
|
||||
}
|
||||
|
||||
fn reset(&mut self) {
|
||||
self.pc = 1024.into();
|
||||
self.dp = 256.into();
|
||||
self.sp = 1024.into();
|
||||
self.iv = 1024.into();
|
||||
self.int_enabled = false;
|
||||
self.halted = true;
|
||||
}
|
||||
|
||||
fn push_data<A: Into<u32>>(&mut self, word: A) {
|
||||
self.memory.poke24(self.dp, word.into());
|
||||
self.dp += 3;
|
||||
}
|
||||
|
||||
fn push_call<A: Into<u32>>(&mut self, word: A) {
|
||||
self.sp -= 3;
|
||||
self.memory.poke24(self.sp, word.into());
|
||||
}
|
||||
|
||||
fn pop_data(&mut self) -> u32 {
|
||||
self.dp -= 3;
|
||||
self.memory.peek24(self.dp)
|
||||
}
|
||||
|
||||
fn pop_call(&mut self) -> u32 {
|
||||
let val = self.memory.peek24(self.sp);
|
||||
self.sp += 3;
|
||||
val
|
||||
}
|
||||
|
||||
fn peek_call(&self) -> u32 {
|
||||
self.memory.peek24(self.sp)
|
||||
}
|
||||
|
||||
fn peek_data(&self) -> u32 {
|
||||
self.memory.peek24(self.dp - 3)
|
||||
}
|
||||
|
||||
fn fetch(&self) -> Result<Instruction, InvalidOpcode> {
|
||||
let instruction = self.memory.peek(self.pc);
|
||||
match Opcode::try_from(instruction >> 2) {
|
||||
Ok(opcode) => {
|
||||
let arg_length = instruction & 3;
|
||||
if arg_length == 0 {
|
||||
Ok(Instruction {
|
||||
opcode: opcode,
|
||||
arg: None,
|
||||
length: 1
|
||||
})
|
||||
} else {
|
||||
let mut arg = 0u32;
|
||||
for n in 0..arg_length {
|
||||
let mut b: u32 = self.memory.peek(self.pc + (n + 1) as i32) as u32;
|
||||
b = b << (8 * n);
|
||||
arg += b;
|
||||
}
|
||||
Ok(Instruction {
|
||||
opcode: opcode,
|
||||
arg: Some(arg),
|
||||
length: arg_length + 1
|
||||
})
|
||||
}
|
||||
},
|
||||
Err(e) => Err(e)
|
||||
}
|
||||
}
|
||||
|
||||
fn execute(&mut self, instruction: Instruction) -> Address {
|
||||
if let Some(arg) = instruction.arg {
|
||||
self.push_data(arg)
|
||||
}
|
||||
|
||||
if instruction.opcode.is_binary() {
|
||||
let x = self.pop_data();
|
||||
let y = self.pop_data();
|
||||
|
||||
match instruction.opcode {
|
||||
Opcode::Add => { self.push_data(x + y) }
|
||||
Opcode::Sub => { self.push_data(y - x) }
|
||||
Opcode::Mul => { self.push_data(y * x) }
|
||||
Opcode::Div => { self.push_data(y / x) }
|
||||
Opcode::Mod => { self.push_data(y % x) }
|
||||
Opcode::And => { self.push_data(y & x) }
|
||||
Opcode::Or => { self.push_data(y | x) }
|
||||
Opcode::Xor => { self.push_data(y ^ x) }
|
||||
Opcode::Gt => { self.push_data(bool_as_word(y > x)) }
|
||||
Opcode::Lt => { self.push_data(bool_as_word(y < x)) }
|
||||
Opcode::Agt => { self.push_data(bool_as_word(word_as_signed(y) > word_as_signed(x))) }
|
||||
Opcode::Alt => { self.push_data(bool_as_word(word_as_signed(y) < word_as_signed(x))) }
|
||||
Opcode::Lshift => { self.push_data(y << x) }
|
||||
Opcode::Rshift => { self.push_data(y >> x) }
|
||||
Opcode::Arshift => {
|
||||
if y & 0x800000 != 0 {
|
||||
let mut shifted = y;
|
||||
for _ in 0..x {
|
||||
shifted = shifted >> 1 | 0x800000;
|
||||
}
|
||||
self.push_data(shifted)
|
||||
} else {
|
||||
self.push_data(y >> x)
|
||||
}
|
||||
}
|
||||
Opcode::Swap => {
|
||||
self.push_data(x);
|
||||
self.push_data(y)
|
||||
}
|
||||
Opcode::Store => { self.memory.poke(x, y as u8) }
|
||||
Opcode::Storew => { self.memory.poke24(x, y) }
|
||||
Opcode::Setsdp => {
|
||||
self.dp = x.into();
|
||||
self.sp = y.into()
|
||||
}
|
||||
Opcode::Brz => { if y == 0 { return self.pc + word_as_signed(x) } }
|
||||
Opcode::Brnz => { if y != 0 { return self.pc + word_as_signed(x) } }
|
||||
_ => {} // This can never happen
|
||||
}
|
||||
self.pc + instruction.length as i32
|
||||
} else {
|
||||
match instruction.opcode {
|
||||
Opcode::Nop => { /* No action required */ }
|
||||
Opcode::Rand => {} // TODO remove this whole instruction
|
||||
Opcode::Not => {
|
||||
let x = self.pop_data();
|
||||
self.push_data(bool_as_word(x == 0))
|
||||
}
|
||||
Opcode::Pop => { self.pop_data(); }
|
||||
Opcode::Dup => { self.push_data(self.peek_data()) }
|
||||
Opcode::Pick => {
|
||||
let index = self.pop_data();
|
||||
let val = self.memory.peek24(self.dp - (index as i32 + 1) * 3);
|
||||
self.push_data(val)
|
||||
}
|
||||
Opcode::Rot => {
|
||||
let x = self.pop_data();
|
||||
let y = self.pop_data();
|
||||
let z = self.pop_data();
|
||||
self.push_data(y);
|
||||
self.push_data(x);
|
||||
self.push_data(z)
|
||||
}
|
||||
Opcode::Jmp => { return self.pop_data().into() }
|
||||
Opcode::Jmpr => {
|
||||
let x = word_as_signed(self.pop_data());
|
||||
return self.pc + x
|
||||
}
|
||||
Opcode::Call => {
|
||||
let x = self.pop_data();
|
||||
self.push_call(self.pc + instruction.length as i32);
|
||||
return x.into()
|
||||
}
|
||||
Opcode::Ret => { return self.pop_call().into() }
|
||||
Opcode::Hlt => { self.halted = true }
|
||||
Opcode::Load => {
|
||||
let x = self.pop_data();
|
||||
self.push_data(self.memory.peek(x) as u32)
|
||||
}
|
||||
Opcode::Loadw => {
|
||||
let x = self.pop_data();
|
||||
self.push_data(self.memory.peek24(x))
|
||||
}
|
||||
Opcode::Inton => { self.int_enabled = true }
|
||||
Opcode::Intoff => { self.int_enabled = false }
|
||||
Opcode::Setiv => { self.iv = self.pop_data().into() }
|
||||
Opcode::Sdp => {
|
||||
self.push_data(self.sp);
|
||||
self.push_data(self.dp + 3) // The +3 accounts for the word we're about to push
|
||||
}
|
||||
Opcode::Pushr => {
|
||||
let x = self.pop_data();
|
||||
self.push_call(x)
|
||||
}
|
||||
Opcode::Popr => {
|
||||
let r = self.pop_call();
|
||||
self.push_data(r)
|
||||
}
|
||||
Opcode::Peekr => {
|
||||
let r = self.peek_call();
|
||||
self.push_data(r)
|
||||
}
|
||||
Opcode::Debug => { /* TODO This should print the stack or something */ }
|
||||
_ => {} // This can never happen
|
||||
}
|
||||
self.pc + instruction.length as i32
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
impl Opcode {
|
||||
fn is_binary(self) -> bool {
|
||||
use Opcode::*;
|
||||
self != Nop && self != Not && self != Rand && self != Pop && self != Dup && self != Pick &&
|
||||
self != Rot && self != Jmp && self != Jmpr && self != Call && self != Ret &&
|
||||
self != Hlt && self != Load && self != Loadw && self != Inton && self != Intoff &&
|
||||
self != Setiv && self != Sdp && self != Pushr && self != Popr && self != Peekr &&
|
||||
self != Debug
|
||||
}
|
||||
}
|
||||
|
||||
fn word_as_signed(word: u32) -> i32 {
|
||||
if word & 0x800000 != 0 {
|
||||
-(((word ^ 0xffffff) + 1) as i32)
|
||||
} else {
|
||||
word as i32
|
||||
}
|
||||
}
|
||||
|
||||
fn bool_as_word(flag: bool) -> u32 { if flag { 1 } else { 0 } }
|
||||
|
||||
#[cfg(test)]
|
||||
mod tests {
|
||||
use super::*;
|
||||
use Opcode::*;
|
||||
|
||||
impl CPU {
|
||||
fn get_stack(&self) -> Vec<u32> {
|
||||
let mut v = Vec::new();
|
||||
let mut curr = Address::from(256);
|
||||
while curr < self.dp {
|
||||
v.push(self.memory.peek24(curr));
|
||||
curr += 3
|
||||
}
|
||||
v
|
||||
}
|
||||
|
||||
fn get_call(&self) -> Vec<u32> {
|
||||
let mut v = Vec::new();
|
||||
let mut curr = Address::from(1024);
|
||||
while curr > self.sp {
|
||||
curr -= 3;
|
||||
v.push(self.memory.peek24(curr));
|
||||
}
|
||||
v
|
||||
}
|
||||
}
|
||||
|
||||
fn predicate_opcode_test<P, Q>(opcode: Opcode, given: P, pred: Q) where P: FnOnce(&mut CPU), Q: FnOnce(&CPU)
|
||||
{
|
||||
let mut cpu = CPU::new(Memory::default());
|
||||
given(&mut cpu);
|
||||
let new_pc = cpu.execute(Instruction{ opcode: opcode, arg: None, length: 1 });
|
||||
cpu.pc = new_pc;
|
||||
pred(&mut cpu)
|
||||
}
|
||||
|
||||
fn simple_opcode_test(given: Vec<u32>, opcode: Opcode, expected: Vec<u32>) {
|
||||
predicate_opcode_test(opcode, |cpu| {
|
||||
for i in given.into_iter() { cpu.push_data(i) }
|
||||
}, |cpu| {
|
||||
assert_eq!(cpu.get_stack(), expected)
|
||||
})
|
||||
}
|
||||
|
||||
fn call_stack_opcode_test(given: Vec<u32>, given_r: Vec<u32>, opcode: Opcode, expected: Vec<u32>, expected_r: Vec<u32>, pc: Address) {
|
||||
predicate_opcode_test(opcode, |cpu| {
|
||||
for i in given.into_iter() { cpu.push_data(i) }
|
||||
for i in given_r.into_iter() { cpu.push_call(i) }
|
||||
}, |cpu| {
|
||||
assert_eq!(cpu.get_stack(), expected);
|
||||
assert_eq!(cpu.get_call(), expected_r);
|
||||
assert_eq!(pc, cpu.pc)
|
||||
})
|
||||
}
|
||||
|
||||
fn control_flow_opcode_test<A>(given: Vec<u32>, opcode: Opcode, expected_pc: A) where A: Into<Address> {
|
||||
predicate_opcode_test(opcode, |cpu| {
|
||||
for i in given.into_iter() { cpu.push_data(i) }
|
||||
}, |cpu| {
|
||||
assert_eq!(cpu.pc, expected_pc.into())
|
||||
})
|
||||
}
|
||||
|
||||
fn memory_opcode_test(given: Vec<u32>, given_memory: Vec<u8>, opcode: Opcode, expected: Vec<u32>, expected_memory: Option<Vec<u8>>) {
|
||||
predicate_opcode_test(opcode,
|
||||
|cpu| {
|
||||
for i in given.into_iter() { cpu.push_data(i) }
|
||||
for (offset, byte) in given_memory.into_iter().enumerate() {
|
||||
cpu.memory.poke(Address::from(2048 + offset as u32), byte)
|
||||
}
|
||||
},
|
||||
|cpu| {
|
||||
if let Some(expected_memory) = expected_memory {
|
||||
for (offset, byte) in expected_memory.into_iter().enumerate() {
|
||||
let actual = cpu.memory.peek(Address::from(2048 + offset as u32));
|
||||
assert_eq!(byte, actual, "At address 2048 + {}", offset)
|
||||
}
|
||||
assert_eq!(cpu.get_stack(), expected)
|
||||
}
|
||||
})
|
||||
}
|
||||
|
||||
fn to_word(val: i32) -> u32 {
|
||||
if val >= 0 {
|
||||
val as u32
|
||||
} else {
|
||||
((-val ^ 0xffffff) + 1) as u32
|
||||
}
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_arithmetic() {
|
||||
simple_opcode_test(vec![5, 3], Add, vec![8]);
|
||||
simple_opcode_test(vec![5, 3], Sub, vec![2]);
|
||||
simple_opcode_test(vec![5, 3], Mul, vec![15]);
|
||||
simple_opcode_test(vec![8, 3], Div, vec![2]);
|
||||
simple_opcode_test(vec![10, 3], Mod, vec![1]);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_stack_manipulation() {
|
||||
simple_opcode_test(vec![5], Dup, vec![5, 5]);
|
||||
simple_opcode_test(vec![5, 3], Swap, vec![3, 5]);
|
||||
simple_opcode_test(vec![10, 20, 30, 2], Pick, vec![10, 20, 30, 10]);
|
||||
simple_opcode_test(vec![1, 4, 9], Rot, vec![4, 9, 1]);
|
||||
simple_opcode_test(vec![1, 4, 9], Pop, vec![1, 4]);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_basic_ops() {
|
||||
control_flow_opcode_test(vec![], Nop, 1025);
|
||||
simple_opcode_test(vec![2], Nop, vec![2]);
|
||||
predicate_opcode_test(Hlt, |_| { }, |cpu| { assert!(cpu.halted) })
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_branching_jumping() {
|
||||
control_flow_opcode_test(vec![1234], Jmp, 1234);
|
||||
control_flow_opcode_test(vec![35], Jmpr, 1024 + 35);
|
||||
control_flow_opcode_test(vec![to_word(-3)], Jmpr, 1024 - 3);
|
||||
control_flow_opcode_test(vec![0, 35], Brnz, 1024 + 1);
|
||||
control_flow_opcode_test(vec![17, 35], Brnz, 1024 + 35);
|
||||
control_flow_opcode_test(vec![5, 35], Brz, 1024 + 1);
|
||||
control_flow_opcode_test(vec![0, 35], Brz, 1024 + 35);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_memory() {
|
||||
memory_opcode_test(vec![2048], vec![123], Load, vec![123], None);
|
||||
memory_opcode_test(vec![2048], vec![0x12, 0x34, 0x56], Loadw, vec![0x123456], None);
|
||||
memory_opcode_test(vec![100, 2048], vec![0x12, 0x34, 0x56], Store, vec![], Some(vec![100, 0x34, 0x56]));
|
||||
memory_opcode_test(vec![0x112233, 2048], vec![0x12, 0x34, 0x56], Storew, vec![], Some(vec![0x33, 0x22, 0x11]));
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_logic() {
|
||||
simple_opcode_test(vec![0b111100, 0b001111], And, vec![0b001100]);
|
||||
simple_opcode_test(vec![0b100, 0b001], Or, vec![0b101]);
|
||||
simple_opcode_test(vec![0b101, 0b011], Xor, vec![0b110]);
|
||||
simple_opcode_test(vec![5], Not, vec![0]);
|
||||
simple_opcode_test(vec![0], Not, vec![1]);
|
||||
simple_opcode_test(vec![5, 3], Gt, vec![1]);
|
||||
simple_opcode_test(vec![5, 7], Gt, vec![0]);
|
||||
simple_opcode_test(vec![5, 3], Lt, vec![0]);
|
||||
simple_opcode_test(vec![5, 7], Lt, vec![1]);
|
||||
simple_opcode_test(vec![5, to_word(-3)], Agt, vec![1]);
|
||||
simple_opcode_test(vec![5, 10], Agt, vec![0]);
|
||||
simple_opcode_test(vec![5, to_word(-3)], Alt, vec![0]);
|
||||
simple_opcode_test(vec![5, 10], Alt, vec![1]);
|
||||
simple_opcode_test(vec![0b1100, 2], Rshift, vec![3]);
|
||||
simple_opcode_test(vec![0b1100, 2], Lshift, vec![0b110000]);
|
||||
simple_opcode_test(vec![0x800010, 2], Arshift, vec![0xe00004]);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_call_stack() {
|
||||
call_stack_opcode_test(vec![5000], vec![], Call, vec![], vec![1025], 5000.into());
|
||||
call_stack_opcode_test(vec![], vec![5000], Ret, vec![], vec![], 5000.into());
|
||||
call_stack_opcode_test(vec![], vec![], Sdp, vec![1024, 256 + 6], vec![], 1025.into());
|
||||
predicate_opcode_test(Setsdp,
|
||||
|cpu| {
|
||||
cpu.push_data(1000u32);
|
||||
cpu.push_data(2000u32)
|
||||
},
|
||||
|cpu| {
|
||||
assert_eq!(cpu.sp, 1000.into());
|
||||
assert_eq!(cpu.dp, 2000.into())
|
||||
});
|
||||
call_stack_opcode_test(vec![123], vec![], Pushr, vec![], vec![123], 1025.into());
|
||||
call_stack_opcode_test(vec![], vec![123], Popr, vec![123], vec![], 1025.into());
|
||||
call_stack_opcode_test(vec![], vec![123], Peekr, vec![123], vec![123], 1025.into());
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_new() {
|
||||
let cpu = CPU::new(Memory::default());
|
||||
assert_eq!(cpu.pc, 1024.into());
|
||||
assert_eq!(cpu.halted, true);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_reset() {
|
||||
let mut cpu = CPU::new(Memory::default());
|
||||
cpu.iv = 12345.into();
|
||||
cpu.reset();
|
||||
assert_eq!(cpu.iv, 1024.into());
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_stacks() {
|
||||
let mut cpu = CPU::new(Memory::default());
|
||||
cpu.push_data(37u32);
|
||||
cpu.push_data(45u32);
|
||||
assert_eq!(cpu.memory.peek24(256), 37);
|
||||
assert_eq!(cpu.memory.peek24(259), 45);
|
||||
|
||||
cpu.push_call(12u32);
|
||||
cpu.push_call(34u32);
|
||||
assert_eq!(cpu.memory.peek24(cpu.sp), 34);
|
||||
assert_eq!(cpu.memory.peek24(cpu.sp + 3), 12);
|
||||
assert_eq!(cpu.sp, (1024 - 6).into());
|
||||
assert_eq!(cpu.dp, (256 + 6).into());
|
||||
|
||||
assert_eq!(cpu.pop_data(), 45);
|
||||
assert_eq!(cpu.pop_data(), 37);
|
||||
assert_eq!(cpu.dp, 256.into());
|
||||
|
||||
assert_eq!(cpu.pop_call(), 34);
|
||||
assert_eq!(cpu.pop_call(), 12);
|
||||
assert_eq!(cpu.sp, 1024.into());
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn test_cpu_fetch() {
|
||||
let mut cpu = CPU::new(Memory::default());
|
||||
cpu.memory.poke(0x400, 0x01); // nop 1 arg
|
||||
cpu.memory.poke(0x401, 0x02); // 2
|
||||
cpu.memory.poke(0x402, 0x07); // add 3 arg
|
||||
cpu.memory.poke24(0x403, 0x123456); // 3-byte arg
|
||||
cpu.memory.poke(0x406, 29 << 2); // hlt
|
||||
cpu.memory.poke(0x407, 0xfc); // gibberish
|
||||
|
||||
assert_eq!(cpu.fetch(), Ok(Instruction { opcode: Opcode::Nop, arg: Some(2), length: 2 }));
|
||||
|
||||
cpu.pc = 0x402.into();
|
||||
assert_eq!(cpu.fetch(), Ok(Instruction { opcode: Opcode::Add, arg: Some(0x123456), length: 4 }));
|
||||
|
||||
cpu.pc = 0x406.into();
|
||||
assert_eq!(cpu.fetch(), Ok(Instruction { opcode: Opcode::Hlt, arg: None, length: 1 }));
|
||||
|
||||
cpu.pc = 0x407.into();
|
||||
assert_eq!(cpu.fetch(), Err(InvalidOpcode(0x3f)));
|
||||
}
|
||||
}
|
||||
mod cpu;
|
||||
|
||||
fn main() {
|
||||
println!("Hello, world!");
|
||||
|
||||
Reference in New Issue
Block a user