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 DSVideoSoftwareRendererDrawScanlineDirectly(struct DSVideoRenderer* renderer, int y, color_t* scanline);
22static void DSVideoSoftwareRendererFinishFrame(struct DSVideoRenderer* renderer);
23static void DSVideoSoftwareRendererGetPixels(struct DSVideoRenderer* renderer, size_t* stride, const void** pixels);
24static void DSVideoSoftwareRendererPutPixels(struct DSVideoRenderer* renderer, size_t stride, const void* pixels);
25
26static void DSVideoSoftwareRendererDrawBackgroundExt0(struct GBAVideoSoftwareRenderer* renderer, struct GBAVideoSoftwareBackground* background, int inY);
27static void DSVideoSoftwareRendererDrawBackgroundExt1(struct GBAVideoSoftwareRenderer* renderer, struct GBAVideoSoftwareBackground* background, int inY);
28static void DSVideoSoftwareRendererDrawBackgroundExt2(struct GBAVideoSoftwareRenderer* renderer, struct GBAVideoSoftwareBackground* background, int inY);
29
30static bool _regenerateExtPalette(struct DSVideoSoftwareRenderer* renderer, bool obj, bool engB, int slot) {
31 color_t* palette;
32 color_t* variantPalette;
33 struct GBAVideoSoftwareRenderer* softwareRenderer;
34 uint16_t* vram;
35 if (!obj) {
36 if (!engB) {
37 palette = &renderer->extPaletteA[slot * 4096];
38 variantPalette = &renderer->variantPaletteA[slot * 4096];
39 softwareRenderer = &renderer->engA;
40 vram = renderer->d.vramABGExtPal[slot];
41 } else {
42 palette = &renderer->extPaletteB[slot * 4096];
43 variantPalette = &renderer->variantPaletteB[slot * 4096];
44 softwareRenderer = &renderer->engB;
45 vram = renderer->d.vramBBGExtPal[slot];
46 }
47 } else {
48 if (!engB) {
49 palette = renderer->objExtPaletteA;
50 variantPalette = renderer->variantPaletteA;
51 softwareRenderer = &renderer->engA;
52 vram = renderer->d.vramAOBJExtPal;
53 } else {
54 palette = renderer->objExtPaletteB;
55 variantPalette = renderer->variantPaletteB;
56 softwareRenderer = &renderer->engB;
57 vram = renderer->d.vramBOBJExtPal;
58 }
59 }
60 if (!vram) {
61 return false;
62 }
63 int i;
64 for (i = 0; i < 4096; ++i) {
65 uint16_t value = vram[i];
66#ifdef COLOR_16_BIT
67#ifdef COLOR_5_6_5
68 unsigned color = 0;
69 color |= (value & 0x001F) << 11;
70 color |= (value & 0x03E0) << 1;
71 color |= (value & 0x7C00) >> 10;
72#else
73 unsigned color = value;
74#endif
75#else
76 unsigned color = 0;
77 color |= (value << 3) & 0xF8;
78 color |= (value << 6) & 0xF800;
79 color |= (value << 9) & 0xF80000;
80 color |= (color >> 5) & 0x070707;
81#endif
82 palette[i] = color;
83 if (softwareRenderer->blendEffect == BLEND_BRIGHTEN) {
84 variantPalette[i] = _brighten(color, softwareRenderer->bldy);
85 } else if (softwareRenderer->blendEffect == BLEND_DARKEN) {
86 variantPalette[i] = _darken(color, softwareRenderer->bldy);
87 }
88 }
89 if (obj) {
90 softwareRenderer->objExtPalette = palette;
91 softwareRenderer->objExtVariantPalette = variantPalette;
92 } else {
93 if (slot >= 2) {
94 if (GBARegisterBGCNTIsExtPaletteSlot(softwareRenderer->bg[slot - 2].control)) {
95 softwareRenderer->bg[slot - 2].extPalette = palette;
96 softwareRenderer->bg[slot - 2].variantPalette = variantPalette;
97 }
98 } else if (slot < 2 && !GBARegisterBGCNTIsExtPaletteSlot(softwareRenderer->bg[slot].control) ) {
99 softwareRenderer->bg[slot].extPalette = palette;
100 softwareRenderer->bg[slot].variantPalette = variantPalette;
101 }
102 softwareRenderer->bg[slot].extPalette = palette;
103 softwareRenderer->bg[slot].variantPalette = variantPalette;
104 }
105 return true;
106}
107
108static void _updateCharBase(struct DSVideoSoftwareRenderer* softwareRenderer, bool engB) {
109 struct GBAVideoSoftwareRenderer* eng;
110 if (!engB) {
111 eng = &softwareRenderer->engA;
112 } else {
113 eng = &softwareRenderer->engB;
114 }
115 int i;
116 uint32_t charBase = DSRegisterDISPCNTGetCharBase(softwareRenderer->dispcntA) << 16;
117 uint32_t screenBase = DSRegisterDISPCNTGetScreenBase(softwareRenderer->dispcntA) << 16;
118 for (i = 0; i < 4; ++i) {
119 if (!engB) {
120 uint32_t control = eng->bg[i].control;
121 eng->d.writeVideoRegister(&eng->d, DS9_REG_A_BG0CNT + i * 2, control);
122 eng->bg[i].control = control;
123 }
124
125 eng->bg[i].charBase = GBARegisterBGCNTGetCharBase(eng->bg[i].control) << 14;
126
127 if (!engB) {
128 softwareRenderer->engA.bg[i].charBase += charBase;
129 softwareRenderer->engA.bg[i].screenBase &= ~0x70000;
130 softwareRenderer->engA.bg[i].screenBase |= screenBase;
131 }
132 }
133}
134
135void DSVideoSoftwareRendererCreate(struct DSVideoSoftwareRenderer* renderer) {
136 renderer->d.init = DSVideoSoftwareRendererInit;
137 renderer->d.reset = DSVideoSoftwareRendererReset;
138 renderer->d.deinit = DSVideoSoftwareRendererDeinit;
139 renderer->d.writeVideoRegister = DSVideoSoftwareRendererWriteVideoRegister;
140 renderer->d.writePalette = DSVideoSoftwareRendererWritePalette;
141 renderer->d.writeOAM = DSVideoSoftwareRendererWriteOAM;
142 renderer->d.invalidateExtPal = DSVideoSoftwareRendererInvalidateExtPal;
143 renderer->d.drawScanline = DSVideoSoftwareRendererDrawScanline;
144 renderer->d.drawScanlineDirectly = DSVideoSoftwareRendererDrawScanlineDirectly;
145 renderer->d.finishFrame = DSVideoSoftwareRendererFinishFrame;
146 renderer->d.getPixels = DSVideoSoftwareRendererGetPixels;
147 renderer->d.putPixels = DSVideoSoftwareRendererPutPixels;
148
149 renderer->d.disableABG[0] = false;
150 renderer->d.disableABG[1] = false;
151 renderer->d.disableABG[2] = false;
152 renderer->d.disableABG[3] = false;
153 renderer->d.disableAOBJ = false;
154
155 renderer->d.disableBBG[0] = false;
156 renderer->d.disableBBG[1] = false;
157 renderer->d.disableBBG[2] = false;
158 renderer->d.disableBBG[3] = false;
159 renderer->d.disableBOBJ = false;
160
161 renderer->engA.d.cache = NULL;
162 GBAVideoSoftwareRendererCreate(&renderer->engA);
163 renderer->engA.combinedObjSort = true;
164
165 renderer->engB.d.cache = NULL;
166 GBAVideoSoftwareRendererCreate(&renderer->engB);
167 renderer->engB.combinedObjSort = true;
168}
169
170static void DSVideoSoftwareRendererInit(struct DSVideoRenderer* renderer) {
171 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
172 softwareRenderer->engA.d.palette = &renderer->palette[0];
173 softwareRenderer->engA.d.oam = &renderer->oam->oam[0];
174 softwareRenderer->engA.masterEnd = DS_VIDEO_HORIZONTAL_PIXELS;
175 softwareRenderer->engA.masterHeight = DS_VIDEO_VERTICAL_PIXELS;
176 softwareRenderer->engA.masterScanlines = DS_VIDEO_VERTICAL_TOTAL_PIXELS;
177 softwareRenderer->engA.outputBufferStride = softwareRenderer->outputBufferStride;
178 softwareRenderer->engB.d.palette = &renderer->palette[512];
179 softwareRenderer->engB.d.oam = &renderer->oam->oam[1];
180 softwareRenderer->engB.masterEnd = DS_VIDEO_HORIZONTAL_PIXELS;
181 softwareRenderer->engB.masterHeight = DS_VIDEO_VERTICAL_PIXELS;
182 softwareRenderer->engB.masterScanlines = DS_VIDEO_VERTICAL_TOTAL_PIXELS;
183 softwareRenderer->engB.outputBufferStride = softwareRenderer->outputBufferStride;
184
185 DSVideoSoftwareRendererReset(renderer);
186}
187
188static void DSVideoSoftwareRendererReset(struct DSVideoRenderer* renderer) {
189 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
190 softwareRenderer->engA.d.reset(&softwareRenderer->engA.d);
191 softwareRenderer->engB.d.reset(&softwareRenderer->engB.d);
192 softwareRenderer->powcnt = 0;
193 softwareRenderer->dispcntA = 0;
194 softwareRenderer->dispcntB = 0;
195}
196
197static void DSVideoSoftwareRendererDeinit(struct DSVideoRenderer* renderer) {
198 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
199 softwareRenderer->engA.d.deinit(&softwareRenderer->engA.d);
200 softwareRenderer->engB.d.deinit(&softwareRenderer->engB.d);
201}
202
203static void DSVideoSoftwareRendererUpdateDISPCNT(struct DSVideoSoftwareRenderer* softwareRenderer, bool engB) {
204 uint32_t dispcnt;
205 struct GBAVideoSoftwareRenderer* eng;
206 if (!engB) {
207 dispcnt = softwareRenderer->dispcntA;
208 eng = &softwareRenderer->engA;
209 } else {
210 dispcnt = softwareRenderer->dispcntB;
211 eng = &softwareRenderer->engB;
212 }
213 uint16_t fakeDispcnt = dispcnt & 0xFF87;
214 if (!DSRegisterDISPCNTIsTileObjMapping(dispcnt)) {
215 eng->tileStride = 0x20;
216 } else {
217 eng->tileStride = 0x20 << DSRegisterDISPCNTGetTileBoundary(dispcnt);
218 fakeDispcnt = GBARegisterDISPCNTFillObjCharacterMapping(fakeDispcnt);
219 }
220 eng->bitmapStride = 0x10 << DSRegisterDISPCNTGetBitmapObj2D(dispcnt);
221 eng->d.writeVideoRegister(&eng->d, DS9_REG_A_DISPCNT_LO, fakeDispcnt);
222 eng->dispcnt |= dispcnt & 0xFFFF0000;
223 if (DSRegisterDISPCNTIsBgExtPalette(dispcnt)) {
224 color_t* extPalette;
225 if (!engB) {
226 extPalette = softwareRenderer->extPaletteA;
227 } else {
228 extPalette = softwareRenderer->extPaletteB;
229 }
230 int i;
231 for (i = 0; i < 4; ++i) {
232 int slot = i;
233 if (i < 2 && GBARegisterBGCNTIsExtPaletteSlot(eng->bg[i].control)) {
234 slot += 2;
235 }
236 if (eng->bg[i].extPalette != &extPalette[slot * 4096]) {
237 _regenerateExtPalette(softwareRenderer, false, engB, slot);
238 }
239 }
240 } else {
241 eng->bg[0].extPalette = NULL;
242 eng->bg[1].extPalette = NULL;
243 eng->bg[2].extPalette = NULL;
244 eng->bg[3].extPalette = NULL;
245 }
246 if (DSRegisterDISPCNTIsObjExtPalette(dispcnt)) {
247 if (!engB) {
248 if (softwareRenderer->engA.objExtPalette != softwareRenderer->objExtPaletteA) {
249 _regenerateExtPalette(softwareRenderer, true, engB, 0);
250 }
251 } else {
252 if (softwareRenderer->engB.objExtPalette != softwareRenderer->objExtPaletteB) {
253 _regenerateExtPalette(softwareRenderer, true, engB, 0);
254 }
255 }
256 } else {
257 if (!engB) {
258 softwareRenderer->engA.objExtPalette = NULL;
259 } else {
260 softwareRenderer->engB.objExtPalette = NULL;
261 }
262 }
263 if (!engB) {
264 eng->dispcnt = DSRegisterDISPCNTClear3D(eng->dispcnt);
265 eng->dispcnt |= DSRegisterDISPCNTIs3D(dispcnt);
266 _updateCharBase(softwareRenderer, engB);
267 }
268}
269
270static uint16_t DSVideoSoftwareRendererWriteVideoRegister(struct DSVideoRenderer* renderer, uint32_t address, uint16_t value) {
271 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
272 if (address >= DS9_REG_A_BG0CNT && address <= DS9_REG_A_BLDY) {
273 softwareRenderer->engA.d.writeVideoRegister(&softwareRenderer->engA.d, address, value);
274 } else if (address >= DS9_REG_B_BG0CNT && address <= DS9_REG_B_BLDY) {
275 softwareRenderer->engB.d.writeVideoRegister(&softwareRenderer->engB.d, address & 0xFF, value);
276 } else {
277 mLOG(DS_VIDEO, STUB, "Stub video register write: %04X:%04X", address, value);
278 }
279 switch (address) {
280 case DS9_REG_A_BG0CNT:
281 case DS9_REG_A_BG1CNT:
282 softwareRenderer->engA.bg[(address - DS9_REG_A_BG0CNT) >> 1].control = value;
283 // Fall through
284 case DS9_REG_A_BG2CNT:
285 case DS9_REG_A_BG3CNT:
286 _updateCharBase(softwareRenderer, false);
287 break;
288 case DS9_REG_B_BG0CNT:
289 case DS9_REG_B_BG1CNT:
290 softwareRenderer->engB.bg[(address - DS9_REG_B_BG0CNT) >> 1].control = value;
291 // Fall through
292 case DS9_REG_B_BG2CNT:
293 case DS9_REG_B_BG3CNT:
294 _updateCharBase(softwareRenderer, true);
295 break;
296 case DS9_REG_A_MASTER_BRIGHT:
297 softwareRenderer->engA.masterBright = DSRegisterMASTER_BRIGHTGetMode(value);
298 softwareRenderer->engA.masterBrightY = DSRegisterMASTER_BRIGHTGetY(value);
299 if (softwareRenderer->engA.masterBrightY > 0x10) {
300 softwareRenderer->engA.masterBrightY = 0x10;
301 }
302 break;
303 case DS9_REG_B_MASTER_BRIGHT:
304 softwareRenderer->engB.masterBright = DSRegisterMASTER_BRIGHTGetMode(value);
305 softwareRenderer->engB.masterBrightY = DSRegisterMASTER_BRIGHTGetY(value);
306 if (softwareRenderer->engB.masterBrightY > 0x10) {
307 softwareRenderer->engB.masterBrightY = 0x10;
308 }
309 break;
310 case DS9_REG_A_BLDCNT:
311 case DS9_REG_A_BLDY:
312 // TODO: Optimize
313 _regenerateExtPalette(softwareRenderer, false, false, 0);
314 _regenerateExtPalette(softwareRenderer, false, false, 1);
315 _regenerateExtPalette(softwareRenderer, false, false, 2);
316 _regenerateExtPalette(softwareRenderer, false, false, 3);
317 _regenerateExtPalette(softwareRenderer, true, false, 0);
318 break;
319 case DS9_REG_B_BLDCNT:
320 case DS9_REG_B_BLDY:
321 // TODO: Optimize
322 _regenerateExtPalette(softwareRenderer, false, true, 0);
323 _regenerateExtPalette(softwareRenderer, false, true, 1);
324 _regenerateExtPalette(softwareRenderer, false, true, 2);
325 _regenerateExtPalette(softwareRenderer, false, true, 3);
326 _regenerateExtPalette(softwareRenderer, true, true, 0);
327 break;
328 case DS9_REG_A_DISPCNT_LO:
329 softwareRenderer->dispcntA &= 0xFFFF0000;
330 softwareRenderer->dispcntA |= value;
331 DSVideoSoftwareRendererUpdateDISPCNT(softwareRenderer, false);
332 break;
333 case DS9_REG_A_DISPCNT_HI:
334 softwareRenderer->dispcntA &= 0x0000FFFF;
335 softwareRenderer->dispcntA |= value << 16;
336 DSVideoSoftwareRendererUpdateDISPCNT(softwareRenderer, false);
337 break;
338 case DS9_REG_B_DISPCNT_LO:
339 softwareRenderer->dispcntB &= 0xFFFF0000;
340 softwareRenderer->dispcntB |= value;
341 DSVideoSoftwareRendererUpdateDISPCNT(softwareRenderer, true);
342 break;
343 case DS9_REG_B_DISPCNT_HI:
344 softwareRenderer->dispcntB &= 0x0000FFFF;
345 softwareRenderer->dispcntB |= value << 16;
346 DSVideoSoftwareRendererUpdateDISPCNT(softwareRenderer, true);
347 break;
348 case DS9_REG_POWCNT1:
349 value &= 0x810F;
350 softwareRenderer->powcnt = value;
351 }
352 return value;
353}
354
355static void DSVideoSoftwareRendererWritePalette(struct DSVideoRenderer* renderer, uint32_t address, uint16_t value) {
356 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
357 if (address < 0x400) {
358 softwareRenderer->engA.d.writePalette(&softwareRenderer->engA.d, address & 0x3FF, value);
359 } else {
360 softwareRenderer->engB.d.writePalette(&softwareRenderer->engB.d, address & 0x3FF, value);
361 }
362}
363
364static void DSVideoSoftwareRendererWriteOAM(struct DSVideoRenderer* renderer, uint32_t oam) {
365 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
366 if (oam < 0x200) {
367 softwareRenderer->engA.d.writeOAM(&softwareRenderer->engA.d, oam & 0x1FF);
368 } else {
369 softwareRenderer->engB.d.writeOAM(&softwareRenderer->engB.d, oam & 0x1FF);
370 }
371}
372
373static void DSVideoSoftwareRendererInvalidateExtPal(struct DSVideoRenderer* renderer, bool obj, bool engB, int slot) {
374 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
375 _regenerateExtPalette(softwareRenderer, obj, engB, slot);
376}
377
378static void DSVideoSoftwareRendererDrawGBAScanline(struct GBAVideoRenderer* renderer, struct DSGX* gx, int y) {
379 struct GBAVideoSoftwareRenderer* softwareRenderer = (struct GBAVideoSoftwareRenderer*) renderer;
380
381 int x;
382 color_t* row = &softwareRenderer->outputBuffer[softwareRenderer->outputBufferStride * y];
383 if (GBARegisterDISPCNTIsForcedBlank(softwareRenderer->dispcnt)) {
384 for (x = 0; x < softwareRenderer->masterEnd; ++x) {
385 row[x] = GBA_COLOR_WHITE;
386 }
387 return;
388 }
389
390 GBAVideoSoftwareRendererPreprocessBuffer(softwareRenderer, y);
391 int spriteLayers = GBAVideoSoftwareRendererPreprocessSpriteLayer(softwareRenderer, y);
392 memset(softwareRenderer->alphaA, softwareRenderer->blda, sizeof(softwareRenderer->alphaA));
393 memset(softwareRenderer->alphaB, softwareRenderer->bldb, sizeof(softwareRenderer->alphaB));
394
395 int w;
396 unsigned priority;
397 for (priority = 0; priority < 4; ++priority) {
398 softwareRenderer->end = 0;
399 for (w = 0; w < softwareRenderer->nWindows; ++w) {
400 softwareRenderer->start = softwareRenderer->end;
401 softwareRenderer->end = softwareRenderer->windows[w].endX;
402 softwareRenderer->currentWindow = softwareRenderer->windows[w].control;
403 if (spriteLayers & (1 << priority)) {
404 GBAVideoSoftwareRendererPostprocessSprite(softwareRenderer, priority);
405 }
406 if (TEST_LAYER_ENABLED(0)) {
407 if (DSRegisterDISPCNTIs3D(softwareRenderer->dispcnt) && gx) {
408 const color_t* scanline;
409 gx->renderer->getScanline(gx->renderer, y, &scanline);
410 uint32_t flags = (softwareRenderer->bg[0].priority << OFFSET_PRIORITY) | FLAG_IS_BACKGROUND | FLAG_TARGET_1 | FLAG_TARGET_2;
411 int x;
412 for (x = softwareRenderer->start; x < softwareRenderer->end; ++x) {
413 color_t color = scanline[x];
414 if (color & 0xFC000000) {
415 if (softwareRenderer->bg[0].target1 && GBAWindowControlIsBlendEnable(softwareRenderer->currentWindow.packed)) {
416 if (softwareRenderer->blendEffect == BLEND_DARKEN) {
417 color = _darken(color, softwareRenderer->bldy) | (color & 0xFF000000);
418 } else if (softwareRenderer->blendEffect == BLEND_BRIGHTEN) {
419 color = _brighten(color, softwareRenderer->bldy) | (color & 0xFF000000);
420 }
421 }
422 if ((scanline[x] >> 28) != 0xF) {
423 // TODO: More precise values
424 softwareRenderer->alphaA[x] = (color >> 28) + 1;
425 softwareRenderer->alphaB[x] = 0xF - (color >> 28);
426 _compositeBlendNoObjwin(softwareRenderer, x, (color & 0x00FFFFFF) | flags, softwareRenderer->row[x]);
427 } else {
428 if (!(softwareRenderer->row[x] & FLAG_TARGET_1)) {
429 _compositeNoBlendNoObjwin(softwareRenderer, x, (color & 0x00FFFFFF) | flags, softwareRenderer->row[x]);
430 } else {
431 _compositeBlendNoObjwin(softwareRenderer, x, (color & 0x00FFFFFF) | flags, softwareRenderer->row[x]);
432 }
433 softwareRenderer->alphaA[x] = 0x10;
434 softwareRenderer->alphaB[x] = 0;
435 }
436 }
437 }
438 } else {
439 GBAVideoSoftwareRendererDrawBackgroundMode0(softwareRenderer, &softwareRenderer->bg[0], y);
440 }
441 }
442 if (TEST_LAYER_ENABLED(1)) {
443 GBAVideoSoftwareRendererDrawBackgroundMode0(softwareRenderer, &softwareRenderer->bg[1], y);
444 }
445 if (TEST_LAYER_ENABLED(2)) {
446 switch (GBARegisterDISPCNTGetMode(softwareRenderer->dispcnt)) {
447 case 0:
448 case 1:
449 case 3:
450 GBAVideoSoftwareRendererDrawBackgroundMode0(softwareRenderer, &softwareRenderer->bg[2], y);
451 break;
452 case 2:
453 case 4:
454 GBAVideoSoftwareRendererDrawBackgroundMode2(softwareRenderer, &softwareRenderer->bg[2], y);
455 break;
456 case 5:
457 if (!GBARegisterBGCNTIsExtendedMode1(softwareRenderer->bg[2].control)) {
458 DSVideoSoftwareRendererDrawBackgroundExt0(softwareRenderer, &softwareRenderer->bg[2], y);
459 } else if (!GBARegisterBGCNTIsExtendedMode0(softwareRenderer->bg[2].control)) {
460 DSVideoSoftwareRendererDrawBackgroundExt1(softwareRenderer, &softwareRenderer->bg[2], y);
461 } else {
462 DSVideoSoftwareRendererDrawBackgroundExt2(softwareRenderer, &softwareRenderer->bg[2], y);
463 }
464 break;
465 }
466 }
467 if (TEST_LAYER_ENABLED(3)) {
468 switch (GBARegisterDISPCNTGetMode(softwareRenderer->dispcnt)) {
469 case 0:
470 GBAVideoSoftwareRendererDrawBackgroundMode0(softwareRenderer, &softwareRenderer->bg[3], y);
471 break;
472 case 1:
473 case 2:
474 GBAVideoSoftwareRendererDrawBackgroundMode2(softwareRenderer, &softwareRenderer->bg[3], y);
475 break;
476 case 3:
477 case 4:
478 case 5:
479 if (!GBARegisterBGCNTIsExtendedMode1(softwareRenderer->bg[3].control)) {
480 DSVideoSoftwareRendererDrawBackgroundExt0(softwareRenderer, &softwareRenderer->bg[3], y);
481 } else if (!GBARegisterBGCNTIsExtendedMode0(softwareRenderer->bg[3].control)) {
482 DSVideoSoftwareRendererDrawBackgroundExt1(softwareRenderer, &softwareRenderer->bg[3], y);
483 } else {
484 DSVideoSoftwareRendererDrawBackgroundExt2(softwareRenderer, &softwareRenderer->bg[3], y);
485 }
486 break;
487 }
488 }
489 }
490 }
491
492 if (softwareRenderer->bg[0].enabled > 0 && softwareRenderer->bg[0].enabled < 4) {
493 ++softwareRenderer->bg[0].enabled;
494 }
495 if (softwareRenderer->bg[1].enabled > 0 && softwareRenderer->bg[1].enabled < 4) {
496 ++softwareRenderer->bg[1].enabled;
497 }
498 if (softwareRenderer->bg[2].enabled > 0 && softwareRenderer->bg[2].enabled < 4) {
499 ++softwareRenderer->bg[2].enabled;
500 }
501 if (softwareRenderer->bg[3].enabled > 0 && softwareRenderer->bg[3].enabled < 4) {
502 ++softwareRenderer->bg[3].enabled;
503 }
504
505 GBAVideoSoftwareRendererPostprocessBuffer(softwareRenderer);
506}
507
508static void _advanceAffine(struct GBAVideoSoftwareRenderer* softwareRenderer) {
509 switch (GBARegisterDISPCNTGetMode(softwareRenderer->dispcnt)) {
510 case 2:
511 case 4:
512 case 5:
513 softwareRenderer->bg[2].sx += softwareRenderer->bg[2].dmx;
514 softwareRenderer->bg[2].sy += softwareRenderer->bg[2].dmy;
515 // Fall through
516 case 1:
517 case 3:
518 softwareRenderer->bg[3].sx += softwareRenderer->bg[3].dmx;
519 softwareRenderer->bg[3].sy += softwareRenderer->bg[3].dmy;
520 break;
521 }
522}
523
524static void _deadvanceAffine(struct GBAVideoSoftwareRenderer* softwareRenderer) {
525 switch (GBARegisterDISPCNTGetMode(softwareRenderer->dispcnt)) {
526 case 2:
527 case 4:
528 case 5:
529 softwareRenderer->bg[2].sx -= softwareRenderer->bg[2].dmx;
530 softwareRenderer->bg[2].sy -= softwareRenderer->bg[2].dmy;
531 // Fall through
532 case 1:
533 case 3:
534 softwareRenderer->bg[3].sx -= softwareRenderer->bg[3].dmx;
535 softwareRenderer->bg[3].sy -= softwareRenderer->bg[3].dmy;
536 break;
537 }
538}
539
540static void _drawScanlineA(struct DSVideoSoftwareRenderer* softwareRenderer, int y) {
541 memcpy(softwareRenderer->engA.d.vramBG, softwareRenderer->d.vramABG, sizeof(softwareRenderer->engA.d.vramBG));
542 memcpy(softwareRenderer->engA.d.vramOBJ, softwareRenderer->d.vramAOBJ, sizeof(softwareRenderer->engA.d.vramOBJ));
543 color_t* row = &softwareRenderer->engA.outputBuffer[softwareRenderer->outputBufferStride * y];
544
545 int x;
546 switch (DSRegisterDISPCNTGetDispMode(softwareRenderer->dispcntA)) {
547 case 0:
548 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
549 row[x] = GBA_COLOR_WHITE;
550 }
551 return;
552 case 1:
553 DSVideoSoftwareRendererDrawGBAScanline(&softwareRenderer->engA.d, softwareRenderer->d.gx, y);
554 break;
555 case 2: {
556 uint16_t* vram = &softwareRenderer->d.vram[0x10000 * DSRegisterDISPCNTGetVRAMBlock(softwareRenderer->dispcntA)];
557 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
558 color_t color;
559 LOAD_16(color, (x + y * DS_VIDEO_HORIZONTAL_PIXELS) * 2, vram);
560#ifndef COLOR_16_BIT
561 unsigned color32 = 0;
562 color32 |= (color << 9) & 0xF80000;
563 color32 |= (color << 3) & 0xF8;
564 color32 |= (color << 6) & 0xF800;
565 color32 |= (color32 >> 5) & 0x070707;
566 color = color32;
567#elif COLOR_5_6_5
568 uint16_t color16 = 0;
569 color16 |= (color & 0x001F) << 11;
570 color16 |= (color & 0x03E0) << 1;
571 color16 |= (color & 0x7C00) >> 10;
572 color = color16;
573#endif
574 softwareRenderer->engA.row[x] = color;
575 }
576 break;
577 }
578 case 3:
579 break;
580 }
581
582 _advanceAffine(&softwareRenderer->engA);
583
584#ifdef COLOR_16_BIT
585#if defined(__ARM_NEON) && !defined(__APPLE__)
586 _to16Bit(row, softwareRenderer->engA.row, DS_VIDEO_HORIZONTAL_PIXELS);
587#else
588 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
589 row[x] = softwareRenderer->engA.row[x];
590 }
591#endif
592#else
593 switch (softwareRenderer->engA.masterBright) {
594 case 0:
595 default:
596 memcpy(row, softwareRenderer->engA.row, softwareRenderer->engA.masterEnd * sizeof(*row));
597 break;
598 case 1:
599 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
600 row[x] = _brighten(softwareRenderer->engA.row[x], softwareRenderer->engA.masterBrightY);
601 }
602 break;
603 case 2:
604 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
605 row[x] = _darken(softwareRenderer->engA.row[x], softwareRenderer->engA.masterBrightY);
606 }
607 break;
608 }
609#endif
610}
611
612static void _drawScanlineB(struct DSVideoSoftwareRenderer* softwareRenderer, int y) {
613 memcpy(softwareRenderer->engB.d.vramBG, softwareRenderer->d.vramBBG, sizeof(softwareRenderer->engB.d.vramBG));
614 memcpy(softwareRenderer->engB.d.vramOBJ, softwareRenderer->d.vramBOBJ, sizeof(softwareRenderer->engB.d.vramOBJ));
615 color_t* row = &softwareRenderer->engB.outputBuffer[softwareRenderer->outputBufferStride * y];
616
617 int x;
618 switch (DSRegisterDISPCNTGetDispMode(softwareRenderer->dispcntB)) {
619 case 0:
620 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
621 row[x] = GBA_COLOR_WHITE;
622 }
623 return;
624 case 1:
625 DSVideoSoftwareRendererDrawGBAScanline(&softwareRenderer->engB.d, NULL, y);
626 break;
627 }
628
629 _advanceAffine(&softwareRenderer->engB);
630
631#ifdef COLOR_16_BIT
632#if defined(__ARM_NEON) && !defined(__APPLE__)
633 _to16Bit(row, softwareRenderer->engB.row, DS_VIDEO_HORIZONTAL_PIXELS);
634#else
635 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
636 row[x] = softwareRenderer->engB.row[x];
637 }
638#endif
639#else
640 switch (softwareRenderer->engB.masterBright) {
641 case 0:
642 default:
643 memcpy(row, softwareRenderer->engB.row, softwareRenderer->engB.masterEnd * sizeof(*row));
644 break;
645 case 1:
646 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
647 row[x] = _brighten(softwareRenderer->engB.row[x], softwareRenderer->engB.masterBrightY);
648 }
649 break;
650 case 2:
651 for (x = 0; x < DS_VIDEO_HORIZONTAL_PIXELS; ++x) {
652 row[x] = _darken(softwareRenderer->engB.row[x], softwareRenderer->engB.masterBrightY);
653 }
654 break;
655 }
656#endif
657}
658
659static void DSVideoSoftwareRendererDrawScanline(struct DSVideoRenderer* renderer, int y) {
660 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
661 if (!DSRegisterPOWCNT1IsSwap(softwareRenderer->powcnt)) {
662 softwareRenderer->engA.outputBuffer = &softwareRenderer->outputBuffer[softwareRenderer->outputBufferStride * DS_VIDEO_VERTICAL_PIXELS];
663 softwareRenderer->engB.outputBuffer = softwareRenderer->outputBuffer;
664 } else {
665 softwareRenderer->engA.outputBuffer = softwareRenderer->outputBuffer;
666 softwareRenderer->engB.outputBuffer = &softwareRenderer->outputBuffer[softwareRenderer->outputBufferStride * DS_VIDEO_VERTICAL_PIXELS];
667 }
668
669 softwareRenderer->engA.d.disableBG[0] = softwareRenderer->d.disableABG[0];
670 softwareRenderer->engA.d.disableBG[1] = softwareRenderer->d.disableABG[1];
671 softwareRenderer->engA.d.disableBG[2] = softwareRenderer->d.disableABG[2];
672 softwareRenderer->engA.d.disableBG[3] = softwareRenderer->d.disableABG[3];
673 softwareRenderer->engA.d.disableOBJ = softwareRenderer->d.disableAOBJ;
674
675 softwareRenderer->engB.d.disableBG[0] = softwareRenderer->d.disableBBG[0];
676 softwareRenderer->engB.d.disableBG[1] = softwareRenderer->d.disableBBG[1];
677 softwareRenderer->engB.d.disableBG[2] = softwareRenderer->d.disableBBG[2];
678 softwareRenderer->engB.d.disableBG[3] = softwareRenderer->d.disableBBG[3];
679 softwareRenderer->engB.d.disableOBJ = softwareRenderer->d.disableBOBJ;
680
681 _drawScanlineA(softwareRenderer, y);
682 _drawScanlineB(softwareRenderer, y);
683}
684
685static void DSVideoSoftwareRendererDrawScanlineDirectly(struct DSVideoRenderer* renderer, int y, color_t* scanline) {
686 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
687 _deadvanceAffine(&softwareRenderer->engA);
688 DSVideoSoftwareRendererDrawGBAScanline(&softwareRenderer->engA.d, softwareRenderer->d.gx, y);
689 _advanceAffine(&softwareRenderer->engA);
690 memcpy(scanline, softwareRenderer->engA.row, softwareRenderer->engA.masterEnd * sizeof(*scanline));
691}
692
693static void DSVideoSoftwareRendererFinishFrame(struct DSVideoRenderer* renderer) {
694 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
695 softwareRenderer->engA.d.finishFrame(&softwareRenderer->engA.d);
696 softwareRenderer->engB.d.finishFrame(&softwareRenderer->engB.d);
697}
698
699static void DSVideoSoftwareRendererGetPixels(struct DSVideoRenderer* renderer, size_t* stride, const void** pixels) {
700 struct DSVideoSoftwareRenderer* softwareRenderer = (struct DSVideoSoftwareRenderer*) renderer;
701#ifdef COLOR_16_BIT
702#error Not yet supported
703#else
704 *stride = softwareRenderer->outputBufferStride;
705 *pixels = softwareRenderer->outputBuffer;
706#endif
707}
708
709static void DSVideoSoftwareRendererPutPixels(struct DSVideoRenderer* renderer, size_t stride, const void* pixels) {
710}
711
712#define EXT_0_COORD_OVERFLOW \
713 localX = x & (sizeAdjusted - 1); \
714 localY = y & (sizeAdjusted - 1); \
715
716#define EXT_0_COORD_NO_OVERFLOW \
717 if ((x | y) & ~(sizeAdjusted - 1)) { \
718 continue; \
719 } \
720 localX = x; \
721 localY = y;
722
723#define EXT_0_EXT_PAL \
724 paletteData = GBA_TEXT_MAP_PALETTE(mapData) << 8; \
725 palette = &mainPalette[paletteData];
726
727#define EXT_0_PAL palette = mainPalette;
728
729#define EXT_0_NO_MOSAIC(COORD, PAL) \
730 COORD \
731 uint32_t screenBase = background->screenBase + (localX >> 10) + (((localY >> 6) & 0xFE0) << background->size); \
732 uint16_t* screenBlock = renderer->d.vramBG[screenBase >> VRAM_BLOCK_OFFSET]; \
733 if (UNLIKELY(!screenBlock)) { \
734 continue; \
735 } \
736 LOAD_16(mapData, screenBase & (VRAM_BLOCK_MASK - 1), screenBlock); \
737 PAL; \
738 if (GBA_TEXT_MAP_VFLIP(mapData)) { \
739 localY = 0x7FF - localY; \
740 } \
741 if (GBA_TEXT_MAP_HFLIP(mapData)) { \
742 localX = 0x7FF - localX; \
743 } \
744 uint32_t charBase = (background->charBase + (GBA_TEXT_MAP_TILE(mapData) << 6)) + ((localY & 0x700) >> 5) + ((localX & 0x700) >> 8); \
745 uint16_t* vram = renderer->d.vramBG[charBase >> VRAM_BLOCK_OFFSET]; \
746 pixelData = ((uint8_t*) vram)[charBase & VRAM_BLOCK_MASK];
747
748#define EXT_0_MOSAIC(COORD, PAL) \
749 if (!mosaicWait) { \
750 EXT_0_NO_MOSAIC(COORD, PAL) \
751 mosaicWait = mosaicH; \
752 } else { \
753 --mosaicWait; \
754 }
755
756#define EXT_0_LOOP(MOSAIC, COORD, PAL, BLEND, OBJWIN) \
757 for (outX = renderer->start, pixel = &renderer->row[outX]; outX < renderer->end; ++outX, ++pixel) { \
758 x += background->dx; \
759 y += background->dy; \
760 \
761 uint32_t current = *pixel; \
762 MOSAIC(COORD, PAL) \
763 if (pixelData) { \
764 COMPOSITE_256_ ## OBJWIN (BLEND, 0); \
765 } \
766 }
767
768#define DRAW_BACKGROUND_EXT_0(BLEND, OBJWIN) \
769 if (background->extPalette) { \
770 if (background->overflow) { \
771 if (mosaicH > 1) { \
772 EXT_0_LOOP(EXT_0_MOSAIC, EXT_0_COORD_OVERFLOW, EXT_0_EXT_PAL, BLEND, OBJWIN); \
773 } else { \
774 EXT_0_LOOP(EXT_0_NO_MOSAIC, EXT_0_COORD_OVERFLOW, EXT_0_EXT_PAL, BLEND, OBJWIN); \
775 } \
776 } else { \
777 if (mosaicH > 1) { \
778 EXT_0_LOOP(EXT_0_MOSAIC, EXT_0_COORD_NO_OVERFLOW, EXT_0_EXT_PAL, BLEND, OBJWIN); \
779 } else { \
780 EXT_0_LOOP(EXT_0_NO_MOSAIC, EXT_0_COORD_NO_OVERFLOW, EXT_0_EXT_PAL, BLEND, OBJWIN); \
781 } \
782 } \
783 } else { \
784 if (background->overflow) { \
785 if (mosaicH > 1) { \
786 EXT_0_LOOP(EXT_0_MOSAIC, EXT_0_COORD_OVERFLOW, EXT_0_PAL, BLEND, OBJWIN); \
787 } else { \
788 EXT_0_LOOP(EXT_0_NO_MOSAIC, EXT_0_COORD_OVERFLOW, EXT_0_PAL, BLEND, OBJWIN); \
789 } \
790 } else { \
791 if (mosaicH > 1) { \
792 EXT_0_LOOP(EXT_0_MOSAIC, EXT_0_COORD_NO_OVERFLOW, EXT_0_PAL, BLEND, OBJWIN); \
793 } else { \
794 EXT_0_LOOP(EXT_0_NO_MOSAIC, EXT_0_COORD_NO_OVERFLOW, EXT_0_PAL, BLEND, OBJWIN); \
795 } \
796 } \
797 }
798
799void DSVideoSoftwareRendererDrawBackgroundExt0(struct GBAVideoSoftwareRenderer* renderer, struct GBAVideoSoftwareBackground* background, int inY) {
800 int sizeAdjusted = 0x8000 << background->size;
801
802 BACKGROUND_BITMAP_INIT;
803
804 color_t* mainPalette = background->extPalette;
805 if (variant) {
806 mainPalette = background->variantPalette;
807 }
808 if (!mainPalette) {
809 mainPalette = renderer->normalPalette;
810 if (variant) {
811 mainPalette = renderer->variantPalette;
812 }
813 }
814 int paletteData;
815
816 uint16_t mapData;
817 uint8_t pixelData = 0;
818
819 int outX;
820 uint32_t* pixel;
821
822 if (!objwinSlowPath) {
823 if (!(flags & FLAG_TARGET_2)) {
824 DRAW_BACKGROUND_EXT_0(NoBlend, NO_OBJWIN);
825 } else {
826 DRAW_BACKGROUND_EXT_0(Blend, NO_OBJWIN);
827 }
828 } else {
829 if (!(flags & FLAG_TARGET_2)) {
830 DRAW_BACKGROUND_EXT_0(NoBlend, OBJWIN);
831 } else {
832 DRAW_BACKGROUND_EXT_0(Blend, OBJWIN);
833 }
834 }
835}
836
837#define DS_BACKGROUND_BITMAP_ITERATE(W, H) \
838 x += background->dx; \
839 y += background->dy; \
840 \
841 if (background->overflow) { \
842 localX = x & ((W << 8) - 1); \
843 localY = y & ((H << 8) - 1); \
844 } else if (x < 0 || y < 0 || (x >> 8) >= W || (y >> 8) >= H) { \
845 continue; \
846 } else { \
847 localX = x; \
848 localY = y; \
849 }
850
851void DSVideoSoftwareRendererDrawBackgroundExt1(struct GBAVideoSoftwareRenderer* renderer, struct GBAVideoSoftwareBackground* background, int inY) {
852 BACKGROUND_BITMAP_INIT;
853
854 uint32_t screenBase = (background->screenBase & 0xFF00) * 8;
855 uint8_t color;
856 int width, height;
857 switch (background->size) {
858 case 0:
859 width = 128;
860 height = 128;
861 break;
862 case 1:
863 width = 256;
864 height = 256;
865 break;
866 case 2:
867 width = 512;
868 height = 256;
869 break;
870 case 3:
871 width = 512;
872 height = 512;
873 break;
874 }
875
876 int outX;
877 for (outX = renderer->start; outX < renderer->end; ++outX) {
878 DS_BACKGROUND_BITMAP_ITERATE(width, height);
879
880 if (!mosaicWait) {
881 uint32_t address = (localX >> 8) + (localY >> 8) * width + screenBase;
882 uint8_t* vram = (uint8_t*) renderer->d.vramBG[address >> VRAM_BLOCK_OFFSET];
883 color = vram[address & VRAM_BLOCK_MASK];
884 mosaicWait = mosaicH;
885 } else {
886 --mosaicWait;
887 }
888
889 uint32_t current = renderer->row[outX];
890 if (color && IS_WRITABLE(current)) {
891 if (!objwinSlowPath) {
892 _compositeBlendNoObjwin(renderer, outX, palette[color] | flags, current);
893 } else if (objwinForceEnable || (!(current & FLAG_OBJWIN)) == objwinOnly) {
894 color_t* currentPalette = (current & FLAG_OBJWIN) ? objwinPalette : palette;
895 unsigned mergedFlags = flags;
896 if (current & FLAG_OBJWIN) {
897 mergedFlags = objwinFlags;
898 }
899 _compositeBlendObjwin(renderer, outX, currentPalette[color] | mergedFlags, current);
900 }
901 }
902 }
903}
904
905void DSVideoSoftwareRendererDrawBackgroundExt2(struct GBAVideoSoftwareRenderer* renderer, struct GBAVideoSoftwareBackground* background, int inY) {
906 BACKGROUND_BITMAP_INIT;
907
908 uint32_t screenBase = (background->screenBase & 0xFF00) * 4;
909 uint32_t color;
910 int width, height;
911 switch (background->size) {
912 case 0:
913 width = 128;
914 height = 128;
915 break;
916 case 1:
917 width = 256;
918 height = 256;
919 break;
920 case 2:
921 width = 512;
922 height = 256;
923 break;
924 case 3:
925 width = 512;
926 height = 512;
927 break;
928 }
929
930 int outX;
931 for (outX = renderer->start; outX < renderer->end; ++outX) {
932 DS_BACKGROUND_BITMAP_ITERATE(width, height);
933
934 if (!mosaicWait) {
935 uint32_t address = ((localX >> 8) + (localY >> 8) * width + screenBase) << 1;
936 uint16_t* vram = renderer->d.vramBG[address >> VRAM_BLOCK_OFFSET];
937 LOAD_16(color, address & VRAM_BLOCK_MASK, vram);
938#ifndef COLOR_16_BIT
939 unsigned color32;
940 color32 = 0;
941 color32 |= (color << 3) & 0xF8;
942 color32 |= (color << 6) & 0xF800;
943 color32 |= (color << 9) & 0xF80000;
944 color32 |= (color32 >> 5) & 0x070707;
945 color = color32;
946#elif COLOR_5_6_5
947 uint16_t color16 = 0;
948 color16 |= (color & 0x001F) << 11;
949 color16 |= (color & 0x03E0) << 1;
950 color16 |= (color & 0x7C00) >> 10;
951 color = color16;
952#endif
953 mosaicWait = mosaicH;
954 } else {
955 --mosaicWait;
956 }
957
958 uint32_t current = renderer->row[outX];
959 if (!objwinSlowPath || (!(current & FLAG_OBJWIN)) != objwinOnly) {
960 unsigned mergedFlags = flags;
961 if (current & FLAG_OBJWIN) {
962 mergedFlags = objwinFlags;
963 }
964 if (!variant) {
965 _compositeBlendObjwin(renderer, outX, color | mergedFlags, current);
966 } else if (renderer->blendEffect == BLEND_BRIGHTEN) {
967 _compositeBlendObjwin(renderer, outX, _brighten(color, renderer->bldy) | mergedFlags, current);
968 } else if (renderer->blendEffect == BLEND_DARKEN) {
969 _compositeBlendObjwin(renderer, outX, _darken(color, renderer->bldy) | mergedFlags, current);
970 }
971 }
972 }
973}