all repos — mgba @ d9764e8cea482fead7e1a3376d1007c884ee252b

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 "gba.h"
  7
  8#include "core/thread.h"
  9
 10#include "arm/decoder.h"
 11#include "arm/debugger/debugger.h"
 12#include "arm/isa-inlines.h"
 13
 14#include "gba/bios.h"
 15#include "gba/cheats.h"
 16#include "gba/io.h"
 17#include "gba/overrides.h"
 18#include "gba/rr/rr.h"
 19#include "gba/serialize.h"
 20#include "gba/sio.h"
 21#include "gba/vfame.h"
 22
 23#include "util/crc32.h"
 24#include "util/memory.h"
 25#include "util/math.h"
 26#include "util/patch.h"
 27#include "util/vfs.h"
 28
 29mLOG_DEFINE_CATEGORY(GBA, "GBA");
 30mLOG_DEFINE_CATEGORY(GBA_DEBUG, "GBA Debug");
 31
 32const uint32_t GBA_COMPONENT_MAGIC = 0x1000000;
 33
 34static const size_t GBA_ROM_MAGIC_OFFSET = 3;
 35static const uint8_t GBA_ROM_MAGIC[] = { 0xEA };
 36
 37static const size_t GBA_MB_MAGIC_OFFSET = 0xC0;
 38
 39static void GBAInit(void* cpu, struct mCPUComponent* component);
 40static void GBAInterruptHandlerInit(struct ARMInterruptHandler* irqh);
 41static void GBAProcessEvents(struct ARMCore* cpu);
 42static int32_t GBATimersProcessEvents(struct GBA* gba, int32_t cycles);
 43static void GBAHitStub(struct ARMCore* cpu, uint32_t opcode);
 44static void GBAIllegal(struct ARMCore* cpu, uint32_t opcode);
 45static void GBABreakpoint(struct ARMCore* cpu, int immediate);
 46
 47static bool _setSoftwareBreakpoint(struct ARMDebugger*, uint32_t address, enum ExecutionMode mode, uint32_t* opcode);
 48static bool _clearSoftwareBreakpoint(struct ARMDebugger*, uint32_t address, enum ExecutionMode mode, uint32_t opcode);
 49
 50
 51#ifdef _3DS
 52extern uint32_t* romBuffer;
 53extern size_t romBufferSize;
 54#endif
 55
 56void GBACreate(struct GBA* gba) {
 57	gba->d.id = GBA_COMPONENT_MAGIC;
 58	gba->d.init = GBAInit;
 59	gba->d.deinit = 0;
 60}
 61
 62static void GBAInit(void* cpu, struct mCPUComponent* component) {
 63	struct GBA* gba = (struct GBA*) component;
 64	gba->cpu = cpu;
 65	gba->debugger = 0;
 66	gba->sync = 0;
 67
 68	GBAInterruptHandlerInit(&gba->cpu->irqh);
 69	GBAMemoryInit(gba);
 70	GBASavedataInit(&gba->memory.savedata, 0);
 71
 72	gba->video.p = gba;
 73	GBAVideoInit(&gba->video);
 74
 75	gba->audio.p = gba;
 76	GBAAudioInit(&gba->audio, GBA_AUDIO_SAMPLES);
 77
 78	GBAIOInit(gba);
 79
 80	gba->sio.p = gba;
 81	GBASIOInit(&gba->sio);
 82
 83	gba->timersEnabled = 0;
 84	memset(gba->timers, 0, sizeof(gba->timers));
 85
 86	gba->springIRQ = 0;
 87	gba->keySource = 0;
 88	gba->rotationSource = 0;
 89	gba->luminanceSource = 0;
 90	gba->rtcSource = 0;
 91	gba->rumble = 0;
 92	gba->rr = 0;
 93
 94	gba->romVf = 0;
 95	gba->biosVf = 0;
 96
 97	gba->stream = NULL;
 98	gba->keyCallback = NULL;
 99	gba->stopCallback = NULL;
100	gba->stopCallback = NULL;
101	gba->coreCallbacks = NULL;
102
103	gba->biosChecksum = GBAChecksum(gba->memory.bios, SIZE_BIOS);
104
105	gba->idleOptimization = IDLE_LOOP_REMOVE;
106	gba->idleLoop = IDLE_LOOP_NONE;
107
108	gba->realisticTiming = true;
109	gba->hardCrash = true;
110	gba->allowOpposingDirections = true;
111
112	gba->performingDMA = false;
113
114	gba->pristineRom = 0;
115	gba->pristineRomSize = 0;
116	gba->yankedRomSize = 0;
117}
118
119void GBAUnloadROM(struct GBA* gba) {
120	if (gba->memory.rom && gba->pristineRom != gba->memory.rom) {
121		if (gba->yankedRomSize) {
122			gba->yankedRomSize = 0;
123		}
124		mappedMemoryFree(gba->memory.rom, SIZE_CART0);
125	}
126	gba->memory.rom = 0;
127
128	if (gba->romVf) {
129#ifndef _3DS
130		gba->romVf->unmap(gba->romVf, gba->pristineRom, gba->pristineRomSize);
131#endif
132		gba->romVf->close(gba->romVf);
133		gba->romVf = 0;
134	}
135	gba->pristineRom = 0;
136
137	GBASavedataDeinit(&gba->memory.savedata);
138	if (gba->memory.savedata.realVf) {
139		gba->memory.savedata.realVf->close(gba->memory.savedata.realVf);
140		gba->memory.savedata.realVf = 0;
141	}
142	gba->idleLoop = IDLE_LOOP_NONE;
143}
144
145void GBADestroy(struct GBA* gba) {
146	GBAUnloadROM(gba);
147
148	if (gba->biosVf) {
149		gba->biosVf->unmap(gba->biosVf, gba->memory.bios, SIZE_BIOS);
150		gba->biosVf->close(gba->biosVf);
151		gba->biosVf = 0;
152	}
153
154	GBAMemoryDeinit(gba);
155	GBAVideoDeinit(&gba->video);
156	GBAAudioDeinit(&gba->audio);
157	GBASIODeinit(&gba->sio);
158	gba->rr = 0;
159}
160
161void GBAInterruptHandlerInit(struct ARMInterruptHandler* irqh) {
162	irqh->reset = GBAReset;
163	irqh->processEvents = GBAProcessEvents;
164	irqh->swi16 = GBASwi16;
165	irqh->swi32 = GBASwi32;
166	irqh->hitIllegal = GBAIllegal;
167	irqh->readCPSR = GBATestIRQ;
168	irqh->hitStub = GBAHitStub;
169	irqh->bkpt16 = GBABreakpoint;
170	irqh->bkpt32 = GBABreakpoint;
171}
172
173void GBAReset(struct ARMCore* cpu) {
174	ARMSetPrivilegeMode(cpu, MODE_IRQ);
175	cpu->gprs[ARM_SP] = SP_BASE_IRQ;
176	ARMSetPrivilegeMode(cpu, MODE_SUPERVISOR);
177	cpu->gprs[ARM_SP] = SP_BASE_SUPERVISOR;
178	ARMSetPrivilegeMode(cpu, MODE_SYSTEM);
179	cpu->gprs[ARM_SP] = SP_BASE_SYSTEM;
180
181	struct GBA* gba = (struct GBA*) cpu->master;
182	if (!gba->rr || (!gba->rr->isPlaying(gba->rr) && !gba->rr->isRecording(gba->rr))) {
183		GBASavedataUnmask(&gba->memory.savedata);
184	}
185
186	if (gba->yankedRomSize) {
187		gba->memory.romSize = gba->yankedRomSize;
188		gba->memory.romMask = toPow2(gba->memory.romSize) - 1;
189		gba->yankedRomSize = 0;
190	}
191	GBAMemoryReset(gba);
192	GBAVideoReset(&gba->video);
193	GBAAudioReset(&gba->audio);
194	GBAIOInit(gba);
195
196	GBASIOReset(&gba->sio);
197
198	gba->timersEnabled = 0;
199	memset(gba->timers, 0, sizeof(gba->timers));
200
201	gba->lastJump = 0;
202	gba->haltPending = false;
203	gba->idleDetectionStep = 0;
204	gba->idleDetectionFailures = 0;
205
206	gba->debug = false;
207	memset(gba->debugString, 0, sizeof(gba->debugString));
208}
209
210void GBASkipBIOS(struct GBA* gba) {
211	struct ARMCore* cpu = gba->cpu;
212	if (cpu->gprs[ARM_PC] == BASE_RESET + WORD_SIZE_ARM) {
213		if (gba->memory.rom) {
214			cpu->gprs[ARM_PC] = BASE_CART0;
215		} else {
216			cpu->gprs[ARM_PC] = BASE_WORKING_RAM;
217		}
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	do {
237		int32_t cycles = cpu->nextEvent;
238		int32_t nextEvent = INT_MAX;
239		int32_t testEvent;
240#ifndef NDEBUG
241		if (cycles < 0) {
242			mLOG(GBA, FATAL, "Negative cycles passed: %i", cycles);
243		}
244#endif
245
246		testEvent = GBAVideoProcessEvents(&gba->video, cycles);
247		if (testEvent < nextEvent) {
248#ifndef NDEBUG
249			if (testEvent == 0) {
250				mLOG(GBA, ERROR, "Video requiring 0 cycles");
251			}
252#endif
253			nextEvent = testEvent;
254		}
255
256		testEvent = GBAAudioProcessEvents(&gba->audio, cycles);
257		if (testEvent < nextEvent) {
258#ifndef NDEBUG
259			if (testEvent == 0) {
260				mLOG(GBA, ERROR, "Audio requiring 0 cycles");
261			}
262#endif
263			nextEvent = testEvent;
264		}
265
266		testEvent = GBATimersProcessEvents(gba, cycles);
267		if (testEvent < nextEvent) {
268#ifndef NDEBUG
269			if (testEvent == 0) {
270				mLOG(GBA, ERROR, "Timers requiring 0 cycles");
271			}
272#endif
273			nextEvent = testEvent;
274		}
275
276		testEvent = GBAMemoryRunDMAs(gba, cycles);
277		if (testEvent < nextEvent) {
278#ifndef NDEBUG
279			if (testEvent == 0) {
280				mLOG(GBA, ERROR, "DMAs requiring 0 cycles");
281			}
282#endif
283			nextEvent = testEvent;
284		}
285
286		testEvent = GBASIOProcessEvents(&gba->sio, cycles);
287		if (testEvent < nextEvent) {
288			nextEvent = testEvent;
289		}
290
291		cpu->cycles -= cycles;
292		cpu->nextEvent = nextEvent;
293
294		if (cpu->halted) {
295			cpu->cycles = cpu->nextEvent;
296			if (!gba->memory.io[REG_IME >> 1] || !gba->memory.io[REG_IE >> 1]) {
297				break;
298			}
299		}
300		if (nextEvent == 0) {
301			break;
302		}
303#ifndef NDEBUG
304		else if (nextEvent < 0) {
305			mLOG(GBA, FATAL, "Negative cycles will pass: %i", nextEvent);
306		}
307#endif
308	} while (cpu->cycles >= cpu->nextEvent);
309}
310
311static int32_t GBATimersProcessEvents(struct GBA* gba, int32_t cycles) {
312	int32_t nextEvent = INT_MAX;
313	if (gba->timersEnabled) {
314		struct GBATimer* timer;
315		struct GBATimer* nextTimer;
316
317		timer = &gba->timers[0];
318		if (GBATimerFlagsIsEnable(timer->flags) && timer->nextEvent != INT_MAX) {
319			timer->nextEvent -= cycles;
320			timer->lastEvent -= cycles;
321			while (timer->nextEvent <= 0) {
322				timer->lastEvent = timer->nextEvent;
323				timer->nextEvent += timer->overflowInterval;
324				gba->memory.io[REG_TM0CNT_LO >> 1] = timer->reload;
325				timer->oldReload = timer->reload;
326
327				if (GBATimerFlagsIsDoIrq(timer->flags)) {
328					GBARaiseIRQ(gba, IRQ_TIMER0);
329				}
330
331				if (gba->audio.enable) {
332					if ((gba->audio.chALeft || gba->audio.chARight) && gba->audio.chATimer == 0) {
333						GBAAudioSampleFIFO(&gba->audio, 0, timer->lastEvent);
334					}
335
336					if ((gba->audio.chBLeft || gba->audio.chBRight) && gba->audio.chBTimer == 0) {
337						GBAAudioSampleFIFO(&gba->audio, 1, timer->lastEvent);
338					}
339				}
340
341				nextTimer = &gba->timers[1];
342				if (GBATimerFlagsIsCountUp(nextTimer->flags)) {
343					++gba->memory.io[REG_TM1CNT_LO >> 1];
344					if (!gba->memory.io[REG_TM1CNT_LO >> 1]) {
345						nextTimer->nextEvent = cycles;
346					}
347				}
348			}
349			nextEvent = timer->nextEvent;
350		}
351
352		timer = &gba->timers[1];
353		if (GBATimerFlagsIsEnable(timer->flags) && timer->nextEvent != INT_MAX) {
354			timer->nextEvent -= cycles;
355			timer->lastEvent -= cycles;
356			if (timer->nextEvent <= 0) {
357				timer->lastEvent = timer->nextEvent;
358				timer->nextEvent += timer->overflowInterval;
359				gba->memory.io[REG_TM1CNT_LO >> 1] = timer->reload;
360				timer->oldReload = timer->reload;
361
362				if (GBATimerFlagsIsDoIrq(timer->flags)) {
363					GBARaiseIRQ(gba, IRQ_TIMER1);
364				}
365
366				if (gba->audio.enable) {
367					if ((gba->audio.chALeft || gba->audio.chARight) && gba->audio.chATimer == 1) {
368						GBAAudioSampleFIFO(&gba->audio, 0, timer->lastEvent);
369					}
370
371					if ((gba->audio.chBLeft || gba->audio.chBRight) && gba->audio.chBTimer == 1) {
372						GBAAudioSampleFIFO(&gba->audio, 1, timer->lastEvent);
373					}
374				}
375
376				if (GBATimerFlagsIsCountUp(timer->flags)) {
377					timer->nextEvent = INT_MAX;
378				}
379
380				nextTimer = &gba->timers[2];
381				if (GBATimerFlagsIsCountUp(nextTimer->flags)) {
382					++gba->memory.io[REG_TM2CNT_LO >> 1];
383					if (!gba->memory.io[REG_TM2CNT_LO >> 1]) {
384						nextTimer->nextEvent = cycles;
385					}
386				}
387			}
388			if (timer->nextEvent < nextEvent) {
389				nextEvent = timer->nextEvent;
390			}
391		}
392
393		timer = &gba->timers[2];
394		if (GBATimerFlagsIsEnable(timer->flags) && timer->nextEvent != INT_MAX) {
395			timer->nextEvent -= cycles;
396			timer->lastEvent -= cycles;
397			if (timer->nextEvent <= 0) {
398				timer->lastEvent = timer->nextEvent;
399				timer->nextEvent += timer->overflowInterval;
400				gba->memory.io[REG_TM2CNT_LO >> 1] = timer->reload;
401				timer->oldReload = timer->reload;
402
403				if (GBATimerFlagsIsDoIrq(timer->flags)) {
404					GBARaiseIRQ(gba, IRQ_TIMER2);
405				}
406
407				if (GBATimerFlagsIsCountUp(timer->flags)) {
408					timer->nextEvent = INT_MAX;
409				}
410
411				nextTimer = &gba->timers[3];
412				if (GBATimerFlagsIsCountUp(nextTimer->flags)) {
413					++gba->memory.io[REG_TM3CNT_LO >> 1];
414					if (!gba->memory.io[REG_TM3CNT_LO >> 1]) {
415						nextTimer->nextEvent = cycles;
416					}
417				}
418			}
419			if (timer->nextEvent < nextEvent) {
420				nextEvent = timer->nextEvent;
421			}
422		}
423
424		timer = &gba->timers[3];
425		if (GBATimerFlagsIsEnable(timer->flags) && timer->nextEvent != INT_MAX) {
426			timer->nextEvent -= cycles;
427			timer->lastEvent -= cycles;
428			if (timer->nextEvent <= 0) {
429				timer->lastEvent = timer->nextEvent;
430				timer->nextEvent += timer->overflowInterval;
431				gba->memory.io[REG_TM3CNT_LO >> 1] = timer->reload;
432				timer->oldReload = timer->reload;
433
434				if (GBATimerFlagsIsDoIrq(timer->flags)) {
435					GBARaiseIRQ(gba, IRQ_TIMER3);
436				}
437
438				if (GBATimerFlagsIsCountUp(timer->flags)) {
439					timer->nextEvent = INT_MAX;
440				}
441			}
442			if (timer->nextEvent < nextEvent) {
443				nextEvent = timer->nextEvent;
444			}
445		}
446	}
447	return nextEvent;
448}
449
450void GBAAttachDebugger(struct GBA* gba, struct mDebugger* debugger) {
451	gba->debugger = (struct ARMDebugger*) debugger->platform;
452	gba->debugger->setSoftwareBreakpoint = _setSoftwareBreakpoint;
453	gba->debugger->clearSoftwareBreakpoint = _clearSoftwareBreakpoint;
454	gba->cpu->components[CPU_COMPONENT_DEBUGGER] = &debugger->d;
455	ARMHotplugAttach(gba->cpu, CPU_COMPONENT_DEBUGGER);
456}
457
458void GBADetachDebugger(struct GBA* gba) {
459	gba->debugger = 0;
460	ARMHotplugDetach(gba->cpu, CPU_COMPONENT_DEBUGGER);
461	gba->cpu->components[CPU_COMPONENT_DEBUGGER] = 0;
462}
463
464bool GBALoadMB(struct GBA* gba, struct VFile* vf) {
465	GBAUnloadROM(gba);
466	gba->romVf = vf;
467	gba->pristineRomSize = vf->size(vf);
468	vf->seek(vf, 0, SEEK_SET);
469	if (gba->pristineRomSize > SIZE_WORKING_RAM) {
470		gba->pristineRomSize = SIZE_WORKING_RAM;
471	}
472#ifdef _3DS
473	gba->pristineRom = 0;
474	if (gba->pristineRomSize <= romBufferSize) {
475		gba->pristineRom = romBuffer;
476		vf->read(vf, romBuffer, gba->pristineRomSize);
477	}
478#else
479	gba->pristineRom = vf->map(vf, gba->pristineRomSize, MAP_READ);
480#endif
481	if (!gba->pristineRom) {
482		mLOG(GBA, WARN, "Couldn't map ROM");
483		return false;
484	}
485	gba->yankedRomSize = 0;
486	gba->memory.romSize = 0;
487	gba->memory.romMask = 0;
488	gba->romCrc32 = doCrc32(gba->pristineRom, gba->pristineRomSize);
489	return true;
490}
491
492bool GBALoadROM(struct GBA* gba, struct VFile* vf) {
493	if (!vf) {
494		return false;
495	}
496	GBAUnloadROM(gba);
497	gba->romVf = vf;
498	gba->pristineRomSize = vf->size(vf);
499	vf->seek(vf, 0, SEEK_SET);
500	if (gba->pristineRomSize > SIZE_CART0) {
501		gba->pristineRomSize = SIZE_CART0;
502	}
503#ifdef _3DS
504	gba->pristineRom = 0;
505	if (gba->pristineRomSize <= romBufferSize) {
506		gba->pristineRom = romBuffer;
507		vf->read(vf, romBuffer, gba->pristineRomSize);
508	}
509#else
510	gba->pristineRom = vf->map(vf, gba->pristineRomSize, MAP_READ);
511#endif
512	if (!gba->pristineRom) {
513		mLOG(GBA, WARN, "Couldn't map ROM");
514		return false;
515	}
516	gba->yankedRomSize = 0;
517	gba->memory.rom = gba->pristineRom;
518	gba->memory.romSize = gba->pristineRomSize;
519	gba->memory.romMask = toPow2(gba->memory.romSize) - 1;
520	gba->memory.mirroring = false;
521	gba->romCrc32 = doCrc32(gba->memory.rom, gba->memory.romSize);
522	GBAHardwareInit(&gba->memory.hw, &((uint16_t*) gba->memory.rom)[GPIO_REG_DATA >> 1]);
523	GBAVFameDetect(&gba->memory.vfame, gba->memory.rom, gba->memory.romSize);
524	// TODO: error check
525	return true;
526}
527
528bool GBALoadSave(struct GBA* gba, struct VFile* sav) {
529	GBASavedataInit(&gba->memory.savedata, sav);
530	return true;
531}
532
533void GBAYankROM(struct GBA* gba) {
534	gba->yankedRomSize = gba->memory.romSize;
535	gba->memory.romSize = 0;
536	gba->memory.romMask = 0;
537	GBARaiseIRQ(gba, IRQ_GAMEPAK);
538}
539
540void GBALoadBIOS(struct GBA* gba, struct VFile* vf) {
541	gba->biosVf = vf;
542	uint32_t* bios = vf->map(vf, SIZE_BIOS, MAP_READ);
543	if (!bios) {
544		mLOG(GBA, WARN, "Couldn't map BIOS");
545		return;
546	}
547	gba->memory.bios = bios;
548	gba->memory.fullBios = 1;
549	uint32_t checksum = GBAChecksum(gba->memory.bios, SIZE_BIOS);
550	mLOG(GBA, DEBUG, "BIOS Checksum: 0x%X", checksum);
551	if (checksum == GBA_BIOS_CHECKSUM) {
552		mLOG(GBA, INFO, "Official GBA BIOS detected");
553	} else if (checksum == GBA_DS_BIOS_CHECKSUM) {
554		mLOG(GBA, INFO, "Official GBA (DS) BIOS detected");
555	} else {
556		mLOG(GBA, WARN, "BIOS checksum incorrect");
557	}
558	gba->biosChecksum = checksum;
559	if (gba->memory.activeRegion == REGION_BIOS) {
560		gba->cpu->memory.activeRegion = gba->memory.bios;
561	}
562	// TODO: error check
563}
564
565void GBAApplyPatch(struct GBA* gba, struct Patch* patch) {
566	size_t patchedSize = patch->outputSize(patch, gba->memory.romSize);
567	if (!patchedSize || patchedSize > SIZE_CART0) {
568		return;
569	}
570	gba->memory.rom = anonymousMemoryMap(SIZE_CART0);
571	if (!patch->applyPatch(patch, gba->pristineRom, gba->pristineRomSize, gba->memory.rom, patchedSize)) {
572		mappedMemoryFree(gba->memory.rom, patchedSize);
573		gba->memory.rom = gba->pristineRom;
574		return;
575	}
576	gba->memory.romSize = patchedSize;
577	gba->memory.romMask = SIZE_CART0 - 1;
578	gba->romCrc32 = doCrc32(gba->memory.rom, gba->memory.romSize);
579}
580
581void GBATimerUpdateRegister(struct GBA* gba, int timer) {
582	struct GBATimer* currentTimer = &gba->timers[timer];
583	if (GBATimerFlagsIsEnable(currentTimer->flags) && !GBATimerFlagsIsCountUp(currentTimer->flags)) {
584		int32_t prefetchSkew = 0;
585		if (gba->memory.lastPrefetchedPc >= (uint32_t) gba->cpu->gprs[ARM_PC]) {
586			prefetchSkew = (gba->memory.lastPrefetchedPc - gba->cpu->gprs[ARM_PC]) * (gba->cpu->memory.activeSeqCycles16 + 1) / WORD_SIZE_THUMB;
587		}
588		// Reading this takes two cycles (1N+1I), so let's remove them preemptively
589		gba->memory.io[(REG_TM0CNT_LO + (timer << 2)) >> 1] = currentTimer->oldReload + ((gba->cpu->cycles - currentTimer->lastEvent - 2 + prefetchSkew) >> GBATimerFlagsGetPrescaleBits(currentTimer->flags));
590	}
591}
592
593void GBATimerWriteTMCNT_LO(struct GBA* gba, int timer, uint16_t reload) {
594	gba->timers[timer].reload = reload;
595	gba->timers[timer].overflowInterval = (0x10000 - gba->timers[timer].reload) << GBATimerFlagsGetPrescaleBits(gba->timers[timer].flags);
596}
597
598void GBATimerWriteTMCNT_HI(struct GBA* gba, int timer, uint16_t control) {
599	struct GBATimer* currentTimer = &gba->timers[timer];
600	GBATimerUpdateRegister(gba, timer);
601
602	unsigned oldPrescale = GBATimerFlagsGetPrescaleBits(currentTimer->flags);
603	switch (control & 0x0003) {
604	case 0x0000:
605		currentTimer->flags = GBATimerFlagsSetPrescaleBits(currentTimer->flags, 0);
606		break;
607	case 0x0001:
608		currentTimer->flags = GBATimerFlagsSetPrescaleBits(currentTimer->flags, 6);
609		break;
610	case 0x0002:
611		currentTimer->flags = GBATimerFlagsSetPrescaleBits(currentTimer->flags, 8);
612		break;
613	case 0x0003:
614		currentTimer->flags = GBATimerFlagsSetPrescaleBits(currentTimer->flags, 10);
615		break;
616	}
617	currentTimer->flags = GBATimerFlagsTestFillCountUp(currentTimer->flags, timer > 0 && (control & 0x0004));
618	currentTimer->flags = GBATimerFlagsTestFillDoIrq(currentTimer->flags, control & 0x0040);
619	currentTimer->overflowInterval = (0x10000 - currentTimer->reload) << GBATimerFlagsGetPrescaleBits(currentTimer->flags);
620	bool wasEnabled = GBATimerFlagsIsEnable(currentTimer->flags);
621	currentTimer->flags = GBATimerFlagsTestFillEnable(currentTimer->flags, control & 0x0080);
622	if (!wasEnabled && GBATimerFlagsIsEnable(currentTimer->flags)) {
623		if (!GBATimerFlagsIsCountUp(currentTimer->flags)) {
624			currentTimer->nextEvent = gba->cpu->cycles + currentTimer->overflowInterval;
625		} else {
626			currentTimer->nextEvent = INT_MAX;
627		}
628		gba->memory.io[(REG_TM0CNT_LO + (timer << 2)) >> 1] = currentTimer->reload;
629		currentTimer->oldReload = currentTimer->reload;
630		currentTimer->lastEvent = gba->cpu->cycles;
631		gba->timersEnabled |= 1 << timer;
632	} else if (wasEnabled && !GBATimerFlagsIsEnable(currentTimer->flags)) {
633		if (!GBATimerFlagsIsCountUp(currentTimer->flags)) {
634			gba->memory.io[(REG_TM0CNT_LO + (timer << 2)) >> 1] = currentTimer->oldReload + ((gba->cpu->cycles - currentTimer->lastEvent) >> oldPrescale);
635		}
636		gba->timersEnabled &= ~(1 << timer);
637	} else if (GBATimerFlagsGetPrescaleBits(currentTimer->flags) != oldPrescale && !GBATimerFlagsIsCountUp(currentTimer->flags)) {
638		// FIXME: this might be before present
639		currentTimer->nextEvent = currentTimer->lastEvent + currentTimer->overflowInterval;
640	}
641
642	if (currentTimer->nextEvent < gba->cpu->nextEvent) {
643		gba->cpu->nextEvent = currentTimer->nextEvent;
644	}
645};
646
647void GBAWriteIE(struct GBA* gba, uint16_t value) {
648	if (value & (1 << IRQ_KEYPAD)) {
649		mLOG(GBA, STUB, "Keypad interrupts not implemented");
650	}
651
652	if (gba->memory.io[REG_IME >> 1] && value & gba->memory.io[REG_IF >> 1]) {
653		ARMRaiseIRQ(gba->cpu);
654	}
655}
656
657void GBAWriteIME(struct GBA* gba, uint16_t value) {
658	if (value && gba->memory.io[REG_IE >> 1] & gba->memory.io[REG_IF >> 1]) {
659		ARMRaiseIRQ(gba->cpu);
660	}
661}
662
663void GBARaiseIRQ(struct GBA* gba, enum GBAIRQ irq) {
664	gba->memory.io[REG_IF >> 1] |= 1 << irq;
665	gba->cpu->halted = 0;
666
667	if (gba->memory.io[REG_IME >> 1] && (gba->memory.io[REG_IE >> 1] & 1 << irq)) {
668		ARMRaiseIRQ(gba->cpu);
669	}
670}
671
672void GBATestIRQ(struct ARMCore* cpu) {
673	struct GBA* gba = (struct GBA*) cpu->master;
674	if (gba->memory.io[REG_IME >> 1] && gba->memory.io[REG_IE >> 1] & gba->memory.io[REG_IF >> 1]) {
675		gba->springIRQ = 1;
676		gba->cpu->nextEvent = gba->cpu->cycles;
677	}
678}
679
680void GBAHalt(struct GBA* gba) {
681	gba->cpu->nextEvent = gba->cpu->cycles;
682	gba->cpu->halted = 1;
683}
684
685void GBAStop(struct GBA* gba) {
686	if (!gba->stopCallback) {
687		return;
688	}
689	gba->cpu->nextEvent = gba->cpu->cycles;
690	gba->stopCallback->stop(gba->stopCallback);
691}
692
693void GBADebug(struct GBA* gba, uint16_t flags) {
694	gba->debugFlags = flags;
695	if (GBADebugFlagsIsSend(gba->debugFlags)) {
696		int level = 1 << GBADebugFlagsGetLevel(gba->debugFlags);
697		level &= 0x1F;
698		char oolBuf[0x101];
699		strncpy(oolBuf, gba->debugString, sizeof(gba->debugString));
700		oolBuf[0x100] = '\0';
701		mLog(_mLOG_CAT_GBA_DEBUG(), level, "%s", oolBuf);
702	}
703	gba->debugFlags = GBADebugFlagsClearSend(gba->debugFlags);
704}
705
706bool GBAIsROM(struct VFile* vf) {
707	if (vf->seek(vf, GBA_ROM_MAGIC_OFFSET, SEEK_SET) < 0) {
708		return false;
709	}
710	uint8_t signature[sizeof(GBA_ROM_MAGIC)];
711	if (vf->read(vf, &signature, sizeof(signature)) != sizeof(signature)) {
712		return false;
713	}
714	if (GBAIsBIOS(vf)) {
715		return false;
716	}
717	return memcmp(signature, GBA_ROM_MAGIC, sizeof(signature)) == 0;
718}
719
720bool GBAIsMB(struct VFile* vf) {
721	if (!GBAIsROM(vf)) {
722		return false;
723	}
724	if (vf->size(vf) > SIZE_WORKING_RAM) {
725		return false;
726	}
727	if (vf->seek(vf, GBA_MB_MAGIC_OFFSET, SEEK_SET) < 0) {
728		return false;
729	}
730	uint32_t signature;
731	if (vf->read(vf, &signature, sizeof(signature)) != sizeof(signature)) {
732		return false;
733	}
734	uint32_t opcode;
735	LOAD_32(opcode, 0, &signature);
736	struct ARMInstructionInfo info;
737	ARMDecodeARM(opcode, &info);
738	if (info.branchType != ARM_BRANCH) {
739		return false;
740	}
741	if (info.op1.immediate <= 0) {
742		return false;
743	} else if (info.op1.immediate == 28) {
744		// Ancient toolchain that is known to throw MB detection for a loop
745		return false;
746	} else if (info.op1.immediate != 24) {
747		return true;
748	}
749	// Found a libgba-linked cart...these are a bit harder to detect.
750	return false;
751}
752
753bool GBAIsBIOS(struct VFile* vf) {
754	if (vf->seek(vf, 0, SEEK_SET) < 0) {
755		return false;
756	}
757	uint8_t interruptTable[7 * 4];
758	if (vf->read(vf, &interruptTable, sizeof(interruptTable)) != sizeof(interruptTable)) {
759		return false;
760	}
761	int i;
762	for (i = 0; i < 7; ++i) {
763		if (interruptTable[4 * i + 3] != 0xEA || interruptTable[4 * i + 2]) {
764			return false;
765		}
766	}
767	return true;
768}
769
770void GBAGetGameCode(const struct GBA* gba, char* out) {
771	memset(out, 0, 8);
772	if (!gba->memory.rom) {
773		return;
774	}
775
776	memcpy(out, "AGB-", 4);
777	memcpy(&out[4], &((struct GBACartridge*) gba->memory.rom)->id, 4);
778}
779
780void GBAGetGameTitle(const struct GBA* gba, char* out) {
781	if (gba->memory.rom) {
782		memcpy(out, &((struct GBACartridge*) gba->memory.rom)->title, 12);
783		return;
784	}
785	if (gba->pristineRom) {
786		memcpy(out, &((struct GBACartridge*) gba->pristineRom)->title, 12);
787		return;
788	}
789	strncpy(out, "(BIOS)", 12);
790}
791
792void GBAHitStub(struct ARMCore* cpu, uint32_t opcode) {
793	struct GBA* gba = (struct GBA*) cpu->master;
794	if (gba->debugger) {
795		struct mDebuggerEntryInfo info = {
796			.address = _ARMPCAddress(cpu),
797			.opcode = opcode
798		};
799		mDebuggerEnter(gba->debugger->d.p, DEBUGGER_ENTER_ILLEGAL_OP, &info);
800	}
801	// TODO: More sensible category?
802	mLOG(GBA, ERROR, "Stub opcode: %08x", opcode);
803}
804
805void GBAIllegal(struct ARMCore* cpu, uint32_t opcode) {
806	struct GBA* gba = (struct GBA*) cpu->master;
807	if (!gba->yankedRomSize) {
808		// TODO: More sensible category?
809		mLOG(GBA, WARN, "Illegal opcode: %08x", opcode);
810	}
811	if (gba->debugger) {
812		struct mDebuggerEntryInfo info = {
813			.address = _ARMPCAddress(cpu),
814			.opcode = opcode
815		};
816		mDebuggerEnter(gba->debugger->d.p, DEBUGGER_ENTER_ILLEGAL_OP, &info);
817	} else {
818		ARMRaiseUndefined(cpu);
819	}
820}
821
822void GBABreakpoint(struct ARMCore* cpu, int immediate) {
823	struct GBA* gba = (struct GBA*) cpu->master;
824	if (immediate >= CPU_COMPONENT_MAX) {
825		return;
826	}
827	switch (immediate) {
828	case CPU_COMPONENT_DEBUGGER:
829		if (gba->debugger) {
830			struct mDebuggerEntryInfo info = {
831				.address = _ARMPCAddress(cpu),
832				.breakType = BREAKPOINT_SOFTWARE
833			};
834			mDebuggerEnter(gba->debugger->d.p, DEBUGGER_ENTER_BREAKPOINT, &info);
835		}
836		break;
837	case CPU_COMPONENT_CHEAT_DEVICE:
838		if (gba->cpu->components[CPU_COMPONENT_CHEAT_DEVICE]) {
839			struct mCheatDevice* device = (struct mCheatDevice*) gba->cpu->components[CPU_COMPONENT_CHEAT_DEVICE];
840			struct GBACheatHook* hook = 0;
841			size_t i;
842			for (i = 0; i < mCheatSetsSize(&device->cheats); ++i) {
843				struct GBACheatSet* cheats = (struct GBACheatSet*) *mCheatSetsGetPointer(&device->cheats, i);
844				if (cheats->hook && cheats->hook->address == _ARMPCAddress(cpu)) {
845					mCheatRefresh(device, &cheats->d);
846					hook = cheats->hook;
847				}
848			}
849			if (hook) {
850				ARMRunFake(cpu, hook->patchedOpcode);
851			}
852		}
853		break;
854	default:
855		break;
856	}
857}
858
859void GBAFrameStarted(struct GBA* gba) {
860	UNUSED(gba);
861
862	struct mCoreCallbacks* callbacks = gba->coreCallbacks;
863	if (callbacks && callbacks->videoFrameStarted) {
864		callbacks->videoFrameStarted(callbacks->context);
865	}
866}
867
868void GBAFrameEnded(struct GBA* gba) {
869	GBASavedataClean(&gba->memory.savedata, gba->video.frameCounter);
870
871	if (gba->rr) {
872		gba->rr->nextFrame(gba->rr);
873	}
874
875	if (gba->cpu->components && gba->cpu->components[CPU_COMPONENT_CHEAT_DEVICE]) {
876		struct mCheatDevice* device = (struct mCheatDevice*) gba->cpu->components[CPU_COMPONENT_CHEAT_DEVICE];
877		size_t i;
878		for (i = 0; i < mCheatSetsSize(&device->cheats); ++i) {
879			struct GBACheatSet* cheats = (struct GBACheatSet*) *mCheatSetsGetPointer(&device->cheats, i);
880			mCheatRefresh(device, &cheats->d);
881		}
882	}
883
884	if (gba->stream && gba->stream->postVideoFrame) {
885		const color_t* pixels;
886		size_t stride;
887		gba->video.renderer->getPixels(gba->video.renderer, &stride, (const void**) &pixels);
888		gba->stream->postVideoFrame(gba->stream, pixels, stride);
889	}
890
891	if (gba->memory.hw.devices & (HW_GB_PLAYER | HW_GB_PLAYER_DETECTION)) {
892		GBAHardwarePlayerUpdate(gba);
893	}
894
895	struct mCoreCallbacks* callbacks = gba->coreCallbacks;
896	if (callbacks && callbacks->videoFrameEnded) {
897		callbacks->videoFrameEnded(callbacks->context);
898	}
899}
900
901void GBASetBreakpoint(struct GBA* gba, struct mCPUComponent* component, uint32_t address, enum ExecutionMode mode, uint32_t* opcode) {
902	size_t immediate;
903	for (immediate = 0; immediate < gba->cpu->numComponents; ++immediate) {
904		if (gba->cpu->components[immediate] == component) {
905			break;
906		}
907	}
908	if (immediate == gba->cpu->numComponents) {
909		return;
910	}
911	if (mode == MODE_ARM) {
912		int32_t value;
913		int32_t old;
914		value = 0xE1200070;
915		value |= immediate & 0xF;
916		value |= (immediate & 0xFFF0) << 4;
917		GBAPatch32(gba->cpu, address, value, &old);
918		*opcode = old;
919	} else {
920		int16_t value;
921		int16_t old;
922		value = 0xBE00;
923		value |= immediate & 0xFF;
924		GBAPatch16(gba->cpu, address, value, &old);
925		*opcode = (uint16_t) old;
926	}
927}
928
929void GBAClearBreakpoint(struct GBA* gba, uint32_t address, enum ExecutionMode mode, uint32_t opcode) {
930	if (mode == MODE_ARM) {
931		GBAPatch32(gba->cpu, address, opcode, 0);
932	} else {
933		GBAPatch16(gba->cpu, address, opcode, 0);
934	}
935}
936
937static bool _setSoftwareBreakpoint(struct ARMDebugger* debugger, uint32_t address, enum ExecutionMode mode, uint32_t* opcode) {
938	GBASetBreakpoint((struct GBA*) debugger->cpu->master, &debugger->d.p->d, address, mode, opcode);
939	return true;
940}
941
942static bool _clearSoftwareBreakpoint(struct ARMDebugger* debugger, uint32_t address, enum ExecutionMode mode, uint32_t opcode) {
943	GBAClearBreakpoint((struct GBA*) debugger->cpu->master, address, mode, opcode);
944	return true;
945}