i need to start caring about carry >.<
This commit is contained in:
@@ -17,6 +17,15 @@ void broadway::addi(ircolib::u32 instr) {
|
||||
gpr[utils::RD(instr)] = gpr[utils::RA(instr)] + (ircolib::s32(utils::SIMM(instr)));
|
||||
}
|
||||
|
||||
void broadway::addicr(ircolib::u32 instr) {
|
||||
gpr[utils::RD(instr)] = gpr[utils::RA(instr)] + (ircolib::s32(utils::SIMM(instr)));
|
||||
cr0_update(true, gpr[utils::RD(instr)]);
|
||||
}
|
||||
|
||||
void broadway::addic(ircolib::u32 instr) {
|
||||
gpr[utils::RD(instr)] = gpr[utils::RA(instr)] + (ircolib::s32(utils::SIMM(instr)));
|
||||
}
|
||||
|
||||
void broadway::addis(ircolib::u32 instr) {
|
||||
if (utils::RA(instr) == 0) { // lis
|
||||
gpr[utils::RD(instr)] = ircolib::s32(utils::SIMM(instr)) << 16;
|
||||
@@ -188,6 +197,20 @@ void broadway::stw(ircolib::u32 instr, mem &mem) {
|
||||
});
|
||||
}
|
||||
|
||||
void broadway::stb(ircolib::u32 instr, mem &mem) {
|
||||
ircolib::s32 b = gpr[utils::RA(instr)];
|
||||
if (utils::RA(instr) == 0)
|
||||
b = 0;
|
||||
|
||||
const ircolib::u32 EA = b + utils::SIMM(instr);
|
||||
auto _ = mem.write8(EA, gpr[utils::RS(instr)])
|
||||
.and_then([&] { return std::expected<void, std::string>(); })
|
||||
.or_else([&](std::string e) {
|
||||
ircolib::panic("stw broadway write failed. Reason: {} (pc: 0x{:08X})", e, pc - 4);
|
||||
return std::expected<void, std::string>();
|
||||
});
|
||||
}
|
||||
|
||||
void broadway::sth(ircolib::u32 instr, mem &mem) {
|
||||
ircolib::u32 b = gpr[utils::RA(instr)];
|
||||
if (utils::RA(instr) == 0)
|
||||
@@ -203,6 +226,20 @@ void broadway::sth(ircolib::u32 instr, mem &mem) {
|
||||
});
|
||||
}
|
||||
|
||||
void broadway::stwx(ircolib::u32 instr, mem &mem) {
|
||||
ircolib::u32 b = gpr[utils::RA(instr)];
|
||||
if (utils::RA(instr) == 0)
|
||||
b = 0;
|
||||
|
||||
const ircolib::u32 EA = b + gpr[utils::RB(instr)];
|
||||
auto _ = mem.write32(EA, gpr[utils::RS(instr)])
|
||||
.and_then([&] { return std::expected<void, std::string>(); })
|
||||
.or_else([&](std::string e) {
|
||||
ircolib::panic("stwx broadway write failed. Reason: {} (pc: 0x{:08X})", e, pc - 4);
|
||||
return std::expected<void, std::string>();
|
||||
});
|
||||
}
|
||||
|
||||
void broadway::lwz(ircolib::u32 instr, mem &mem) {
|
||||
ircolib::u32 b = gpr[utils::RA(instr)];
|
||||
if (utils::RA(instr) == 0)
|
||||
@@ -213,7 +250,39 @@ void broadway::lwz(ircolib::u32 instr, mem &mem) {
|
||||
gpr[utils::RD(instr)] = mem.read32(ea)
|
||||
.and_then([&](ircolib::u32 val) { return std::expected<ircolib::u32, std::string>(val); })
|
||||
.or_else([&](std::string e) {
|
||||
ircolib::panic("broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
ircolib::panic("lwz broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
return std::expected<ircolib::u32, std::string>();
|
||||
})
|
||||
.value();
|
||||
}
|
||||
|
||||
void broadway::lwzx(ircolib::u32 instr, mem &mem) {
|
||||
ircolib::u32 b = gpr[utils::RA(instr)];
|
||||
if (utils::RA(instr) == 0)
|
||||
b = 0;
|
||||
|
||||
ircolib::u32 ea = ircolib::s32(b) + gpr[utils::RB(instr)];
|
||||
|
||||
gpr[utils::RD(instr)] = mem.read32(ea)
|
||||
.and_then([&](ircolib::u32 val) { return std::expected<ircolib::u32, std::string>(val); })
|
||||
.or_else([&](std::string e) {
|
||||
ircolib::panic("lwz broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
return std::expected<ircolib::u32, std::string>();
|
||||
})
|
||||
.value();
|
||||
}
|
||||
|
||||
void broadway::lhz(ircolib::u32 instr, mem &mem) {
|
||||
ircolib::u32 b = gpr[utils::RA(instr)];
|
||||
if (utils::RA(instr) == 0)
|
||||
b = 0;
|
||||
|
||||
ircolib::u32 ea = ircolib::s32(b) + utils::SIMM(instr);
|
||||
|
||||
gpr[utils::RD(instr)] = mem.read16(ea)
|
||||
.and_then([&](ircolib::u32 val) { return std::expected<ircolib::u32, std::string>(val); })
|
||||
.or_else([&](std::string e) {
|
||||
ircolib::panic("lhz broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
return std::expected<ircolib::u32, std::string>();
|
||||
})
|
||||
.value();
|
||||
@@ -229,7 +298,7 @@ void broadway::lbz(ircolib::u32 instr, mem &mem) {
|
||||
gpr[utils::RD(instr)] = mem.read8(ea)
|
||||
.and_then([&](ircolib::u32 val) { return std::expected<ircolib::u32, std::string>(val); })
|
||||
.or_else([&](std::string e) {
|
||||
ircolib::panic("broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
ircolib::panic("lbz broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
return std::expected<ircolib::u32, std::string>();
|
||||
})
|
||||
.value();
|
||||
@@ -246,7 +315,7 @@ void broadway::lfd(ircolib::u32 instr, mem &mem) {
|
||||
mem.read64(ea)
|
||||
.and_then([&](ircolib::u64 val) { return std::expected<ircolib::u64, std::string>(val); })
|
||||
.or_else([&](std::string e) {
|
||||
ircolib::panic("broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
ircolib::panic("lfd broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
return std::expected<ircolib::u64, std::string>();
|
||||
})
|
||||
.value();
|
||||
@@ -337,6 +406,23 @@ void broadway::rlwinm(ircolib::u32 instr) {
|
||||
cr0_update(instr & 1, r);
|
||||
}
|
||||
|
||||
void broadway::rlwimi(ircolib::u32 instr) {
|
||||
const ircolib::u8 sh = (instr >> 11) & 0x1f;
|
||||
ircolib::u32 r = std::rotl(gpr[utils::RS(instr)], sh);
|
||||
const ircolib::u8 mb = (instr >> 6) & 0x1f;
|
||||
const ircolib::u8 me = (instr >> 1) & 0x1f;
|
||||
const ircolib::u32 start = 0xffffffff >> mb;
|
||||
const ircolib::u32 end = 0x7fffffff >> me;
|
||||
ircolib::u32 mask = start ^ end;
|
||||
if (mb > me)
|
||||
mask = ~mask;
|
||||
|
||||
r &= mask;
|
||||
r |= (gpr[utils::RA(instr)] & ~mask);
|
||||
gpr[utils::RA(instr)] = r;
|
||||
cr0_update(instr & 1, r);
|
||||
}
|
||||
|
||||
void broadway::lwzu(ircolib::u32 instr, mem &mem) {
|
||||
if (utils::RA(instr) == 0 || utils::RA(instr) == utils::RD(instr))
|
||||
ircolib::panic("broadway::lwzu with ra == 0");
|
||||
@@ -348,7 +434,7 @@ void broadway::lwzu(ircolib::u32 instr, mem &mem) {
|
||||
return std::expected<ircolib::u32, std::string>(val);
|
||||
})
|
||||
.or_else([&](std::string e) {
|
||||
ircolib::panic("broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
ircolib::panic("lwzu broadway read failed. Reason {} (pc: 0x{:08X})", e, pc - 4);
|
||||
return std::expected<ircolib::u32, std::string>();
|
||||
})
|
||||
.value();
|
||||
@@ -365,6 +451,18 @@ void broadway::andi(ircolib::u32 instr) {
|
||||
cr0_update(true, result);
|
||||
}
|
||||
|
||||
void broadway::andis(ircolib::u32 instr) {
|
||||
const ircolib::s32 result = gpr[utils::RS(instr)] & (ircolib::u32(utils::UIMM(instr)) << 16);
|
||||
gpr[utils::RA(instr)] = result;
|
||||
cr0_update(true, result);
|
||||
}
|
||||
|
||||
void broadway::and(ircolib::u32 instr) {
|
||||
const ircolib::s32 result = gpr[utils::RS(instr)] & gpr[utils::RB(instr)];
|
||||
gpr[utils::RA(instr)] = result;
|
||||
cr0_update(instr & 1, result);
|
||||
}
|
||||
|
||||
void broadway::mtfsf(ircolib::u32 instr) {
|
||||
const ircolib::u8 fm = (instr >> 17) & 0xff;
|
||||
ircolib::u8 mask = 0;
|
||||
@@ -395,6 +493,7 @@ void broadway::mtfsb1(ircolib::u32 instr) {
|
||||
}
|
||||
|
||||
void broadway::mfmsr(ircolib::u32 instr) { gpr[utils::RS(instr)] = msr; }
|
||||
void broadway::mtmsr(ircolib::u32 instr) { msr = gpr[utils::RS(instr)]; }
|
||||
|
||||
void broadway::nand(ircolib::u32 instr) {
|
||||
gpr[utils::RA(instr)] = ~(gpr[utils::RS(instr)] & gpr[utils::RB(instr)]);
|
||||
@@ -410,4 +509,38 @@ void broadway:: or (ircolib::u32 instr) {
|
||||
gpr[utils::RA(instr)] = gpr[utils::RS(instr)] | gpr[utils::RB(instr)];
|
||||
cr0_update(instr & 1, gpr[utils::RA(instr)]);
|
||||
}
|
||||
|
||||
void broadway::mullw(ircolib::u32 instr) {
|
||||
gpr[utils::RD(instr)] = ircolib::u64(gpr[utils::RA(instr)]) * ircolib::u64(gpr[utils::RB(instr)]);
|
||||
}
|
||||
|
||||
void broadway::mulli(ircolib::u32 instr) {
|
||||
gpr[utils::RD(instr)] = ircolib::u64(gpr[utils::RA(instr)]) * ircolib::u64(utils::SIMM(instr));
|
||||
}
|
||||
|
||||
void broadway::mfcr(ircolib::u32 instr) { gpr[utils::RD(instr)] = cr; }
|
||||
|
||||
void broadway::mtcrf(ircolib::u32 instr) {
|
||||
ircolib::u32 mask = 0;
|
||||
const ircolib::u8 crm = (instr >> 13) & 0xff;
|
||||
for (int i = 0; i < 7; i++) {
|
||||
if (ircolib::is_bit_set(crm, i)) {
|
||||
set_cr(gpr[utils::RS(instr)] & (0xffff << i * 4), i);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void broadway::divwu(ircolib::u32 instr) {
|
||||
ircolib::u32 dividend = gpr[utils::RA(instr)];
|
||||
ircolib::u32 divisor = gpr[utils::RB(instr)];
|
||||
if (divisor == 0) {
|
||||
if ((instr >> 11) & 1)
|
||||
xer.ov = true;
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
gpr[utils::RD(instr)] = dividend / divisor;
|
||||
cr0_update(instr & 1, gpr[utils::RD(instr)]);
|
||||
}
|
||||
} // namespace weee::core
|
||||
|
||||
Reference in New Issue
Block a user