1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
|
namespace Q1.Emulator.Chip;
using System;
using Assembler;
public partial class Q1Cpu
{
public Random Random;
public u16 AX = 0; // Accumulator register
public u16 DX = 0; // Data register
public u16 LX = 0; // Logical register
public u16 SP { get; set; } // Stack pointer
public u16 PC { get; set; } // Program counter
public u16[] V { get; set; } // Variable registers (64 total)
public u16 Cycles { get; set; } // Number of cycles
public Bus Bus { get; set; }
public bool AbortRequested = false;
public Q1Cpu()
{
this.LoadInstructionLookup();
}
public void Reset()
{
this.AbortRequested = false;
this.V = new u16[16];
this.SP = Q1Layout.StackStart;
this.PushStack(0xFFFF);
this.PC = Q1Layout.ProgramStart;
}
public void Clock()
{
var pc = this.PC;
if (pc == 0xFFFF)
{
this.AbortRequested = true;
return;
}
u16 instruction = this.FetchInstruction(out u8 op, out u8 m1, out u8 m2, out _);
if (instruction != 0x0101)
Console.WriteLine($"CPU.Clock: {pc:X4} | {Disassembler.ParseInstruction(instruction)}");
bool ex = m2 > 0;
switch (m1, ex)
{
case (0x00, false):
this.InstructionLookup[op].Item1(); // Implicit
break;
case (> 0x00, false):
this.InstructionLookup[op].Item2(m1); // Simple addressing mode
break;
case (0x00, true):
this.InstructionLookup[op].Item3(); // Extended implicit
break;
case (> 0x00, true):
this.InstructionLookup[op].Item4(m1, m2); // Extended addressing mode
break;
}
this.Cycles++;
}
public u16 FetchInstruction(out u8 op, out u8 m1, out u8 m2, out u8 length)
{
u16 instruction = this.Bus.ReadWord(this.PC);
this.PC += 2;
op = (u8) ((instruction >> 8) & 0xFF); // 256 opcodes
m1 = (u8) ((instruction >> 4) & 0x0F); // 16 modes
m2 = (u8) (instruction & 0x0F); // 16 modes
length = (u8) (this.AddressingModeLength(m1) + this.AddressingModeLength(m2));
return instruction;
}
private void PushStack(u16 value)
{
if (this.SP + 2 >= Q1Layout.StackStart + Q1Layout.StackLength)
throw new InvalidOperationException("Stack overflow");
this.Bus.WriteWord(this.SP, value);
this.SP += 2;
}
private u16 PopStack()
{
if (this.SP - 2 < Q1Layout.StackStart)
throw new InvalidOperationException("Stack underflow");
this.SP -= 2;
return this.Bus.ReadWord(this.SP);
}
private u16 FetchRegister(u8 regIndex)
{
return regIndex switch
{
<= 0x3F => this.V[regIndex],
0x40 => this.AX,
0x41 => (u16) (this.AX >> 8), // High byte of AX
0x42 => (u16) (this.AX & 0xFF), // Low byte of AX
0x43 => this.DX,
0x44 => (u16) (this.DX >> 8), // High byte of DX
0x45 => (u16) (this.DX & 0xFF), // Low byte of DX
0x46 => this.LX,
0x50 => this.PC,
0x51 => this.SP,
_ => throw new InvalidOperationException($"Unknown register index: {regIndex:X2}"),
};
}
private void StoreRegister(u8 regIndex, u16 value)
{
switch (regIndex)
{
case <= 0x3F:
this.V[regIndex] = value;
break;
case 0x40:
this.AX = value;
break;
case 0x41:
this.AX = (u16) ((this.AX & 0x00FF) | (value << 8));
break; // Set high byte
case 0x42:
this.AX = (u16) ((this.AX & 0xFF00) | (value & 0x00FF));
break; // Set low byte
case 0x43:
this.DX = value;
break;
case 0x44:
this.DX = (u16) ((this.DX & 0x00FF) | (value << 8));
break; // Set high byte
case 0x45:
this.DX = (u16) ((this.DX & 0xFF00) | (value & 0x00FF));
break; // Set low byte
case 0x46:
this.LX = value;
break;
case 0x50:
this.PC = value;
break;
case 0x51:
this.SP = value;
break;
default:
throw new InvalidOperationException($"Unknown register index: {regIndex:X2}");
}
}
}
|
