apple2-go/cpu/debug.go

package cpu

import (
	"fmt"
	"mos6502go/mmu"
	"strings"
)

func printFlag(p byte, flag uint8, code string) {
	if (p & flag) == 0 {
		fmt.Print(code)
	} else {
		fmt.Printf("%s", strings.ToUpper(code))
	}
}

func printInstruction(instruction string) {
	fmt.Printf("%04x   %-24s A=%02x X=%02x Y=%02x S=%02x P=%02x ",
		State.PC,
		instruction,
		State.A,
		State.X,
		State.Y,
		State.SP,
		State.P,
	)

	printFlag(State.P, CpuFlagN, "n")
	printFlag(State.P, CpuFlagV, "v")
	fmt.Print("-") // CpuFlagR flag that's always 1
	printFlag(State.P, CpuFlagB, "b")
	printFlag(State.P, CpuFlagD, "d")
	printFlag(State.P, CpuFlagI, "i")
	printFlag(State.P, CpuFlagZ, "z")
	printFlag(State.P, CpuFlagC, "c")

	fmt.Println("")
}

func PrintInstruction() {
	opcodeValue := mmu.PageTable[(State.PC)>>8][(State.PC)&0xff]
	opcode := OpCodes[opcodeValue]
	mnemonic := opcode.Mnemonic
	size := opcode.AddressingMode.OperandSize
	stringFormat := opcode.AddressingMode.StringFormat

	var value uint16
	if size == 0 {
		printInstruction(fmt.Sprintf("%02x        %s", opcodeValue, mnemonic))
		return
	}

	var opcodes string
	var suffix string

	if opcode.AddressingMode.Mode == AmRelative {
		value = uint16(mmu.PageTable[(State.PC+1)>>8][(State.PC+1)&0xff])
		var relativeAddress uint16
		if (value & 0x80) == 0 {
			relativeAddress = State.PC + 2 + uint16(value)
		} else {
			relativeAddress = State.PC + 2 + uint16(value) - 0x100
		}

		suffix = fmt.Sprintf(stringFormat, relativeAddress)
		opcodes = fmt.Sprintf("%02x %02x    ", opcodeValue, value)
	} else if size == 1 {
		value = uint16(mmu.PageTable[(State.PC+1)>>8][(State.PC+1)&0xff])
		suffix = fmt.Sprintf(stringFormat, value)
		opcodes = fmt.Sprintf("%02x %02x    ", opcodeValue, value)
	} else if size == 2 {
		lsb := mmu.PageTable[(State.PC+1)>>8][(State.PC+1)&0xff]
		msb := mmu.PageTable[(State.PC+2)>>8][(State.PC+2)&0xff]
		value = uint16(lsb) + uint16(msb)*0x100
		suffix = fmt.Sprintf(stringFormat, value)
		opcodes = fmt.Sprintf("%02x %02x %02x ", opcodeValue, lsb, msb)
	}

	printInstruction(fmt.Sprintf("%s %s %s", opcodes, mnemonic, suffix))
}

func DumpMemory(offset uint16) {
	var i uint16
	for i = 0; i < 0x100; i++ {
		if (i & 0xf) == 8 {
			fmt.Print(" ")
		}
		if (i & 0xf) == 0 {
			if i > 0 {
				fmt.Print("\n")
			}
			fmt.Printf("%04x  ", offset+i)
		}
		fmt.Printf(" %02x", mmu.PageTable[(offset+i)>>8][(offset+i)&0xff])
	}
	fmt.Print("\n")
}