xfb loop copy finished

core/broadway/instructions.cpp

@@ -3,6 +3,8 @@
 #include <mem.hpp>
 
 namespace weee::core {
+void broadway::add(ircolib::u32 instr) { gpr[utils::RD(instr)] = gpr[utils::RA(instr)] + gpr[utils::RB(instr)]; }
+
 void broadway::addi(ircolib::u32 instr) {
     if (utils::RA(instr) == 0) { // lis
         gpr[utils::RD(instr)] = ircolib::s32(utils::SIMM(instr));
@@ -77,41 +79,38 @@ void broadway::bcx(ircolib::u32 instr) {
     pc = bd;
 }
 
-void broadway::move_spr(ircolib::u32 instr) {
-    const size_t spr_field = (instr >> 12) & 0x3FF;
-    const size_t direction = (instr >> 1) & 0x3FF;
-
-    if (direction == 339) {
-        switch (spr_field) {
-        case 0x80:
-            gpr[utils::RD(instr)] = lr;
-            break;
-        case 0x90:
-            gpr[utils::RD(instr)] = ctr;
-            break;
-        default:
-            ircolib::panic("broadway::mfspr with unimplemented spr field of value {}", spr_field);
-        }
-
-        return;
+void broadway::mfspr(ircolib::u32 instr) {
+    const size_t spr_field = (instr >> 11) & 0x3FF;
+    switch (spr_field) {
+    case 0b0000100000:
+        gpr[utils::RD(instr)] = xer.raw;
+        break;
+    case 0b0100000000:
+        gpr[utils::RD(instr)] = lr;
+        break;
+    case 0b0100100000:
+        gpr[utils::RD(instr)] = ctr;
+        break;
+    default:
+        ircolib::panic("broadway::mfspr with unimplemented spr field of value 0x{:04X}", spr_field);
     }
+}
 
-    if (direction == 467) {
-        switch (spr_field) {
-        case 0x80:
-            lr = gpr[utils::RS(instr)];
-            break;
-        case 0x90:
-            ctr = gpr[utils::RS(instr)];
-            break;
-        default:
-            ircolib::panic("broadway::mtspr with unimplemented spr field of value {}", spr_field);
-        }
-
-        return;
+void broadway::mtspr(ircolib::u32 instr) {
+    const size_t spr_field = (instr >> 11) & 0x3FF;
+    switch (spr_field) {
+    case 0b0000100000:
+        xer.raw = gpr[utils::RS(instr)];
+        break;
+    case 0b0100000000:
+        lr = gpr[utils::RS(instr)];
+        break;
+    case 0b0100100000:
+        ctr = gpr[utils::RS(instr)];
+        break;
+    default:
+        ircolib::panic("broadway::mtspr with unimplemented spr field of value 0x{:04X}", spr_field);
     }
-
-    ircolib::panic("broadway::move_spr with unknown sub op {}", direction);
 }
 
 void broadway::stwu(ircolib::u32 instr, mem &mem) {
@@ -151,4 +150,92 @@ void broadway::lwz(ircolib::u32 instr, mem &mem) {
     ircolib::u32 ea = ircolib::s32(b) + utils::SIMM(instr);
     gpr[utils::RD(instr)] = mem.read32(ea);
 }
+
+void broadway::bclrx(ircolib::u32 instr) {
+    const bool link = instr & 1;
+
+    ircolib::s32 bd = lr & 0xFFFFFFFC;
+
+    if (!ircolib::is_bit_set<ircolib::u32, 25>(instr)) {
+        if (!ircolib::is_bit_set<ircolib::u32, 24>(instr))
+            ircolib::panic("broadway::bclrx unimplemented variants with bit 24 == 0");
+
+        if (!ircolib::is_bit_set<ircolib::u32, 23>(instr))
+            ircolib::panic("broadway::bclrx unimplemented variants with bit 23 == 0");
+
+        const ircolib::u8 bi = (instr >> 16) & 0x1f;
+
+        if (ircolib::is_bit_set(cr, 32 - bi)) {
+            if (link)
+                lr = pc;
+
+            pc = bd;
+        }
+
+        return;
+    }
+
+    if (ircolib::is_bit_set<ircolib::u32, 23>(instr)) { // always
+        if (link)
+            lr = pc;
+
+        pc = bd;
+        return;
+    }
+
+    if (ircolib::is_bit_set<ircolib::u32, 22>(instr)) { // --ctr == 0
+        if (--ctr != 0)
+            return;
+
+        if (link)
+            lr = pc;
+
+        pc = bd;
+        return;
+    }
+
+    // --ctr != 0
+    if (--ctr == 0)
+        return;
+
+    if (link)
+        lr = pc;
+
+    pc = bd;
+}
+
+void broadway::cmpi(ircolib::u32 instr) {
+    const ircolib::s32 a = gpr[utils::RA(instr)];
+    const ircolib::s32 simm = utils::SIMM(instr);
+    ircolib::u8 c;
+    if (a < simm)
+        c = 0b001;
+    else if (a > simm)
+        c = 0b010;
+    else
+        c = 0b100;
+
+    const ircolib::u32 result = ((xer.so << 3) | c) << (28 - 4 * utils::crfD(instr));
+    cr &= ~(0xffff << (28 - 4 * utils::crfD(instr)));
+    cr |= result;
+}
+
+void broadway::rlwinm(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;
+
+    r &= ~((0xFFFF'FFFF >> mb) << me);
+    gpr[utils::RA(instr)] = 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");
+
+    const ircolib::u32 EA = ircolib::s32(gpr[utils::RA(instr)]) + utils::SIMM(instr);
+    gpr[utils::RD(instr)] = mem.read32(EA);
+    gpr[utils::RA(instr)] = EA;
+}
 } // namespace weee::core