all repos — mgba @ 2b64d45906d5b687d4cf240a140dee7a48cf1aad

mGBA Game Boy Advance Emulator

src/ds/renderers/software.c (view raw)

  1/* Copyright (c) 2013-2017 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/ds/renderers/software.h>
  7#include "gba/renderers/software-private.h"
  8
  9#include <mgba/internal/arm/macros.h>
 10#include <mgba/internal/ds/gx.h>
 11#include <mgba/internal/ds/io.h>
 12
 13static void DSVideoSoftwareRendererInit(struct DSVideoRenderer* renderer);
 14static void DSVideoSoftwareRendererDeinit(struct DSVideoRenderer* renderer);
 15static void DSVideoSoftwareRendererReset(struct DSVideoRenderer* renderer);
 16static uint16_t DSVideoSoftwareRendererWriteVideoRegister(struct DSVideoRenderer* renderer, uint32_t address, uint16_t value);
 17static void DSVideoSoftwareRendererWritePalette(struct DSVideoRenderer* renderer, uint32_t address, uint16_t value);
 18static void DSVideoSoftwareRendererWriteOAM(struct DSVideoRenderer* renderer, uint32_t oam);
 19static void DSVideoSoftwareRendererInvalidateExtPal(struct DSVideoRenderer* renderer, bool obj, bool engB, int slot);
 20static void DSVideoSoftwareRendererDrawScanline(struct DSVideoRenderer* renderer, int y);
 21static void DSVideoSoftwareRendererFinishFrame(struct DSVideoRenderer* renderer);
 22static void DSVideoSoftwareRendererGetPixels(struct DSVideoRenderer* renderer, size_t* stride, const void** pixels);
 23static void DSVideoSoftwareRendererPutPixels(struct DSVideoRenderer* renderer, size_t stride, const void* pixels);
 24
 25static void DSVideoSoftwareRendererDrawBackgroundExt0(struct GBAVideoSoftwareRenderer* renderer, struct GBAVideoSoftwareBackground* background, int inY);
 26
 27static bool _regenerateExtPalette(struct DSVideoSoftwareRenderer* renderer, bool obj, bool engB, int slot) {
 28	color_t* palette;
 29	color_t* variantPalette;
 30	struct GBAVideoSoftwareRenderer* softwareRenderer;
 31	uint16_t* vram;
 32	if (!obj) {
 33		if (!engB) {
 34			palette = &renderer->extPaletteA[slot * 4096];
 35			variantPalette = &renderer->variantPaletteA[slot * 4096];
 36			softwareRenderer = &renderer->engA;
 37			vram = renderer->d.vramABGExtPal[slot];
 38		} else {
 39			palette = &renderer->extPaletteB[slot * 4096];
 40			variantPalette = &renderer->variantPaletteB[slot * 4096];
 41			softwareRenderer = &renderer->engB;
 42			vram = renderer->d.vramBBGExtPal[slot];
 43		}
 44	} else {
 45		if (!engB) {
 46			palette = renderer->objExtPaletteA;
 47			variantPalette = renderer->variantPaletteA;
 48			softwareRenderer = &renderer->engA;
 49			vram = renderer->d.vramAOBJExtPal;
 50		} else {
 51			palette = renderer->objExtPaletteB;
 52			variantPalette = renderer->variantPaletteB;
 53			softwareRenderer = &renderer->engB;
 54			vram = renderer->d.vramBOBJExtPal;
 55		}
 56	}
 57	if (!vram) {
 58		return false;
 59	}
 60	int i;
 61	for (i = 0; i < 4096; ++i) {
 62		uint16_t value = vram[i];
 63#ifdef COLOR_16_BIT
 64#ifdef COLOR_5_6_5
 65		unsigned color = 0;
 66		color |= (value & 0x001F) << 11;
 67		color |= (value & 0x03E0) << 1;
 68		color |= (value & 0x7C00) >> 10;
 69#else
 70		unsigned color = value;
 71#endif
 72#else
 73		unsigned color = 0;
 74		color |= (value << 3) & 0xF8;
 75		color |= (value << 6) & 0xF800;
 76		color |= (value << 9) & 0xF80000;
 77		color |= (color >> 5) & 0x070707;
 78#endif
 79		palette[i] = color;
 80		if (softwareRenderer->blendEffect == BLEND_BRIGHTEN) {
 81			variantPalette[i] = _brighten(color, softwareRenderer->bldy);
 82		} else if (softwareRenderer->blendEffect == BLEND_DARKEN) {
 83			variantPalette[i] = _darken(color, softwareRenderer->bldy);
 84		}
 85	}
 86	if (obj) {
 87		softwareRenderer->objExtPalette = palette;
 88	} else {
 89		if (slot >= 2) {
 90			if (GBARegisterBGCNTIsExtPaletteSlot(softwareRenderer->bg[slot - 2].control)) {
 91				softwareRenderer->bg[slot - 2].extPalette = palette;
 92				softwareRenderer->bg[slot - 2].variantPalette = variantPalette;
 93			}
 94		} else if (slot < 2 && !GBARegisterBGCNTIsExtPaletteSlot(softwareRenderer->bg[slot].control) ) {
 95			softwareRenderer->bg[slot].extPalette = palette;
 96			softwareRenderer->bg[slot].variantPalette = variantPalette;
 97		}
 98		softwareRenderer->bg[slot].extPalette = palette;
 99		softwareRenderer->bg[slot].variantPalette = variantPalette;
100	}
101	return true;
102}
103
104static void _updateCharBase(struct DSVideoSoftwareRenderer* softwareRenderer, bool engB) {
105	struct GBAVideoSoftwareRenderer* eng;
106	if (!engB) {
107		eng = &softwareRenderer->engA;
108	} else {
109		eng = &softwareRenderer->engB;
110	}
111	int i;
112	uint32_t charBase = DSRegisterDISPCNTGetCharBase(softwareRenderer->dispcntA) << 16;
113	uint32_t screenBase = DSRegisterDISPCNTGetScreenBase(softwareRenderer->dispcntA) << 16;
114	for (i = 0; i < 4; ++i) {
115		if (!engB) {
116			uint32_t control = eng->bg[i].control;
117			eng->d.writeVideoRegister(&eng->d, DS9_REG_A_BG0CNT + i * 2, control);
118			eng->bg[i].control = control;
119		}
120
121		eng->bg[i].charBase = GBARegisterBGCNTGetCharBase(eng->bg[i].control) << 14;
122
123		if (!engB) {
124			softwareRenderer->engA.bg[i].charBase += charBase;
125			softwareRenderer->engA.bg[i].screenBase &= ~0x70000;
126			softwareRenderer->engA.bg[i].screenBase |= screenBase;
127		}
128	}
129}
130
131
132void DSVideoSoftwareRendererCreate(struct DSVideoSoftwareRenderer* renderer) {
133	renderer->d.init = DSVideoSoftwareRendererInit;
134	renderer->d.reset = DSVideoSoftwareRendererReset;
135	renderer->d.deinit = DSVideoSoftwareRendererDeinit;
136	renderer->d.writeVideoRegister = DSVideoSoftwareRendererWriteVideoRegister;
137	renderer->d.writePalette = DSVideoSoftwareRendererWritePalette;
138	renderer->d.writeOAM = DSVideoSoftwareRendererWriteOAM;
139	renderer->d.invalidateExtPal = DSVideoSoftwareRendererInvalidateExtPal;
140	renderer->d.drawScanline = DSVideoSoftwareRendererDrawScanline;
141	renderer->d.finishFrame = DSVideoSoftwareRendererFinishFrame;
142	renderer->d.getPixels = DSVideoSoftwareRendererGetPixels;
143	renderer->d.putPixels = DSVideoSoftwareRendererPutPixels;
144
145	renderer->engA.d.cache = NULL;
146	GBAVideoSoftwareRendererCreate(&renderer->engA);
147	renderer->engB.d.cache = NULL;
148	GBAVideoSoftwareRendererCreate(&renderer->engB);
149}
150
151static void DSVideoSoftwareRendererInit(struct DSVideoRenderer* renderer) {
152	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
153	softwareRenderer->engA.d.palette = &renderer->palette[0];
154	softwareRenderer->engA.d.oam = &renderer->oam->oam[0];
155	softwareRenderer->engA.masterEnd = DS_VIDEO_HORIZONTAL_PIXELS;
156	softwareRenderer->engA.masterHeight = DS_VIDEO_VERTICAL_PIXELS;
157	softwareRenderer->engA.masterScanlines = DS_VIDEO_VERTICAL_TOTAL_PIXELS;
158	softwareRenderer->engA.outputBufferStride = softwareRenderer->outputBufferStride;
159	softwareRenderer->engB.d.palette = &renderer->palette[512];
160	softwareRenderer->engB.d.oam = &renderer->oam->oam[1];
161	softwareRenderer->engB.masterEnd = DS_VIDEO_HORIZONTAL_PIXELS;
162	softwareRenderer->engB.masterHeight = DS_VIDEO_VERTICAL_PIXELS;
163	softwareRenderer->engB.masterScanlines = DS_VIDEO_VERTICAL_TOTAL_PIXELS;
164	softwareRenderer->engB.outputBufferStride = softwareRenderer->outputBufferStride;
165
166	DSVideoSoftwareRendererReset(renderer);
167}
168
169static void DSVideoSoftwareRendererReset(struct DSVideoRenderer* renderer) {
170	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
171	softwareRenderer->engA.d.reset(&softwareRenderer->engA.d);
172	softwareRenderer->engB.d.reset(&softwareRenderer->engB.d);
173	softwareRenderer->powcnt = 0;
174	softwareRenderer->dispcntA = 0;
175	softwareRenderer->dispcntB = 0;
176}
177
178static void DSVideoSoftwareRendererDeinit(struct DSVideoRenderer* renderer) {
179	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
180	softwareRenderer->engA.d.deinit(&softwareRenderer->engA.d);
181	softwareRenderer->engB.d.deinit(&softwareRenderer->engB.d);
182}
183
184static void DSVideoSoftwareRendererUpdateDISPCNT(struct DSVideoSoftwareRenderer* softwareRenderer, bool engB) {
185	uint32_t dispcnt;
186	struct GBAVideoSoftwareRenderer* eng;
187	if (!engB) {
188		dispcnt = softwareRenderer->dispcntA;
189		eng = &softwareRenderer->engA;
190	} else {
191		dispcnt = softwareRenderer->dispcntB;
192		eng = &softwareRenderer->engB;
193	}
194	uint16_t fakeDispcnt = dispcnt & 0xFF87;
195	if (!DSRegisterDISPCNTIsTileObjMapping(dispcnt)) {
196		eng->tileStride = 0x20;
197	} else {
198		eng->tileStride = 0x20 << DSRegisterDISPCNTGetTileBoundary(dispcnt);
199		fakeDispcnt = GBARegisterDISPCNTFillObjCharacterMapping(fakeDispcnt);
200	}
201	eng->d.writeVideoRegister(&eng->d, DS9_REG_A_DISPCNT_LO, fakeDispcnt);
202	eng->dispcnt |= dispcnt & 0xFFFF0000;
203	if (DSRegisterDISPCNTIsBgExtPalette(dispcnt)) {
204		color_t* extPalette;
205		if (!engB) {
206			extPalette = softwareRenderer->extPaletteA;
207		} else {
208			extPalette = softwareRenderer->extPaletteB;
209		}
210		int i;
211		for (i = 0; i < 4; ++i) {
212			int slot = i;
213			if (i < 2 && GBARegisterBGCNTIsExtPaletteSlot(eng->bg[i].control)) {
214				slot += 2;
215			}
216			if (eng->bg[i].extPalette != &extPalette[slot * 4096]) {
217				_regenerateExtPalette(softwareRenderer, false, engB, slot);
218			}
219		}
220	} else {
221		eng->bg[0].extPalette = NULL;
222		eng->bg[1].extPalette = NULL;
223		eng->bg[2].extPalette = NULL;
224		eng->bg[3].extPalette = NULL;
225	}
226	if (DSRegisterDISPCNTIsObjExtPalette(dispcnt)) {
227		if (!engB) {
228			if (softwareRenderer->engA.objExtPalette != softwareRenderer->objExtPaletteA) {
229				_regenerateExtPalette(softwareRenderer, true, engB, 0);
230			}
231		} else {
232			if (softwareRenderer->engB.objExtPalette != softwareRenderer->objExtPaletteB) {
233				_regenerateExtPalette(softwareRenderer, true, engB, 0);
234			}
235		}
236	} else {
237		if (!engB) {
238			softwareRenderer->engA.objExtPalette = NULL;
239		} else {
240			softwareRenderer->engB.objExtPalette = NULL;
241		}
242	}
243	if (!engB) {
244		eng->dispcnt = DSRegisterDISPCNTClear3D(eng->dispcnt);
245		eng->dispcnt |= DSRegisterDISPCNTIs3D(dispcnt);
246		_updateCharBase(softwareRenderer, engB);
247	}
248}
249
250static uint16_t DSVideoSoftwareRendererWriteVideoRegister(struct DSVideoRenderer* renderer, uint32_t address, uint16_t value) {
251	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
252	if (address >= DS9_REG_A_BG0CNT && address <= DS9_REG_A_BLDY) {
253		softwareRenderer->engA.d.writeVideoRegister(&softwareRenderer->engA.d, address, value);
254	} else if (address >= DS9_REG_B_BG0CNT && address <= DS9_REG_B_BLDY) {
255		softwareRenderer->engB.d.writeVideoRegister(&softwareRenderer->engB.d, address & 0xFF, value);
256	} else {
257		mLOG(DS_VIDEO, STUB, "Stub video register write: %04X:%04X", address, value);
258	}
259	switch (address) {
260	case DS9_REG_A_BG0CNT:
261	case DS9_REG_A_BG1CNT:
262		softwareRenderer->engA.bg[(address - DS9_REG_A_BG0CNT) >> 1].control = value;
263		// Fall through
264	case DS9_REG_A_BG2CNT:
265	case DS9_REG_A_BG3CNT:
266		_updateCharBase(softwareRenderer, false);
267		break;
268	case DS9_REG_B_BG0CNT:
269	case DS9_REG_B_BG1CNT:
270		softwareRenderer->engB.bg[(address - DS9_REG_B_BG0CNT) >> 1].control = value;
271		// Fall through
272	case DS9_REG_B_BG2CNT:
273	case DS9_REG_B_BG3CNT:
274		_updateCharBase(softwareRenderer, true);
275		break;
276	case DS9_REG_A_MASTER_BRIGHT:
277		softwareRenderer->engA.masterBright = DSRegisterMASTER_BRIGHTGetMode(value);
278		softwareRenderer->engA.masterBrightY = DSRegisterMASTER_BRIGHTGetY(value);
279		if (softwareRenderer->engA.masterBrightY > 0x10) {
280			softwareRenderer->engA.masterBrightY = 0x10;
281		}
282		break;
283	case DS9_REG_B_MASTER_BRIGHT:
284		softwareRenderer->engB.masterBright = DSRegisterMASTER_BRIGHTGetMode(value);
285		softwareRenderer->engB.masterBrightY = DSRegisterMASTER_BRIGHTGetY(value);
286		if (softwareRenderer->engB.masterBrightY > 0x10) {
287			softwareRenderer->engB.masterBrightY = 0x10;
288		}
289		break;
290	case DS9_REG_A_BLDCNT:
291	case DS9_REG_A_BLDY:
292		// TODO: Optimize
293		_regenerateExtPalette(softwareRenderer, false, false, 0);
294		_regenerateExtPalette(softwareRenderer, false, false, 1);
295		_regenerateExtPalette(softwareRenderer, false, false, 2);
296		_regenerateExtPalette(softwareRenderer, false, false, 3);
297		_regenerateExtPalette(softwareRenderer, true, false, 0);
298		break;
299	case DS9_REG_B_BLDCNT:
300	case DS9_REG_B_BLDY:
301		// TODO: Optimize
302		_regenerateExtPalette(softwareRenderer, false, true, 0);
303		_regenerateExtPalette(softwareRenderer, false, true, 1);
304		_regenerateExtPalette(softwareRenderer, false, true, 2);
305		_regenerateExtPalette(softwareRenderer, false, true, 3);
306		_regenerateExtPalette(softwareRenderer, true, true, 0);
307		break;
308	case DS9_REG_A_DISPCNT_LO:
309		softwareRenderer->dispcntA &= 0xFFFF0000;
310		softwareRenderer->dispcntA |= value;
311		DSVideoSoftwareRendererUpdateDISPCNT(softwareRenderer, false);
312		break;
313	case DS9_REG_A_DISPCNT_HI:
314		softwareRenderer->dispcntA &= 0x0000FFFF;
315		softwareRenderer->dispcntA |= value << 16;
316		DSVideoSoftwareRendererUpdateDISPCNT(softwareRenderer, false);
317		break;
318	case DS9_REG_B_DISPCNT_LO:
319		softwareRenderer->dispcntB &= 0xFFFF0000;
320		softwareRenderer->dispcntB |= value;
321		DSVideoSoftwareRendererUpdateDISPCNT(softwareRenderer, true);
322		break;
323	case DS9_REG_B_DISPCNT_HI:
324		softwareRenderer->dispcntB &= 0x0000FFFF;
325		softwareRenderer->dispcntB |= value << 16;
326		DSVideoSoftwareRendererUpdateDISPCNT(softwareRenderer, true);
327		break;
328	case DS9_REG_POWCNT1:
329		value &= 0x810F;
330		softwareRenderer->powcnt = value;
331	}
332	return value;
333}
334
335static void DSVideoSoftwareRendererWritePalette(struct DSVideoRenderer* renderer, uint32_t address, uint16_t value) {
336	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
337	if (address < 0x400) {
338		softwareRenderer->engA.d.writePalette(&softwareRenderer->engA.d, address & 0x3FF, value);
339	} else {
340		softwareRenderer->engB.d.writePalette(&softwareRenderer->engB.d, address & 0x3FF, value);
341	}
342}
343
344static void DSVideoSoftwareRendererWriteOAM(struct DSVideoRenderer* renderer, uint32_t oam) {
345	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
346	if (oam < 0x200) {
347		softwareRenderer->engA.d.writeOAM(&softwareRenderer->engA.d, oam & 0x1FF);
348	} else {
349		softwareRenderer->engB.d.writeOAM(&softwareRenderer->engB.d, oam & 0x1FF);
350	}
351}
352
353static void DSVideoSoftwareRendererInvalidateExtPal(struct DSVideoRenderer* renderer, bool obj, bool engB, int slot) {
354	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
355	_regenerateExtPalette(softwareRenderer, obj, engB, slot);
356}
357
358static void DSVideoSoftwareRendererDrawGBAScanline(struct GBAVideoRenderer* renderer, struct DSGX* gx, int y) {
359	struct GBAVideoSoftwareRenderer* softwareRenderer = (struct GBAVideoSoftwareRenderer*) renderer;
360
361	int x;
362	color_t* row = &softwareRenderer->outputBuffer[softwareRenderer->outputBufferStride * y];
363	if (GBARegisterDISPCNTIsForcedBlank(softwareRenderer->dispcnt)) {
364		for (x = 0; x < softwareRenderer->masterEnd; ++x) {
365			row[x] = GBA_COLOR_WHITE;
366		}
367		return;
368	}
369
370	GBAVideoSoftwareRendererPreprocessBuffer(softwareRenderer, y);
371	int spriteLayers = GBAVideoSoftwareRendererPreprocessSpriteLayer(softwareRenderer, y);
372
373	int w;
374	unsigned priority;
375	for (priority = 0; priority < 4; ++priority) {
376		softwareRenderer->end = 0;
377		for (w = 0; w < softwareRenderer->nWindows; ++w) {
378			softwareRenderer->start = softwareRenderer->end;
379			softwareRenderer->end = softwareRenderer->windows[w].endX;
380			softwareRenderer->currentWindow = softwareRenderer->windows[w].control;
381			if (spriteLayers & (1 << priority)) {
382				GBAVideoSoftwareRendererPostprocessSprite(softwareRenderer, priority);
383			}
384			if (TEST_LAYER_ENABLED(0)) {
385				if (DSRegisterDISPCNTIs3D(softwareRenderer->dispcnt) && gx) {
386					color_t* scanline;
387					gx->renderer->getScanline(gx->renderer, y, &scanline);
388					uint32_t flags = (softwareRenderer->bg[0].priority << OFFSET_PRIORITY) | FLAG_IS_BACKGROUND;
389					int x;
390					for (x = softwareRenderer->start; x < softwareRenderer->end; ++x) {
391						if ((scanline[x] & FLAG_UNWRITTEN) != FLAG_UNWRITTEN) {
392							_compositeNoBlendNoObjwin(softwareRenderer, &softwareRenderer->row[x], scanline[x] | flags, softwareRenderer->row[x]);
393						}
394					}
395				} else {
396					GBAVideoSoftwareRendererDrawBackgroundMode0(softwareRenderer, &softwareRenderer->bg[0], y);
397				}
398			}
399			if (TEST_LAYER_ENABLED(1)) {
400				GBAVideoSoftwareRendererDrawBackgroundMode0(softwareRenderer, &softwareRenderer->bg[1], y);
401			}
402			if (TEST_LAYER_ENABLED(2)) {
403				switch (GBARegisterDISPCNTGetMode(softwareRenderer->dispcnt)) {
404				case 0:
405				case 1:
406				case 3:
407					GBAVideoSoftwareRendererDrawBackgroundMode0(softwareRenderer, &softwareRenderer->bg[2], y);
408					break;
409				case 2:
410				case 4:
411					GBAVideoSoftwareRendererDrawBackgroundMode2(softwareRenderer, &softwareRenderer->bg[2], y);
412					break;
413				case 5:
414					DSVideoSoftwareRendererDrawBackgroundExt0(softwareRenderer, &softwareRenderer->bg[2], y);
415					break;
416				}
417			}
418			if (TEST_LAYER_ENABLED(3)) {
419				switch (GBARegisterDISPCNTGetMode(softwareRenderer->dispcnt)) {
420				case 0:
421					GBAVideoSoftwareRendererDrawBackgroundMode0(softwareRenderer, &softwareRenderer->bg[3], y);
422					break;
423				case 1:
424				case 2:
425					GBAVideoSoftwareRendererDrawBackgroundMode2(softwareRenderer, &softwareRenderer->bg[3], y);
426					break;
427				case 3:
428				case 4:
429				case 5:
430					DSVideoSoftwareRendererDrawBackgroundExt0(softwareRenderer, &softwareRenderer->bg[3], y);
431					break;
432				}
433			}
434		}
435	}
436	softwareRenderer->bg[2].sx += softwareRenderer->bg[2].dmx;
437	softwareRenderer->bg[2].sy += softwareRenderer->bg[2].dmy;
438	softwareRenderer->bg[3].sx += softwareRenderer->bg[3].dmx;
439	softwareRenderer->bg[3].sy += softwareRenderer->bg[3].dmy;
440
441	GBAVideoSoftwareRendererPostprocessBuffer(softwareRenderer);
442
443#ifdef COLOR_16_BIT
444#if defined(__ARM_NEON) && !defined(__APPLE__)
445	_to16Bit(row, softwareRenderer->row, softwareRenderer->masterEnd);
446#else
447	for (x = 0; x < softwareRenderer->masterEnd; ++x) {
448		row[x] = softwareRenderer->row[x];
449	}
450#endif
451#else
452	switch (softwareRenderer->masterBright) {
453	case 0:
454	default:
455		memcpy(row, softwareRenderer->row, softwareRenderer->masterEnd * sizeof(*row));
456		break;
457	case 1:
458		for (x = 0; x < softwareRenderer->masterEnd; ++x) {
459			row[x] = _brighten(softwareRenderer->row[x], softwareRenderer->masterBrightY);
460		}
461		break;
462	case 2:
463		for (x = 0; x < softwareRenderer->masterEnd; ++x) {
464			row[x] = _darken(softwareRenderer->row[x], softwareRenderer->masterBrightY);
465		}
466		break;
467	}
468#endif
469}
470
471static void _drawScanlineA(struct DSVideoSoftwareRenderer* softwareRenderer, int y) {
472	memcpy(softwareRenderer->engA.d.vramBG, softwareRenderer->d.vramABG, sizeof(softwareRenderer->engA.d.vramBG));
473	memcpy(softwareRenderer->engA.d.vramOBJ, softwareRenderer->d.vramAOBJ, sizeof(softwareRenderer->engA.d.vramOBJ));
474	color_t* row = &softwareRenderer->engA.outputBuffer[softwareRenderer->outputBufferStride * y];
475
476	int x;
477	switch (DSRegisterDISPCNTGetDispMode(softwareRenderer->dispcntA)) {
478	case 0:
479		for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
480			row[x] = GBA_COLOR_WHITE;
481		}
482		return;
483	case 1:
484		DSVideoSoftwareRendererDrawGBAScanline(&softwareRenderer->engA.d, softwareRenderer->d.gx, y);
485		return;
486	case 2: {
487		uint16_t* vram = &softwareRenderer->d.vram[0x10000 * DSRegisterDISPCNTGetVRAMBlock(softwareRenderer->dispcntA)];
488		for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
489			color_t color;
490			LOAD_16(color, (x + y * DS_VIDEO_HORIZONTAL_PIXELS) * 2, vram);
491#ifndef COLOR_16_BIT
492			unsigned color32 = 0;
493			color32 |= (color << 9) & 0xF80000;
494			color32 |= (color << 3) & 0xF8;
495			color32 |= (color << 6) & 0xF800;
496			color32 |= (color32 >> 5) & 0x070707;
497			color = color32;
498#elif COLOR_5_6_5
499			uint16_t color16 = 0;
500			color16 |= (color & 0x001F) << 11;
501			color16 |= (color & 0x03E0) << 1;
502			color16 |= (color & 0x7C00) >> 10;
503			color = color16;
504#endif
505			softwareRenderer->row[x] = color;
506		}
507		break;
508	}
509	case 3:
510		break;
511	}
512
513#ifdef COLOR_16_BIT
514#if defined(__ARM_NEON) && !defined(__APPLE__)
515	_to16Bit(row, softwareRenderer->row, DS_VIDEO_HORIZONTAL_PIXELS);
516#else
517	for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
518		row[x] = softwareRenderer->row[x];
519	}
520#endif
521#else
522	memcpy(row, softwareRenderer->row, DS_VIDEO_HORIZONTAL_PIXELS * sizeof(*row));
523#endif
524}
525
526static void _drawScanlineB(struct DSVideoSoftwareRenderer* softwareRenderer, int y) {
527	memcpy(softwareRenderer->engB.d.vramBG, softwareRenderer->d.vramBBG, sizeof(softwareRenderer->engB.d.vramBG));
528	memcpy(softwareRenderer->engB.d.vramOBJ, softwareRenderer->d.vramBOBJ, sizeof(softwareRenderer->engB.d.vramOBJ));
529	color_t* row = &softwareRenderer->engB.outputBuffer[softwareRenderer->outputBufferStride * y];
530
531	int x;
532	switch (DSRegisterDISPCNTGetDispMode(softwareRenderer->dispcntB)) {
533	case 0:
534		for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
535			row[x] = GBA_COLOR_WHITE;
536		}
537		return;
538	case 1:
539		DSVideoSoftwareRendererDrawGBAScanline(&softwareRenderer->engB.d, NULL, y);
540		return;
541	}
542
543#ifdef COLOR_16_BIT
544#if defined(__ARM_NEON) && !defined(__APPLE__)
545	_to16Bit(row, softwareRenderer->row, DS_VIDEO_HORIZONTAL_PIXELS);
546#else
547	for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
548		row[x] = softwareRenderer->row[x];
549	}
550#endif
551#else
552	memcpy(row, softwareRenderer->row, DS_VIDEO_HORIZONTAL_PIXELS * sizeof(*row));
553#endif
554}
555
556static void DSVideoSoftwareRendererDrawScanline(struct DSVideoRenderer* renderer, int y) {
557	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
558	if (!DSRegisterPOWCNT1IsSwap(softwareRenderer->powcnt)) {
559		softwareRenderer->engA.outputBuffer = &softwareRenderer->outputBuffer[softwareRenderer->outputBufferStride * DS_VIDEO_VERTICAL_PIXELS];
560		softwareRenderer->engB.outputBuffer = softwareRenderer->outputBuffer;
561	} else {
562		softwareRenderer->engA.outputBuffer = softwareRenderer->outputBuffer;
563		softwareRenderer->engB.outputBuffer = &softwareRenderer->outputBuffer[softwareRenderer->outputBufferStride * DS_VIDEO_VERTICAL_PIXELS];
564	}
565
566	_drawScanlineA(softwareRenderer, y);
567	_drawScanlineB(softwareRenderer, y);
568}
569
570static void DSVideoSoftwareRendererFinishFrame(struct DSVideoRenderer* renderer) {
571	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
572	softwareRenderer->engA.d.finishFrame(&softwareRenderer->engA.d);
573	softwareRenderer->engB.d.finishFrame(&softwareRenderer->engB.d);
574}
575
576static void DSVideoSoftwareRendererGetPixels(struct DSVideoRenderer* renderer, size_t* stride, const void** pixels) {
577	struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
578#ifdef COLOR_16_BIT
579#error Not yet supported
580#else
581	*stride = softwareRenderer->outputBufferStride;
582	*pixels = softwareRenderer->outputBuffer;
583#endif
584}
585
586static void DSVideoSoftwareRendererPutPixels(struct DSVideoRenderer* renderer, size_t stride, const void* pixels) {
587}
588
589#define EXT_0_COORD_OVERFLOW \
590	localX = x & (sizeAdjusted - 1); \
591	localY = y & (sizeAdjusted - 1); \
592
593#define EXT_0_COORD_NO_OVERFLOW \
594	if ((x | y) & ~(sizeAdjusted - 1)) { \
595		continue; \
596	} \
597	localX = x; \
598	localY = y;
599
600#define EXT_0_NO_MOSAIC(COORD) \
601	COORD \
602	uint32_t screenBase = background->screenBase + (localX >> 10) + (((localY >> 6) & 0xFE0) << background->size); \
603	uint16_t* screenBlock = renderer->d.vramBG[screenBase >> VRAM_BLOCK_OFFSET]; \
604	if (UNLIKELY(!screenBlock)) { \
605		continue; \
606	} \
607	LOAD_16(mapData, screenBase & (VRAM_BLOCK_MASK - 1), screenBlock); \
608	paletteData = GBA_TEXT_MAP_PALETTE(mapData) << 8; \
609	palette = &mainPalette[paletteData]; \
610	uint32_t charBase = (background->charBase + (GBA_TEXT_MAP_TILE(mapData) << 6)) + ((localY & 0x700) >> 5) + ((localX & 0x700) >> 8); \
611	uint16_t* vram = renderer->d.vramBG[charBase >> VRAM_BLOCK_OFFSET]; \
612	if (UNLIKELY(!vram)) { \
613		continue; \
614	} \
615	pixelData = ((uint8_t*) vram)[charBase & VRAM_BLOCK_MASK];
616
617#define EXT_0_MOSAIC(COORD) \
618		if (!mosaicWait) { \
619			EXT_0_NO_MOSAIC(COORD) \
620			mosaicWait = mosaicH; \
621		} else { \
622			--mosaicWait; \
623		}
624
625#define EXT_0_LOOP(MOSAIC, COORD, BLEND, OBJWIN) \
626	for (outX = renderer->start, pixel = &renderer->row[outX]; outX < renderer->end; ++outX, ++pixel) { \
627		x += background->dx; \
628		y += background->dy; \
629		\
630		uint32_t current = *pixel; \
631		MOSAIC(COORD) \
632		if (pixelData) { \
633			COMPOSITE_256_ ## OBJWIN (BLEND, 0); \
634		} \
635	}
636
637#define DRAW_BACKGROUND_EXT_0(BLEND, OBJWIN) \
638	if (background->overflow) { \
639		if (mosaicH > 1) { \
640			EXT_0_LOOP(EXT_0_MOSAIC, EXT_0_COORD_OVERFLOW, BLEND, OBJWIN); \
641		} else { \
642			EXT_0_LOOP(EXT_0_NO_MOSAIC, EXT_0_COORD_OVERFLOW, BLEND, OBJWIN); \
643		} \
644	} else { \
645		if (mosaicH > 1) { \
646			EXT_0_LOOP(EXT_0_MOSAIC, EXT_0_COORD_NO_OVERFLOW, BLEND, OBJWIN); \
647		} else { \
648			EXT_0_LOOP(EXT_0_NO_MOSAIC, EXT_0_COORD_NO_OVERFLOW, BLEND, OBJWIN); \
649		} \
650	}
651
652void DSVideoSoftwareRendererDrawBackgroundExt0(struct GBAVideoSoftwareRenderer* renderer, struct GBAVideoSoftwareBackground* background, int inY) {
653	int sizeAdjusted = 0x8000 << background->size;
654
655	BACKGROUND_BITMAP_INIT;
656
657	color_t* mainPalette = background->extPalette;
658	if (variant) {
659		palette = background->variantPalette;
660	}
661	int paletteData;
662
663	uint16_t mapData;
664	uint8_t pixelData = 0;
665
666	int outX;
667	uint32_t* pixel;
668
669	if (!objwinSlowPath) {
670		if (!(flags & FLAG_TARGET_2)) {
671			DRAW_BACKGROUND_EXT_0(NoBlend, NO_OBJWIN);
672		} else {
673			DRAW_BACKGROUND_EXT_0(Blend, NO_OBJWIN);
674		}
675	} else {
676		if (!(flags & FLAG_TARGET_2)) {
677			DRAW_BACKGROUND_EXT_0(NoBlend, OBJWIN);
678		} else {
679			DRAW_BACKGROUND_EXT_0(Blend, OBJWIN);
680		}
681	}
682}