#include "../copyright" #include "snes9x.h" #include "sar.h" #include "memmap.h" #include "ppu.h" #include "c4.h" void S9xInitC4(void) { Memory.C4RAM = &Memory.FillRAM [0x6000]; } uint8_t S9xGetC4(uint16_t Address) { if (Address == 0x7f5e) return 0; return Memory.C4RAM [Address - 0x6000]; } static uint8_t C4TestPattern [12 * 4] = { 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0x00, 0xff, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0x00, 0x00, 0xff, 0xff, 0x00, 0x00, 0x80, 0xff, 0xff, 0x7f, 0x00, 0x80, 0x00, 0xff, 0x7f, 0x00, 0xff, 0x7f, 0xff, 0x7f, 0xff, 0xff, 0x00, 0x00, 0x01, 0xff, 0xff, 0xfe, 0x00, 0x01, 0x00, 0xff, 0xfe, 0x00 }; static void C4ConvOAM(void) { uint16_t globalX, globalY; uint8_t* OAMptr2; int16_t SprX, SprY; uint8_t SprName, SprAttr; uint8_t SprCount; uint8_t* i; uint8_t* OAMptr = Memory.C4RAM + (Memory.C4RAM[0x626] << 2); for (i = Memory.C4RAM + 0x1fd; i > OAMptr; i -= 4) *i = 0xe0; /* Clear OAM-to-be */ globalX = READ_WORD(Memory.C4RAM + 0x0621); globalY = READ_WORD(Memory.C4RAM + 0x0623); OAMptr2 = Memory.C4RAM + 0x200 + (Memory.C4RAM[0x626] >> 2); if (Memory.C4RAM[0x0620] != 0) { uint8_t offset; int32_t prio, i; SprCount = 128 - Memory.C4RAM[0x626]; offset = (Memory.C4RAM[0x626] & 3) * 2; for (prio = 0x30; prio >= 0; prio -= 0x10) { uint8_t* srcptr = Memory.C4RAM + 0x220; for (i = Memory.C4RAM[0x0620]; i > 0 && SprCount > 0; i--, srcptr += 16) { uint8_t *sprptr; if ((srcptr[4] & 0x30) != prio) continue; SprX = READ_WORD(srcptr) - globalX; SprY = READ_WORD(srcptr + 2) - globalY; SprName = srcptr[5]; SprAttr = srcptr[4] | srcptr[0x06]; /* XXX: mask bits? */ sprptr = S9xGetMemPointer(READ_3WORD(srcptr + 7)); if (*sprptr != 0) { int32_t SprCnt; int16_t X, Y; for (SprCnt = *sprptr++; SprCnt > 0 && SprCount > 0; SprCnt--, sprptr += 4) { X = (int8_t)sprptr[1]; if (SprAttr & 0x40) /* flip X */ X = -X - ((sprptr[0] & 0x20) ? 16 : 8); X += SprX; if (X >= -16 && X <= 272) { Y = (int8_t)sprptr[2]; if (SprAttr & 0x80) Y = -Y - ((sprptr[0] & 0x20) ? 16 : 8); Y += SprY; if (Y >= -16 && Y <= 224) { OAMptr[0] = X & 0xff; OAMptr[1] = (uint8_t)Y; OAMptr[2] = SprName + sprptr[3]; OAMptr[3] = SprAttr ^ (sprptr[0] & 0xc0); /* XXX: Carry from SprName addition? */ *OAMptr2 &= ~(3 << offset); if (X & 0x100) *OAMptr2 |= 1 << offset; if (sprptr[0] & 0x20) *OAMptr2 |= 2 << offset; OAMptr += 4; SprCount--; offset = (offset + 2) & 6; if (offset == 0) OAMptr2++; } } } } else if (SprCount > 0) { OAMptr[0] = (uint8_t)SprX; OAMptr[1] = (uint8_t)SprY; OAMptr[2] = SprName; OAMptr[3] = SprAttr; *OAMptr2 &= ~(3 << offset); if (SprX & 0x100) *OAMptr2 |= 3 << offset; else *OAMptr2 |= 2 << offset; OAMptr += 4; SprCount--; offset = (offset + 2) & 6; if (offset == 0) OAMptr2++; } } } } } static void C4DoScaleRotate(int32_t row_padding) { int16_t A, B, C, D; int32_t YScale; uint8_t w, h; int32_t Cx, Cy; int32_t LineX, LineY; uint32_t X, Y; uint8_t byte; int32_t outidx = 0; int32_t x, y; uint8_t bit = 0x80; /* Calculate matrix */ int32_t XScale = READ_WORD(Memory.C4RAM + 0x1f8f); if (XScale & 0x8000) XScale = 0x7fff; YScale = READ_WORD(Memory.C4RAM + 0x1f92); if (YScale & 0x8000) YScale = 0x7fff; if (READ_WORD(Memory.C4RAM + 0x1f80) == 0) { /* no rotation * XXX: only do this for C and D? * XXX: and then only when YScale is 0x1000? */ A = (int16_t)XScale; B = 0; C = 0; D = (int16_t)YScale; } else if (READ_WORD(Memory.C4RAM + 0x1f80) == 128) /* 90 degree rotation */ { /* XXX: Really do this? */ A = 0; B = (int16_t)(-YScale); C = (int16_t)XScale; D = 0; } else if (READ_WORD(Memory.C4RAM + 0x1f80) == 256) /* 180 degree rotation */ { /* XXX: Really do this? */ A = (int16_t)(-XScale); B = 0; C = 0; D = (int16_t)(-YScale); } else if (READ_WORD(Memory.C4RAM + 0x1f80) == 384) /* 270 degree rotation */ { /* XXX: Really do this? */ A = 0; B = (int16_t)YScale; C = (int16_t)(-XScale); D = 0; } else { A = (int16_t) SAR16(C4CosTable[READ_WORD(Memory.C4RAM + 0x1f80) & 0x1ff] * XScale, 15); B = (int16_t)(-SAR16(C4SinTable[READ_WORD(Memory.C4RAM + 0x1f80) & 0x1ff] * YScale, 15)); C = (int16_t) SAR16(C4SinTable[READ_WORD(Memory.C4RAM + 0x1f80) & 0x1ff] * XScale, 15); D = (int16_t) SAR16(C4CosTable[READ_WORD(Memory.C4RAM + 0x1f80) & 0x1ff] * YScale, 15); } /* Calculate Pixel Resolution */ w = Memory.C4RAM[0x1f89] & ~7; h = Memory.C4RAM[0x1f8c] & ~7; /* Clear the output RAM */ memset(Memory.C4RAM, 0, (w + row_padding / 4)*h / 2); Cx = (int16_t)READ_WORD(Memory.C4RAM + 0x1f83); Cy = (int16_t)READ_WORD(Memory.C4RAM + 0x1f86); /* Calculate start position (i.e. (Ox, Oy) = (0, 0)) * The low 12 bits are fractional, so (Cx<<12) gives us the Cx we want in * the function. We do Cx*A etc normally because the matrix parameters * already have the fractional parts. */ LineX = (Cx << 12) - Cx * A - Cx * B; LineY = (Cy << 12) - Cy * C - Cy * D; /* Start loop */ for (y = 0; y < h; y++) { X = LineX; Y = LineY; for (x = 0; x < w; x++) { if ((X >> 12) >= w || (Y >> 12) >= h) byte = 0; else { uint32_t addr = (Y >> 12) * w + (X >> 12); byte = Memory.C4RAM[0x600 + (addr >> 1)]; if (addr & 1) byte >>= 4; } /* De-bitplanify */ if (byte & 1) Memory.C4RAM[outidx] |= bit; if (byte & 2) Memory.C4RAM[outidx + 1] |= bit; if (byte & 4) Memory.C4RAM[outidx + 16] |= bit; if (byte & 8) Memory.C4RAM[outidx + 17] |= bit; bit >>= 1; if (bit == 0) { bit = 0x80; outidx += 32; } X += A; /* Add 1 to output x => add an A and a C */ Y += C; } outidx += 2 + row_padding; if (outidx & 0x10) outidx &= ~0x10; else outidx -= w * 4 + row_padding; LineX += B; /* Add 1 to output y => add a B and a D */ LineY += D; } } static void C4DrawLine(int32_t X1, int32_t Y1, int16_t Z1, int32_t X2, int32_t Y2, int16_t Z2, uint8_t Color) { int32_t i; /* Transform coordinates */ C4WFXVal = (int16_t)X1; C4WFYVal = (int16_t)Y1; C4WFZVal = Z1; C4WFScale = Memory.C4RAM[0x1f90]; C4WFX2Val = Memory.C4RAM[0x1f86]; C4WFY2Val = Memory.C4RAM[0x1f87]; C4WFDist = Memory.C4RAM[0x1f88]; C4TransfWireFrame2(); X1 = (C4WFXVal + 48) << 8; Y1 = (C4WFYVal + 48) << 8; C4WFXVal = (int16_t)X2; C4WFYVal = (int16_t)Y2; C4WFZVal = Z2; C4TransfWireFrame2(); X2 = (C4WFXVal + 48) << 8; Y2 = (C4WFYVal + 48) << 8; /* get line info */ C4WFXVal = (int16_t)(X1 >> 8); C4WFYVal = (int16_t)(Y1 >> 8); C4WFX2Val = (int16_t)(X2 >> 8); C4WFY2Val = (int16_t)(Y2 >> 8); C4CalcWireFrame(); X2 = (int16_t)C4WFXVal; Y2 = (int16_t)C4WFYVal; /* render line */ for (i = C4WFDist ? C4WFDist : 1; i > 0; i--) { /*.loop */ if (X1 > 0xff && Y1 > 0xff && X1 < 0x6000 && Y1 < 0x6000) { uint16_t addr = (((Y1 >> 8) >> 3) << 8) - (((Y1 >> 8) >> 3) << 6) + (((X1 >> 8) >> 3) << 4) + ((Y1 >> 8) & 7) * 2; uint8_t bit = 0x80 >> ((X1 >> 8) & 7); Memory.C4RAM[addr + 0x300] &= ~bit; Memory.C4RAM[addr + 0x301] &= ~bit; if (Color & 1) Memory.C4RAM[addr + 0x300] |= bit; if (Color & 2) Memory.C4RAM[addr + 0x301] |= bit; } X1 += X2; Y1 += Y2; } } static void C4DrawWireFrame(void) { uint8_t* line = S9xGetMemPointer(READ_3WORD(Memory.C4RAM + 0x1f80)); uint8_t* point1, *point2; int16_t X1, Y1, Z1; int16_t X2, Y2, Z2; uint8_t Color; int32_t i; for (i = Memory.C4RAM[0x0295]; i > 0; i--, line += 5) { if (line[0] == 0xff && line[1] == 0xff) { uint8_t* tmp = line - 5; while (tmp[2] == 0xff && tmp[3] == 0xff) tmp -= 5; point1 = S9xGetMemPointer((Memory.C4RAM[0x1f82] << 16) | (tmp[2] << 8) | tmp[3]); } else point1 = S9xGetMemPointer((Memory.C4RAM[0x1f82] << 16) | (line[0] << 8) | line[1]); point2 = S9xGetMemPointer((Memory.C4RAM[0x1f82] << 16) | (line[2] << 8) | line[3]); X1 = (point1[0] << 8) | point1[1]; Y1 = (point1[2] << 8) | point1[3]; Z1 = (point1[4] << 8) | point1[5]; X2 = (point2[0] << 8) | point2[1]; Y2 = (point2[2] << 8) | point2[3]; Z2 = (point2[4] << 8) | point2[5]; Color = line[4]; C4DrawLine(X1, Y1, Z1, X2, Y2, Z2, Color); } } static void C4TransformLines(void) { int32_t i; uint8_t *ptr; uint8_t* ptr2; C4WFX2Val = Memory.C4RAM[0x1f83]; C4WFY2Val = Memory.C4RAM[0x1f86]; C4WFDist = Memory.C4RAM[0x1f89]; C4WFScale = Memory.C4RAM[0x1f8c]; /* transform vertices */ ptr = Memory.C4RAM; for (i = READ_WORD(Memory.C4RAM + 0x1f80); i > 0; i--, ptr += 0x10) { C4WFXVal = READ_WORD(ptr + 1); C4WFYVal = READ_WORD(ptr + 5); C4WFZVal = READ_WORD(ptr + 9); C4TransfWireFrame(); /* displace */ WRITE_WORD(ptr + 1, C4WFXVal + 0x80); WRITE_WORD(ptr + 5, C4WFYVal + 0x50); } WRITE_WORD(Memory.C4RAM + 0x600, 23); WRITE_WORD(Memory.C4RAM + 0x602, 0x60); WRITE_WORD(Memory.C4RAM + 0x605, 0x40); WRITE_WORD(Memory.C4RAM + 0x600 + 8, 23); WRITE_WORD(Memory.C4RAM + 0x602 + 8, 0x60); WRITE_WORD(Memory.C4RAM + 0x605 + 8, 0x40); ptr = Memory.C4RAM + 0xb02; ptr2 = Memory.C4RAM; for (i = READ_WORD(Memory.C4RAM + 0xb00); i > 0; i--, ptr += 2, ptr2 += 8) { C4WFXVal = READ_WORD(Memory.C4RAM + (ptr[0] << 4) + 1); C4WFYVal = READ_WORD(Memory.C4RAM + (ptr[0] << 4) + 5); C4WFX2Val = READ_WORD(Memory.C4RAM + (ptr[1] << 4) + 1); C4WFY2Val = READ_WORD(Memory.C4RAM + (ptr[1] << 4) + 5); C4CalcWireFrame(); WRITE_WORD(ptr2 + 0x600, C4WFDist ? C4WFDist : 1); WRITE_WORD(ptr2 + 0x602, C4WFXVal); WRITE_WORD(ptr2 + 0x605, C4WFYVal); } } static void C4BitPlaneWave(void) { static uint16_t bmpdata[] = { 0x0000, 0x0002, 0x0004, 0x0006, 0x0008, 0x000A, 0x000C, 0x000E, 0x0200, 0x0202, 0x0204, 0x0206, 0x0208, 0x020A, 0x020C, 0x020E, 0x0400, 0x0402, 0x0404, 0x0406, 0x0408, 0x040A, 0x040C, 0x040E, 0x0600, 0x0602, 0x0604, 0x0606, 0x0608, 0x060A, 0x060C, 0x060E, 0x0800, 0x0802, 0x0804, 0x0806, 0x0808, 0x080A, 0x080C, 0x080E }; uint8_t* dst = Memory.C4RAM; uint32_t waveptr = Memory.C4RAM[0x1f83]; uint16_t mask1 = 0xc0c0; uint16_t mask2 = 0x3f3f; int32_t i, j; for (j = 0; j < 0x10; j++) { do { int16_t height = -((int8_t)Memory.C4RAM[waveptr + 0xb00]) - 16; for (i = 0; i < 40; i++) { uint16_t tmp = READ_WORD(dst + bmpdata[i]) & mask2; if (height >= 0) { if (height < 8) tmp |= mask1 & READ_WORD(Memory.C4RAM + 0xa00 + height * 2); else tmp |= mask1 & 0xff00; } WRITE_WORD(dst + bmpdata[i], tmp); height++; } waveptr = (waveptr + 1) & 0x7f; mask1 = (mask1 >> 2) | (mask1 << 6); mask2 = (mask2 >> 2) | (mask2 << 6); } while (mask1 != 0xc0c0); dst += 16; do { int32_t i; int16_t height = -((int8_t)Memory.C4RAM[waveptr + 0xb00]) - 16; for (i = 0; i < 40; i++) { uint16_t tmp = READ_WORD(dst + bmpdata[i]) & mask2; if (height >= 0) { if (height < 8) tmp |= mask1 & READ_WORD(Memory.C4RAM + 0xa10 + height * 2); else tmp |= mask1 & 0xff00; } WRITE_WORD(dst + bmpdata[i], tmp); height++; } waveptr = (waveptr + 1) & 0x7f; mask1 = (mask1 >> 2) | (mask1 << 6); mask2 = (mask2 >> 2) | (mask2 << 6); } while (mask1 != 0xc0c0); dst += 16; } } static void C4SprDisintegrate(void) { uint32_t x, y, i, j; uint8_t width = Memory.C4RAM[0x1f89]; uint8_t height = Memory.C4RAM[0x1f8c]; int32_t Cx = (int16_t)READ_WORD(Memory.C4RAM + 0x1f80); int32_t Cy = (int16_t)READ_WORD(Memory.C4RAM + 0x1f83); int32_t scaleX = (int16_t)READ_WORD(Memory.C4RAM + 0x1f86); int32_t scaleY = (int16_t)READ_WORD(Memory.C4RAM + 0x1f8f); uint32_t StartX = -Cx * scaleX + (Cx << 8); uint32_t StartY = -Cy * scaleY + (Cy << 8); uint8_t *src = Memory.C4RAM + 0x600; memset(Memory.C4RAM, 0, width * height / 2); for (y = StartY, i = 0; i < height; i++, y += scaleY) { for (x = StartX, j = 0; j < width; j++, x += scaleX) { if ((x >> 8) < width && (y >> 8) < height && (y >> 8)*width + (x >> 8) < 0x2000) { uint8_t pixel = (j & 1) ? (*src >> 4) : *src; int32_t idx = (y >> 11) * width * 4 + (x >> 11) * 32 + ((y >> 8) & 7) * 2; uint8_t mask = 0x80 >> ((x >> 8) & 7); if (pixel & 1) Memory.C4RAM[idx] |= mask; if (pixel & 2) Memory.C4RAM[idx + 1] |= mask; if (pixel & 4) Memory.C4RAM[idx + 16] |= mask; if (pixel & 8) Memory.C4RAM[idx + 17] |= mask; } if (j & 1) src++; } } } static void S9xC4ProcessSprites(void) { switch (Memory.C4RAM[0x1f4d]) { case 0x00: /* Build OAM */ C4ConvOAM(); break; case 0x03: /* Scale/Rotate */ C4DoScaleRotate(0); break; case 0x05: /* Transform Lines */ C4TransformLines(); break; case 0x07: /* Scale/Rotate */ C4DoScaleRotate(64); break; case 0x08: /* Draw wireframe */ C4DrawWireFrame(); break; case 0x0b: /* Disintegrate */ C4SprDisintegrate(); break; case 0x0c: /* Wave */ C4BitPlaneWave(); break; default: break; } } void S9xSetC4(uint8_t byte, uint16_t Address) { int32_t i; Memory.C4RAM [Address - 0x6000] = byte; if (Address == 0x7f4f) { if (Memory.C4RAM[0x1f4d] == 0x0e && byte < 0x40 && (byte & 3) == 0) Memory.C4RAM[0x1f80] = byte >> 2; else { switch (byte) { case 0x00: /* Sprite */ S9xC4ProcessSprites(); break; case 0x01: /* Draw wireframe */ memset(Memory.C4RAM + 0x300, 0, 16 * 12 * 3 * 4); C4DrawWireFrame(); break; case 0x05: /* Propulsion (?) */ { int32_t tmp = 0x10000; if (READ_WORD(Memory.C4RAM + 0x1f83)) tmp = SAR32((tmp / READ_WORD(Memory.C4RAM + 0x1f83)) * READ_WORD(Memory.C4RAM + 0x1f81), 8); WRITE_WORD(Memory.C4RAM + 0x1f80, (uint16_t)tmp); break; } case 0x0d: /* Set vector length */ C41FXVal = READ_WORD(Memory.C4RAM + 0x1f80); C41FYVal = READ_WORD(Memory.C4RAM + 0x1f83); C41FDistVal = READ_WORD(Memory.C4RAM + 0x1f86); tanval = C41FDistVal / _isqrt((int32_t) C41FYVal * C41FYVal + (int32_t) C41FXVal * C41FXVal); C41FYVal = (int16_t)(((int32_t)C41FYVal * tanval * 99) / 100); C41FXVal = (int16_t)(((int32_t)C41FXVal * tanval * 98) / 100); WRITE_WORD(Memory.C4RAM + 0x1f89, C41FXVal); WRITE_WORD(Memory.C4RAM + 0x1f8c, C41FYVal); break; case 0x10: /* Polar to rectangular */ { int32_t tmp = SAR32((int32_t)READ_WORD(Memory.C4RAM + 0x1f83) * C4CosTable[READ_WORD(Memory.C4RAM + 0x1f80) & 0x1ff] * 2, 16); WRITE_3WORD(Memory.C4RAM + 0x1f86, tmp); tmp = SAR32((int32_t)READ_WORD(Memory.C4RAM + 0x1f83) * C4SinTable[READ_WORD(Memory.C4RAM + 0x1f80) & 0x1ff] * 2, 16); WRITE_3WORD(Memory.C4RAM + 0x1f89, (tmp - SAR32(tmp, 6))); break; } case 0x13: /* Polar to rectangular */ { int32_t tmp = SAR32((int32_t)READ_WORD(Memory.C4RAM + 0x1f83) * C4CosTable[READ_WORD(Memory.C4RAM + 0x1f80) & 0x1ff] * 2, 8); WRITE_3WORD(Memory.C4RAM + 0x1f86, tmp); tmp = SAR32((int32_t)READ_WORD(Memory.C4RAM + 0x1f83) * C4SinTable[READ_WORD(Memory.C4RAM + 0x1f80) & 0x1ff] * 2, 8); WRITE_3WORD(Memory.C4RAM + 0x1f89, tmp); break; } case 0x15: /* Pythagorean */ C41FXVal = READ_WORD(Memory.C4RAM + 0x1f80); C41FYVal = READ_WORD(Memory.C4RAM + 0x1f83); C41FDist = (int16_t)_isqrt((int32_t) C41FXVal * C41FXVal + (int32_t) C41FYVal * C41FYVal); WRITE_WORD(Memory.C4RAM + 0x1f80, C41FDist); break; case 0x1f: /* atan */ C41FXVal = READ_WORD(Memory.C4RAM + 0x1f80); C41FYVal = READ_WORD(Memory.C4RAM + 0x1f83); if (C41FXVal == 0) { if (C41FYVal > 0) C41FAngleRes = 0x80; else C41FAngleRes = 0x180; } else { C41FAngleRes = (int16_t)(_atan2(C41FYVal, C41FXVal) / 2); if (C41FXVal < 0) C41FAngleRes += 0x100; C41FAngleRes &= 0x1FF; } WRITE_WORD(Memory.C4RAM + 0x1f86, C41FAngleRes); break; case 0x22: /* Trapezoid */ { int16_t angle1 = READ_WORD(Memory.C4RAM + 0x1f8c) & 0x1ff; int16_t angle2 = READ_WORD(Memory.C4RAM + 0x1f8f) & 0x1ff; int32_t tan1 = (C4CosTable[angle1] != 0) ? ((((int32_t)C4SinTable[angle1]) << 16) / C4CosTable[angle1]) : 0x80000000; int32_t tan2 = (C4CosTable[angle2] != 0) ? ((((int32_t)C4SinTable[angle2]) << 16) / C4CosTable[angle2]) : 0x80000000; int16_t y = READ_WORD(Memory.C4RAM + 0x1f83) - READ_WORD(Memory.C4RAM + 0x1f89); int16_t left, right; int32_t j; for (j = 0; j < 225; j++) { if (y >= 0) { left = SAR32((int32_t)tan1 * y, 16) - READ_WORD(Memory.C4RAM + 0x1f80) + READ_WORD(Memory.C4RAM + 0x1f86); right = SAR32((int32_t)tan2 * y, 16) - READ_WORD(Memory.C4RAM + 0x1f80) + READ_WORD(Memory.C4RAM + 0x1f86) + READ_WORD(Memory.C4RAM + 0x1f93); if (left < 0 && right < 0) { left = 1; right = 0; } else if (left < 0) left = 0; else if (right < 0) right = 0; if (left > 255 && right > 255) { left = 255; right = 254; } else if (left > 255) left = 255; else if (right > 255) right = 255; } else { left = 1; right = 0; } Memory.C4RAM[j + 0x800] = (uint8_t)left; Memory.C4RAM[j + 0x900] = (uint8_t)right; y++; } break; } case 0x25: /* Multiply */ { int32_t foo = READ_3WORD(Memory.C4RAM + 0x1f80); int32_t bar = READ_3WORD(Memory.C4RAM + 0x1f83); foo *= bar; WRITE_3WORD(Memory.C4RAM + 0x1f80, foo); break; } case 0x2d: /* Transform Coords */ C4WFXVal = READ_WORD(Memory.C4RAM + 0x1f81); C4WFYVal = READ_WORD(Memory.C4RAM + 0x1f84); C4WFZVal = READ_WORD(Memory.C4RAM + 0x1f87); C4WFX2Val = Memory.C4RAM[0x1f89]; C4WFY2Val = Memory.C4RAM[0x1f8a]; C4WFDist = Memory.C4RAM[0x1f8b]; C4WFScale = READ_WORD(Memory.C4RAM + 0x1f90); C4TransfWireFrame2(); WRITE_WORD(Memory.C4RAM + 0x1f80, C4WFXVal); WRITE_WORD(Memory.C4RAM + 0x1f83, C4WFYVal); break; case 0x40: /* Sum */ { int32_t i; uint16_t sum = 0; for (i = 0; i < 0x800; sum += Memory.C4RAM[i++]); WRITE_WORD(Memory.C4RAM + 0x1f80, sum); break; } case 0x54: /* Square */ { int64_t a = SAR64((int64_t)READ_3WORD(Memory.C4RAM + 0x1f80) << 40, 40); a *= a; WRITE_3WORD(Memory.C4RAM + 0x1f83, a); WRITE_3WORD(Memory.C4RAM + 0x1f86, (a >> 24)); break; } case 0x5c: /* Immediate Reg */ for (i = 0; i < 12 * 4; i++) Memory.C4RAM [i] = C4TestPattern [i]; break; case 0x89: /* Immediate ROM */ Memory.C4RAM [0x1f80] = 0x36; Memory.C4RAM [0x1f81] = 0x43; Memory.C4RAM [0x1f82] = 0x05; break; default: break; } } } else if (Address == 0x7f47) /* memmove required: Can overlap arbitrarily [Neb] */ memmove(Memory.C4RAM + (READ_WORD(Memory.C4RAM + 0x1f45) & 0x1fff), S9xGetMemPointer(READ_3WORD(Memory.C4RAM + 0x1f40)), READ_WORD(Memory.C4RAM + 0x1f43)); } int16_t C4SinTable[512] = { 0, 402, 804, 1206, 1607, 2009, 2410, 2811, 3211, 3611, 4011, 4409, 4808, 5205, 5602, 5997, 6392, 6786, 7179, 7571, 7961, 8351, 8739, 9126, 9512, 9896, 10278, 10659, 11039, 11416, 11793, 12167, 12539, 12910, 13278, 13645, 14010, 14372, 14732, 15090, 15446, 15800, 16151, 16499, 16846, 17189, 17530, 17869, 18204, 18537, 18868, 19195, 19519, 19841, 20159, 20475, 20787, 21097, 21403, 21706, 22005, 22301, 22594, 22884, 23170, 23453, 23732, 24007, 24279, 24547, 24812, 25073, 25330, 25583, 25832, 26077, 26319, 26557, 26790, 27020, 27245, 27466, 27684, 27897, 28106, 28310, 28511, 28707, 28898, 29086, 29269, 29447, 29621, 29791, 29956, 30117, 30273, 30425, 30572, 30714, 30852, 30985, 31114, 31237, 31357, 31471, 31581, 31685, 31785, 31881, 31971, 32057, 32138, 32214, 32285, 32351, 32413, 32469, 32521, 32568, 32610, 32647, 32679, 32706, 32728, 32745, 32758, 32765, 32767, 32765, 32758, 32745, 32728, 32706, 32679, 32647, 32610, 32568, 32521, 32469, 32413, 32351, 32285, 32214, 32138, 32057, 31971, 31881, 31785, 31685, 31581, 31471, 31357, 31237, 31114, 30985, 30852, 30714, 30572, 30425, 30273, 30117, 29956, 29791, 29621, 29447, 29269, 29086, 28898, 28707, 28511, 28310, 28106, 27897, 27684, 27466, 27245, 27020, 26790, 26557, 26319, 26077, 25832, 25583, 25330, 25073, 24812, 24547, 24279, 24007, 23732, 23453, 23170, 22884, 22594, 22301, 22005, 21706, 21403, 21097, 20787, 20475, 20159, 19841, 19519, 19195, 18868, 18537, 18204, 17869, 17530, 17189, 16846, 16499, 16151, 15800, 15446, 15090, 14732, 14372, 14010, 13645, 13278, 12910, 12539, 12167, 11793, 11416, 11039, 10659, 10278, 9896, 9512, 9126, 8739, 8351, 7961, 7571, 7179, 6786, 6392, 5997, 5602, 5205, 4808, 4409, 4011, 3611, 3211, 2811, 2410, 2009, 1607, 1206, 804, 402, 0, -402, -804, -1206, -1607, -2009, -2410, -2811, -3211, -3611, -4011, -4409, -4808, -5205, -5602, -5997, -6392, -6786, -7179, -7571, -7961, -8351, -8739, -9126, -9512, -9896, -10278, -10659, -11039, -11416, -11793, -12167, -12539, -12910, -13278, -13645, -14010, -14372, -14732, -15090, -15446, -15800, -16151, -16499, -16846, -17189, -17530, -17869, -18204, -18537, -18868, -19195, -19519, -19841, -20159, -20475, -20787, -21097, -21403, -21706, -22005, -22301, -22594, -22884, -23170, -23453, -23732, -24007, -24279, -24547, -24812, -25073, -25330, -25583, -25832, -26077, -26319, -26557, -26790, -27020, -27245, -27466, -27684, -27897, -28106, -28310, -28511, -28707, -28898, -29086, -29269, -29447, -29621, -29791, -29956, -30117, -30273, -30425, -30572, -30714, -30852, -30985, -31114, -31237, -31357, -31471, -31581, -31685, -31785, -31881, -31971, -32057, -32138, -32214, -32285, -32351, -32413, -32469, -32521, -32568, -32610, -32647, -32679, -32706, -32728, -32745, -32758, -32765, -32767, -32765, -32758, -32745, -32728, -32706, -32679, -32647, -32610, -32568, -32521, -32469, -32413, -32351, -32285, -32214, -32138, -32057, -31971, -31881, -31785, -31685, -31581, -31471, -31357, -31237, -31114, -30985, -30852, -30714, -30572, -30425, -30273, -30117, -29956, -29791, -29621, -29447, -29269, -29086, -28898, -28707, -28511, -28310, -28106, -27897, -27684, -27466, -27245, -27020, -26790, -26557, -26319, -26077, -25832, -25583, -25330, -25073, -24812, -24547, -24279, -24007, -23732, -23453, -23170, -22884, -22594, -22301, -22005, -21706, -21403, -21097, -20787, -20475, -20159, -19841, -19519, -19195, -18868, -18537, -18204, -17869, -17530, -17189, -16846, -16499, -16151, -15800, -15446, -15090, -14732, -14372, -14010, -13645, -13278, -12910, -12539, -12167, -11793, -11416, -11039, -10659, -10278, -9896, -9512, -9126, -8739, -8351, -7961, -7571, -7179, -6786, -6392, -5997, -5602, -5205, -4808, -4409, -4011, -3611, -3211, -2811, -2410, -2009, -1607, -1206, -804, -402 }; int16_t C4CosTable[512] = { 32767, 32765, 32758, 32745, 32728, 32706, 32679, 32647, 32610, 32568, 32521, 32469, 32413, 32351, 32285, 32214, 32138, 32057, 31971, 31881, 31785, 31685, 31581, 31471, 31357, 31237, 31114, 30985, 30852, 30714, 30572, 30425, 30273, 30117, 29956, 29791, 29621, 29447, 29269, 29086, 28898, 28707, 28511, 28310, 28106, 27897, 27684, 27466, 27245, 27020, 26790, 26557, 26319, 26077, 25832, 25583, 25330, 25073, 24812, 24547, 24279, 24007, 23732, 23453, 23170, 22884, 22594, 22301, 22005, 21706, 21403, 21097, 20787, 20475, 20159, 19841, 19519, 19195, 18868, 18537, 18204, 17869, 17530, 17189, 16846, 16499, 16151, 15800, 15446, 15090, 14732, 14372, 14010, 13645, 13278, 12910, 12539, 12167, 11793, 11416, 11039, 10659, 10278, 9896, 9512, 9126, 8739, 8351, 7961, 7571, 7179, 6786, 6392, 5997, 5602, 5205, 4808, 4409, 4011, 3611, 3211, 2811, 2410, 2009, 1607, 1206, 804, 402, 0, -402, -804, -1206, -1607, -2009, -2410, -2811, -3211, -3611, -4011, -4409, -4808, -5205, -5602, -5997, -6392, -6786, -7179, -7571, -7961, -8351, -8739, -9126, -9512, -9896, -10278, -10659, -11039, -11416, -11793, -12167, -12539, -12910, -13278, -13645, -14010, -14372, -14732, -15090, -15446, -15800, -16151, -16499, -16846, -17189, -17530, -17869, -18204, -18537, -18868, -19195, -19519, -19841, -20159, -20475, -20787, -21097, -21403, -21706, -22005, -22301, -22594, -22884, -23170, -23453, -23732, -24007, -24279, -24547, -24812, -25073, -25330, -25583, -25832, -26077, -26319, -26557, -26790, -27020, -27245, -27466, -27684, -27897, -28106, -28310, -28511, -28707, -28898, -29086, -29269, -29447, -29621, -29791, -29956, -30117, -30273, -30425, -30572, -30714, -30852, -30985, -31114, -31237, -31357, -31471, -31581, -31685, -31785, -31881, -31971, -32057, -32138, -32214, -32285, -32351, -32413, -32469, -32521, -32568, -32610, -32647, -32679, -32706, -32728, -32745, -32758, -32765, -32767, -32765, -32758, -32745, -32728, -32706, -32679, -32647, -32610, -32568, -32521, -32469, -32413, -32351, -32285, -32214, -32138, -32057, -31971, -31881, -31785, -31685, -31581, -31471, -31357, -31237, -31114, -30985, -30852, -30714, -30572, -30425, -30273, -30117, -29956, -29791, -29621, -29447, -29269, -29086, -28898, -28707, -28511, -28310, -28106, -27897, -27684, -27466, -27245, -27020, -26790, -26557, -26319, -26077, -25832, -25583, -25330, -25073, -24812, -24547, -24279, -24007, -23732, -23453, -23170, -22884, -22594, -22301, -22005, -21706, -21403, -21097, -20787, -20475, -20159, -19841, -19519, -19195, -18868, -18537, -18204, -17869, -17530, -17189, -16846, -16499, -16151, -15800, -15446, -15090, -14732, -14372, -14010, -13645, -13278, -12910, -12539, -12167, -11793, -11416, -11039, -10659, -10278, -9896, -9512, -9126, -8739, -8351, -7961, -7571, -7179, -6786, -6392, -5997, -5602, -5205, -4808, -4409, -4011, -3611, -3211, -2811, -2410, -2009, -1607, -1206, -804, -402, 0, 402, 804, 1206, 1607, 2009, 2410, 2811, 3211, 3611, 4011, 4409, 4808, 5205, 5602, 5997, 6392, 6786, 7179, 7571, 7961, 8351, 8739, 9126, 9512, 9896, 10278, 10659, 11039, 11416, 11793, 12167, 12539, 12910, 13278, 13645, 14010, 14372, 14732, 15090, 15446, 15800, 16151, 16499, 16846, 17189, 17530, 17869, 18204, 18537, 18868, 19195, 19519, 19841, 20159, 20475, 20787, 21097, 21403, 21706, 22005, 22301, 22594, 22884, 23170, 23453, 23732, 24007, 24279, 24547, 24812, 25073, 25330, 25583, 25832, 26077, 26319, 26557, 26790, 27020, 27245, 27466, 27684, 27897, 28106, 28310, 28511, 28707, 28898, 29086, 29269, 29447, 29621, 29791, 29956, 30117, 30273, 30425, 30572, 30714, 30852, 30985, 31114, 31237, 31357, 31471, 31581, 31685, 31785, 31881, 31971, 32057, 32138, 32214, 32285, 32351, 32413, 32469, 32521, 32568, 32610, 32647, 32679, 32706, 32728, 32745, 32758, 32765 };