chore: organize io switch statements

SRAM is mirrored in 64K chunks
TODO: According to GBATEK SRAM chips are 32K and mirrored

src/Bus.zig

@@ -13,6 +13,8 @@ const Allocator = std.mem.Allocator;
 const log = std.log.scoped(.Bus);
 const Self = @This();
 
+const panic_on_und_bus: bool = false;
+
 pak: GamePak,
 bios: Bios,
 ppu: Ppu,
@@ -27,7 +29,7 @@ pub fn init(alloc: Allocator, sched: *Scheduler, rom_path: []const u8, maybe_bio
         .ppu = try Ppu.init(alloc, sched),
         .iwram = try Iwram.init(alloc),
         .ewram = try Ewram.init(alloc),
-        .io = Io.init(),
+        .io = Io.init(sched),
     };
 }
 
@@ -57,7 +59,7 @@ pub fn read32(self: *const Self, addr: u32) u32 {
         0x0A00_0000...0x0BFF_FFFF => self.pak.get32(addr - 0x0A00_0000),
         0x0C00_0000...0x0DFF_FFFF => self.pak.get32(addr - 0x0C00_0000),
 
-        else => failedRead("Tried to read from 0x{X:0>8}", .{addr}),
+        else => undRead("Tried to read from 0x{X:0>8}", .{addr}),
     };
 }
 
@@ -75,7 +77,7 @@ pub fn write32(self: *Self, addr: u32, word: u32) void {
         0x0600_0000...0x0601_7FFF => self.ppu.vram.set32(addr - 0x0600_0000, word),
         0x0700_0000...0x07FF_FFFF => self.ppu.oam.set32(addr & 0x3FF, word),
 
-        else => log.warn("Tried to write 0x{X:0>8} to 0x{X:0>8}", .{ word, addr }),
+        else => undWrite("Tried to write 0x{X:0>8} to 0x{X:0>8}", .{ word, addr }),
     }
 }
 
@@ -97,7 +99,7 @@ pub fn read16(self: *const Self, addr: u32) u16 {
         0x0A00_0000...0x0BFF_FFFF => self.pak.get16(addr - 0x0A00_0000),
         0x0C00_0000...0x0DFF_FFFF => self.pak.get16(addr - 0x0C00_0000),
 
-        else => std.debug.panic("Tried to read from 0x{X:0>8}", .{addr}),
+        else => undRead("Tried to read from 0x{X:0>8}", .{addr}),
     };
 }
 
@@ -114,7 +116,7 @@ pub fn write16(self: *Self, addr: u32, halfword: u16) void {
         0x0600_0000...0x0601_7FFF => self.ppu.vram.set16(addr - 0x0600_0000, halfword),
         0x0700_0000...0x07FF_FFFF => self.ppu.oam.set16(addr & 0x3FF, halfword),
 
-        else => std.debug.panic("Tried to write 0x{X:0>4} to 0x{X:0>8}", .{ halfword, addr }),
+        else => undWrite("Tried to write 0x{X:0>4} to 0x{X:0>8}", .{ halfword, addr }),
     }
 }
 
@@ -135,9 +137,9 @@ pub fn read8(self: *const Self, addr: u32) u8 {
         0x0800_0000...0x09FF_FFFF => self.pak.get8(addr - 0x0800_0000),
         0x0A00_0000...0x0BFF_FFFF => self.pak.get8(addr - 0x0A00_0000),
         0x0C00_0000...0x0DFF_FFFF => self.pak.get8(addr - 0x0C00_0000),
-        0x0E00_0000...0x0E00_FFFF => self.pak.sram.get8(addr - 0x0E00_0000),
+        0x0E00_0000...0x0EFF_FFFF => self.pak.sram.get8(addr & 0xFFFF),
 
-        else => std.debug.panic("Tried to read from 0x{X:0>2}", .{addr}),
+        else => undRead("Tried to read from 0x{X:0>2}", .{addr}),
     };
 }
 
@@ -147,15 +149,19 @@ pub fn write8(self: *Self, addr: u32, byte: u8) void {
         0x0200_0000...0x02FF_FFFF => self.ewram.set8(addr & 0x3FFFF, byte),
         0x0300_0000...0x03FF_FFFF => self.iwram.set8(addr & 0x7FFF, byte),
         0x0400_0000...0x0400_03FE => io.write8(self, addr, byte),
-        0x0400_0410 => log.info("Wrote 0x{X:0>2} to 0x{X:0>8}. Ignored", .{ byte, addr }),
+        0x0400_0410 => log.info("Ignored write of 0x{X:0>2} to 0x{X:0>8}", .{ byte, addr }),
 
         // External Memory (Game Pak)
-        0x0E00_0000...0x0E00_FFFF => self.pak.sram.set8(addr - 0x0E00_0000, byte),
+        0x0E00_0000...0x0E00_FFFF => self.pak.sram.set8(addr & 0xFFFF, byte),
-        else => std.debug.panic("Tried to write 0x{X:0>2} to 0x{X:0>8}", .{ byte, addr }),
+        else => undWrite("Tried to write 0x{X:0>2} to 0x{X:0>8}", .{ byte, addr }),
     }
 }
 
-fn failedRead(comptime format: []const u8, args: anytype) u8 {
+fn undRead(comptime format: []const u8, args: anytype) u8 {
-    log.warn(format, args);
+    if (panic_on_und_bus) std.debug.panic(format, args) else log.warn(format, args);
     return 0;
 }
+
+fn undWrite(comptime format: []const u8, args: anytype) void {
+    if (panic_on_und_bus) std.debug.panic(format, args) else log.warn(format, args);
+}

src/bus/io.zig

@@ -4,6 +4,10 @@ const Bit = @import("bitfield").Bit;
 const Bitfield = @import("bitfield").Bitfield;
 const Bus = @import("../Bus.zig");
 const DmaController = @import("dma.zig").DmaController;
+const Timer = @import("timer.zig").Timer;
+const Scheduler = @import("../scheduler.zig").Scheduler;
+
+const panic_on_und_io: bool = false;
 
 const log = std.log.scoped(.@"I/O");
 
@@ -24,9 +28,16 @@ pub const Io = struct {
     dma2: DmaController(2),
     dma3: DmaController(3),
 
+    // Timers
+    // TODO: Figure out how to turn this into an array
+    tim0: Timer(0),
+    tim1: Timer(1),
+    tim2: Timer(2),
+    tim3: Timer(3),
+
     keyinput: KeyInput,
 
-    pub fn init() Self {
+    pub fn init(sched: *Scheduler) Self {
         return .{
             .ime = false,
             .ie = .{ .raw = 0x0000 },
@@ -35,11 +46,17 @@ pub const Io = struct {
             .postflg = .FirstBoot,
             .haltcnt = .Execute,
 
-            // Dma Transfers
+            // Dma Controllers
             .dma0 = DmaController(0).init(),
             .dma1 = DmaController(1).init(),
             .dma2 = DmaController(2).init(),
             .dma3 = DmaController(3).init(),
+
+            // Timers
+            .tim0 = Timer(0).init(sched),
+            .tim1 = Timer(1).init(sched),
+            .tim2 = Timer(2).init(sched),
+            .tim3 = Timer(3).init(sched),
         };
     }
 
@@ -51,21 +68,33 @@ pub const Io = struct {
 
 pub fn read32(bus: *const Bus, addr: u32) u32 {
     return switch (addr) {
+        // Display
         0x0400_0000 => bus.ppu.dispcnt.raw,
         0x0400_0004 => @as(u32, bus.ppu.vcount.raw) << 16 | bus.ppu.dispstat.raw,
         0x0400_0006 => @as(u32, bus.ppu.bg[0].cnt.raw) << 16 | bus.ppu.vcount.raw,
-        0x0400_0200 => @as(u32, bus.io.irq.raw) << 16 | bus.io.ie.raw,
+
-        0x0400_0208 => @boolToInt(bus.io.ime),
+        // DMA Transfers
         0x0400_00B8 => @as(u32, bus.io.dma0.cnt.raw) << 16,
         0x0400_00C4 => @as(u32, bus.io.dma1.cnt.raw) << 16,
         0x0400_00D0 => @as(u32, bus.io.dma1.cnt.raw) << 16,
         0x0400_00DC => @as(u32, bus.io.dma3.cnt.raw) << 16,
-        else => std.debug.panic("Tried to read word from 0x{X:0>8}", .{addr}),
+
+        // Timers
+        0x0400_0100 => @as(u32, bus.io.tim0.cnt.raw) << 16 | bus.io.tim0.counter(),
+        0x0400_0104 => @as(u32, bus.io.tim1.cnt.raw) << 16 | bus.io.tim1.counter(),
+        0x0400_0108 => @as(u32, bus.io.tim2.cnt.raw) << 16 | bus.io.tim2.counter(),
+        0x0400_010C => @as(u32, bus.io.tim3.cnt.raw) << 16 | bus.io.tim3.counter(),
+
+        // Interrupts
+        0x0400_0200 => @as(u32, bus.io.irq.raw) << 16 | bus.io.ie.raw,
+        0x0400_0208 => @boolToInt(bus.io.ime),
+        else => undRead("Tried to read word from 0x{X:0>8}", .{addr}),
     };
 }
 
 pub fn write32(bus: *Bus, addr: u32, word: u32) void {
     switch (addr) {
+        // Display
         0x0400_0000 => bus.ppu.dispcnt.raw = @truncate(u16, word),
         0x0400_0004 => {
             bus.ppu.dispstat.raw = @truncate(u16, word);
@@ -77,8 +106,12 @@ pub fn write32(bus: *Bus, addr: u32, word: u32) void {
         0x0400_0014 => bus.ppu.setBgOffsets(1, word),
         0x0400_0018 => bus.ppu.setBgOffsets(2, word),
         0x0400_001C => bus.ppu.setBgOffsets(3, word),
+
+        // Sound
         0x0400_00A0 => log.warn("Wrote 0x{X:0>8} to FIFO_A", .{word}),
         0x0400_00A4 => log.warn("Wrote 0x{X:0>8} to FIFO_B", .{word}),
+
+        // DMA Transfers
         0x0400_00B0 => bus.io.dma0.writeSad(word),
         0x0400_00B4 => bus.io.dma0.writeDad(word),
         0x0400_00B8 => bus.io.dma0.writeCnt(word),
@@ -91,33 +124,62 @@ pub fn write32(bus: *Bus, addr: u32, word: u32) void {
         0x0400_00D4 => bus.io.dma3.writeSad(word),
         0x0400_00D8 => bus.io.dma3.writeDad(word),
         0x0400_00DC => bus.io.dma3.writeCnt(word),
+
+        // Timers
+        0x0400_0100 => bus.io.tim0.writeCnt(word),
+        0x0400_0104 => bus.io.tim1.writeCnt(word),
+        0x0400_0108 => bus.io.tim2.writeCnt(word),
+        0x0400_010C => bus.io.tim3.writeCnt(word),
+
+        // Serial Communication 1
+        0x0400_0120 => log.warn("Wrote 0x{X:0>8} to SIODATA32", .{word}),
+
+        // Interrupts
         0x0400_0200 => bus.io.setIrqs(word),
         0x0400_0204 => log.warn("Wrote 0x{X:0>8} to WAITCNT", .{word}),
         0x0400_0208 => bus.io.ime = word & 1 == 1,
-        else => std.debug.panic("Tried to write 0x{X:0>8} to 0x{X:0>8}", .{ word, addr }),
+        else => undWrite("Tried to write 0x{X:0>8} to 0x{X:0>8}", .{ word, addr }),
     }
 }
 
 pub fn read16(bus: *const Bus, addr: u32) u16 {
     return switch (addr) {
+        // Display
         0x0400_0000 => bus.ppu.dispcnt.raw,
         0x0400_0004 => bus.ppu.dispstat.raw,
         0x0400_0006 => bus.ppu.vcount.raw,
+
+        // Sound
+        0x0400_0088 => unimplementedRead("Read halfword from SOUNDBIAS", .{}),
+
+        // Timers
+        0x0400_0100 => bus.io.tim0.counter(),
+        0x0400_0102 => bus.io.tim0.cnt.raw,
+        0x0400_0104 => bus.io.tim1.counter(),
+        0x0400_0106 => bus.io.tim1.cnt.raw,
+        0x0400_0108 => bus.io.tim2.counter(),
+        0x0400_010A => bus.io.tim2.cnt.raw,
+        0x0400_010C => bus.io.tim3.counter(),
+        0x0400_010E => bus.io.tim3.cnt.raw,
+
+        // Serial Communication 1
+        0x0400_0128 => unimplementedRead("Read halfword from SIOCNT", .{}),
+
+        // Keypad Input
         0x0400_0130 => bus.io.keyinput.raw,
+
+        // Interrupts
         0x0400_0200 => bus.io.ie.raw,
         0x0400_0202 => bus.io.irq.raw,
+        0x0400_0204 => unimplementedRead("Read halfword from WAITCNT", .{}),
         0x0400_0208 => @boolToInt(bus.io.ime),
-        0x0400_0102 => failedRead("Tried to read halfword from TM0CNT_H", .{}),
+        else => undRead("Tried to read halfword from 0x{X:0>8}", .{addr}),
-        0x0400_0106 => failedRead("Tried to read halfword from TM1CNT_H", .{}),
-        0x0400_010A => failedRead("Tried to read halfword from TM2CNT_H", .{}),
-        0x0400_010E => failedRead("Tried to read halfword from TM3CNT_H", .{}),
-        0x0400_0204 => failedRead("Tried to read halfword from WAITCNT", .{}),
-        else => std.debug.panic("Tried to read halfword from 0x{X:0>8}", .{addr}),
     };
 }
 
 pub fn write16(bus: *Bus, addr: u32, halfword: u16) void {
     switch (addr) {
+        // Display
         0x0400_0000 => bus.ppu.dispcnt.raw = halfword,
         0x0400_0004 => bus.ppu.dispstat.raw = halfword,
         0x0400_0008 => bus.ppu.bg[0].cnt.raw = halfword,
@@ -132,6 +194,10 @@ pub fn write16(bus: *Bus, addr: u32, halfword: u16) void {
         0x0400_001A => bus.ppu.bg[2].vofs.raw = halfword,
         0x0400_001C => bus.ppu.bg[3].hofs.raw = halfword,
         0x0400_001E => bus.ppu.bg[3].vofs.raw = halfword,
+        0x0400_0020 => log.warn("Wrote 0x{X:0>4} to BG2PA", .{halfword}),
+        0x0400_0026 => log.warn("Wrote 0x{X:0>4} to BG2PD", .{halfword}),
+        0x0400_0030 => log.warn("Wrote 0x{X:0>4} to BG3PA", .{halfword}),
+        0x0400_0036 => log.warn("Wrote 0x{X:0>4} to BG3PD", .{halfword}),
         0x0400_0040 => log.warn("Wrote 0x{X:0>4} to WIN0H", .{halfword}),
         0x0400_0042 => log.warn("Wrote 0x{X:0>4} to WIN1H", .{halfword}),
         0x0400_0044 => log.warn("Wrote 0x{X:0>4} to WIN0V", .{halfword}),
@@ -142,9 +208,14 @@ pub fn write16(bus: *Bus, addr: u32, halfword: u16) void {
         0x0400_0050 => log.warn("Wrote 0x{X:0>4} to BLDCNT", .{halfword}),
         0x0400_0052 => log.warn("Wrote 0x{X:0>4} to BLDALPHA", .{halfword}),
         0x0400_0054 => log.warn("Wrote 0x{X:0>4} to BLDY", .{halfword}),
+
+        // Sound
         0x0400_0080 => log.warn("Wrote 0x{X:0>4} to SOUNDCNT_L", .{halfword}),
         0x0400_0082 => log.warn("Wrote 0x{X:0>4} to SOUNDCNT_H", .{halfword}),
         0x0400_0084 => log.warn("Wrote 0x{X:0>4} to SOUNDCNT_X", .{halfword}),
+        0x0400_0088 => log.warn("Wrote 0x{X:0>4} to SOUNDBIAS", .{halfword}),
+
+        // Dma Transfers
         0x0400_00B8 => bus.io.dma0.writeWordCount(halfword),
         0x0400_00BA => bus.io.dma0.writeCntHigh(halfword),
         0x0400_00C4 => bus.io.dma1.writeWordCount(halfword),
@@ -153,67 +224,106 @@ pub fn write16(bus: *Bus, addr: u32, halfword: u16) void {
         0x0400_00D2 => bus.io.dma2.writeCntHigh(halfword),
         0x0400_00DC => bus.io.dma3.writeWordCount(halfword),
         0x0400_00DE => bus.io.dma3.writeCntHigh(halfword),
-        0x0400_0100 => log.warn("Wrote 0x{X:0>4} to TM0CNT_L", .{halfword}),
+
-        0x0400_0102 => log.warn("Wrote 0x{X:0>4} to TM0CNT_H", .{halfword}),
+        // Timers
-        0x0400_0104 => log.warn("Wrote 0x{X:0>4} to TM1CNT_L", .{halfword}),
+        0x0400_0100 => bus.io.tim0.writeCntLow(halfword),
-        0x0400_0106 => log.warn("Wrote 0x{X:0>4} to TM1CNT_H", .{halfword}),
+        0x0400_0102 => bus.io.tim0.writeCntHigh(halfword),
-        0x0400_0108 => log.warn("Wrote 0x{X:0>4} to TM2CNT_L", .{halfword}),
+        0x0400_0104 => bus.io.tim1.writeCntLow(halfword),
-        0x0400_010A => log.warn("Wrote 0x{X:0>4} to TM2CNT_H", .{halfword}),
+        0x0400_0106 => bus.io.tim1.writeCntHigh(halfword),
-        0x0400_010C => log.warn("Wrote 0x{X:0>4} to TM3CNT_L", .{halfword}),
+        0x0400_0108 => bus.io.tim2.writeCntLow(halfword),
-        0x0400_010E => log.warn("Wrote 0x{X:0>4} to TM3CNT_H", .{halfword}),
+        0x0400_010A => bus.io.tim2.writeCntHigh(halfword),
+        0x0400_010C => bus.io.tim3.writeCntLow(halfword),
+        0x0400_010E => bus.io.tim3.writeCntHigh(halfword),
+
+        // Serial Communication 1
         0x0400_0120 => log.warn("Wrote 0x{X:0>4} to SIOMULTI0", .{halfword}),
         0x0400_0122 => log.warn("Wrote 0x{X:0>4} to SIOMULTI1", .{halfword}),
         0x0400_0124 => log.warn("Wrote 0x{X:0>4} to SIOMULTI2", .{halfword}),
         0x0400_0126 => log.warn("Wrote 0x{X:0>4} to SIOMULTI3", .{halfword}),
         0x0400_0128 => log.warn("Wrote 0x{X:0>4} to SIOCNT", .{halfword}),
         0x0400_012A => log.warn("Wrote 0x{X:0>4} to SIOMLT_SEND", .{halfword}),
+
+        // Keypad Input
         0x0400_0130 => log.warn("Wrote 0x{X:0>4} to KEYINPUT. Ignored", .{halfword}),
         0x0400_0132 => log.warn("Wrote 0x{X:0>4} to KEYCNT", .{halfword}),
+
+        // Serial Communication 2
         0x0400_0134 => log.warn("Wrote 0x{X:0>4} to RCNT", .{halfword}),
+
+        // Interrupts
         0x0400_0200 => bus.io.ie.raw = halfword,
         0x0400_0202 => bus.io.irq.raw &= ~halfword,
         0x0400_0204 => log.warn("Wrote 0x{X:0>4} to WAITCNT", .{halfword}),
         0x0400_0208 => bus.io.ime = halfword & 1 == 1,
-        else => std.debug.panic("Tried to write 0x{X:0>4} to 0x{X:0>8}", .{ halfword, addr }),
+        else => undWrite("Tried to write 0x{X:0>4} to 0x{X:0>8}", .{ halfword, addr }),
     }
 }
 
 pub fn read8(bus: *const Bus, addr: u32) u8 {
     return switch (addr) {
+        // Display
         0x0400_0000 => @truncate(u8, bus.ppu.dispcnt.raw),
         0x0400_0004 => @truncate(u8, bus.ppu.dispstat.raw),
+        0x0400_0006 => @truncate(u8, bus.ppu.vcount.raw),
+
+        // Sound
+        0x0400_0089 => unimplementedRead("Read (high) byte from SOUNDBIAS", .{}),
+
+        // Serial Communication 1
+        0x0400_0128 => unimplementedRead("Read (low) byte from SIOCNT", .{}),
+
+        // Interrupts
         0x0400_0200 => @truncate(u8, bus.io.ie.raw),
         0x0400_0300 => @enumToInt(bus.io.postflg),
-        0x0400_0006 => @truncate(u8, bus.ppu.vcount.raw),
+        else => undRead("Tried to read byte from 0x{X:0>8}", .{addr}),
-        0x0400_0089 => failedRead("Tried to read (high) byte from SOUNDBIAS", .{}),
-        else => std.debug.panic("Tried to read byte from 0x{X:0>8}", .{addr}),
     };
 }
 
 pub fn write8(self: *Bus, addr: u32, byte: u8) void {
     switch (addr) {
+        // Display
         0x0400_0004 => self.ppu.dispstat.raw = (self.ppu.dispstat.raw & 0xFF00) | byte,
         0x0400_0005 => self.ppu.dispstat.raw = (@as(u16, byte) << 8) | (self.ppu.dispstat.raw & 0xFF),
+
+        // Sound
+        0x0400_0063 => log.warn("Wrote 0x{X:0>2} to SOUND1CNT_H (high)", .{byte}),
+        0x0400_0065 => log.warn("Wrote 0x{X:0>2} to SOUND1CNT_X (high)", .{byte}),
+        0x0400_0069 => log.warn("Wrote 0x{X:0>2} to SOUND2CNT_L (high)", .{byte}),
+        0x0400_006D => log.warn("Wrote 0x{X:0>2} to SOUND2CNT_H (high)", .{byte}),
+        0x0400_0070 => log.warn("Wrote 0x{X:0>2} to SOUND3CNT_L (low)", .{byte}),
+        0x0400_0079 => log.warn("Wrote 0x{X:0>2} to SOUND4CNT_L (high)", .{byte}),
+        0x0400_007D => log.warn("Wrote 0x{X:0>2} to SOUND4CNT_H (high)", .{byte}),
+        0x0400_0080 => log.warn("Wrote 0x{X:0>2} to SOUNDCNT_L (low)", .{byte}),
+        0x0400_0084 => log.warn("Wrote 0x{X:0>2} to SOUNDCNT_X (low)", .{byte}),
+        0x0400_0089 => log.warn("Wrote 0x{X:0>2} to SOUNDBIAS (high)", .{byte}),
+
+        // Serial Communication 1
+        0x0400_0128 => log.warn("Wrote 0x{X:0>2} to SIOCNT (low)", .{byte}),
+
+        // Serial Communication 2
+        0x0400_0140 => log.warn("Wrote 0x{X:0>2} to JOYCNT (low)", .{byte}),
+
+        // Interrupts
         0x0400_0208 => self.io.ime = byte & 1 == 1,
         0x0400_0301 => self.io.haltcnt = if (byte >> 7 & 1 == 0) .Halt else std.debug.panic("TODO: Implement STOP", .{}),
-        0x0400_0063 => log.warn("Tried to write 0x{X:0>2} to SOUND1CNT_H (high)", .{byte}),
+        else => undWrite("Tried to write 0x{X:0>2} to 0x{X:0>8}", .{ byte, addr }),
-        0x0400_0065 => log.warn("Tried to write 0x{X:0>2} to SOUND1CNT_X (high)", .{byte}),
-        0x0400_0069 => log.warn("Tried to write 0x{X:0>2} to SOUND2CNT_L (high)", .{byte}),
-        0x0400_006D => log.warn("Tried to write 0x{X:0>2} to SOUND2CNT_H (high)", .{byte}),
-        0x0400_0070 => log.warn("Tried to write 0x{X:0>2} to SOUND3CNT_L (low)", .{byte}),
-        0x0400_0079 => log.warn("Tried to write 0x{X:0>2} to SOUND4CNT_L (high)", .{byte}),
-        0x0400_007D => log.warn("Tried to write 0x{X:0>2} to SOUND4CNT_H (high)", .{byte}),
-        0x0400_0080 => log.warn("Tried to write 0x{X:0>2} to SOUNDCNT_L (low)", .{byte}),
-        0x0400_0089 => log.warn("Tried to write 0x{X:0>2} to SOUNDBIAS (high)", .{byte}),
-        else => std.debug.panic("Tried to write 0x{X:0>2} to 0x{X:0>8}", .{ byte, addr }),
     }
 }
 
-fn failedRead(comptime format: []const u8, args: anytype) u8 {
+fn undRead(comptime format: []const u8, args: anytype) u8 {
+    if (panic_on_und_io) std.debug.panic(format, args) else log.warn(format, args);
+    return 0;
+}
+
+fn unimplementedRead(comptime format: []const u8, args: anytype) u8 {
     log.warn(format, args);
     return 0;
 }
 
+fn undWrite(comptime format: []const u8, args: anytype) void {
+    if (panic_on_und_io) std.debug.panic(format, args) else log.warn(format, args);
+}
+
 /// Read / Write
 pub const PostFlag = enum(u1) {
     FirstBoot = 0,
@@ -343,3 +453,12 @@ pub const DmaControl = extern union {
     enabled: Bit(u16, 15),
     raw: u16,
 };
+
+/// Read / Write
+pub const TimerControl = extern union {
+    frequency: Bitfield(u16, 0, 2),
+    cascade: Bit(u16, 2),
+    irq: Bit(u16, 6),
+    enabled: Bit(u16, 7),
+    raw: u16,
+};

src/bus/timer.zig

@@ -0,0 +1,131 @@
+const std = @import("std");
+
+const TimerControl = @import("io.zig").TimerControl;
+const Io = @import("io.zig").Io;
+const Scheduler = @import("../scheduler.zig").Scheduler;
+const Event = @import("../scheduler.zig").Event;
+const Arm7tdmi = @import("../cpu.zig").Arm7tdmi;
+
+const log = std.log.scoped(.Timer);
+
+pub fn Timer(comptime id: u2) type {
+    return struct {
+        const Self = @This();
+
+        /// Read Only, Internal. Please use self.counter()
+        _counter: u16,
+
+        /// Write Only, Internal. Please use self.writeCntLow()
+        _reload: u16,
+
+        /// Write Only, Internal. Please use self.WriteCntHigh()
+        cnt: TimerControl,
+
+        /// Internal.
+        sched: *Scheduler,
+
+        /// Internal
+        _start_timestamp: u64,
+
+        pub fn init(sched: *Scheduler) Self {
+            return .{
+                ._reload = 0,
+                ._counter = 0,
+                .cnt = .{ .raw = 0x0000 },
+                .sched = sched,
+                ._start_timestamp = 0,
+            };
+        }
+
+        pub fn counter(self: *const Self) u16 {
+            if (self.cnt.cascade.read())
+                return self._counter
+            else
+                return self._counter +% @truncate(u16, (self.sched.now() - self._start_timestamp) / self.frequency());
+        }
+
+        pub fn writeCnt(self: *Self, word: u32) void {
+            self.writeCntLow(@truncate(u16, word));
+            self.writeCntHigh(@truncate(u16, word >> 16));
+        }
+
+        pub fn writeCntLow(self: *Self, halfword: u16) void {
+            self._reload = halfword;
+        }
+
+        pub fn writeCntHigh(self: *Self, halfword: u16) void {
+            const new = TimerControl{ .raw = halfword };
+
+            // If Timer happens to be enabled, It will either be resheduled or disabled
+            self.sched.removeScheduledEvent(.{ .TimerOverflow = id });
+
+            if (!self.cnt.enabled.read() and new.enabled.read()) {
+                // Reload on Rising edge
+                self._counter = self._reload;
+
+                if (!new.cascade.read()) self.scheduleOverflow();
+            }
+
+            self.cnt.raw = halfword;
+        }
+
+        pub fn handleOverflow(self: *Self, cpu: *Arm7tdmi, io: *Io) void {
+            // Fire IRQ if enabled
+            if (self.cnt.irq.read()) {
+                switch (id) {
+                    0 => io.irq.tim0_overflow.set(),
+                    1 => io.irq.tim1_overflow.set(),
+                    2 => io.irq.tim2_overflow.set(),
+                    3 => io.irq.tim3_overflow.set(),
+                }
+
+                cpu.handleInterrupt();
+            }
+
+            // Perform Cascade Behaviour
+            switch (id) {
+                0 => if (io.tim1.cnt.cascade.read()) {
+                    io.tim1._counter +%= 1;
+
+                    if (io.tim1._counter == 0)
+                        io.tim1.handleOverflow(cpu, io);
+                },
+                1 => if (io.tim2.cnt.cascade.read()) {
+                    io.tim2._counter +%= 1;
+
+                    if (io.tim2._counter == 0)
+                        io.tim2.handleOverflow(cpu, io);
+                },
+                2 => if (io.tim3.cnt.cascade.read()) {
+                    io.tim3._counter +%= 1;
+
+                    if (io.tim3._counter == 0)
+                        io.tim3.handleOverflow(cpu, io);
+                },
+                3 => {}, // There is no Timer for TIM3 to "cascade" to,
+            }
+
+            // Reschedule Timer if we're not cascading
+            if (!self.cnt.cascade.read()) {
+                self._counter = self._reload;
+                self.scheduleOverflow();
+            }
+        }
+
+        fn scheduleOverflow(self: *Self) void {
+            const when = (@as(u64, 0x10000) - self._counter) * self.frequency();
+
+            self._start_timestamp = self.sched.now();
+            self.sched.push(.{ .TimerOverflow = id }, self.sched.now() + when);
+        }
+
+        fn frequency(self: *const Self) u16 {
+            return switch (self.cnt.frequency.read()) {
+                0 => 1,
+                1 => 64,
+                2 => 256,
+                3 => 1024,
+            };
+        }
+    };
+}

src/scheduler.zig

@@ -27,6 +27,10 @@ pub const Scheduler = struct {
         self.queue.deinit();
     }
 
+    pub inline fn now(self: *const Self) u64 {
+        return self.tick;
+    }
+
     pub fn handleEvent(self: *Self, cpu: *Arm7tdmi, bus: *Bus) void {
         const should_handle = if (self.queue.peek()) |e| self.tick >= e.tick else false;
         const stat = &bus.ppu.dispstat;
@@ -39,7 +43,8 @@ pub const Scheduler = struct {
 
             switch (event.kind) {
                 .HeatDeath => {
-                    std.debug.panic("[Scheduler] Somehow, a u64 overflowed", .{});
+                    log.err("A u64 overflowered. This *actually* should never happen.", .{});
+                    unreachable;
                 },
                 .HBlank => {
                     // The End of a Hblank (During Draw or Vblank)
@@ -110,6 +115,35 @@ pub const Scheduler = struct {
                     bus.ppu.dispstat.hblank.set();
                     self.push(.HBlank, self.tick + (68 * 4));
                 },
+                .TimerOverflow => |id| {
+                    // log.warn("TIM{} Overflowed", .{id});
+
+                    switch (id) {
+                        0 => bus.io.tim0.handleOverflow(cpu, &bus.io),
+                        1 => bus.io.tim1.handleOverflow(cpu, &bus.io),
+                        2 => bus.io.tim2.handleOverflow(cpu, &bus.io),
+                        3 => bus.io.tim3.handleOverflow(cpu, &bus.io),
+                    }
+                },
+            }
+        }
+    }
+
+    /// Removes the **first** scheduled event of type `needle` 
+    pub fn removeScheduledEvent(self: *Self, needle: EventKind) void {
+        var it = self.queue.iterator();
+
+        var i: usize = 0;
+        while (it.next()) |event| : (i += 1) {
+            if (std.meta.eql(event.kind, needle)) {
+
+                // This invalidates the iterator
+                _ = self.queue.removeIndex(i);
+
+                // Since removing something from the PQ invalidates the iterator,
+                // this implementation can safely only remove the first instance of
+                // a Scheduled Event. Exit Early
+                break;
             }
         }
     }
@@ -134,9 +168,10 @@ fn lessThan(_: void, a: Event, b: Event) Order {
     return std.math.order(a.tick, b.tick);
 }
 
-pub const EventKind = enum {
+pub const EventKind = union(enum) {
     HeatDeath,
     HBlank,
     VBlank,
     Draw,
+    TimerOverflow: u2,
 };