all repos — mgba @ 9ed7c9129d63194b40fd3ae2453ea6d6f6bafe0f

mGBA Game Boy Advance Emulator

src/gba/gba.c (view raw)

  1/* Copyright (c) 2013-2015 Jeffrey Pfau
  2 *
  3 * This Source Code Form is subject to the terms of the Mozilla Public
  4 * License, v. 2.0. If a copy of the MPL was not distributed with this
  5 * file, You can obtain one at http://mozilla.org/MPL/2.0/. */
  6#include <mgba/internal/gba/gba.h>
  7
  8#include <mgba/internal/arm/isa-inlines.h>
  9#include <mgba/internal/arm/debugger/debugger.h>
 10#include <mgba/internal/arm/decoder.h>
 11
 12#include <mgba/internal/gba/bios.h>
 13#include <mgba/internal/gba/cheats.h>
 14#include <mgba/internal/gba/io.h>
 15#include <mgba/internal/gba/overrides.h>
 16#include <mgba/internal/gba/rr/rr.h>
 17
 18#include <mgba-util/patch.h>
 19#include <mgba-util/crc32.h>
 20#include <mgba-util/math.h>
 21#include <mgba-util/memory.h>
 22#include <mgba-util/vfs.h>
 23
 24mLOG_DEFINE_CATEGORY(GBA, "GBA", "gba");
 25mLOG_DEFINE_CATEGORY(GBA_DEBUG, "GBA Debug", "gba.debug");
 26
 27const uint32_t GBA_COMPONENT_MAGIC = 0x1000000;
 28
 29static const size_t GBA_ROM_MAGIC_OFFSET = 3;
 30static const uint8_t GBA_ROM_MAGIC[] = { 0xEA };
 31
 32static const size_t GBA_MB_MAGIC_OFFSET = 0xC0;
 33
 34static void GBAInit(void* cpu, struct mCPUComponent* component);
 35static void GBAInterruptHandlerInit(struct ARMInterruptHandler* irqh);
 36static void GBAProcessEvents(struct ARMCore* cpu);
 37static void GBAHitStub(struct ARMCore* cpu, uint32_t opcode);
 38static void GBAIllegal(struct ARMCore* cpu, uint32_t opcode);
 39static void GBABreakpoint(struct ARMCore* cpu, int immediate);
 40
 41static bool _setSoftwareBreakpoint(struct ARMDebugger*, uint32_t address, enum ExecutionMode mode, uint32_t* opcode);
 42static bool _clearSoftwareBreakpoint(struct ARMDebugger*, uint32_t address, enum ExecutionMode mode, uint32_t opcode);
 43
 44
 45#ifdef FIXED_ROM_BUFFER
 46extern uint32_t* romBuffer;
 47extern size_t romBufferSize;
 48#endif
 49
 50void GBACreate(struct GBA* gba) {
 51	gba->d.id = GBA_COMPONENT_MAGIC;
 52	gba->d.init = GBAInit;
 53	gba->d.deinit = 0;
 54}
 55
 56static void GBAInit(void* cpu, struct mCPUComponent* component) {
 57	struct GBA* gba = (struct GBA*) component;
 58	gba->cpu = cpu;
 59	gba->debugger = 0;
 60	gba->sync = 0;
 61
 62	GBAInterruptHandlerInit(&gba->cpu->irqh);
 63	GBAMemoryInit(gba);
 64
 65	gba->memory.savedata.timing = &gba->timing;
 66	GBASavedataInit(&gba->memory.savedata, NULL);
 67
 68	gba->video.p = gba;
 69	GBAVideoInit(&gba->video);
 70
 71	gba->audio.p = gba;
 72	GBAAudioInit(&gba->audio, GBA_AUDIO_SAMPLES);
 73
 74	GBAIOInit(gba);
 75
 76	gba->sio.p = gba;
 77	GBASIOInit(&gba->sio);
 78
 79	GBAHardwareInit(&gba->memory.hw, NULL);
 80
 81	gba->springIRQ = 0;
 82	gba->keySource = 0;
 83	gba->rotationSource = 0;
 84	gba->luminanceSource = 0;
 85	gba->rtcSource = 0;
 86	gba->rumble = 0;
 87	gba->rr = 0;
 88
 89	gba->romVf = 0;
 90	gba->biosVf = 0;
 91
 92	gba->stream = NULL;
 93	gba->keyCallback = NULL;
 94	mCoreCallbacksListInit(&gba->coreCallbacks, 0);
 95
 96	gba->biosChecksum = GBAChecksum(gba->memory.bios, SIZE_BIOS);
 97
 98	gba->idleOptimization = IDLE_LOOP_REMOVE;
 99	gba->idleLoop = IDLE_LOOP_NONE;
100
101	gba->realisticTiming = true;
102	gba->hardCrash = true;
103	gba->allowOpposingDirections = true;
104
105	gba->performingDMA = false;
106
107	gba->isPristine = false;
108	gba->pristineRomSize = 0;
109	gba->yankedRomSize = 0;
110
111	mTimingInit(&gba->timing, &gba->cpu->cycles, &gba->cpu->nextEvent);
112}
113
114void GBAUnloadROM(struct GBA* gba) {
115	if (gba->memory.rom && !gba->isPristine) {
116		if (gba->yankedRomSize) {
117			gba->yankedRomSize = 0;
118		}
119		mappedMemoryFree(gba->memory.rom, SIZE_CART0);
120	}
121
122	if (gba->romVf) {
123#ifndef FIXED_ROM_BUFFER
124		gba->romVf->unmap(gba->romVf, gba->memory.rom, gba->pristineRomSize);
125#endif
126		gba->romVf->close(gba->romVf);
127		gba->romVf = NULL;
128	}
129	gba->memory.rom = NULL;
130	gba->isPristine = false;
131
132	GBASavedataDeinit(&gba->memory.savedata);
133	if (gba->memory.savedata.realVf) {
134		gba->memory.savedata.realVf->close(gba->memory.savedata.realVf);
135		gba->memory.savedata.realVf = 0;
136	}
137	gba->idleLoop = IDLE_LOOP_NONE;
138}
139
140void GBADestroy(struct GBA* gba) {
141	GBAUnloadROM(gba);
142
143	if (gba->biosVf) {
144		gba->biosVf->unmap(gba->biosVf, gba->memory.bios, SIZE_BIOS);
145		gba->biosVf->close(gba->biosVf);
146		gba->biosVf = 0;
147	}
148
149	GBAMemoryDeinit(gba);
150	GBAVideoDeinit(&gba->video);
151	GBAAudioDeinit(&gba->audio);
152	GBASIODeinit(&gba->sio);
153	gba->rr = 0;
154	mTimingDeinit(&gba->timing);
155	mCoreCallbacksListDeinit(&gba->coreCallbacks);
156}
157
158void GBAInterruptHandlerInit(struct ARMInterruptHandler* irqh) {
159	irqh->reset = GBAReset;
160	irqh->processEvents = GBAProcessEvents;
161	irqh->swi16 = GBASwi16;
162	irqh->swi32 = GBASwi32;
163	irqh->hitIllegal = GBAIllegal;
164	irqh->readCPSR = GBATestIRQ;
165	irqh->hitStub = GBAHitStub;
166	irqh->bkpt16 = GBABreakpoint;
167	irqh->bkpt32 = GBABreakpoint;
168}
169
170void GBAReset(struct ARMCore* cpu) {
171	ARMSetPrivilegeMode(cpu, MODE_IRQ);
172	cpu->gprs[ARM_SP] = SP_BASE_IRQ;
173	ARMSetPrivilegeMode(cpu, MODE_SUPERVISOR);
174	cpu->gprs[ARM_SP] = SP_BASE_SUPERVISOR;
175	ARMSetPrivilegeMode(cpu, MODE_SYSTEM);
176	cpu->gprs[ARM_SP] = SP_BASE_SYSTEM;
177
178	struct GBA* gba = (struct GBA*) cpu->master;
179	if (!gba->rr || (!gba->rr->isPlaying(gba->rr) && !gba->rr->isRecording(gba->rr))) {
180		GBASavedataUnmask(&gba->memory.savedata);
181	}
182
183	gba->cpuBlocked = false;
184	gba->earlyExit = false;
185	if (gba->yankedRomSize) {
186		gba->memory.romSize = gba->yankedRomSize;
187		gba->memory.romMask = toPow2(gba->memory.romSize) - 1;
188		gba->yankedRomSize = 0;
189	}
190	mTimingClear(&gba->timing);
191	GBAMemoryReset(gba);
192	GBAVideoReset(&gba->video);
193	GBAAudioReset(&gba->audio);
194	GBAIOInit(gba);
195	GBATimerInit(gba);
196
197	GBASIOReset(&gba->sio);
198
199	gba->lastJump = 0;
200	gba->haltPending = false;
201	gba->idleDetectionStep = 0;
202	gba->idleDetectionFailures = 0;
203
204	gba->debug = false;
205	memset(gba->debugString, 0, sizeof(gba->debugString));
206}
207
208void GBASkipBIOS(struct GBA* gba) {
209	struct ARMCore* cpu = gba->cpu;
210	if (cpu->gprs[ARM_PC] == BASE_RESET + WORD_SIZE_ARM) {
211		if (gba->memory.rom) {
212			cpu->gprs[ARM_PC] = BASE_CART0;
213		} else {
214			cpu->gprs[ARM_PC] = BASE_WORKING_RAM;
215		}
216		gba->memory.io[REG_VCOUNT >> 1] = 0x7E;
217		gba->memory.io[REG_POSTFLG >> 1] = 1;
218		int currentCycles = 0;
219		ARM_WRITE_PC;
220	}
221}
222
223static void GBAProcessEvents(struct ARMCore* cpu) {
224	struct GBA* gba = (struct GBA*) cpu->master;
225
226	gba->bus = cpu->prefetch[1];
227	if (cpu->executionMode == MODE_THUMB) {
228		gba->bus |= cpu->prefetch[1] << 16;
229	}
230
231	if (gba->springIRQ && !cpu->cpsr.i) {
232		ARMRaiseIRQ(cpu);
233		gba->springIRQ = 0;
234	}
235
236	int32_t nextEvent = cpu->nextEvent;
237	while (cpu->cycles >= nextEvent) {
238		int32_t cycles = cpu->cycles;
239
240		cpu->cycles = 0;
241		cpu->nextEvent = INT_MAX;
242
243#ifndef NDEBUG
244		if (cycles < 0) {
245			mLOG(GBA, FATAL, "Negative cycles passed: %i", cycles);
246		}
247#endif
248		nextEvent = cycles;
249		do {
250			nextEvent = mTimingTick(&gba->timing, nextEvent);
251		} while (gba->cpuBlocked);
252
253		cpu->nextEvent = nextEvent;
254
255		if (gba->earlyExit) {
256			gba->earlyExit = false;
257			break;
258		}
259		if (cpu->halted) {
260			cpu->cycles = nextEvent;
261			if (!gba->memory.io[REG_IME >> 1] || !gba->memory.io[REG_IE >> 1]) {
262				break;
263			}
264		}
265#ifndef NDEBUG
266		else if (nextEvent < 0) {
267			mLOG(GBA, FATAL, "Negative cycles will pass: %i", nextEvent);
268		}
269#endif
270	}
271}
272
273#ifdef USE_DEBUGGERS
274void GBAAttachDebugger(struct GBA* gba, struct mDebugger* debugger) {
275	gba->debugger = (struct ARMDebugger*) debugger->platform;
276	gba->debugger->setSoftwareBreakpoint = _setSoftwareBreakpoint;
277	gba->debugger->clearSoftwareBreakpoint = _clearSoftwareBreakpoint;
278	gba->cpu->components[CPU_COMPONENT_DEBUGGER] = &debugger->d;
279	ARMHotplugAttach(gba->cpu, CPU_COMPONENT_DEBUGGER);
280}
281
282void GBADetachDebugger(struct GBA* gba) {
283	if (gba->debugger) {
284		ARMHotplugDetach(gba->cpu, CPU_COMPONENT_DEBUGGER);
285	}
286	gba->cpu->components[CPU_COMPONENT_DEBUGGER] = NULL;
287	gba->debugger = NULL;
288}
289#endif
290
291bool GBALoadMB(struct GBA* gba, struct VFile* vf) {
292	GBAUnloadROM(gba);
293	gba->romVf = vf;
294	gba->pristineRomSize = vf->size(vf);
295	vf->seek(vf, 0, SEEK_SET);
296	if (gba->pristineRomSize > SIZE_WORKING_RAM) {
297		gba->pristineRomSize = SIZE_WORKING_RAM;
298	}
299	gba->isPristine = true;
300	gba->memory.wram = anonymousMemoryMap(SIZE_WORKING_RAM);
301	memset(gba->memory.wram, 0, SIZE_WORKING_RAM);
302	vf->read(vf, gba->memory.wram, gba->pristineRomSize);
303	if (!gba->memory.wram) {
304		mLOG(GBA, WARN, "Couldn't map ROM");
305		return false;
306	}
307	gba->yankedRomSize = 0;
308	gba->memory.romSize = 0;
309	gba->memory.romMask = 0;
310	gba->romCrc32 = doCrc32(gba->memory.wram, gba->pristineRomSize);
311	return true;
312}
313
314bool GBALoadROM(struct GBA* gba, struct VFile* vf) {
315	if (!vf) {
316		return false;
317	}
318	GBAUnloadROM(gba);
319	gba->romVf = vf;
320	gba->pristineRomSize = vf->size(vf);
321	vf->seek(vf, 0, SEEK_SET);
322	if (gba->pristineRomSize > SIZE_CART0) {
323		gba->pristineRomSize = SIZE_CART0;
324	}
325	gba->isPristine = true;
326#ifdef FIXED_ROM_BUFFER
327	if (gba->pristineRomSize <= romBufferSize) {
328		gba->memory.rom = romBuffer;
329		vf->read(vf, romBuffer, gba->pristineRomSize);
330	}
331#else
332	gba->memory.rom = vf->map(vf, gba->pristineRomSize, MAP_READ);
333#endif
334	if (!gba->memory.rom) {
335		mLOG(GBA, WARN, "Couldn't map ROM");
336		return false;
337	}
338	gba->yankedRomSize = 0;
339	gba->memory.romSize = gba->pristineRomSize;
340	gba->memory.romMask = toPow2(gba->memory.romSize) - 1;
341	gba->memory.mirroring = false;
342	gba->romCrc32 = doCrc32(gba->memory.rom, gba->memory.romSize);
343	GBAHardwareInit(&gba->memory.hw, &((uint16_t*) gba->memory.rom)[GPIO_REG_DATA >> 1]);
344	GBAVFameDetect(&gba->memory.vfame, gba->memory.rom, gba->memory.romSize);
345	if (popcount32(gba->memory.romSize) != 1) {
346		// This ROM is either a bad dump or homebrew. Emulate flash cart behavior.
347#ifndef FIXED_ROM_BUFFER
348		void* newRom = anonymousMemoryMap(SIZE_CART0);
349		memcpy(newRom, gba->memory.rom, gba->pristineRomSize);
350		gba->memory.rom = newRom;
351#endif
352		gba->memory.romSize = SIZE_CART0;
353		gba->isPristine = false;
354	}
355	// TODO: error check
356	return true;
357}
358
359bool GBALoadSave(struct GBA* gba, struct VFile* sav) {
360	GBASavedataInit(&gba->memory.savedata, sav);
361	return true;
362}
363
364void GBAYankROM(struct GBA* gba) {
365	gba->yankedRomSize = gba->memory.romSize;
366	gba->memory.romSize = 0;
367	gba->memory.romMask = 0;
368	GBARaiseIRQ(gba, IRQ_GAMEPAK);
369}
370
371void GBALoadBIOS(struct GBA* gba, struct VFile* vf) {
372	gba->biosVf = vf;
373	uint32_t* bios = vf->map(vf, SIZE_BIOS, MAP_READ);
374	if (!bios) {
375		mLOG(GBA, WARN, "Couldn't map BIOS");
376		return;
377	}
378	gba->memory.bios = bios;
379	gba->memory.fullBios = 1;
380	uint32_t checksum = GBAChecksum(gba->memory.bios, SIZE_BIOS);
381	mLOG(GBA, DEBUG, "BIOS Checksum: 0x%X", checksum);
382	if (checksum == GBA_BIOS_CHECKSUM) {
383		mLOG(GBA, INFO, "Official GBA BIOS detected");
384	} else if (checksum == GBA_DS_BIOS_CHECKSUM) {
385		mLOG(GBA, INFO, "Official GBA (DS) BIOS detected");
386	} else {
387		mLOG(GBA, WARN, "BIOS checksum incorrect");
388	}
389	gba->biosChecksum = checksum;
390	if (gba->memory.activeRegion == REGION_BIOS) {
391		gba->cpu->memory.activeRegion = gba->memory.bios;
392	}
393	// TODO: error check
394}
395
396void GBAApplyPatch(struct GBA* gba, struct Patch* patch) {
397	size_t patchedSize = patch->outputSize(patch, gba->memory.romSize);
398	if (!patchedSize || patchedSize > SIZE_CART0) {
399		return;
400	}
401	void* newRom = anonymousMemoryMap(SIZE_CART0);
402	if (!patch->applyPatch(patch, gba->memory.rom, gba->pristineRomSize, newRom, patchedSize)) {
403		mappedMemoryFree(newRom, SIZE_CART0);
404		return;
405	}
406	if (gba->romVf) {
407#ifndef FIXED_ROM_BUFFER
408		gba->romVf->unmap(gba->romVf, gba->memory.rom, gba->pristineRomSize);
409#endif
410		gba->romVf->close(gba->romVf);
411		gba->romVf = NULL;
412	}
413	gba->isPristine = false;
414	gba->memory.rom = newRom;
415	gba->memory.hw.gpioBase = &((uint16_t*) gba->memory.rom)[GPIO_REG_DATA >> 1];
416	gba->memory.romSize = patchedSize;
417	gba->memory.romMask = SIZE_CART0 - 1;
418	gba->romCrc32 = doCrc32(gba->memory.rom, gba->memory.romSize);
419}
420
421void GBAWriteIE(struct GBA* gba, uint16_t value) {
422	if (gba->memory.io[REG_IME >> 1] && value & gba->memory.io[REG_IF >> 1]) {
423		ARMRaiseIRQ(gba->cpu);
424	}
425}
426
427void GBAWriteIME(struct GBA* gba, uint16_t value) {
428	if (value && gba->memory.io[REG_IE >> 1] & gba->memory.io[REG_IF >> 1]) {
429		ARMRaiseIRQ(gba->cpu);
430	}
431}
432
433void GBARaiseIRQ(struct GBA* gba, enum GBAIRQ irq) {
434	gba->memory.io[REG_IF >> 1] |= 1 << irq;
435
436	if (gba->memory.io[REG_IE >> 1] & 1 << irq) {
437		gba->cpu->halted = 0;
438		if (gba->memory.io[REG_IME >> 1]) {
439			ARMRaiseIRQ(gba->cpu);
440		}
441	}
442}
443
444void GBATestIRQ(struct ARMCore* cpu) {
445	struct GBA* gba = (struct GBA*) cpu->master;
446	if (gba->memory.io[REG_IME >> 1] && gba->memory.io[REG_IE >> 1] & gba->memory.io[REG_IF >> 1]) {
447		gba->springIRQ = gba->memory.io[REG_IE >> 1] & gba->memory.io[REG_IF >> 1];
448		gba->cpu->nextEvent = gba->cpu->cycles;
449	}
450}
451
452void GBAHalt(struct GBA* gba) {
453	gba->cpu->nextEvent = gba->cpu->cycles;
454	gba->cpu->halted = 1;
455}
456
457void GBAStop(struct GBA* gba) {
458	size_t c;
459	for (c = 0; c < mCoreCallbacksListSize(&gba->coreCallbacks); ++c) {
460		struct mCoreCallbacks* callbacks = mCoreCallbacksListGetPointer(&gba->coreCallbacks, c);
461		if (callbacks->sleep) {
462			callbacks->sleep(callbacks->context);
463		}
464	}
465	gba->cpu->nextEvent = gba->cpu->cycles;
466}
467
468void GBADebug(struct GBA* gba, uint16_t flags) {
469	gba->debugFlags = flags;
470	if (GBADebugFlagsIsSend(gba->debugFlags)) {
471		int level = 1 << GBADebugFlagsGetLevel(gba->debugFlags);
472		level &= 0x1F;
473		char oolBuf[0x101];
474		strncpy(oolBuf, gba->debugString, sizeof(gba->debugString));
475		oolBuf[0x100] = '\0';
476		mLog(_mLOG_CAT_GBA_DEBUG(), level, "%s", oolBuf);
477	}
478	gba->debugFlags = GBADebugFlagsClearSend(gba->debugFlags);
479}
480
481bool GBAIsROM(struct VFile* vf) {
482	if (vf->seek(vf, GBA_ROM_MAGIC_OFFSET, SEEK_SET) < 0) {
483		return false;
484	}
485	uint8_t signature[sizeof(GBA_ROM_MAGIC)];
486	if (vf->read(vf, &signature, sizeof(signature)) != sizeof(signature)) {
487		return false;
488	}
489	if (GBAIsBIOS(vf)) {
490		return false;
491	}
492	return memcmp(signature, GBA_ROM_MAGIC, sizeof(signature)) == 0;
493}
494
495bool GBAIsMB(struct VFile* vf) {
496	if (!GBAIsROM(vf)) {
497		return false;
498	}
499	if (vf->size(vf) > SIZE_WORKING_RAM) {
500		return false;
501	}
502	if (vf->seek(vf, GBA_MB_MAGIC_OFFSET, SEEK_SET) < 0) {
503		return false;
504	}
505	uint32_t signature;
506	if (vf->read(vf, &signature, sizeof(signature)) != sizeof(signature)) {
507		return false;
508	}
509	uint32_t opcode;
510	LOAD_32(opcode, 0, &signature);
511	struct ARMInstructionInfo info;
512	ARMDecodeARM(opcode, &info);
513	if (info.branchType != ARM_BRANCH) {
514		return false;
515	}
516	if (info.op1.immediate <= 0) {
517		return false;
518	} else if (info.op1.immediate == 28) {
519		// Ancient toolchain that is known to throw MB detection for a loop
520		return false;
521	} else if (info.op1.immediate != 24) {
522		return true;
523	}
524	// Found a libgba-linked cart...these are a bit harder to detect.
525	return false;
526}
527
528bool GBAIsBIOS(struct VFile* vf) {
529	if (vf->seek(vf, 0, SEEK_SET) < 0) {
530		return false;
531	}
532	uint8_t interruptTable[7 * 4];
533	if (vf->read(vf, &interruptTable, sizeof(interruptTable)) != sizeof(interruptTable)) {
534		return false;
535	}
536	int i;
537	for (i = 0; i < 7; ++i) {
538		if (interruptTable[4 * i + 3] != 0xEA || interruptTable[4 * i + 2]) {
539			return false;
540		}
541	}
542	return true;
543}
544
545void GBAGetGameCode(const struct GBA* gba, char* out) {
546	memset(out, 0, 8);
547	if (!gba->memory.rom) {
548		return;
549	}
550
551	memcpy(out, "AGB-", 4);
552	memcpy(&out[4], &((struct GBACartridge*) gba->memory.rom)->id, 4);
553}
554
555void GBAGetGameTitle(const struct GBA* gba, char* out) {
556	if (gba->memory.rom) {
557		memcpy(out, &((struct GBACartridge*) gba->memory.rom)->title, 12);
558		return;
559	}
560	if (gba->isPristine && gba->memory.wram) {
561		memcpy(out, &((struct GBACartridge*) gba->memory.wram)->title, 12);
562		return;
563	}
564	strncpy(out, "(BIOS)", 12);
565}
566
567void GBAHitStub(struct ARMCore* cpu, uint32_t opcode) {
568	struct GBA* gba = (struct GBA*) cpu->master;
569#ifdef USE_DEBUGGERS
570	if (gba->debugger) {
571		struct mDebuggerEntryInfo info = {
572			.address = _ARMPCAddress(cpu),
573			.opcode = opcode
574		};
575		mDebuggerEnter(gba->debugger->d.p, DEBUGGER_ENTER_ILLEGAL_OP, &info);
576	}
577#endif
578	// TODO: More sensible category?
579	mLOG(GBA, ERROR, "Stub opcode: %08x", opcode);
580}
581
582void GBAIllegal(struct ARMCore* cpu, uint32_t opcode) {
583	struct GBA* gba = (struct GBA*) cpu->master;
584	if (!gba->yankedRomSize) {
585		// TODO: More sensible category?
586		mLOG(GBA, WARN, "Illegal opcode: %08x", opcode);
587	}
588	if (cpu->executionMode == MODE_THUMB && (opcode & 0xFFC0) == 0xE800) {
589		mLOG(GBA, DEBUG, "Hit Wii U VC opcode: %08x", opcode);
590		return;
591	}
592#ifdef USE_DEBUGGERS
593	if (gba->debugger) {
594		struct mDebuggerEntryInfo info = {
595			.address = _ARMPCAddress(cpu),
596			.opcode = opcode
597		};
598		mDebuggerEnter(gba->debugger->d.p, DEBUGGER_ENTER_ILLEGAL_OP, &info);
599	} else
600#endif
601	{
602		ARMRaiseUndefined(cpu);
603	}
604}
605
606void GBABreakpoint(struct ARMCore* cpu, int immediate) {
607	struct GBA* gba = (struct GBA*) cpu->master;
608	if (immediate >= CPU_COMPONENT_MAX) {
609		return;
610	}
611	switch (immediate) {
612#ifdef USE_DEBUGGERS
613	case CPU_COMPONENT_DEBUGGER:
614		if (gba->debugger) {
615			struct mDebuggerEntryInfo info = {
616				.address = _ARMPCAddress(cpu),
617				.breakType = BREAKPOINT_SOFTWARE
618			};
619			mDebuggerEnter(gba->debugger->d.p, DEBUGGER_ENTER_BREAKPOINT, &info);
620		}
621		break;
622#endif
623	case CPU_COMPONENT_CHEAT_DEVICE:
624		if (gba->cpu->components[CPU_COMPONENT_CHEAT_DEVICE]) {
625			struct mCheatDevice* device = (struct mCheatDevice*) gba->cpu->components[CPU_COMPONENT_CHEAT_DEVICE];
626			struct GBACheatHook* hook = 0;
627			size_t i;
628			for (i = 0; i < mCheatSetsSize(&device->cheats); ++i) {
629				struct GBACheatSet* cheats = (struct GBACheatSet*) *mCheatSetsGetPointer(&device->cheats, i);
630				if (cheats->hook && cheats->hook->address == _ARMPCAddress(cpu)) {
631					mCheatRefresh(device, &cheats->d);
632					hook = cheats->hook;
633				}
634			}
635			if (hook) {
636				ARMRunFake(cpu, hook->patchedOpcode);
637			}
638		}
639		break;
640	default:
641		break;
642	}
643}
644
645void GBAFrameStarted(struct GBA* gba) {
646	GBATestKeypadIRQ(gba);
647
648	size_t c;
649	for (c = 0; c < mCoreCallbacksListSize(&gba->coreCallbacks); ++c) {
650		struct mCoreCallbacks* callbacks = mCoreCallbacksListGetPointer(&gba->coreCallbacks, c);
651		if (callbacks->videoFrameStarted) {
652			callbacks->videoFrameStarted(callbacks->context);
653		}
654	}
655}
656
657void GBAFrameEnded(struct GBA* gba) {
658	GBASavedataClean(&gba->memory.savedata, gba->video.frameCounter);
659
660	if (gba->rr) {
661		gba->rr->nextFrame(gba->rr);
662	}
663
664	if (gba->cpu->components && gba->cpu->components[CPU_COMPONENT_CHEAT_DEVICE]) {
665		struct mCheatDevice* device = (struct mCheatDevice*) gba->cpu->components[CPU_COMPONENT_CHEAT_DEVICE];
666		size_t i;
667		for (i = 0; i < mCheatSetsSize(&device->cheats); ++i) {
668			struct GBACheatSet* cheats = (struct GBACheatSet*) *mCheatSetsGetPointer(&device->cheats, i);
669			mCheatRefresh(device, &cheats->d);
670		}
671	}
672
673	if (gba->stream && gba->stream->postVideoFrame) {
674		const color_t* pixels;
675		size_t stride;
676		gba->video.renderer->getPixels(gba->video.renderer, &stride, (const void**) &pixels);
677		gba->stream->postVideoFrame(gba->stream, pixels, stride);
678	}
679
680	if (gba->memory.hw.devices & (HW_GB_PLAYER | HW_GB_PLAYER_DETECTION)) {
681		GBAHardwarePlayerUpdate(gba);
682	}
683
684	size_t c;
685	for (c = 0; c < mCoreCallbacksListSize(&gba->coreCallbacks); ++c) {
686		struct mCoreCallbacks* callbacks = mCoreCallbacksListGetPointer(&gba->coreCallbacks, c);
687		if (callbacks->videoFrameEnded) {
688			callbacks->videoFrameEnded(callbacks->context);
689		}
690	}
691}
692
693void GBATestKeypadIRQ(struct GBA* gba) {
694	uint16_t keycnt = gba->memory.io[REG_KEYCNT >> 1];
695	if (!(keycnt & 0x4000)) {
696		return;
697	}
698	int isAnd = keycnt & 0x8000;
699	uint16_t keyInput;
700
701	if (!gba->keySource) {
702		// TODO?
703		return;
704	}
705
706	keycnt &= 0x3FF;
707	keyInput = *gba->keySource;
708
709	if (isAnd && keycnt == keyInput) {
710		GBARaiseIRQ(gba, IRQ_KEYPAD);
711	} else if (!isAnd && keycnt & keyInput) {
712		GBARaiseIRQ(gba, IRQ_KEYPAD);
713	}
714}
715
716void GBASetBreakpoint(struct GBA* gba, struct mCPUComponent* component, uint32_t address, enum ExecutionMode mode, uint32_t* opcode) {
717	size_t immediate;
718	for (immediate = 0; immediate < gba->cpu->numComponents; ++immediate) {
719		if (gba->cpu->components[immediate] == component) {
720			break;
721		}
722	}
723	if (immediate == gba->cpu->numComponents) {
724		return;
725	}
726	if (mode == MODE_ARM) {
727		int32_t value;
728		int32_t old;
729		value = 0xE1200070;
730		value |= immediate & 0xF;
731		value |= (immediate & 0xFFF0) << 4;
732		GBAPatch32(gba->cpu, address, value, &old);
733		*opcode = old;
734	} else {
735		int16_t value;
736		int16_t old;
737		value = 0xBE00;
738		value |= immediate & 0xFF;
739		GBAPatch16(gba->cpu, address, value, &old);
740		*opcode = (uint16_t) old;
741	}
742}
743
744void GBAClearBreakpoint(struct GBA* gba, uint32_t address, enum ExecutionMode mode, uint32_t opcode) {
745	if (mode == MODE_ARM) {
746		GBAPatch32(gba->cpu, address, opcode, 0);
747	} else {
748		GBAPatch16(gba->cpu, address, opcode, 0);
749	}
750}
751
752static bool _setSoftwareBreakpoint(struct ARMDebugger* debugger, uint32_t address, enum ExecutionMode mode, uint32_t* opcode) {
753	GBASetBreakpoint((struct GBA*) debugger->cpu->master, &debugger->d.p->d, address, mode, opcode);
754	return true;
755}
756
757static bool _clearSoftwareBreakpoint(struct ARMDebugger* debugger, uint32_t address, enum ExecutionMode mode, uint32_t opcode) {
758	GBAClearBreakpoint((struct GBA*) debugger->cpu->master, address, mode, opcode);
759	return true;
760}