all repos — mgba @ 9567a8632f4a3804051866ec4174feb3460d0cdf

mGBA Game Boy Advance Emulator

src/ds/gx.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/gx.h>
   7
   8#include <mgba/internal/ds/ds.h>
   9#include <mgba/internal/ds/io.h>
  10
  11mLOG_DEFINE_CATEGORY(DS_GX, "DS GX", "ds.gx");
  12
  13#define DS_GX_FIFO_SIZE 256
  14#define DS_GX_PIPE_SIZE 4
  15
  16static void DSGXDummyRendererInit(struct DSGXRenderer* renderer);
  17static void DSGXDummyRendererReset(struct DSGXRenderer* renderer);
  18static void DSGXDummyRendererDeinit(struct DSGXRenderer* renderer);
  19static void DSGXDummyRendererInvalidateTex(struct DSGXRenderer* renderer, int slot);
  20static void DSGXDummyRendererSetRAM(struct DSGXRenderer* renderer, struct DSGXVertex* verts, struct DSGXPolygon* polys, unsigned polyCount, bool wSort);
  21static void DSGXDummyRendererDrawScanline(struct DSGXRenderer* renderer, int y);
  22static void DSGXDummyRendererGetScanline(struct DSGXRenderer* renderer, int y, const color_t** output);
  23
  24static void DSGXWriteFIFO(struct DSGX* gx, struct DSGXEntry entry);
  25
  26static bool _boxTestVertex(struct DSGX* gx, struct DSGXVertex* vertex);
  27
  28static const int32_t _gxCommandCycleBase[DS_GX_CMD_MAX] = {
  29	[DS_GX_CMD_NOP] = 0,
  30	[DS_GX_CMD_MTX_MODE] = 2,
  31	[DS_GX_CMD_MTX_PUSH] = 34,
  32	[DS_GX_CMD_MTX_POP] = 72,
  33	[DS_GX_CMD_MTX_STORE] = 34,
  34	[DS_GX_CMD_MTX_RESTORE] = 72,
  35	[DS_GX_CMD_MTX_IDENTITY] = 38,
  36	[DS_GX_CMD_MTX_LOAD_4x4] = 68,
  37	[DS_GX_CMD_MTX_LOAD_4x3] = 60,
  38	[DS_GX_CMD_MTX_MULT_4x4] = 70,
  39	[DS_GX_CMD_MTX_MULT_4x3] = 62,
  40	[DS_GX_CMD_MTX_MULT_3x3] = 56,
  41	[DS_GX_CMD_MTX_SCALE] = 44,
  42	[DS_GX_CMD_MTX_TRANS] = 44,
  43	[DS_GX_CMD_COLOR] = 2,
  44	[DS_GX_CMD_NORMAL] = 18,
  45	[DS_GX_CMD_TEXCOORD] = 2,
  46	[DS_GX_CMD_VTX_16] = 18,
  47	[DS_GX_CMD_VTX_10] = 16,
  48	[DS_GX_CMD_VTX_XY] = 16,
  49	[DS_GX_CMD_VTX_XZ] = 16,
  50	[DS_GX_CMD_VTX_YZ] = 16,
  51	[DS_GX_CMD_VTX_DIFF] = 16,
  52	[DS_GX_CMD_POLYGON_ATTR] = 2,
  53	[DS_GX_CMD_TEXIMAGE_PARAM] = 2,
  54	[DS_GX_CMD_PLTT_BASE] = 2,
  55	[DS_GX_CMD_DIF_AMB] = 8,
  56	[DS_GX_CMD_SPE_EMI] = 8,
  57	[DS_GX_CMD_LIGHT_VECTOR] = 12,
  58	[DS_GX_CMD_LIGHT_COLOR] = 2,
  59	[DS_GX_CMD_SHININESS] = 64,
  60	[DS_GX_CMD_BEGIN_VTXS] = 2,
  61	[DS_GX_CMD_END_VTXS] = 2,
  62	[DS_GX_CMD_SWAP_BUFFERS] = 784,
  63	[DS_GX_CMD_VIEWPORT] = 2,
  64	[DS_GX_CMD_BOX_TEST] = 206,
  65	[DS_GX_CMD_POS_TEST] = 18,
  66	[DS_GX_CMD_VEC_TEST] = 10,
  67};
  68
  69static const int32_t _gxCommandParams[DS_GX_CMD_MAX] = {
  70	[DS_GX_CMD_MTX_MODE] = 1,
  71	[DS_GX_CMD_MTX_POP] = 1,
  72	[DS_GX_CMD_MTX_STORE] = 1,
  73	[DS_GX_CMD_MTX_RESTORE] = 1,
  74	[DS_GX_CMD_MTX_LOAD_4x4] = 16,
  75	[DS_GX_CMD_MTX_LOAD_4x3] = 12,
  76	[DS_GX_CMD_MTX_MULT_4x4] = 16,
  77	[DS_GX_CMD_MTX_MULT_4x3] = 12,
  78	[DS_GX_CMD_MTX_MULT_3x3] = 9,
  79	[DS_GX_CMD_MTX_SCALE] = 3,
  80	[DS_GX_CMD_MTX_TRANS] = 3,
  81	[DS_GX_CMD_COLOR] = 1,
  82	[DS_GX_CMD_NORMAL] = 1,
  83	[DS_GX_CMD_TEXCOORD] = 1,
  84	[DS_GX_CMD_VTX_16] = 2,
  85	[DS_GX_CMD_VTX_10] = 1,
  86	[DS_GX_CMD_VTX_XY] = 1,
  87	[DS_GX_CMD_VTX_XZ] = 1,
  88	[DS_GX_CMD_VTX_YZ] = 1,
  89	[DS_GX_CMD_VTX_DIFF] = 1,
  90	[DS_GX_CMD_POLYGON_ATTR] = 1,
  91	[DS_GX_CMD_TEXIMAGE_PARAM] = 1,
  92	[DS_GX_CMD_PLTT_BASE] = 1,
  93	[DS_GX_CMD_DIF_AMB] = 1,
  94	[DS_GX_CMD_SPE_EMI] = 1,
  95	[DS_GX_CMD_LIGHT_VECTOR] = 1,
  96	[DS_GX_CMD_LIGHT_COLOR] = 1,
  97	[DS_GX_CMD_SHININESS] = 32,
  98	[DS_GX_CMD_BEGIN_VTXS] = 1,
  99	[DS_GX_CMD_SWAP_BUFFERS] = 1,
 100	[DS_GX_CMD_VIEWPORT] = 1,
 101	[DS_GX_CMD_BOX_TEST] = 3,
 102	[DS_GX_CMD_POS_TEST] = 2,
 103	[DS_GX_CMD_VEC_TEST] = 1,
 104};
 105
 106static struct DSGXRenderer dummyRenderer = {
 107	.init = DSGXDummyRendererInit,
 108	.reset = DSGXDummyRendererReset,
 109	.deinit = DSGXDummyRendererDeinit,
 110	.invalidateTex = DSGXDummyRendererInvalidateTex,
 111	.setRAM = DSGXDummyRendererSetRAM,
 112	.drawScanline = DSGXDummyRendererDrawScanline,
 113	.getScanline = DSGXDummyRendererGetScanline,
 114};
 115
 116static void _pullPipe(struct DSGX* gx) {
 117	if (CircleBufferSize(&gx->fifo) >= sizeof(struct DSGXEntry)) {
 118		struct DSGXEntry entry = { 0 };
 119		CircleBufferRead(&gx->fifo, &entry, sizeof(entry));
 120		CircleBufferWrite(&gx->pipe, &entry, sizeof(entry));
 121	}
 122	if (CircleBufferSize(&gx->fifo) >= sizeof(struct DSGXEntry)) {
 123		struct DSGXEntry entry = { 0 };
 124		CircleBufferRead(&gx->fifo, &entry, sizeof(entry));
 125		CircleBufferWrite(&gx->pipe, &entry, sizeof(entry));
 126	}
 127}
 128
 129static void _updateClipMatrix(struct DSGX* gx) {
 130	DSGXMtxMultiply(&gx->clipMatrix, &gx->posMatrix, &gx->projMatrix);
 131	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_00 >> 1] = gx->clipMatrix.m[0];
 132	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_01 >> 1] = gx->clipMatrix.m[0] >> 16;
 133	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_02 >> 1] = gx->clipMatrix.m[1];
 134	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_03 >> 1] = gx->clipMatrix.m[1] >> 16;
 135	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_04 >> 1] = gx->clipMatrix.m[2];
 136	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_05 >> 1] = gx->clipMatrix.m[2] >> 16;
 137	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_06 >> 1] = gx->clipMatrix.m[3];
 138	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_07 >> 1] = gx->clipMatrix.m[3] >> 16;
 139	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_08 >> 1] = gx->clipMatrix.m[4];
 140	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_09 >> 1] = gx->clipMatrix.m[4] >> 16;
 141	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_0A >> 1] = gx->clipMatrix.m[5];
 142	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_0B >> 1] = gx->clipMatrix.m[5] >> 16;
 143	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_0C >> 1] = gx->clipMatrix.m[6];
 144	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_0D >> 1] = gx->clipMatrix.m[6] >> 16;
 145	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_0E >> 1] = gx->clipMatrix.m[7];
 146	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_0F >> 1] = gx->clipMatrix.m[7] >> 16;
 147	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_10 >> 1] = gx->clipMatrix.m[8];
 148	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_11 >> 1] = gx->clipMatrix.m[8] >> 16;
 149	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_12 >> 1] = gx->clipMatrix.m[9];
 150	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_13 >> 1] = gx->clipMatrix.m[9] >> 16;
 151	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_14 >> 1] = gx->clipMatrix.m[10];
 152	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_15 >> 1] = gx->clipMatrix.m[10] >> 16;
 153	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_16 >> 1] = gx->clipMatrix.m[11];
 154	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_17 >> 1] = gx->clipMatrix.m[11] >> 16;
 155	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_18 >> 1] = gx->clipMatrix.m[12];
 156	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_19 >> 1] = gx->clipMatrix.m[12] >> 16;
 157	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_1A >> 1] = gx->clipMatrix.m[13];
 158	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_1B >> 1] = gx->clipMatrix.m[13] >> 16;
 159	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_1C >> 1] = gx->clipMatrix.m[14];
 160	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_1D >> 1] = gx->clipMatrix.m[14] >> 16;
 161	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_1E >> 1] = gx->clipMatrix.m[15];
 162	gx->p->memory.io9[DS9_REG_CLIPMTX_RESULT_1F >> 1] = gx->clipMatrix.m[15] >> 16;
 163}
 164
 165static inline int32_t _lerp(int32_t x0, int32_t x1, int32_t q, int64_t r) {
 166	int64_t x = x1 - x0;
 167	x *= q;
 168	x /= r;
 169	x += x0;
 170	return x;
 171}
 172
 173static int _cohenSutherlandCode(const struct DSGXVertex* v) {
 174	int code = 0;
 175	if (v->viewCoord[0] < -v->viewCoord[3]) {
 176		code |= 1 << 0;
 177	} else if (v->viewCoord[0] > v->viewCoord[3]) {
 178		code |= 2 << 0;
 179	}
 180	if (v->viewCoord[1] < -v->viewCoord[3]) {
 181		code |= 1 << 2;
 182	} else if (v->viewCoord[1] > v->viewCoord[3]) {
 183		code |= 2 << 2;
 184	}
 185	if (v->viewCoord[2] < -v->viewCoord[3]) {
 186		code |= 1 << 4;
 187	} else if (v->viewCoord[2] > v->viewCoord[3]) {
 188		code |= 2 << 4;
 189	}
 190	return code;
 191}
 192
 193static bool _lerpVertex(const struct DSGXVertex* v0, const struct DSGXVertex* v1, struct DSGXVertex* out, int32_t q, int64_t r) {
 194	if (!r) {
 195		return false;
 196	}
 197	int cr0 = (v0->color) & 0x1F;
 198	int cg0 = (v0->color >> 5) & 0x1F;
 199	int cb0 = (v0->color >> 10) & 0x1F;
 200	int cr1 = (v1->color) & 0x1F;
 201	int cg1 = (v1->color >> 5) & 0x1F;
 202	int cb1 = (v1->color >> 10) & 0x1F;
 203	cr0 = _lerp(cr0, cr1, q, r) & 0x1F;
 204	cg0 = _lerp(cg0, cg1, q, r) & 0x1F;
 205	cb0 = _lerp(cb0, cb1, q, r) & 0x1F;
 206	out->color = cr0 | (cg0 << 5) | (cb0 << 10);
 207
 208	out->viewCoord[0] = _lerp(v0->viewCoord[0], v1->viewCoord[0], q, r);
 209	out->viewCoord[1] = _lerp(v0->viewCoord[1], v1->viewCoord[1], q, r);
 210	out->viewCoord[2] = _lerp(v0->viewCoord[2], v1->viewCoord[2], q, r);
 211	out->viewCoord[3] = _lerp(v0->viewCoord[3], v1->viewCoord[3], q, r);
 212
 213	out->vs = _lerp(v0->vs, v1->vs, q, r);
 214	out->vt = _lerp(v0->vt, v1->vt, q, r);
 215	return true;
 216}
 217
 218static bool _lerpVertexP(const struct DSGXVertex* v0, const struct DSGXVertex* v1, struct DSGXVertex* out, int plane, int sign) {
 219	int32_t q = v0->viewCoord[3] - sign * v0->viewCoord[plane];
 220	int64_t r = q - (v1->viewCoord[3] - sign * v1->viewCoord[plane]);
 221	return _lerpVertex(v0, v1, out, q, r);
 222}
 223
 224static bool _clipPolygon(struct DSGX* gx, struct DSGXPolygon* poly) {
 225	int nOffscreen = 0;
 226	int offscreenVerts[10] = { 0, 0, 0, 0 };
 227	unsigned oldVerts[4];
 228	int v;
 229
 230	if (!DSGXPolygonAttrsIsBackFace(poly->polyParams) || !DSGXPolygonAttrsIsFrontFace(poly->polyParams)) {
 231		// Calculate normal direction and camera dot product average
 232		int64_t nx = 0;
 233		int64_t ny = 0;
 234		int64_t nz = 0;
 235		int64_t dot = 0;
 236		for (v = 0; v < poly->verts; ++v) {
 237			struct DSGXVertex* v0 = &gx->pendingVertices[poly->vertIds[v]];
 238			struct DSGXVertex* v1;
 239			struct DSGXVertex* v2;
 240			if (v < poly->verts - 2) {
 241				v1 = &gx->pendingVertices[poly->vertIds[v + 1]];
 242				v2 = &gx->pendingVertices[poly->vertIds[v + 2]];
 243			} else if (v < poly->verts - 1) {
 244				v1 = &gx->pendingVertices[poly->vertIds[v + 1]];
 245				v2 = &gx->pendingVertices[poly->vertIds[v + 2 - poly->verts]];
 246			} else {
 247				v1 = &gx->pendingVertices[poly->vertIds[v + 1 - poly->verts]];
 248				v2 = &gx->pendingVertices[poly->vertIds[v + 2 - poly->verts]];
 249			}
 250			nx = ((int64_t) v0->viewCoord[1] * v2->viewCoord[3] - (int64_t) v0->viewCoord[3] * v2->viewCoord[1]) >> 24;
 251			ny = ((int64_t) v0->viewCoord[3] * v2->viewCoord[0] - (int64_t) v0->viewCoord[0] * v2->viewCoord[3]) >> 24;
 252			nz = ((int64_t) v0->viewCoord[0] * v2->viewCoord[1] - (int64_t) v0->viewCoord[1] * v2->viewCoord[0]) >> 24;
 253			dot += nx * v1->viewCoord[0] + ny * v1->viewCoord[1] + nz * v1->viewCoord[3];
 254		}
 255		if (!DSGXPolygonAttrsIsBackFace(poly->polyParams) && dot < 0) {
 256			return false;
 257		}
 258		if (!DSGXPolygonAttrsIsFrontFace(poly->polyParams) && dot > 0) {
 259			return false;
 260		}
 261	}
 262
 263	// Collect offscreen vertices
 264	for (v = 0; v < poly->verts; ++v) {
 265		offscreenVerts[v] = _cohenSutherlandCode(&gx->pendingVertices[poly->vertIds[v]]);
 266		oldVerts[v] = poly->vertIds[v];
 267		if (offscreenVerts[v]) {
 268			++nOffscreen;
 269		}
 270	}
 271
 272	struct DSGXVertex* vbuf = gx->vertexBuffer[gx->bufferIndex];
 273
 274	if (!nOffscreen) {
 275		for (v = 0; v < poly->verts; ++v) {
 276			if (gx->vertexIndex == DS_GX_VERTEX_BUFFER_SIZE) {
 277				return false;
 278			}
 279			int vertexId = oldVerts[v];
 280			if (gx->pendingVertexIds[vertexId] >= 0) {
 281				poly->vertIds[v] = gx->pendingVertexIds[vertexId];
 282			} else {
 283				vbuf[gx->vertexIndex] = gx->pendingVertices[vertexId];
 284				gx->pendingVertexIds[vertexId] = gx->vertexIndex;
 285				poly->vertIds[v] = gx->vertexIndex;
 286				++gx->vertexIndex;
 287			}
 288		}
 289		return true;
 290	}
 291
 292	struct DSGXVertex inList[10];
 293	struct DSGXVertex outList[10];
 294	int outOffscreenVerts[10] = { 0, 0, 0, 0 };
 295	for (v = 0; v < poly->verts; ++v) {
 296		inList[v] = gx->pendingVertices[oldVerts[v]];
 297	}
 298
 299	int newV;
 300
 301	int plane;
 302	for (plane = 5; plane >= 0; --plane) {
 303		newV = 0;
 304		for (v = 0; v < poly->verts; ++v) {
 305			if (!(offscreenVerts[v] & (1 << plane))) {
 306				outList[newV] = inList[v];
 307				outOffscreenVerts[newV] = offscreenVerts[v];
 308				++newV;
 309			} else {
 310				struct DSGXVertex* in = &inList[v];
 311				struct DSGXVertex* in2;
 312				struct DSGXVertex* out;
 313				int iv;
 314
 315				if (v > 0) {
 316					iv = v - 1;
 317				} else {
 318					iv = poly->verts - 1;
 319				}
 320				if (!(offscreenVerts[iv] & (1 << plane))) {
 321					in2 = &inList[iv];
 322					out = &outList[newV];
 323					if (_lerpVertexP(in, in2, out, plane >> 1, -1 + (plane & 1) * 2)) {
 324						outOffscreenVerts[newV] = _cohenSutherlandCode(out);
 325						++newV;
 326					}
 327				}
 328
 329				if (v < poly->verts - 1) {
 330					iv = v + 1;
 331				} else {
 332					iv = 0;
 333				}
 334				if (!(offscreenVerts[iv] & (1 << plane))) {
 335					in2 = &inList[iv];
 336					out = &outList[newV];
 337					if (_lerpVertexP(in, in2, out, plane >> 1, -1 + (plane & 1) * 2)) {
 338						outOffscreenVerts[newV] = _cohenSutherlandCode(out);
 339						++newV;
 340					}
 341				}
 342			}
 343		}
 344		poly->verts = newV;
 345		memcpy(inList, outList, newV * sizeof(*inList));
 346		memcpy(offscreenVerts, outOffscreenVerts, newV * sizeof(*offscreenVerts));
 347	}
 348
 349	for (v = 0; v < poly->verts; ++v) {
 350		if (gx->vertexIndex == DS_GX_VERTEX_BUFFER_SIZE) {
 351			return false;
 352		}
 353		// TODO: merge strips
 354		vbuf[gx->vertexIndex] = inList[v];
 355		poly->vertIds[v] = gx->vertexIndex;
 356		++gx->vertexIndex;
 357	}
 358
 359	return newV > 2;
 360}
 361
 362static int32_t _dotViewport(struct DSGXVertex* vertex, int32_t* col) {
 363	int64_t a;
 364	int64_t b;
 365	int64_t sum;
 366	a = col[0];
 367	b = vertex->coord[0];
 368	sum = a * b;
 369	a = col[4];
 370	b = vertex->coord[1];
 371	sum += a * b;
 372	a = col[8];
 373	b = vertex->coord[2];
 374	sum += a * b;
 375	a = col[12];
 376	b = MTX_ONE;
 377	sum += a * b;
 378	return sum >> 8LL;
 379}
 380
 381static int16_t _dotTexture(struct DSGXVertex* vertex, int mode, int32_t* col) {
 382	int64_t a;
 383	int64_t b;
 384	int64_t sum;
 385	switch (mode) {
 386	case 1:
 387		a = col[0];
 388		b = vertex->s << 8;
 389		sum = a * b;
 390		a = col[4];
 391		b = vertex->t << 8;
 392		sum += a * b;
 393		a = col[8];
 394		b = MTX_ONE >> 4;
 395		sum += a * b;
 396		a = col[12];
 397		b = MTX_ONE >> 4;
 398		sum += a * b;
 399		break;
 400	case 2:
 401		return 0;
 402	case 3:
 403		a = col[0];
 404		b = vertex->viewCoord[0] << 8;
 405		sum = a * b;
 406		a = col[4];
 407		b = vertex->viewCoord[1] << 8;
 408		sum += a * b;
 409		a = col[8];
 410		b = vertex->viewCoord[2] << 8;
 411		sum += a * b;
 412		a = col[12];
 413		b = MTX_ONE;
 414		sum += a * b;
 415	}
 416	return sum >> 20;
 417}
 418
 419static int32_t _dotFrac(int16_t x, int16_t y, int16_t z, int32_t* col) {
 420	int64_t a;
 421	int64_t b;
 422	int64_t sum;
 423	a = col[0];
 424	b = x;
 425	sum = a * b;
 426	a = col[4];
 427	b = y;
 428	sum += a * b;
 429	a = col[8];
 430	b = z;
 431	sum += a * b;
 432	return sum >> 12;
 433}
 434
 435static int16_t _dot3(int32_t x0, int32_t y0, int32_t z0, int32_t x1, int32_t y1, int32_t z1) {
 436	int32_t a = x0 * x1;
 437	a += y0 * y1;
 438	a += z0 * z1;
 439	a >>= 12;
 440	return a;
 441}
 442
 443static void _emitVertex(struct DSGX* gx, uint16_t x, uint16_t y, uint16_t z) {
 444	if (gx->vertexMode < 0 || gx->vertexIndex == DS_GX_VERTEX_BUFFER_SIZE || gx->polygonIndex == DS_GX_POLYGON_BUFFER_SIZE) {
 445		return;
 446	}
 447	gx->currentVertex.coord[0] = x;
 448	gx->currentVertex.coord[1] = y;
 449	gx->currentVertex.coord[2] = z;
 450	gx->currentVertex.viewCoord[0] = _dotViewport(&gx->currentVertex, &gx->clipMatrix.m[0]);
 451	gx->currentVertex.viewCoord[1] = _dotViewport(&gx->currentVertex, &gx->clipMatrix.m[1]);
 452	gx->currentVertex.viewCoord[2] = _dotViewport(&gx->currentVertex, &gx->clipMatrix.m[2]);
 453	gx->currentVertex.viewCoord[3] = _dotViewport(&gx->currentVertex, &gx->clipMatrix.m[3]);
 454
 455	if (DSGXTexParamsGetCoordTfMode(gx->currentPoly.texParams) == 0) {
 456		gx->currentVertex.vs = gx->currentVertex.s;
 457		gx->currentVertex.vt = gx->currentVertex.t;
 458	} else if (DSGXTexParamsGetCoordTfMode(gx->currentPoly.texParams) == 3) {
 459		int32_t m12 = gx->texMatrix.m[12];
 460		int32_t m13 = gx->texMatrix.m[13];
 461		gx->texMatrix.m[12] = gx->currentVertex.s;
 462		gx->texMatrix.m[13] = gx->currentVertex.t;
 463		gx->currentVertex.vs = _dotTexture(&gx->currentVertex, 3, &gx->texMatrix.m[0]);
 464		gx->currentVertex.vt = _dotTexture(&gx->currentVertex, 3, &gx->texMatrix.m[1]);
 465		gx->texMatrix.m[12] = m12;
 466		gx->texMatrix.m[13] = m13;
 467	}
 468
 469	gx->pendingVertices[gx->pendingVertexIndex] = gx->currentVertex;
 470	gx->currentPoly.vertIds[gx->currentPoly.verts] = gx->pendingVertexIndex;
 471	gx->pendingVertexIndex = (gx->pendingVertexIndex + 1) & 3;
 472
 473	++gx->currentPoly.verts;
 474	int totalVertices;
 475	switch (gx->vertexMode) {
 476	case 0:
 477	case 2:
 478		totalVertices = 3;
 479		break;
 480	case 1:
 481	case 3:
 482		totalVertices = 4;
 483		break;
 484	}
 485	if (gx->currentPoly.verts == totalVertices) {
 486		struct DSGXPolygon* pbuf = gx->polygonBuffer[gx->bufferIndex];
 487
 488		pbuf[gx->polygonIndex] = gx->currentPoly;
 489		switch (gx->vertexMode) {
 490		case 0:
 491		case 1:
 492			gx->currentPoly.verts = 0;
 493			break;
 494		case 2:
 495			// Reverse winding if needed
 496			if (gx->reverseWinding) {
 497				pbuf[gx->polygonIndex].vertIds[1] = gx->currentPoly.vertIds[2];
 498				pbuf[gx->polygonIndex].vertIds[2] = gx->currentPoly.vertIds[1];
 499			}
 500			gx->reverseWinding = !gx->reverseWinding;
 501			gx->currentPoly.vertIds[0] = gx->currentPoly.vertIds[1];
 502			gx->currentPoly.vertIds[1] = gx->currentPoly.vertIds[2];
 503			gx->currentPoly.verts = 2;
 504			break;
 505		case 3:
 506			gx->currentPoly.vertIds[0] = gx->currentPoly.vertIds[2];
 507			gx->currentPoly.vertIds[1] = gx->currentPoly.vertIds[3];
 508			// Ensure quads don't cross over
 509			pbuf[gx->polygonIndex].vertIds[2] = gx->currentPoly.vertIds[3];
 510			pbuf[gx->polygonIndex].vertIds[3] = gx->currentPoly.vertIds[2];
 511			gx->currentPoly.verts = 2;
 512			break;
 513		}
 514
 515		if (_clipPolygon(gx, &pbuf[gx->polygonIndex])) {
 516			++gx->polygonIndex;
 517		}
 518		if (gx->vertexMode < 2) {
 519			memset(gx->pendingVertexIds, -1, sizeof(gx->pendingVertexIds));
 520		} else {
 521			gx->pendingVertexIds[gx->pendingVertexIndex] = -1;
 522			gx->pendingVertexIds[(gx->pendingVertexIndex + 1) & 3] = -1;
 523		}
 524	}
 525}
 526
 527static void _flushOutstanding(struct DSGX* gx) {
 528	if (gx->p->cpuBlocked & DS_CPU_BLOCK_GX) {
 529		gx->p->cpuBlocked &= ~DS_CPU_BLOCK_GX;
 530		struct DSGXEntry entry = gx->outstandingEntry;
 531		gx->outstandingEntry.command = 0;
 532		DSGXWriteFIFO(gx, entry);
 533	}
 534	while (gx->outstandingCommand[0] && !gx->outstandingParams[0]) {
 535		if (gx->p->cpuBlocked & DS_CPU_BLOCK_GX) {
 536			return;
 537		}
 538		DSGXWriteFIFO(gx, (struct DSGXEntry) { gx->outstandingCommand[0] });
 539	}
 540}
 541
 542static bool _boxTestVertex(struct DSGX* gx, struct DSGXVertex* vertex) {
 543	vertex->viewCoord[0] = _dotViewport(vertex, &gx->clipMatrix.m[0]);
 544	vertex->viewCoord[1] = _dotViewport(vertex, &gx->clipMatrix.m[1]);
 545	vertex->viewCoord[2] = _dotViewport(vertex, &gx->clipMatrix.m[2]);
 546	vertex->viewCoord[3] = _dotViewport(vertex, &gx->clipMatrix.m[3]);
 547
 548	return !_cohenSutherlandCode(vertex);
 549}
 550
 551static bool _boxTest(struct DSGX* gx) {
 552	int16_t x = gx->activeEntries[0].params[0];
 553	x |= gx->activeEntries[0].params[1] << 8;
 554	int16_t y = gx->activeEntries[0].params[2];
 555	y |= gx->activeEntries[0].params[3] << 8;
 556	int16_t z = gx->activeEntries[1].params[0];
 557	z |= gx->activeEntries[1].params[1] << 8;
 558	int16_t w = gx->activeEntries[1].params[2];
 559	w |= gx->activeEntries[1].params[3] << 8;
 560	int16_t h = gx->activeEntries[2].params[0];
 561	h |= gx->activeEntries[2].params[1] << 8;
 562	int16_t d = gx->activeEntries[2].params[2];
 563	d |= gx->activeEntries[2].params[3] << 8;
 564
 565	struct DSGXVertex vertex = {
 566		.coord = { x, y, z }
 567	};
 568	if (_boxTestVertex(gx, &vertex)) {
 569		return true;
 570	}
 571
 572	vertex.coord[0] += w;
 573	if (_boxTestVertex(gx, &vertex)) {
 574		return true;
 575	}
 576
 577	vertex.coord[0] = x;
 578	vertex.coord[1] += h;
 579	if (_boxTestVertex(gx, &vertex)) {
 580		return true;
 581	}
 582
 583	vertex.coord[0] += w;
 584	if (_boxTestVertex(gx, &vertex)) {
 585		return true;
 586	}
 587
 588	vertex.coord[0] = x;
 589	vertex.coord[1] = y;
 590	vertex.coord[2] += d;
 591	if (_boxTestVertex(gx, &vertex)) {
 592		return true;
 593	}
 594
 595	vertex.coord[0] += w;
 596	if (_boxTestVertex(gx, &vertex)) {
 597		return true;
 598	}
 599
 600	vertex.coord[0] = x;
 601	vertex.coord[1] += h;
 602	if (_boxTestVertex(gx, &vertex)) {
 603		return true;
 604	}
 605
 606	vertex.coord[0] += w;
 607	if (_boxTestVertex(gx, &vertex)) {
 608		return true;
 609	}
 610
 611	return false;
 612}
 613
 614static void _fifoRun(struct mTiming* timing, void* context, uint32_t cyclesLate) {
 615	struct DSGX* gx = context;
 616	uint32_t cycles;
 617	bool first = true;
 618	while (!gx->swapBuffers) {
 619		if (CircleBufferSize(&gx->pipe) <= 2 * sizeof(struct DSGXEntry)) {
 620			_pullPipe(gx);
 621		}
 622
 623		if (!CircleBufferSize(&gx->pipe)) {
 624			cycles = 0;
 625			break;
 626		}
 627
 628		DSRegGXSTAT gxstat = gx->p->memory.io9[DS9_REG_GXSTAT_LO >> 1];
 629		int projMatrixPointer = DSRegGXSTATGetProjMatrixStackLevel(gxstat);
 630
 631		struct DSGXEntry entry = { 0 };
 632		CircleBufferDump(&gx->pipe, (int8_t*) &entry.command, 1);
 633		cycles = _gxCommandCycleBase[entry.command];
 634
 635		if (first) {
 636			first = false;
 637		} else if (!gx->activeParams && cycles > cyclesLate) {
 638			break;
 639		}
 640		CircleBufferRead(&gx->pipe, &entry, sizeof(entry));
 641
 642		if (gx->activeParams) {
 643			int index = _gxCommandParams[entry.command] - gx->activeParams;
 644			gx->activeEntries[index] = entry;
 645			--gx->activeParams;
 646		} else {
 647			gx->activeParams = _gxCommandParams[entry.command];
 648			if (gx->activeParams) {
 649				--gx->activeParams;
 650			}
 651			if (gx->activeParams) {
 652				gx->activeEntries[0] = entry;
 653			}
 654		}
 655
 656		if (gx->activeParams) {
 657			continue;
 658		}
 659
 660		switch (entry.command) {
 661		case DS_GX_CMD_MTX_MODE:
 662			if (entry.params[0] < 4) {
 663				gx->mtxMode = entry.params[0];
 664			} else {
 665				mLOG(DS_GX, GAME_ERROR, "Invalid GX MTX_MODE %02X", entry.params[0]);
 666			}
 667			break;
 668		case DS_GX_CMD_MTX_PUSH:
 669			switch (gx->mtxMode) {
 670			case 0:
 671				memcpy(&gx->projMatrixStack, &gx->projMatrix, sizeof(gx->projMatrix));
 672				++projMatrixPointer;
 673				break;
 674			case 1:
 675			case 2:
 676				memcpy(&gx->vecMatrixStack[gx->pvMatrixPointer & 0x1F], &gx->vecMatrix, sizeof(gx->vecMatrix));
 677				memcpy(&gx->posMatrixStack[gx->pvMatrixPointer & 0x1F], &gx->posMatrix, sizeof(gx->posMatrix));
 678				++gx->pvMatrixPointer;
 679				break;
 680			case 3:
 681				mLOG(DS_GX, STUB, "Unimplemented GX MTX_PUSH mode");
 682				break;
 683			}
 684			break;
 685		case DS_GX_CMD_MTX_POP: {
 686			int8_t offset = entry.params[0];
 687			offset <<= 2;
 688			offset >>= 2;
 689			switch (gx->mtxMode) {
 690			case 0:
 691				projMatrixPointer -= offset;
 692				memcpy(&gx->projMatrix, &gx->projMatrixStack, sizeof(gx->projMatrix));
 693				break;
 694			case 1:
 695			case 2:
 696				gx->pvMatrixPointer -= offset;
 697				memcpy(&gx->vecMatrix, &gx->vecMatrixStack[gx->pvMatrixPointer & 0x1F], sizeof(gx->vecMatrix));
 698				memcpy(&gx->posMatrix, &gx->posMatrixStack[gx->pvMatrixPointer & 0x1F], sizeof(gx->posMatrix));
 699				break;
 700			case 3:
 701				mLOG(DS_GX, STUB, "Unimplemented GX MTX_POP mode");
 702				break;
 703			}
 704			_updateClipMatrix(gx);
 705			break;
 706		}
 707		case DS_GX_CMD_MTX_STORE: {
 708			int8_t offset = entry.params[0] & 0x1F;
 709			// TODO: overflow
 710			switch (gx->mtxMode) {
 711			case 0:
 712				memcpy(&gx->projMatrixStack, &gx->projMatrix, sizeof(gx->projMatrixStack));
 713				break;
 714			case 1:
 715			case 2:
 716				memcpy(&gx->vecMatrixStack[offset], &gx->vecMatrix, sizeof(gx->vecMatrix));
 717				memcpy(&gx->posMatrixStack[offset], &gx->posMatrix, sizeof(gx->posMatrix));
 718				break;
 719			case 3:
 720				mLOG(DS_GX, STUB, "Unimplemented GX MTX_STORE mode");
 721				break;
 722			}
 723			break;
 724		}
 725		case DS_GX_CMD_MTX_RESTORE: {
 726			int8_t offset = entry.params[0] & 0x1F;
 727			// TODO: overflow
 728			switch (gx->mtxMode) {
 729			case 0:
 730				memcpy(&gx->projMatrix, &gx->projMatrixStack, sizeof(gx->projMatrix));
 731				break;
 732			case 1:
 733			case 2:
 734				memcpy(&gx->vecMatrix, &gx->vecMatrixStack[offset], sizeof(gx->vecMatrix));
 735				memcpy(&gx->posMatrix, &gx->posMatrixStack[offset], sizeof(gx->posMatrix));
 736				break;
 737			case 3:
 738				mLOG(DS_GX, STUB, "Unimplemented GX MTX_RESTORE mode");
 739				break;
 740			}
 741			_updateClipMatrix(gx);
 742			break;
 743		}
 744		case DS_GX_CMD_MTX_IDENTITY:
 745			switch (gx->mtxMode) {
 746			case 0:
 747				DSGXMtxIdentity(&gx->projMatrix);
 748				break;
 749			case 2:
 750				DSGXMtxIdentity(&gx->vecMatrix);
 751				// Fall through
 752			case 1:
 753				DSGXMtxIdentity(&gx->posMatrix);
 754				break;
 755			case 3:
 756				DSGXMtxIdentity(&gx->texMatrix);
 757				break;
 758			}
 759			_updateClipMatrix(gx);
 760			break;
 761		case DS_GX_CMD_MTX_LOAD_4x4: {
 762			struct DSGXMatrix m;
 763			int i;
 764			for (i = 0; i < 16; ++i) {
 765				m.m[i] = gx->activeEntries[i].params[0];
 766				m.m[i] |= gx->activeEntries[i].params[1] << 8;
 767				m.m[i] |= gx->activeEntries[i].params[2] << 16;
 768				m.m[i] |= gx->activeEntries[i].params[3] << 24;
 769			}
 770			switch (gx->mtxMode) {
 771			case 0:
 772				memcpy(&gx->projMatrix, &m, sizeof(gx->projMatrix));
 773				break;
 774			case 2:
 775				memcpy(&gx->vecMatrix, &m, sizeof(gx->vecMatrix));
 776				// Fall through
 777			case 1:
 778				memcpy(&gx->posMatrix, &m, sizeof(gx->posMatrix));
 779				break;
 780			case 3:
 781				memcpy(&gx->texMatrix, &m, sizeof(gx->texMatrix));
 782				break;
 783			}
 784			_updateClipMatrix(gx);
 785			break;
 786		}
 787		case DS_GX_CMD_MTX_LOAD_4x3: {
 788			struct DSGXMatrix m;
 789			int i, j;
 790			for (j = 0; j < 4; ++j) {
 791				for (i = 0; i < 3; ++i) {
 792					m.m[i + j * 4] = gx->activeEntries[i + j * 3].params[0];
 793					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[1] << 8;
 794					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[2] << 16;
 795					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[3] << 24;
 796				}
 797				m.m[j * 4 + 3] = 0;
 798			}
 799			m.m[15] = MTX_ONE;
 800			switch (gx->mtxMode) {
 801			case 0:
 802				memcpy(&gx->projMatrix, &m, sizeof(gx->projMatrix));
 803				break;
 804			case 2:
 805				memcpy(&gx->vecMatrix, &m, sizeof(gx->vecMatrix));
 806				// Fall through
 807			case 1:
 808				memcpy(&gx->posMatrix, &m, sizeof(gx->posMatrix));
 809				break;
 810			case 3:
 811				memcpy(&gx->texMatrix, &m, sizeof(gx->texMatrix));
 812				break;
 813			}
 814			_updateClipMatrix(gx);
 815			break;
 816		}
 817		case DS_GX_CMD_MTX_MULT_4x4: {
 818			struct DSGXMatrix m;
 819			int i;
 820			for (i = 0; i < 16; ++i) {
 821				m.m[i] = gx->activeEntries[i].params[0];
 822				m.m[i] |= gx->activeEntries[i].params[1] << 8;
 823				m.m[i] |= gx->activeEntries[i].params[2] << 16;
 824				m.m[i] |= gx->activeEntries[i].params[3] << 24;
 825			}
 826			switch (gx->mtxMode) {
 827			case 0:
 828				DSGXMtxMultiply(&gx->projMatrix, &m, &gx->projMatrix);
 829				break;
 830			case 2:
 831				DSGXMtxMultiply(&gx->vecMatrix, &m, &gx->vecMatrix);
 832				// Fall through
 833			case 1:
 834				DSGXMtxMultiply(&gx->posMatrix, &m, &gx->posMatrix);
 835				break;
 836			case 3:
 837				DSGXMtxMultiply(&gx->texMatrix, &m, &gx->texMatrix);
 838				break;
 839			}
 840			_updateClipMatrix(gx);
 841			break;
 842		}
 843		case DS_GX_CMD_MTX_MULT_4x3: {
 844			struct DSGXMatrix m;
 845			int i, j;
 846			for (j = 0; j < 4; ++j) {
 847				for (i = 0; i < 3; ++i) {
 848					m.m[i + j * 4] = gx->activeEntries[i + j * 3].params[0];
 849					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[1] << 8;
 850					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[2] << 16;
 851					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[3] << 24;
 852				}
 853				m.m[j * 4 + 3] = 0;
 854			}
 855			m.m[15] = MTX_ONE;
 856			switch (gx->mtxMode) {
 857			case 0:
 858				DSGXMtxMultiply(&gx->projMatrix, &m, &gx->projMatrix);
 859				break;
 860			case 2:
 861				DSGXMtxMultiply(&gx->vecMatrix, &m, &gx->vecMatrix);
 862				// Fall through
 863			case 1:
 864				DSGXMtxMultiply(&gx->posMatrix, &m, &gx->posMatrix);
 865				break;
 866			case 3:
 867				DSGXMtxMultiply(&gx->texMatrix, &m, &gx->texMatrix);
 868				break;
 869			}
 870			_updateClipMatrix(gx);
 871			break;
 872		}
 873		case DS_GX_CMD_MTX_MULT_3x3: {
 874			struct DSGXMatrix m;
 875			int i, j;
 876			for (j = 0; j < 3; ++j) {
 877				for (i = 0; i < 3; ++i) {
 878					m.m[i + j * 4] = gx->activeEntries[i + j * 3].params[0];
 879					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[1] << 8;
 880					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[2] << 16;
 881					m.m[i + j * 4] |= gx->activeEntries[i + j * 3].params[3] << 24;
 882				}
 883				m.m[j * 4 + 3] = 0;
 884			}
 885			m.m[12] = 0;
 886			m.m[13] = 0;
 887			m.m[14] = 0;
 888			m.m[15] = MTX_ONE;
 889			switch (gx->mtxMode) {
 890			case 0:
 891				DSGXMtxMultiply(&gx->projMatrix, &m, &gx->projMatrix);
 892				break;
 893			case 2:
 894				DSGXMtxMultiply(&gx->vecMatrix, &m, &gx->vecMatrix);
 895				// Fall through
 896			case 1:
 897				DSGXMtxMultiply(&gx->posMatrix, &m, &gx->posMatrix);
 898				break;
 899			case 3:
 900				DSGXMtxMultiply(&gx->texMatrix, &m, &gx->texMatrix);
 901				break;
 902			}
 903			_updateClipMatrix(gx);
 904			break;
 905		}
 906		case DS_GX_CMD_MTX_TRANS: {
 907			int32_t m[3];
 908			m[0] = gx->activeEntries[0].params[0];
 909			m[0] |= gx->activeEntries[0].params[1] << 8;
 910			m[0] |= gx->activeEntries[0].params[2] << 16;
 911			m[0] |= gx->activeEntries[0].params[3] << 24;
 912			m[1] = gx->activeEntries[1].params[0];
 913			m[1] |= gx->activeEntries[1].params[1] << 8;
 914			m[1] |= gx->activeEntries[1].params[2] << 16;
 915			m[1] |= gx->activeEntries[1].params[3] << 24;
 916			m[2] = gx->activeEntries[2].params[0];
 917			m[2] |= gx->activeEntries[2].params[1] << 8;
 918			m[2] |= gx->activeEntries[2].params[2] << 16;
 919			m[2] |= gx->activeEntries[2].params[3] << 24;
 920			switch (gx->mtxMode) {
 921			case 0:
 922				DSGXMtxTranslate(&gx->projMatrix, m);
 923				break;
 924			case 2:
 925				DSGXMtxTranslate(&gx->vecMatrix, m);
 926				// Fall through
 927			case 1:
 928				DSGXMtxTranslate(&gx->posMatrix, m);
 929				break;
 930			case 3:
 931				DSGXMtxTranslate(&gx->texMatrix, m);
 932				break;
 933			}
 934			_updateClipMatrix(gx);
 935			break;
 936		}
 937		case DS_GX_CMD_MTX_SCALE: {
 938			int32_t m[3];
 939			m[0] = gx->activeEntries[0].params[0];
 940			m[0] |= gx->activeEntries[0].params[1] << 8;
 941			m[0] |= gx->activeEntries[0].params[2] << 16;
 942			m[0] |= gx->activeEntries[0].params[3] << 24;
 943			m[1] = gx->activeEntries[1].params[0];
 944			m[1] |= gx->activeEntries[1].params[1] << 8;
 945			m[1] |= gx->activeEntries[1].params[2] << 16;
 946			m[1] |= gx->activeEntries[1].params[3] << 24;
 947			m[2] = gx->activeEntries[2].params[0];
 948			m[2] |= gx->activeEntries[2].params[1] << 8;
 949			m[2] |= gx->activeEntries[2].params[2] << 16;
 950			m[2] |= gx->activeEntries[2].params[3] << 24;
 951			switch (gx->mtxMode) {
 952			case 0:
 953				DSGXMtxScale(&gx->projMatrix, m);
 954				break;
 955			case 1:
 956			case 2:
 957				DSGXMtxScale(&gx->posMatrix, m);
 958				break;
 959			case 3:
 960				DSGXMtxScale(&gx->texMatrix, m);
 961				break;
 962			}
 963			_updateClipMatrix(gx);
 964			break;
 965		}
 966		case DS_GX_CMD_COLOR:
 967			gx->currentVertex.color = entry.params[0];
 968			gx->currentVertex.color |= entry.params[1] << 8;
 969			break;
 970		case DS_GX_CMD_NORMAL: {
 971			int32_t xyz = entry.params[0];
 972			xyz |= entry.params[1] << 8;
 973			xyz |= entry.params[2] << 16;
 974			xyz |= entry.params[3] << 24;
 975			int16_t x = (xyz << 6) & 0xFFC0;
 976			int16_t y = (xyz >> 4) & 0xFFC0;
 977			int16_t z = (xyz >> 14) & 0xFFC0;
 978			x >>= 3;
 979			y >>= 3;
 980			z >>= 3;
 981			if (DSGXTexParamsGetCoordTfMode(gx->currentPoly.texParams) == 2) {
 982				gx->currentVertex.vs = _dotFrac(x, y, z, &gx->texMatrix.m[0]) + gx->currentVertex.s;
 983				gx->currentVertex.vt = _dotFrac(x, y, z, &gx->texMatrix.m[1]) + gx->currentVertex.t;
 984			}
 985			int16_t nx = _dotFrac(x, y, z, &gx->vecMatrix.m[0]);
 986			int16_t ny = _dotFrac(x, y, z, &gx->vecMatrix.m[1]);
 987			int16_t nz = _dotFrac(x, y, z, &gx->vecMatrix.m[2]);
 988			int r = gx->emit & 0x1F;
 989			int g = (gx->emit >> 5) & 0x1F;
 990			int b = (gx->emit >> 10) & 0x1F;
 991			int i;
 992			for (i = 0; i < 4; ++i) {
 993				if (!(DSGXPolygonAttrsGetLights(gx->currentPoly.polyParams) & (1 << i))) {
 994					continue;
 995				}
 996				struct DSGXLight* light = &gx->lights[i];
 997				int diffuse = -_dot3(light->x, light->y, light->z, nx, ny, nz);
 998				if (diffuse < 0) {
 999					diffuse = 0;
1000				}
1001				int specular = -_dot3(-light->x >> 1, -light->y >> 1, (0x1000 - light->z) >> 1, nx, ny, nz);
1002				if (specular < 0) {
1003					specular = 0;
1004				} else {
1005					specular = 2 * specular * specular - (1 << 10);
1006				}
1007				unsigned lr = (light->color) & 0x1F;
1008				unsigned lg = (light->color >> 5) & 0x1F;
1009				unsigned lb = (light->color >> 10) & 0x1F;
1010				unsigned xr, xg, xb;
1011				xr = gx->specular & 0x1F;
1012				xg = (gx->specular >> 5) & 0x1F;
1013				xb = (gx->specular >> 10) & 0x1F;
1014				r += (specular * xr * lr) >> 17;
1015				g += (specular * xg * lg) >> 17;
1016				b += (specular * xb * lb) >> 17;
1017				xr = gx->diffuse & 0x1F;
1018				xg = (gx->diffuse >> 5) & 0x1F;
1019				xb = (gx->diffuse >> 10) & 0x1F;
1020				r += (diffuse * xr * lr) >> 17;
1021				g += (diffuse * xg * lg) >> 17;
1022				b += (diffuse * xb * lb) >> 17;
1023				xr = gx->ambient & 0x1F;
1024				xg = (gx->ambient >> 5) & 0x1F;
1025				xb = (gx->ambient >> 10) & 0x1F;
1026				r += (xr * lr) >> 5;
1027				g += (xg * lg) >> 5;
1028				b += (xb * lb) >> 5;
1029			}
1030			if (r < 0) {
1031				r = 0;
1032			} else if (r > 0x1F) {
1033				r = 0x1F;
1034			}
1035			if (g < 0) {
1036				g = 0;
1037			} else if (g > 0x1F) {
1038				g = 0x1F;
1039			}
1040			if (b < 0) {
1041				b = 0;
1042			} else if (b > 0x1F) {
1043				b = 0x1F;
1044			}
1045			gx->currentVertex.color = r | (g << 5) | (b << 10);
1046			break;
1047		}
1048		case DS_GX_CMD_TEXCOORD:
1049			gx->currentVertex.s = entry.params[0];
1050			gx->currentVertex.s |= entry.params[1] << 8;
1051			gx->currentVertex.t = entry.params[2];
1052			gx->currentVertex.t |= entry.params[3] << 8;
1053			if (DSGXTexParamsGetCoordTfMode(gx->currentPoly.texParams) == 1) {
1054				gx->currentVertex.vs = _dotTexture(&gx->currentVertex, 1, &gx->texMatrix.m[0]);
1055				gx->currentVertex.vt = _dotTexture(&gx->currentVertex, 1, &gx->texMatrix.m[1]);
1056			}
1057			break;
1058		case DS_GX_CMD_VTX_16: {
1059			int16_t x = gx->activeEntries[0].params[0];
1060			x |= gx->activeEntries[0].params[1] << 8;
1061			int16_t y = gx->activeEntries[0].params[2];
1062			y |= gx->activeEntries[0].params[3] << 8;
1063			int16_t z = gx->activeEntries[1].params[0];
1064			z |= gx->activeEntries[1].params[1] << 8;
1065			_emitVertex(gx, x, y, z);
1066			break;
1067		}
1068		case DS_GX_CMD_VTX_10: {
1069			int32_t xyz = entry.params[0];
1070			xyz |= entry.params[1] << 8;
1071			xyz |= entry.params[2] << 16;
1072			xyz |= entry.params[3] << 24;
1073			int16_t x = (xyz << 6) & 0xFFC0;
1074			int16_t y = (xyz >> 4) & 0xFFC0;
1075			int16_t z = (xyz >> 14) & 0xFFC0;
1076			_emitVertex(gx, x, y, z);
1077			break;
1078		}
1079		case DS_GX_CMD_VTX_XY: {
1080			int16_t x = entry.params[0];
1081			x |= entry.params[1] << 8;
1082			int16_t y = entry.params[2];
1083			y |= entry.params[3] << 8;
1084			_emitVertex(gx, x, y, gx->currentVertex.coord[2]);
1085			break;
1086		}
1087		case DS_GX_CMD_VTX_XZ: {
1088			int16_t x = entry.params[0];
1089			x |= entry.params[1] << 8;
1090			int16_t z = entry.params[2];
1091			z |= entry.params[3] << 8;
1092			_emitVertex(gx, x, gx->currentVertex.coord[1], z);
1093			break;
1094		}
1095		case DS_GX_CMD_VTX_YZ: {
1096			int16_t y = entry.params[0];
1097			y |= entry.params[1] << 8;
1098			int16_t z = entry.params[2];
1099			z |= entry.params[3] << 8;
1100			_emitVertex(gx, gx->currentVertex.coord[0], y, z);
1101			break;
1102		}
1103		case DS_GX_CMD_VTX_DIFF: {
1104			int32_t xyz = entry.params[0];
1105			xyz |= entry.params[1] << 8;
1106			xyz |= entry.params[2] << 16;
1107			xyz |= entry.params[3] << 24;
1108			int16_t x = (xyz << 6) & 0xFFC0;
1109			int16_t y = (xyz >> 4) & 0xFFC0;
1110			int16_t z = (xyz >> 14) & 0xFFC0;
1111			_emitVertex(gx, gx->currentVertex.coord[0] + (x >> 6),
1112			                gx->currentVertex.coord[1] + (y >> 6),
1113			                gx->currentVertex.coord[2] + (z >> 6));
1114			break;
1115		}
1116		case DS_GX_CMD_DIF_AMB:
1117			gx->diffuse = entry.params[0];
1118			gx->diffuse |= entry.params[1] << 8;
1119			if (gx->diffuse & 0x8000) {
1120				gx->currentVertex.color = gx->diffuse;
1121			}
1122			gx->ambient = entry.params[2];
1123			gx->ambient |= entry.params[3] << 8;
1124			break;
1125		case DS_GX_CMD_SPE_EMI:
1126			gx->specular = entry.params[0];
1127			gx->specular |= entry.params[1] << 8;
1128			gx->emit = entry.params[2];
1129			gx->emit |= entry.params[3] << 8;
1130			break;
1131		case DS_GX_CMD_LIGHT_VECTOR: {
1132			uint32_t xyz = entry.params[0];
1133			xyz |= entry.params[1] << 8;
1134			xyz |= entry.params[2] << 16;
1135			xyz |= entry.params[3] << 24;
1136			struct DSGXLight* light = &gx->lights[xyz >> 30];
1137			int16_t x = (xyz << 6) & 0xFFC0;
1138			int16_t y = (xyz >> 4) & 0xFFC0;
1139			int16_t z = (xyz >> 14) & 0xFFC0;
1140			x >>= 3;
1141			y >>= 3;
1142			z >>= 3;
1143			light->x = _dotFrac(x, y, z, &gx->vecMatrix.m[0]);
1144			light->y = _dotFrac(x, y, z, &gx->vecMatrix.m[1]);
1145			light->z = _dotFrac(x, y, z, &gx->vecMatrix.m[2]);
1146			break;
1147		}
1148		case DS_GX_CMD_LIGHT_COLOR: {
1149			struct DSGXLight* light = &gx->lights[entry.params[3] >> 6];
1150			light->color = entry.params[0];
1151			light->color |= entry.params[1] << 8;
1152			break;
1153		}
1154		case DS_GX_CMD_POLYGON_ATTR:
1155			gx->nextPoly.polyParams = entry.params[0];
1156			gx->nextPoly.polyParams |= entry.params[1] << 8;
1157			gx->nextPoly.polyParams |= entry.params[2] << 16;
1158			gx->nextPoly.polyParams |= entry.params[3] << 24;
1159			break;
1160		case DS_GX_CMD_TEXIMAGE_PARAM:
1161			gx->nextPoly.texParams = entry.params[0];
1162			gx->nextPoly.texParams |= entry.params[1] << 8;
1163			gx->nextPoly.texParams |= entry.params[2] << 16;
1164			gx->nextPoly.texParams |= entry.params[3] << 24;
1165			gx->currentPoly.texParams = gx->nextPoly.texParams;
1166			break;
1167		case DS_GX_CMD_PLTT_BASE:
1168			gx->nextPoly.palBase = entry.params[0];
1169			gx->nextPoly.palBase |= entry.params[1] << 8;
1170			gx->nextPoly.palBase |= entry.params[2] << 16;
1171			gx->nextPoly.palBase |= entry.params[3] << 24;
1172			gx->currentPoly.palBase = gx->nextPoly.palBase;
1173			break;
1174		case DS_GX_CMD_BEGIN_VTXS:
1175			gx->vertexMode = entry.params[0] & 3;
1176			gx->currentPoly = gx->nextPoly;
1177			gx->reverseWinding = false;
1178			memset(gx->pendingVertexIds, -1, sizeof(gx->pendingVertexIds));
1179			break;
1180		case DS_GX_CMD_END_VTXS:
1181			gx->vertexMode = -1;
1182			break;
1183		case DS_GX_CMD_SWAP_BUFFERS:
1184			gx->swapBuffers = true;
1185			gx->wSort = entry.params[0] & 2;
1186			memset(&gx->currentVertex, 0, sizeof(gx->currentVertex));
1187			memset(&gx->nextPoly, 0, sizeof(gx-> nextPoly));
1188			gx->currentVertex.color = 0x7FFF;
1189			break;
1190		case DS_GX_CMD_VIEWPORT:
1191			gx->viewportX1 = (uint8_t) entry.params[0];
1192			gx->viewportY1 = (uint8_t) entry.params[1];
1193			gx->viewportX2 = (uint8_t) entry.params[2];
1194			gx->viewportY2 = (uint8_t) entry.params[3];
1195			gx->viewportWidth = gx->viewportX2 - gx->viewportX1 + 1;
1196			gx->viewportHeight = gx->viewportY2 - gx->viewportY1 + 1;
1197			gx->renderer->viewportX = gx->viewportX1;
1198			gx->renderer->viewportY = gx->viewportY1;
1199			gx->renderer->viewportWidth = gx->viewportWidth;
1200			gx->renderer->viewportHeight = gx->viewportHeight;
1201			break;
1202		case DS_GX_CMD_BOX_TEST:
1203			gxstat = DSRegGXSTATClearTestBusy(gxstat);
1204			gxstat = DSRegGXSTATTestFillBoxTestResult(gxstat, _boxTest(gx));
1205			break;
1206		default:
1207			mLOG(DS_GX, STUB, "Unimplemented GX command %02X:%02X %02X %02X %02X", entry.command, entry.params[0], entry.params[1], entry.params[2], entry.params[3]);
1208			break;
1209		}
1210
1211		gxstat = DSRegGXSTATSetPVMatrixStackLevel(gxstat, gx->pvMatrixPointer);
1212		gxstat = DSRegGXSTATSetProjMatrixStackLevel(gxstat, projMatrixPointer);
1213		gxstat = DSRegGXSTATTestFillMatrixStackError(gxstat, projMatrixPointer || gx->pvMatrixPointer >= 0x1F);
1214		gx->p->memory.io9[DS9_REG_GXSTAT_LO >> 1] = gxstat;
1215
1216		if (cyclesLate >= cycles) {
1217			cyclesLate -= cycles;
1218		} else {
1219			break;
1220		}
1221	}
1222	if (cycles && !gx->swapBuffers) {
1223		mTimingSchedule(timing, &gx->fifoEvent, cycles - cyclesLate);
1224	}
1225	if (CircleBufferSize(&gx->fifo) < (DS_GX_FIFO_SIZE * sizeof(struct DSGXEntry))) {
1226		_flushOutstanding(gx);
1227	}
1228	DSGXUpdateGXSTAT(gx);
1229}
1230
1231void DSGXInit(struct DSGX* gx) {
1232	gx->renderer = &dummyRenderer;
1233	CircleBufferInit(&gx->fifo, sizeof(struct DSGXEntry) * DS_GX_FIFO_SIZE);
1234	CircleBufferInit(&gx->pipe, sizeof(struct DSGXEntry) * DS_GX_PIPE_SIZE);
1235	gx->vertexBuffer[0] = malloc(sizeof(struct DSGXVertex) * DS_GX_VERTEX_BUFFER_SIZE);
1236	gx->vertexBuffer[1] = malloc(sizeof(struct DSGXVertex) * DS_GX_VERTEX_BUFFER_SIZE);
1237	gx->polygonBuffer[0] = malloc(sizeof(struct DSGXPolygon) * DS_GX_POLYGON_BUFFER_SIZE);
1238	gx->polygonBuffer[1] = malloc(sizeof(struct DSGXPolygon) * DS_GX_POLYGON_BUFFER_SIZE);
1239	gx->fifoEvent.name = "DS GX FIFO";
1240	gx->fifoEvent.priority = 0xC;
1241	gx->fifoEvent.context = gx;
1242	gx->fifoEvent.callback = _fifoRun;
1243}
1244
1245void DSGXDeinit(struct DSGX* gx) {
1246	DSGXAssociateRenderer(gx, &dummyRenderer);
1247	CircleBufferDeinit(&gx->fifo);
1248	CircleBufferDeinit(&gx->pipe);
1249	free(gx->vertexBuffer[0]);
1250	free(gx->vertexBuffer[1]);
1251	free(gx->polygonBuffer[0]);
1252	free(gx->polygonBuffer[1]);
1253}
1254
1255void DSGXReset(struct DSGX* gx) {
1256	CircleBufferClear(&gx->fifo);
1257	CircleBufferClear(&gx->pipe);
1258	DSGXMtxIdentity(&gx->projMatrix);
1259	DSGXMtxIdentity(&gx->texMatrix);
1260	DSGXMtxIdentity(&gx->posMatrix);
1261	DSGXMtxIdentity(&gx->vecMatrix);
1262
1263	DSGXMtxIdentity(&gx->clipMatrix);
1264	DSGXMtxIdentity(&gx->projMatrixStack);
1265	DSGXMtxIdentity(&gx->texMatrixStack);
1266	int i;
1267	for (i = 0; i < 32; ++i) {
1268		DSGXMtxIdentity(&gx->posMatrixStack[i]);
1269		DSGXMtxIdentity(&gx->vecMatrixStack[i]);
1270	}
1271	gx->swapBuffers = false;
1272	gx->bufferIndex = 0;
1273	gx->vertexIndex = 0;
1274	gx->polygonIndex = 0;
1275	gx->mtxMode = 0;
1276	gx->pvMatrixPointer = 0;
1277	gx->vertexMode = -1;
1278
1279	gx->viewportX1 = 0;
1280	gx->viewportY1 = 0;
1281	gx->viewportX2 = DS_VIDEO_HORIZONTAL_PIXELS - 1;
1282	gx->viewportY2 = DS_VIDEO_VERTICAL_PIXELS - 1;
1283	gx->viewportWidth = gx->viewportX2 - gx->viewportX1 + 1;
1284	gx->viewportHeight = gx->viewportY2 - gx->viewportY1 + 1;
1285
1286	memset(gx->outstandingParams, 0, sizeof(gx->outstandingParams));
1287	memset(gx->outstandingCommand, 0, sizeof(gx->outstandingCommand));
1288	memset(&gx->outstandingEntry, 0, sizeof(gx->outstandingEntry));
1289	gx->activeParams = 0;
1290	memset(&gx->currentVertex, 0, sizeof(gx->currentVertex));
1291	memset(&gx->nextPoly, 0, sizeof(gx-> nextPoly));
1292	gx->currentVertex.color = 0x7FFF;
1293	gx->dmaSource = -1;
1294}
1295
1296void DSGXAssociateRenderer(struct DSGX* gx, struct DSGXRenderer* renderer) {
1297	gx->renderer->deinit(gx->renderer);
1298	gx->renderer = renderer;
1299	memcpy(gx->renderer->tex, gx->tex, sizeof(gx->renderer->tex));
1300	memcpy(gx->renderer->texPal, gx->texPal, sizeof(gx->renderer->texPal));
1301	gx->renderer->init(gx->renderer);
1302}
1303
1304void DSGXUpdateGXSTAT(struct DSGX* gx) {
1305	uint32_t value = gx->p->memory.io9[DS9_REG_GXSTAT_HI >> 1] << 16;
1306	value = DSRegGXSTATIsDoIRQ(value);
1307
1308	size_t entries = CircleBufferSize(&gx->fifo) / sizeof(struct DSGXEntry);
1309	// XXX
1310	if (gx->swapBuffers) {
1311		entries++;
1312	}
1313	value = DSRegGXSTATSetFIFOEntries(value, entries);
1314	value = DSRegGXSTATSetFIFOLtHalf(value, entries < (DS_GX_FIFO_SIZE / 2));
1315	value = DSRegGXSTATSetFIFOEmpty(value, entries == 0);
1316
1317	if ((DSRegGXSTATGetDoIRQ(value) == 1 && entries < (DS_GX_FIFO_SIZE / 2)) ||
1318		(DSRegGXSTATGetDoIRQ(value) == 2 && entries == 0)) {
1319		DSRaiseIRQ(gx->p->ds9.cpu, gx->p->ds9.memory.io, DS_IRQ_GEOM_FIFO);
1320	}
1321
1322	value = DSRegGXSTATSetBusy(value, mTimingIsScheduled(&gx->p->ds9.timing, &gx->fifoEvent) || gx->swapBuffers);
1323
1324	gx->p->memory.io9[DS9_REG_GXSTAT_HI >> 1] = value >> 16;
1325
1326	struct GBADMA* dma = NULL;
1327	if (gx->dmaSource >= 0) {
1328		dma = &gx->p->ds9.memory.dma[gx->dmaSource];
1329		if (GBADMARegisterGetTiming9(dma->reg) != DS_DMA_TIMING_GEOM_FIFO) {
1330			gx->dmaSource = -1;
1331		} else if (GBADMARegisterIsEnable(dma->reg) && entries < (DS_GX_FIFO_SIZE / 2) && !dma->nextCount) {
1332			dma->nextCount = dma->count;
1333			dma->when = mTimingCurrentTime(&gx->p->ds9.timing);
1334			DSDMAUpdate(&gx->p->ds9);
1335		}
1336	}
1337}
1338
1339static void DSGXUnpackCommand(struct DSGX* gx, uint32_t command) {
1340	gx->outstandingCommand[0] = command;
1341	gx->outstandingCommand[1] = command >> 8;
1342	gx->outstandingCommand[2] = command >> 16;
1343	gx->outstandingCommand[3] = command >> 24;
1344	if (gx->outstandingCommand[0] >= DS_GX_CMD_MAX) {
1345		gx->outstandingCommand[0] = 0;
1346	}
1347	if (gx->outstandingCommand[1] >= DS_GX_CMD_MAX) {
1348		gx->outstandingCommand[1] = 0;
1349	}
1350	if (gx->outstandingCommand[2] >= DS_GX_CMD_MAX) {
1351		gx->outstandingCommand[2] = 0;
1352	}
1353	if (gx->outstandingCommand[3] >= DS_GX_CMD_MAX) {
1354		gx->outstandingCommand[3] = 0;
1355	}
1356	if (!_gxCommandCycleBase[gx->outstandingCommand[0]]) {
1357		gx->outstandingCommand[0] = gx->outstandingCommand[1];
1358		gx->outstandingCommand[1] = gx->outstandingCommand[2];
1359		gx->outstandingCommand[2] = gx->outstandingCommand[3];
1360		gx->outstandingCommand[3] = 0;
1361	}
1362	if (!_gxCommandCycleBase[gx->outstandingCommand[1]]) {
1363		gx->outstandingCommand[1] = gx->outstandingCommand[2];
1364		gx->outstandingCommand[2] = gx->outstandingCommand[3];
1365		gx->outstandingCommand[3] = 0;
1366	}
1367	if (!_gxCommandCycleBase[gx->outstandingCommand[2]]) {
1368		gx->outstandingCommand[2] = gx->outstandingCommand[3];
1369		gx->outstandingCommand[3] = 0;
1370	}
1371	gx->outstandingParams[0] = _gxCommandParams[gx->outstandingCommand[0]];
1372	gx->outstandingParams[1] = _gxCommandParams[gx->outstandingCommand[1]];
1373	gx->outstandingParams[2] = _gxCommandParams[gx->outstandingCommand[2]];
1374	gx->outstandingParams[3] = _gxCommandParams[gx->outstandingCommand[3]];
1375	_flushOutstanding(gx);
1376	DSGXUpdateGXSTAT(gx);
1377}
1378
1379static void DSGXWriteFIFO(struct DSGX* gx, struct DSGXEntry entry) {
1380	if (CircleBufferSize(&gx->fifo) == (DS_GX_FIFO_SIZE * sizeof(entry))) {
1381		mLOG(DS_GX, INFO, "FIFO full");
1382		while (gx->p->cpuBlocked & DS_CPU_BLOCK_GX) {
1383			// Can happen from STM
1384			mTimingDeschedule(&gx->p->ds9.timing, &gx->fifoEvent);
1385			_fifoRun(&gx->p->ds9.timing, gx, 0);
1386		}
1387		gx->p->cpuBlocked |= DS_CPU_BLOCK_GX;
1388		gx->outstandingEntry = entry;
1389		gx->p->ds9.cpu->nextEvent = 0;
1390		return;
1391	}
1392	if (gx->outstandingCommand[0]) {
1393		entry.command = gx->outstandingCommand[0];
1394		if (gx->outstandingParams[0]) {
1395			--gx->outstandingParams[0];
1396		}
1397		if (!gx->outstandingParams[0]) {
1398			// TODO: improve this
1399			memmove(&gx->outstandingParams[0], &gx->outstandingParams[1], sizeof(gx->outstandingParams[0]) * 3);
1400			memmove(&gx->outstandingCommand[0], &gx->outstandingCommand[1], sizeof(gx->outstandingCommand[0]) * 3);
1401			gx->outstandingParams[3] = 0;
1402			gx->outstandingCommand[3] = 0;
1403		}
1404	} else {
1405		gx->outstandingParams[0] = _gxCommandParams[entry.command];
1406		if (gx->outstandingParams[0]) {
1407			--gx->outstandingParams[0];
1408		}
1409		if (gx->outstandingParams[0]) {
1410			gx->outstandingCommand[0] = entry.command;
1411		}
1412	}
1413	uint32_t cycles = _gxCommandCycleBase[entry.command];
1414	if (!cycles) {
1415		return;
1416	}
1417	if (CircleBufferSize(&gx->fifo) == 0 && CircleBufferSize(&gx->pipe) < (DS_GX_PIPE_SIZE * sizeof(entry))) {
1418		CircleBufferWrite(&gx->pipe, &entry, sizeof(entry));
1419	} else if (CircleBufferSize(&gx->fifo) < (DS_GX_FIFO_SIZE * sizeof(entry))) {
1420		CircleBufferWrite(&gx->fifo, &entry, sizeof(entry));
1421	}
1422	if (entry.command == DS_GX_CMD_BOX_TEST) {
1423		DSRegGXSTAT gxstat = gx->p->memory.io9[DS9_REG_GXSTAT_LO >> 1];
1424		gxstat = DSRegGXSTATFillTestBusy(gxstat);
1425		gxstat = DSRegGXSTATClearBoxTestResult(gxstat);
1426		gx->p->memory.io9[DS9_REG_GXSTAT_LO >> 1] = gxstat;
1427	}
1428	if (!gx->swapBuffers && !mTimingIsScheduled(&gx->p->ds9.timing, &gx->fifoEvent)) {
1429		mTimingSchedule(&gx->p->ds9.timing, &gx->fifoEvent, cycles);
1430	}
1431
1432	_flushOutstanding(gx);
1433}
1434
1435uint16_t DSGXWriteRegister(struct DSGX* gx, uint32_t address, uint16_t value) {
1436	uint16_t oldValue = gx->p->memory.io9[address >> 1];
1437	switch (address) {
1438	case DS9_REG_DISP3DCNT:
1439		mLOG(DS_GX, STUB, "Unimplemented GX write %03X:%04X", address, value);
1440		break;
1441	case DS9_REG_GXSTAT_LO:
1442		value = DSRegGXSTATIsMatrixStackError(value);
1443		if (value) {
1444			oldValue = DSRegGXSTATClearMatrixStackError(oldValue);
1445			oldValue = DSRegGXSTATClearProjMatrixStackLevel(oldValue);
1446		}
1447		value = oldValue;
1448		break;
1449	case DS9_REG_GXSTAT_HI:
1450		value = DSRegGXSTATIsDoIRQ(value << 16) >> 16;
1451		gx->p->memory.io9[address >> 1] = value;
1452		DSGXUpdateGXSTAT(gx);
1453		value = gx->p->memory.io9[address >> 1];
1454		break;
1455	default:
1456		if (address < DS9_REG_GXFIFO_00) {
1457			mLOG(DS_GX, STUB, "Unimplemented GX write %03X:%04X", address, value);
1458		} else if (address <= DS9_REG_GXFIFO_1F) {
1459			mLOG(DS_GX, STUB, "Unimplemented GX write %03X:%04X", address, value);
1460		} else if (address < DS9_REG_GXSTAT_LO) {
1461			struct DSGXEntry entry = {
1462				.command = (address & 0x1FC) >> 2,
1463				.params = {
1464					value,
1465					value >> 8,
1466				}
1467			};
1468			if (entry.command < DS_GX_CMD_MAX) {
1469				DSGXWriteFIFO(gx, entry);
1470			}
1471		} else {
1472			mLOG(DS_GX, STUB, "Unimplemented GX write %03X:%04X", address, value);
1473		}
1474		break;
1475	}
1476	return value;
1477}
1478
1479uint32_t DSGXWriteRegister32(struct DSGX* gx, uint32_t address, uint32_t value) {
1480	switch (address) {
1481	case DS9_REG_DISP3DCNT:
1482		mLOG(DS_GX, STUB, "Unimplemented GX write %03X:%08X", address, value);
1483		break;
1484	case DS9_REG_GXSTAT_LO:
1485		value = (value & 0xFFFF0000) | DSGXWriteRegister(gx, DS9_REG_GXSTAT_LO, value);
1486		value = (value & 0x0000FFFF) | (DSGXWriteRegister(gx, DS9_REG_GXSTAT_HI, value >> 16) << 16);
1487		break;
1488	default:
1489		if (address < DS9_REG_GXFIFO_00) {
1490			mLOG(DS_GX, STUB, "Unimplemented GX write %03X:%08X", address, value);
1491		} else if (address <= DS9_REG_GXFIFO_1F) {
1492			if (gx->outstandingParams[0]) {
1493				struct DSGXEntry entry = {
1494					.command = gx->outstandingCommand[0],
1495					.params = {
1496						value,
1497						value >> 8,
1498						value >> 16,
1499						value >> 24
1500					}
1501				};
1502				DSGXWriteFIFO(gx, entry);
1503			} else {
1504				DSGXUnpackCommand(gx, value);
1505			}
1506		} else if (address < DS9_REG_GXSTAT_LO) {
1507			struct DSGXEntry entry = {
1508				.command = (address & 0x1FC) >> 2,
1509				.params = {
1510					value,
1511					value >> 8,
1512					value >> 16,
1513					value >> 24
1514				}
1515			};
1516			DSGXWriteFIFO(gx, entry);
1517		} else {
1518			mLOG(DS_GX, STUB, "Unimplemented GX write %03X:%08X", address, value);
1519		}
1520		break;
1521	}
1522	return value;
1523}
1524
1525void DSGXFlush(struct DSGX* gx) {
1526	if (gx->swapBuffers) {
1527		gx->renderer->setRAM(gx->renderer, gx->vertexBuffer[gx->bufferIndex], gx->polygonBuffer[gx->bufferIndex], gx->polygonIndex, gx->wSort);
1528		gx->swapBuffers = false;
1529		gx->bufferIndex ^= 1;
1530		gx->vertexIndex = 0;
1531		gx->pendingVertexIndex = 0;
1532		gx->polygonIndex = 0;
1533		if (CircleBufferSize(&gx->fifo)) {
1534			mTimingSchedule(&gx->p->ds9.timing, &gx->fifoEvent, 0);
1535		}
1536	}
1537
1538	DSGXUpdateGXSTAT(gx);
1539}
1540
1541void DSGXScheduleDMA(struct DSCommon* dscore, int number, struct GBADMA* info) {
1542	UNUSED(info);
1543	dscore->p->gx.dmaSource = number;
1544}
1545
1546static void DSGXDummyRendererInit(struct DSGXRenderer* renderer) {
1547	UNUSED(renderer);
1548	// Nothing to do
1549}
1550
1551static void DSGXDummyRendererReset(struct DSGXRenderer* renderer) {
1552	UNUSED(renderer);
1553	// Nothing to do
1554}
1555
1556static void DSGXDummyRendererDeinit(struct DSGXRenderer* renderer) {
1557	UNUSED(renderer);
1558	// Nothing to do
1559}
1560
1561static void DSGXDummyRendererInvalidateTex(struct DSGXRenderer* renderer, int slot) {
1562	UNUSED(renderer);
1563	UNUSED(slot);
1564	// Nothing to do
1565}
1566
1567static void DSGXDummyRendererSetRAM(struct DSGXRenderer* renderer, struct DSGXVertex* verts, struct DSGXPolygon* polys, unsigned polyCount, bool wSort) {
1568	UNUSED(renderer);
1569	UNUSED(verts);
1570	UNUSED(polys);
1571	UNUSED(polyCount);
1572	UNUSED(wSort);
1573	// Nothing to do
1574}
1575
1576static void DSGXDummyRendererDrawScanline(struct DSGXRenderer* renderer, int y) {
1577	UNUSED(renderer);
1578	UNUSED(y);
1579	// Nothing to do
1580}
1581
1582static void DSGXDummyRendererGetScanline(struct DSGXRenderer* renderer, int y, const color_t** output) {
1583	UNUSED(renderer);
1584	UNUSED(y);
1585	*output = NULL;
1586	// Nothing to do
1587}