all repos — mgba @ 4d2675e3e8b03d259631242437334a22af4f21dc

mGBA Game Boy Advance Emulator

src/gb/video.c (view raw)

  1/* Copyright (c) 2013-2016 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/gb/video.h>
  7
  8#include <mgba/core/sync.h>
  9#include <mgba/core/thread.h>
 10#include <mgba/core/cache-set.h>
 11#include <mgba/internal/gb/gb.h>
 12#include <mgba/internal/gb/io.h>
 13#include <mgba/internal/gb/renderers/cache-set.h>
 14#include <mgba/internal/gb/serialize.h>
 15#include <mgba/internal/lr35902/lr35902.h>
 16
 17#include <mgba-util/memory.h>
 18
 19static void GBVideoDummyRendererInit(struct GBVideoRenderer* renderer, enum GBModel model, bool borders);
 20static void GBVideoDummyRendererDeinit(struct GBVideoRenderer* renderer);
 21static uint8_t GBVideoDummyRendererWriteVideoRegister(struct GBVideoRenderer* renderer, uint16_t address, uint8_t value);
 22static void GBVideoDummyRendererWriteSGBPacket(struct GBVideoRenderer* renderer, uint8_t* data);
 23static void GBVideoDummyRendererWritePalette(struct GBVideoRenderer* renderer, int index, uint16_t value);
 24static void GBVideoDummyRendererWriteVRAM(struct GBVideoRenderer* renderer, uint16_t address);
 25static void GBVideoDummyRendererWriteOAM(struct GBVideoRenderer* renderer, uint16_t oam);
 26static void GBVideoDummyRendererDrawRange(struct GBVideoRenderer* renderer, int startX, int endX, int y, struct GBObj* obj, size_t oamMax);
 27static void GBVideoDummyRendererFinishScanline(struct GBVideoRenderer* renderer, int y);
 28static void GBVideoDummyRendererFinishFrame(struct GBVideoRenderer* renderer);
 29static void GBVideoDummyRendererGetPixels(struct GBVideoRenderer* renderer, size_t* stride, const void** pixels);
 30static void GBVideoDummyRendererPutPixels(struct GBVideoRenderer* renderer, size_t stride, const void* pixels);
 31
 32static void _cleanOAM(struct GBVideo* video, int y);
 33
 34static void _endMode0(struct mTiming* timing, void* context, uint32_t cyclesLate);
 35static void _endMode1(struct mTiming* timing, void* context, uint32_t cyclesLate);
 36static void _endMode2(struct mTiming* timing, void* context, uint32_t cyclesLate);
 37static void _endMode3(struct mTiming* timing, void* context, uint32_t cyclesLate);
 38static void _updateFrameCount(struct mTiming* timing, void* context, uint32_t cyclesLate);
 39
 40static struct GBVideoRenderer dummyRenderer = {
 41	.init = GBVideoDummyRendererInit,
 42	.deinit = GBVideoDummyRendererDeinit,
 43	.writeVideoRegister = GBVideoDummyRendererWriteVideoRegister,
 44	.writeSGBPacket = GBVideoDummyRendererWriteSGBPacket,
 45	.writeVRAM = GBVideoDummyRendererWriteVRAM,
 46	.writeOAM = GBVideoDummyRendererWriteOAM,
 47	.writePalette = GBVideoDummyRendererWritePalette,
 48	.drawRange = GBVideoDummyRendererDrawRange,
 49	.finishScanline = GBVideoDummyRendererFinishScanline,
 50	.finishFrame = GBVideoDummyRendererFinishFrame,
 51	.getPixels = GBVideoDummyRendererGetPixels,
 52	.putPixels = GBVideoDummyRendererPutPixels,
 53};
 54
 55void GBVideoInit(struct GBVideo* video) {
 56	video->renderer = &dummyRenderer;
 57	video->renderer->cache = NULL;
 58	video->renderer->sgbRenderMode = 0;
 59	video->vram = 0;
 60	video->frameskip = 0;
 61
 62	video->modeEvent.context = video;
 63	video->modeEvent.name = "GB Video Mode";
 64	video->modeEvent.callback = NULL;
 65	video->modeEvent.priority = 8;
 66	video->frameEvent.context = video;
 67	video->frameEvent.name = "GB Video Frame";
 68	video->frameEvent.callback = _updateFrameCount;
 69	video->frameEvent.priority = 9;
 70
 71	video->dmgPalette[0] = 0x7FFF;
 72	video->dmgPalette[1] = 0x56B5;
 73	video->dmgPalette[2] = 0x294A;
 74	video->dmgPalette[3] = 0x0000;
 75	video->dmgPalette[4] = 0x7FFF;
 76	video->dmgPalette[5] = 0x56B5;
 77	video->dmgPalette[6] = 0x294A;
 78	video->dmgPalette[7] = 0x0000;
 79	video->dmgPalette[8] = 0x7FFF;
 80	video->dmgPalette[9] = 0x56B5;
 81	video->dmgPalette[10] = 0x294A;
 82	video->dmgPalette[11] = 0x0000;
 83
 84	video->sgbBorders = true;
 85
 86	video->renderer->sgbCharRam = NULL;
 87	video->renderer->sgbMapRam = NULL;
 88	video->renderer->sgbPalRam = NULL;
 89	video->renderer->sgbAttributes = NULL;
 90	video->renderer->sgbAttributeFiles = NULL;
 91}
 92
 93void GBVideoReset(struct GBVideo* video) {
 94	video->ly = 0;
 95	video->x = 0;
 96	video->mode = 1;
 97	video->stat = 1;
 98
 99	video->frameCounter = 0;
100	video->frameskipCounter = 0;
101
102	if (video->vram) {
103		mappedMemoryFree(video->vram, GB_SIZE_VRAM);
104	}
105	video->vram = anonymousMemoryMap(GB_SIZE_VRAM);
106	GBVideoSwitchBank(video, 0);
107	video->renderer->vram = video->vram;
108	memset(&video->oam, 0, sizeof(video->oam));
109	video->renderer->oam = &video->oam;
110	memset(&video->palette, 0, sizeof(video->palette));
111
112	if (video->p->model == GB_MODEL_SGB) {
113		video->renderer->sgbCharRam = anonymousMemoryMap(SGB_SIZE_CHAR_RAM);
114		video->renderer->sgbMapRam = anonymousMemoryMap(SGB_SIZE_MAP_RAM);
115		video->renderer->sgbPalRam = anonymousMemoryMap(SGB_SIZE_PAL_RAM);
116		video->renderer->sgbAttributeFiles = anonymousMemoryMap(SGB_SIZE_ATF_RAM);
117		video->renderer->sgbAttributes = malloc(90 * 45);
118		memset(video->renderer->sgbAttributes, 0, 90 * 45);
119		video->sgbCommandHeader = 0;
120	}
121
122	video->palette[0] = video->dmgPalette[0];
123	video->palette[1] = video->dmgPalette[1];
124	video->palette[2] = video->dmgPalette[2];
125	video->palette[3] = video->dmgPalette[3];
126	video->palette[8 * 4 + 0] = video->dmgPalette[4];
127	video->palette[8 * 4 + 1] = video->dmgPalette[5];
128	video->palette[8 * 4 + 2] = video->dmgPalette[6];
129	video->palette[8 * 4 + 3] = video->dmgPalette[7];
130	video->palette[9 * 4 + 0] = video->dmgPalette[8];
131	video->palette[9 * 4 + 1] = video->dmgPalette[9];
132	video->palette[9 * 4 + 2] = video->dmgPalette[10];
133	video->palette[9 * 4 + 3] = video->dmgPalette[11];
134
135	video->renderer->deinit(video->renderer);
136	video->renderer->init(video->renderer, video->p->model, video->sgbBorders);
137
138	video->renderer->writePalette(video->renderer, 0, video->palette[0]);
139	video->renderer->writePalette(video->renderer, 1, video->palette[1]);
140	video->renderer->writePalette(video->renderer, 2, video->palette[2]);
141	video->renderer->writePalette(video->renderer, 3, video->palette[3]);
142	video->renderer->writePalette(video->renderer, 8 * 4 + 0, video->palette[8 * 4 + 0]);
143	video->renderer->writePalette(video->renderer, 8 * 4 + 1, video->palette[8 * 4 + 1]);
144	video->renderer->writePalette(video->renderer, 8 * 4 + 2, video->palette[8 * 4 + 2]);
145	video->renderer->writePalette(video->renderer, 8 * 4 + 3, video->palette[8 * 4 + 3]);
146	video->renderer->writePalette(video->renderer, 9 * 4 + 0, video->palette[9 * 4 + 0]);
147	video->renderer->writePalette(video->renderer, 9 * 4 + 1, video->palette[9 * 4 + 1]);
148	video->renderer->writePalette(video->renderer, 9 * 4 + 2, video->palette[9 * 4 + 2]);
149	video->renderer->writePalette(video->renderer, 9 * 4 + 3, video->palette[9 * 4 + 3]);
150}
151
152void GBVideoDeinit(struct GBVideo* video) {
153	GBVideoAssociateRenderer(video, &dummyRenderer);
154	mappedMemoryFree(video->vram, GB_SIZE_VRAM);
155	if (video->renderer->sgbCharRam) {
156		mappedMemoryFree(video->renderer->sgbCharRam, SGB_SIZE_CHAR_RAM);
157		video->renderer->sgbCharRam = NULL;
158	}
159	if (video->renderer->sgbMapRam) {
160		mappedMemoryFree(video->renderer->sgbMapRam, SGB_SIZE_MAP_RAM);
161		video->renderer->sgbMapRam = NULL;
162	}
163	if (video->renderer->sgbPalRam) {
164		mappedMemoryFree(video->renderer->sgbPalRam, SGB_SIZE_PAL_RAM);
165		video->renderer->sgbPalRam = NULL;
166	}
167	if (video->renderer->sgbAttributeFiles) {
168		mappedMemoryFree(video->renderer->sgbAttributeFiles, SGB_SIZE_ATF_RAM);
169		video->renderer->sgbAttributeFiles = NULL;
170	}
171	if (video->renderer->sgbAttributes) {
172		free(video->renderer->sgbAttributes);
173		video->renderer->sgbAttributes = NULL;
174	}
175}
176
177void GBVideoAssociateRenderer(struct GBVideo* video, struct GBVideoRenderer* renderer) {
178	video->renderer->deinit(video->renderer);
179	renderer->cache = video->renderer->cache;
180	renderer->sgbRenderMode = video->renderer->sgbRenderMode;
181	renderer->sgbCharRam = video->renderer->sgbCharRam;
182	renderer->sgbMapRam = video->renderer->sgbMapRam;
183	renderer->sgbPalRam = video->renderer->sgbPalRam;
184	renderer->sgbAttributeFiles = video->renderer->sgbAttributeFiles;
185	renderer->sgbAttributes = video->renderer->sgbAttributes;
186	video->renderer = renderer;
187	renderer->vram = video->vram;
188	video->renderer->init(video->renderer, video->p->model, video->sgbBorders);
189}
190
191static bool _statIRQAsserted(struct GBVideo* video, GBRegisterSTAT stat) {
192	// TODO: variable for the IRQ line value?
193	if (GBRegisterSTATIsLYCIRQ(stat) && GBRegisterSTATIsLYC(stat)) {
194		return true;
195	}
196	switch (GBRegisterSTATGetMode(stat)) {
197	case 0:
198		if (GBRegisterSTATIsHblankIRQ(stat)) {
199			return true;
200		}
201		break;
202	case 1:
203		if (GBRegisterSTATIsVblankIRQ(stat)) {
204			return true;
205		}
206		break;
207	case 2:
208		if (GBRegisterSTATIsOAMIRQ(stat)) {
209			return true;
210		}
211		break;
212	case 3:
213		break;
214	}
215	return false;
216}
217
218void _endMode0(struct mTiming* timing, void* context, uint32_t cyclesLate) {
219	struct GBVideo* video = context;
220	if (video->frameskipCounter <= 0) {
221		video->renderer->finishScanline(video->renderer, video->ly);
222	}
223	int lyc = video->p->memory.io[REG_LYC];
224	int32_t next;
225	++video->ly;
226	video->p->memory.io[REG_LY] = video->ly;
227	GBRegisterSTAT oldStat = video->stat;
228	video->stat = GBRegisterSTATSetLYC(video->stat, lyc == video->ly);
229	if (video->ly < GB_VIDEO_VERTICAL_PIXELS) {
230		// TODO: Cache SCX & 7 in case it changes during mode 2
231		next = GB_VIDEO_MODE_2_LENGTH + (video->p->memory.io[REG_SCX] & 7);
232		video->mode = 2;
233		video->modeEvent.callback = _endMode2;
234	} else {
235		next = GB_VIDEO_HORIZONTAL_LENGTH;
236		video->mode = 1;
237		video->modeEvent.callback = _endMode1;
238
239		mTimingDeschedule(&video->p->timing, &video->frameEvent);
240		mTimingSchedule(&video->p->timing, &video->frameEvent, -cyclesLate);
241
242		if (!_statIRQAsserted(video, oldStat) && GBRegisterSTATIsOAMIRQ(video->stat)) {
243			video->p->memory.io[REG_IF] |= (1 << GB_IRQ_LCDSTAT);
244		}
245		video->p->memory.io[REG_IF] |= (1 << GB_IRQ_VBLANK);
246	}
247	video->stat = GBRegisterSTATSetMode(video->stat, video->mode);
248	if (!_statIRQAsserted(video, oldStat) && _statIRQAsserted(video, video->stat)) {
249		video->p->memory.io[REG_IF] |= (1 << GB_IRQ_LCDSTAT);
250	}
251	GBUpdateIRQs(video->p);
252	video->p->memory.io[REG_STAT] = video->stat;
253	mTimingSchedule(timing, &video->modeEvent, (next << video->p->doubleSpeed) - cyclesLate);
254}
255
256void _endMode1(struct mTiming* timing, void* context, uint32_t cyclesLate) {
257	struct GBVideo* video = context;
258	if (!GBRegisterLCDCIsEnable(video->p->memory.io[REG_LCDC])) {
259		return;
260	}
261	int lyc = video->p->memory.io[REG_LYC];
262	// TODO: One M-cycle delay
263	++video->ly;
264	int32_t next;
265	if (video->ly == GB_VIDEO_VERTICAL_TOTAL_PIXELS + 1) {
266		video->ly = 0;
267		video->p->memory.io[REG_LY] = video->ly;
268		next = GB_VIDEO_MODE_2_LENGTH + (video->p->memory.io[REG_SCX] & 7);
269		video->mode = 2;
270		video->modeEvent.callback = _endMode2;
271	} else if (video->ly == GB_VIDEO_VERTICAL_TOTAL_PIXELS) {
272		video->p->memory.io[REG_LY] = 0;
273		next = GB_VIDEO_HORIZONTAL_LENGTH - 8;
274	} else if (video->ly == GB_VIDEO_VERTICAL_TOTAL_PIXELS - 1) {
275		video->p->memory.io[REG_LY] = video->ly;
276		next = 8;
277	} else {
278		video->p->memory.io[REG_LY] = video->ly;
279		next = GB_VIDEO_HORIZONTAL_LENGTH;
280	}
281
282	GBRegisterSTAT oldStat = video->stat;
283	video->stat = GBRegisterSTATSetMode(video->stat, video->mode);
284	video->stat = GBRegisterSTATSetLYC(video->stat, lyc == video->p->memory.io[REG_LY]);
285	if (!_statIRQAsserted(video, oldStat) && _statIRQAsserted(video, video->stat)) {
286		video->p->memory.io[REG_IF] |= (1 << GB_IRQ_LCDSTAT);
287		GBUpdateIRQs(video->p);
288	}
289	video->p->memory.io[REG_STAT] = video->stat;
290	mTimingSchedule(timing, &video->modeEvent, (next << video->p->doubleSpeed) - cyclesLate);
291}
292
293void _endMode2(struct mTiming* timing, void* context, uint32_t cyclesLate) {
294	struct GBVideo* video = context;
295	_cleanOAM(video, video->ly);
296	video->x = 0;
297	video->dotClock = mTimingCurrentTime(timing) - cyclesLate;
298	int32_t next = GB_VIDEO_MODE_3_LENGTH_BASE + video->objMax * 6 - (video->p->memory.io[REG_SCX] & 7);
299	video->mode = 3;
300	video->modeEvent.callback = _endMode3;
301	GBRegisterSTAT oldStat = video->stat;
302	video->stat = GBRegisterSTATSetMode(video->stat, video->mode);
303	if (!_statIRQAsserted(video, oldStat) && _statIRQAsserted(video, video->stat)) {
304		video->p->memory.io[REG_IF] |= (1 << GB_IRQ_LCDSTAT);
305		GBUpdateIRQs(video->p);
306	}
307	video->p->memory.io[REG_STAT] = video->stat;
308	mTimingSchedule(timing, &video->modeEvent, (next << video->p->doubleSpeed) - cyclesLate);
309}
310
311void _endMode3(struct mTiming* timing, void* context, uint32_t cyclesLate) {
312	struct GBVideo* video = context;
313	GBVideoProcessDots(video, cyclesLate);
314	if (video->ly < GB_VIDEO_VERTICAL_PIXELS && video->p->memory.isHdma && video->p->memory.io[REG_HDMA5] != 0xFF) {
315		video->p->memory.hdmaRemaining = 0x10;
316		video->p->cpuBlocked = true;
317		mTimingDeschedule(timing, &video->p->memory.hdmaEvent);
318		mTimingSchedule(timing, &video->p->memory.hdmaEvent, 0);
319	}
320	video->mode = 0;
321	video->modeEvent.callback = _endMode0;
322	GBRegisterSTAT oldStat = video->stat;
323	video->stat = GBRegisterSTATSetMode(video->stat, video->mode);
324	if (!_statIRQAsserted(video, oldStat) && _statIRQAsserted(video, video->stat)) {
325		video->p->memory.io[REG_IF] |= (1 << GB_IRQ_LCDSTAT);
326		GBUpdateIRQs(video->p);
327	}
328	video->p->memory.io[REG_STAT] = video->stat;
329	int32_t next = GB_VIDEO_MODE_0_LENGTH_BASE - video->objMax * 6;
330	mTimingSchedule(timing, &video->modeEvent, (next << video->p->doubleSpeed) - cyclesLate);
331}
332
333void _updateFrameCount(struct mTiming* timing, void* context, uint32_t cyclesLate) {
334	UNUSED(cyclesLate);
335	struct GBVideo* video = context;
336	if (video->p->cpu->executionState != LR35902_CORE_FETCH) {
337		mTimingSchedule(timing, &video->frameEvent, 4 - ((video->p->cpu->executionState + 1) & 3));
338		return;
339	}
340
341	size_t c;
342	for (c = 0; c < mCoreCallbacksListSize(&video->p->coreCallbacks); ++c) {
343		struct mCoreCallbacks* callbacks = mCoreCallbacksListGetPointer(&video->p->coreCallbacks, c);
344		if (callbacks->videoFrameEnded) {
345			callbacks->videoFrameEnded(callbacks->context);
346		}
347	}
348
349	GBFrameEnded(video->p);
350	mCoreSyncPostFrame(video->p->sync);
351	--video->frameskipCounter;
352	if (video->frameskipCounter < 0) {
353		video->renderer->finishFrame(video->renderer);
354		video->frameskipCounter = video->frameskip;
355	}
356	++video->frameCounter;
357
358	// TODO: Move to common code
359	if (video->p->stream && video->p->stream->postVideoFrame) {
360		const color_t* pixels;
361		size_t stride;
362		video->renderer->getPixels(video->renderer, &stride, (const void**) &pixels);
363		video->p->stream->postVideoFrame(video->p->stream, pixels, stride);
364	}
365
366	if (!GBRegisterLCDCIsEnable(video->p->memory.io[REG_LCDC])) {
367		mTimingSchedule(timing, &video->frameEvent, GB_VIDEO_TOTAL_LENGTH);
368	}
369
370	for (c = 0; c < mCoreCallbacksListSize(&video->p->coreCallbacks); ++c) {
371		struct mCoreCallbacks* callbacks = mCoreCallbacksListGetPointer(&video->p->coreCallbacks, c);
372		if (callbacks->videoFrameStarted) {
373			callbacks->videoFrameStarted(callbacks->context);
374		}
375	}
376}
377
378static void _cleanOAM(struct GBVideo* video, int y) {
379	// TODO: GBC differences
380	// TODO: Optimize
381	video->objMax = 0;
382	int spriteHeight = 8;
383	if (GBRegisterLCDCIsObjSize(video->p->memory.io[REG_LCDC])) {
384		spriteHeight = 16;
385	}
386	int o = 0;
387	int i;
388	for (i = 0; i < 40; ++i) {
389		uint8_t oy = video->oam.obj[i].y;
390		if (y < oy - 16 || y >= oy - 16 + spriteHeight) {
391			continue;
392		}
393		// TODO: Sort
394		video->objThisLine[o] = video->oam.obj[i];
395		++o;
396		if (o == 10) {
397			break;
398		}
399	}
400	video->objMax = o;
401}
402
403void GBVideoProcessDots(struct GBVideo* video, uint32_t cyclesLate) {
404	if (video->mode != 3) {
405		return;
406	}
407	int oldX = video->x;
408	video->x = (mTimingCurrentTime(&video->p->timing) - video->dotClock - cyclesLate) >> video->p->doubleSpeed;
409	if (video->x > GB_VIDEO_HORIZONTAL_PIXELS) {
410		video->x = GB_VIDEO_HORIZONTAL_PIXELS;
411	} else if (video->x < 0) {
412		mLOG(GB, FATAL, "Video dot clock went negative!");
413		video->x = oldX;
414	}
415	if (video->frameskipCounter <= 0) {
416		video->renderer->drawRange(video->renderer, oldX, video->x, video->ly, video->objThisLine, video->objMax);
417	}
418}
419
420void GBVideoWriteLCDC(struct GBVideo* video, GBRegisterLCDC value) {
421	if (!GBRegisterLCDCIsEnable(video->p->memory.io[REG_LCDC]) && GBRegisterLCDCIsEnable(value)) {
422		video->mode = 2;
423		video->modeEvent.callback = _endMode2;
424		int32_t next = GB_VIDEO_MODE_2_LENGTH - 5; // TODO: Why is this fudge factor needed? Might be related to T-cycles for load/store differing
425		mTimingSchedule(&video->p->timing, &video->modeEvent, next << video->p->doubleSpeed);
426
427		video->ly = 0;
428		video->p->memory.io[REG_LY] = 0;
429		GBRegisterSTAT oldStat = video->stat;
430		video->stat = GBRegisterSTATSetMode(video->stat, 0);
431		video->stat = GBRegisterSTATSetLYC(video->stat, video->ly == video->p->memory.io[REG_LYC]);
432		if (!_statIRQAsserted(video, oldStat) && _statIRQAsserted(video, video->stat)) {
433			video->p->memory.io[REG_IF] |= (1 << GB_IRQ_LCDSTAT);
434			GBUpdateIRQs(video->p);
435		}
436		video->p->memory.io[REG_STAT] = video->stat;
437		video->renderer->writePalette(video->renderer, 0, video->palette[0]);
438
439		mTimingDeschedule(&video->p->timing, &video->frameEvent);
440	}
441	if (GBRegisterLCDCIsEnable(video->p->memory.io[REG_LCDC]) && !GBRegisterLCDCIsEnable(value)) {
442		// TODO: Fix serialization; this gets internal and visible modes out of sync
443		video->stat = GBRegisterSTATSetMode(video->stat, 0);
444		video->p->memory.io[REG_STAT] = video->stat;
445		video->ly = 0;
446		video->p->memory.io[REG_LY] = 0;
447		video->renderer->writePalette(video->renderer, 0, video->dmgPalette[0]);
448	
449		mTimingDeschedule(&video->p->timing, &video->modeEvent);
450		mTimingSchedule(&video->p->timing, &video->frameEvent, GB_VIDEO_TOTAL_LENGTH);
451	}
452	video->p->memory.io[REG_STAT] = video->stat;
453}
454
455void GBVideoWriteSTAT(struct GBVideo* video, GBRegisterSTAT value) {
456	GBRegisterSTAT oldStat = video->stat;
457	video->stat = (video->stat & 0x7) | (value & 0x78);
458	if (!GBRegisterLCDCIsEnable(video->p->memory.io[REG_LCDC]) || video->p->model >= GB_MODEL_CGB) {
459		return;
460	}
461	if (!_statIRQAsserted(video, oldStat) && video->mode < 3) {
462		// TODO: variable for the IRQ line value?
463		video->p->memory.io[REG_IF] |= (1 << GB_IRQ_LCDSTAT);
464		GBUpdateIRQs(video->p);
465	}
466}
467
468void GBVideoWriteLYC(struct GBVideo* video, uint8_t value) {
469	GBRegisterSTAT oldStat = video->stat;
470	video->stat = GBRegisterSTATSetLYC(video->stat, value == video->ly);
471	if (!_statIRQAsserted(video, oldStat) && _statIRQAsserted(video, video->stat)) {
472		video->p->memory.io[REG_IF] |= (1 << GB_IRQ_LCDSTAT);
473		GBUpdateIRQs(video->p);
474	}
475	video->p->memory.io[REG_STAT] = video->stat;
476}
477
478void GBVideoWritePalette(struct GBVideo* video, uint16_t address, uint8_t value) {
479	if (video->p->model < GB_MODEL_SGB) {
480		switch (address) {
481		case REG_BGP:
482			video->palette[0] = video->dmgPalette[value & 3];
483			video->palette[1] = video->dmgPalette[(value >> 2) & 3];
484			video->palette[2] = video->dmgPalette[(value >> 4) & 3];
485			video->palette[3] = video->dmgPalette[(value >> 6) & 3];
486			video->renderer->writePalette(video->renderer, 0, video->palette[0]);
487			video->renderer->writePalette(video->renderer, 1, video->palette[1]);
488			video->renderer->writePalette(video->renderer, 2, video->palette[2]);
489			video->renderer->writePalette(video->renderer, 3, video->palette[3]);
490			break;
491		case REG_OBP0:
492			video->palette[8 * 4 + 0] = video->dmgPalette[(value & 3) + 4];
493			video->palette[8 * 4 + 1] = video->dmgPalette[((value >> 2) & 3) + 4];
494			video->palette[8 * 4 + 2] = video->dmgPalette[((value >> 4) & 3) + 4];
495			video->palette[8 * 4 + 3] = video->dmgPalette[((value >> 6) & 3) + 4];
496			video->renderer->writePalette(video->renderer, 8 * 4 + 0, video->palette[8 * 4 + 0]);
497			video->renderer->writePalette(video->renderer, 8 * 4 + 1, video->palette[8 * 4 + 1]);
498			video->renderer->writePalette(video->renderer, 8 * 4 + 2, video->palette[8 * 4 + 2]);
499			video->renderer->writePalette(video->renderer, 8 * 4 + 3, video->palette[8 * 4 + 3]);
500			break;
501		case REG_OBP1:
502			video->palette[9 * 4 + 0] = video->dmgPalette[(value & 3) + 8];
503			video->palette[9 * 4 + 1] = video->dmgPalette[((value >> 2) & 3) + 8];
504			video->palette[9 * 4 + 2] = video->dmgPalette[((value >> 4) & 3) + 8];
505			video->palette[9 * 4 + 3] = video->dmgPalette[((value >> 6) & 3) + 8];
506			video->renderer->writePalette(video->renderer, 9 * 4 + 0, video->palette[9 * 4 + 0]);
507			video->renderer->writePalette(video->renderer, 9 * 4 + 1, video->palette[9 * 4 + 1]);
508			video->renderer->writePalette(video->renderer, 9 * 4 + 2, video->palette[9 * 4 + 2]);
509			video->renderer->writePalette(video->renderer, 9 * 4 + 3, video->palette[9 * 4 + 3]);
510			break;
511		}
512	} else if (video->p->model == GB_MODEL_SGB) {
513		video->renderer->writeVideoRegister(video->renderer, address, value);
514	} else {
515		switch (address) {
516		case REG_BCPD:
517			if (video->bcpIndex & 1) {
518				video->palette[video->bcpIndex >> 1] &= 0x00FF;
519				video->palette[video->bcpIndex >> 1] |= value << 8;
520			} else {
521				video->palette[video->bcpIndex >> 1] &= 0xFF00;
522				video->palette[video->bcpIndex >> 1] |= value;
523			}
524			video->renderer->writePalette(video->renderer, video->bcpIndex >> 1, video->palette[video->bcpIndex >> 1]);
525			if (video->bcpIncrement) {
526				++video->bcpIndex;
527				video->bcpIndex &= 0x3F;
528				video->p->memory.io[REG_BCPS] &= 0x80;
529				video->p->memory.io[REG_BCPS] |= video->bcpIndex;
530			}
531			video->p->memory.io[REG_BCPD] = video->palette[video->bcpIndex >> 1] >> (8 * (video->bcpIndex & 1));
532			break;
533		case REG_OCPD:
534			if (video->ocpIndex & 1) {
535				video->palette[8 * 4 + (video->ocpIndex >> 1)] &= 0x00FF;
536				video->palette[8 * 4 + (video->ocpIndex >> 1)] |= value << 8;
537			} else {
538				video->palette[8 * 4 + (video->ocpIndex >> 1)] &= 0xFF00;
539				video->palette[8 * 4 + (video->ocpIndex >> 1)] |= value;
540			}
541			video->renderer->writePalette(video->renderer, 8 * 4 + (video->ocpIndex >> 1), video->palette[8 * 4 + (video->ocpIndex >> 1)]);
542			if (video->ocpIncrement) {
543				++video->ocpIndex;
544				video->ocpIndex &= 0x3F;
545				video->p->memory.io[REG_OCPS] &= 0x80;
546				video->p->memory.io[REG_OCPS] |= video->ocpIndex;
547			}
548			video->p->memory.io[REG_OCPD] = video->palette[8 * 4 + (video->ocpIndex >> 1)] >> (8 * (video->ocpIndex & 1));
549			break;
550		}
551	}
552}
553
554void GBVideoSwitchBank(struct GBVideo* video, uint8_t value) {
555	value &= 1;
556	video->vramBank = &video->vram[value * GB_SIZE_VRAM_BANK0];
557	video->vramCurrentBank = value;
558}
559
560void GBVideoSetPalette(struct GBVideo* video, unsigned index, uint32_t color) {
561	if (index >= 12) {
562		return;
563	}
564	video->dmgPalette[index] = M_RGB8_TO_RGB5(color);
565}
566
567void GBVideoDisableCGB(struct GBVideo* video) {
568	video->dmgPalette[0] = video->palette[0];
569	video->dmgPalette[1] = video->palette[1];
570	video->dmgPalette[2] = video->palette[2];
571	video->dmgPalette[3] = video->palette[3];
572	video->dmgPalette[4] = video->palette[8 * 4 + 0];
573	video->dmgPalette[5] = video->palette[8 * 4 + 1];
574	video->dmgPalette[6] = video->palette[8 * 4 + 2];
575	video->dmgPalette[7] = video->palette[8 * 4 + 3];
576	video->dmgPalette[8] = video->palette[9 * 4 + 0];
577	video->dmgPalette[9] = video->palette[9 * 4 + 1];
578	video->dmgPalette[10] = video->palette[9 * 4 + 2];
579	video->dmgPalette[11] = video->palette[9 * 4 + 3];
580	video->renderer->deinit(video->renderer);
581	video->renderer->init(video->renderer, video->p->model, video->sgbBorders);
582}
583
584void GBVideoWriteSGBPacket(struct GBVideo* video, uint8_t* data) {
585	int i;
586	if (!(video->sgbCommandHeader & 7)) {
587		if ((data[0] >> 3) > SGB_OBJ_TRN) {
588			video->sgbCommandHeader = 0;
589			return;
590		}
591		video->sgbCommandHeader = data[0];
592	}
593	--video->sgbCommandHeader;
594	switch (video->sgbCommandHeader >> 3) {
595	case SGB_PAL01:
596		video->palette[0] = data[1] | (data[2] << 8);
597		video->palette[1] = data[3] | (data[4] << 8);
598		video->palette[2] = data[5] | (data[6] << 8);
599		video->palette[3] = data[7] | (data[8] << 8);
600
601		video->palette[16] = data[1] | (data[2] << 8);
602		video->palette[17] = data[9] | (data[10] << 8);
603		video->palette[18] = data[11] | (data[12] << 8);
604		video->palette[19] = data[13] | (data[14] << 8);
605
606		video->palette[32] = data[1] | (data[2] << 8);
607		video->palette[48] = data[1] | (data[2] << 8);
608
609		video->renderer->writePalette(video->renderer, 0, video->palette[0]);
610		video->renderer->writePalette(video->renderer, 1, video->palette[1]);
611		video->renderer->writePalette(video->renderer, 2, video->palette[2]);
612		video->renderer->writePalette(video->renderer, 3, video->palette[3]);
613		video->renderer->writePalette(video->renderer, 16, video->palette[0]);
614		video->renderer->writePalette(video->renderer, 17, video->palette[17]);
615		video->renderer->writePalette(video->renderer, 18, video->palette[18]);
616		video->renderer->writePalette(video->renderer, 19, video->palette[19]);
617		video->renderer->writePalette(video->renderer, 32, video->palette[0]);
618		video->renderer->writePalette(video->renderer, 48, video->palette[0]);
619		break;
620	case SGB_PAL23:
621		video->palette[33] = data[3] | (data[4] << 8);
622		video->palette[34] = data[5] | (data[6] << 8);
623		video->palette[35] = data[7] | (data[8] << 8);
624
625		video->palette[49] = data[9] | (data[10] << 8);
626		video->palette[50] = data[11] | (data[12] << 8);
627		video->palette[51] = data[13] | (data[14] << 8);
628		video->renderer->writePalette(video->renderer, 33, video->palette[33]);
629		video->renderer->writePalette(video->renderer, 34, video->palette[34]);
630		video->renderer->writePalette(video->renderer, 35, video->palette[35]);
631		video->renderer->writePalette(video->renderer, 49, video->palette[49]);
632		video->renderer->writePalette(video->renderer, 50, video->palette[50]);
633		video->renderer->writePalette(video->renderer, 51, video->palette[51]);
634		break;
635	case SGB_PAL03:
636		video->palette[0] = data[1] | (data[2] << 8);
637		video->palette[1] = data[3] | (data[4] << 8);
638		video->palette[2] = data[5] | (data[6] << 8);
639		video->palette[3] = data[7] | (data[8] << 8);
640
641		video->palette[16] = data[1] | (data[2] << 8);
642		video->palette[32] = data[1] | (data[2] << 8);
643
644		video->palette[48] = data[1] | (data[2] << 8);
645		video->palette[49] = data[9] | (data[10] << 8);
646		video->palette[50] = data[11] | (data[12] << 8);
647		video->palette[51] = data[13] | (data[14] << 8);
648		video->renderer->writePalette(video->renderer, 0, video->palette[0]);
649		video->renderer->writePalette(video->renderer, 1, video->palette[1]);
650		video->renderer->writePalette(video->renderer, 2, video->palette[2]);
651		video->renderer->writePalette(video->renderer, 3, video->palette[3]);
652		video->renderer->writePalette(video->renderer, 16, video->palette[0]);
653		video->renderer->writePalette(video->renderer, 32, video->palette[0]);
654		video->renderer->writePalette(video->renderer, 48, video->palette[0]);
655		video->renderer->writePalette(video->renderer, 49, video->palette[49]);
656		video->renderer->writePalette(video->renderer, 50, video->palette[50]);
657		video->renderer->writePalette(video->renderer, 51, video->palette[51]);
658		break;
659	case SGB_PAL12:
660		video->palette[17] = data[3] | (data[4] << 8);
661		video->palette[18] = data[5] | (data[6] << 8);
662		video->palette[19] = data[7] | (data[8] << 8);
663
664		video->palette[33] = data[9] | (data[10] << 8);
665		video->palette[34] = data[11] | (data[12] << 8);
666		video->palette[35] = data[13] | (data[14] << 8);
667		video->renderer->writePalette(video->renderer, 17, video->palette[17]);
668		video->renderer->writePalette(video->renderer, 18, video->palette[18]);
669		video->renderer->writePalette(video->renderer, 19, video->palette[19]);
670		video->renderer->writePalette(video->renderer, 33, video->palette[33]);
671		video->renderer->writePalette(video->renderer, 34, video->palette[34]);
672		video->renderer->writePalette(video->renderer, 35, video->palette[35]);
673		break;
674	case SGB_PAL_SET:
675		for (i = 0; i < 4; ++i) {
676			uint16_t entry = (data[2 + (i * 2)] << 8) | data[1 + (i * 2)];
677			if (entry >= 0x200) {
678				mLOG(GB, STUB, "Unimplemented SGB palette overflow: %03X", entry);
679				continue;
680			}
681			LOAD_16LE(video->palette[i * 4 + 0], entry * 8 + 0, video->renderer->sgbPalRam);
682			video->renderer->writePalette(video->renderer, i * 4 + 0, video->palette[0]);
683			LOAD_16LE(video->palette[i * 4 + 1], entry * 8 + 2, video->renderer->sgbPalRam);
684			video->renderer->writePalette(video->renderer, i * 4 + 1, video->palette[i * 4 + 1]);
685			LOAD_16LE(video->palette[i * 4 + 2], entry * 8 + 4, video->renderer->sgbPalRam);
686			video->renderer->writePalette(video->renderer, i * 4 + 2, video->palette[i * 4 + 2]);
687			LOAD_16LE(video->palette[i * 4 + 3], entry * 8 + 6, video->renderer->sgbPalRam);
688			video->renderer->writePalette(video->renderer, i * 4 + 3, video->palette[i * 4 + 3]);
689		}
690		break;
691	case SGB_ATTR_BLK:
692	case SGB_PAL_TRN:
693	case SGB_ATRC_EN:
694	case SGB_CHR_TRN:
695	case SGB_PCT_TRN:
696	case SGB_ATTR_TRN:
697	case SGB_ATTR_SET:
698		break;
699	case SGB_MLT_REG:
700		return;
701	case SGB_MASK_EN:
702		video->renderer->sgbRenderMode = data[1] & 0x3;
703		break;
704	default:
705		mLOG(GB, STUB, "Unimplemented SGB command: %02X", data[0] >> 3);
706		return;
707	}
708	video->renderer->writeSGBPacket(video->renderer, data);
709}
710
711static void GBVideoDummyRendererInit(struct GBVideoRenderer* renderer, enum GBModel model, bool borders) {
712	UNUSED(renderer);
713	UNUSED(model);
714	UNUSED(borders);
715	// Nothing to do
716}
717
718static void GBVideoDummyRendererDeinit(struct GBVideoRenderer* renderer) {
719	UNUSED(renderer);
720	// Nothing to do
721}
722
723static uint8_t GBVideoDummyRendererWriteVideoRegister(struct GBVideoRenderer* renderer, uint16_t address, uint8_t value) {
724	if (renderer->cache) {
725		GBVideoCacheWriteVideoRegister(renderer->cache, address, value);
726	}
727	return value;
728}
729
730static void GBVideoDummyRendererWriteSGBPacket(struct GBVideoRenderer* renderer, uint8_t* data) {
731	UNUSED(renderer);
732	UNUSED(data);
733}
734
735static void GBVideoDummyRendererWriteVRAM(struct GBVideoRenderer* renderer, uint16_t address) {
736	if (renderer->cache) {
737		mCacheSetWriteVRAM(renderer->cache, address);
738	}
739}
740
741static void GBVideoDummyRendererWriteOAM(struct GBVideoRenderer* renderer, uint16_t oam) {
742	UNUSED(renderer);
743	UNUSED(oam);
744	// Nothing to do
745}
746
747static void GBVideoDummyRendererWritePalette(struct GBVideoRenderer* renderer, int index, uint16_t value) {
748	if (renderer->cache) {
749		mCacheSetWritePalette(renderer->cache, index, mColorFrom555(value));
750	}
751}
752
753static void GBVideoDummyRendererDrawRange(struct GBVideoRenderer* renderer, int startX, int endX, int y, struct GBObj* obj, size_t oamMax) {
754	UNUSED(renderer);
755	UNUSED(endX);
756	UNUSED(startX);
757	UNUSED(y);
758	UNUSED(obj);
759	UNUSED(oamMax);
760	// Nothing to do
761}
762
763static void GBVideoDummyRendererFinishScanline(struct GBVideoRenderer* renderer, int y) {
764	UNUSED(renderer);
765	UNUSED(y);
766	// Nothing to do
767}
768
769static void GBVideoDummyRendererFinishFrame(struct GBVideoRenderer* renderer) {
770	UNUSED(renderer);
771	// Nothing to do
772}
773
774static void GBVideoDummyRendererGetPixels(struct GBVideoRenderer* renderer, size_t* stride, const void** pixels) {
775	UNUSED(renderer);
776	UNUSED(stride);
777	UNUSED(pixels);
778	// Nothing to do
779}
780
781static void GBVideoDummyRendererPutPixels(struct GBVideoRenderer* renderer, size_t stride, const void* pixels) {
782	UNUSED(renderer);
783	UNUSED(stride);
784	UNUSED(pixels);
785	// Nothing to do
786}
787
788void GBVideoSerialize(const struct GBVideo* video, struct GBSerializedState* state) {
789	STORE_16LE(video->x, 0, &state->video.x);
790	STORE_16LE(video->ly, 0, &state->video.ly);
791	STORE_32LE(video->frameCounter, 0, &state->video.frameCounter);
792	STORE_32LE(video->dotClock, 0, &state->video.dotCounter);
793	state->video.vramCurrentBank = video->vramCurrentBank;
794
795	GBSerializedVideoFlags flags = 0;
796	flags = GBSerializedVideoFlagsSetBcpIncrement(flags, video->bcpIncrement);
797	flags = GBSerializedVideoFlagsSetOcpIncrement(flags, video->ocpIncrement);
798	flags = GBSerializedVideoFlagsSetMode(flags, video->mode);
799	flags = GBSerializedVideoFlagsSetNotModeEventScheduled(flags, !mTimingIsScheduled(&video->p->timing, &video->modeEvent));
800	flags = GBSerializedVideoFlagsSetNotFrameEventScheduled(flags, !mTimingIsScheduled(&video->p->timing, &video->frameEvent));
801	state->video.flags = flags;
802	STORE_16LE(video->bcpIndex, 0, &state->video.bcpIndex);
803	STORE_16LE(video->ocpIndex, 0, &state->video.ocpIndex);
804
805	size_t i;
806	for (i = 0; i < 64; ++i) {
807		STORE_16LE(video->palette[i], i * 2, state->video.palette);
808	}
809
810	STORE_32LE(video->modeEvent.when - mTimingCurrentTime(&video->p->timing), 0, &state->video.nextMode);
811	STORE_32LE(video->frameEvent.when - mTimingCurrentTime(&video->p->timing), 0, &state->video.nextFrame);
812
813	memcpy(state->vram, video->vram, GB_SIZE_VRAM);
814	memcpy(state->oam, &video->oam.raw, GB_SIZE_OAM);
815}
816
817void GBVideoDeserialize(struct GBVideo* video, const struct GBSerializedState* state) {
818	LOAD_16LE(video->x, 0, &state->video.x);
819	LOAD_16LE(video->ly, 0, &state->video.ly);
820	LOAD_32LE(video->frameCounter, 0, &state->video.frameCounter);
821	LOAD_32LE(video->dotClock, 0, &state->video.dotCounter);
822	video->vramCurrentBank = state->video.vramCurrentBank;
823
824	GBSerializedVideoFlags flags = state->video.flags;
825	video->bcpIncrement = GBSerializedVideoFlagsGetBcpIncrement(flags);
826	video->ocpIncrement = GBSerializedVideoFlagsGetOcpIncrement(flags);
827	video->mode = GBSerializedVideoFlagsGetMode(flags);
828	LOAD_16LE(video->bcpIndex, 0, &state->video.bcpIndex);
829	video->bcpIndex &= 0x3F;
830	LOAD_16LE(video->ocpIndex, 0, &state->video.ocpIndex);
831	video->ocpIndex &= 0x3F;
832
833	switch (video->mode) {
834	case 0:
835		video->modeEvent.callback = _endMode0;
836		break;
837	case 1:
838		video->modeEvent.callback = _endMode1;
839		break;
840	case 2:
841		video->modeEvent.callback = _endMode2;
842		break;
843	case 3:
844		video->modeEvent.callback = _endMode3;
845		break;
846	}
847
848	uint32_t when;
849	if (!GBSerializedVideoFlagsIsNotModeEventScheduled(flags)) {
850		LOAD_32LE(when, 0, &state->video.nextMode);
851		mTimingSchedule(&video->p->timing, &video->modeEvent, when);
852	}
853	if (!GBSerializedVideoFlagsIsNotFrameEventScheduled(flags)) {
854		LOAD_32LE(when, 0, &state->video.nextFrame);
855		mTimingSchedule(&video->p->timing, &video->frameEvent, when);
856	}
857
858	size_t i;
859	for (i = 0; i < 64; ++i) {
860		LOAD_16LE(video->palette[i], i * 2, state->video.palette);
861		video->renderer->writePalette(video->renderer, i, video->palette[i]);
862	}
863
864	memcpy(video->vram, state->vram, GB_SIZE_VRAM);
865	memcpy(&video->oam.raw, state->oam, GB_SIZE_OAM);
866
867	_cleanOAM(video, video->ly);
868	GBVideoSwitchBank(video, video->vramCurrentBank);
869
870	video->renderer->deinit(video->renderer);
871	video->renderer->init(video->renderer, video->p->model, video->sgbBorders);
872}