/*********************************************************************************** Snes9x - Portable Super Nintendo Entertainment System (TM) emulator. (c) Copyright 1996 - 2002 Gary Henderson (gary.henderson@ntlworld.com), Jerremy Koot (jkoot@snes9x.com) (c) Copyright 2002 - 2004 Matthew Kendora (c) Copyright 2002 - 2005 Peter Bortas (peter@bortas.org) (c) Copyright 2004 - 2005 Joel Yliluoma (http://iki.fi/bisqwit/) (c) Copyright 2001 - 2006 John Weidman (jweidman@slip.net) (c) Copyright 2002 - 2006 funkyass (funkyass@spam.shaw.ca), Kris Bleakley (codeviolation@hotmail.com) (c) Copyright 2002 - 2010 Brad Jorsch (anomie@users.sourceforge.net), Nach (n-a-c-h@users.sourceforge.net), zones (kasumitokoduck@yahoo.com) (c) Copyright 2006 - 2007 nitsuja (c) Copyright 2009 - 2010 BearOso, OV2 BS-X C emulator code (c) Copyright 2005 - 2006 Dreamer Nom, zones C4 x86 assembler and some C emulation code (c) Copyright 2000 - 2003 _Demo_ (_demo_@zsnes.com), Nach, zsKnight (zsknight@zsnes.com) C4 C++ code (c) Copyright 2003 - 2006 Brad Jorsch, Nach DSP-1 emulator code (c) Copyright 1998 - 2006 _Demo_, Andreas Naive (andreasnaive@gmail.com), Gary Henderson, Ivar (ivar@snes9x.com), John Weidman, Kris Bleakley, Matthew Kendora, Nach, neviksti (neviksti@hotmail.com) DSP-2 emulator code (c) Copyright 2003 John Weidman, Kris Bleakley, Lord Nightmare (lord_nightmare@users.sourceforge.net), Matthew Kendora, neviksti DSP-3 emulator code (c) Copyright 2003 - 2006 John Weidman, Kris Bleakley, Lancer, z80 gaiden DSP-4 emulator code (c) Copyright 2004 - 2006 Dreamer Nom, John Weidman, Kris Bleakley, Nach, z80 gaiden OBC1 emulator code (c) Copyright 2001 - 2004 zsKnight, pagefault (pagefault@zsnes.com), Kris Bleakley Ported from x86 assembler to C by sanmaiwashi SPC7110 and RTC C++ emulator code used in 1.39-1.51 (c) Copyright 2002 Matthew Kendora with research by zsKnight, John Weidman, Dark Force SPC7110 and RTC C++ emulator code used in 1.52+ (c) Copyright 2009 byuu, neviksti S-DD1 C emulator code (c) Copyright 2003 Brad Jorsch with research by Andreas Naive, John Weidman S-RTC C emulator code (c) Copyright 2001 - 2006 byuu, John Weidman ST010 C++ emulator code (c) Copyright 2003 Feather, John Weidman, Kris Bleakley, Matthew Kendora Super FX x86 assembler emulator code (c) Copyright 1998 - 2003 _Demo_, pagefault, zsKnight Super FX C emulator code (c) Copyright 1997 - 1999 Ivar, Gary Henderson, John Weidman Sound emulator code used in 1.5-1.51 (c) Copyright 1998 - 2003 Brad Martin (c) Copyright 1998 - 2006 Charles Bilyue' Sound emulator code used in 1.52+ (c) Copyright 2004 - 2007 Shay Green (gblargg@gmail.com) SH assembler code partly based on x86 assembler code (c) Copyright 2002 - 2004 Marcus Comstedt (marcus@mc.pp.se) 2xSaI filter (c) Copyright 1999 - 2001 Derek Liauw Kie Fa HQ2x, HQ3x, HQ4x filters (c) Copyright 2003 Maxim Stepin (maxim@hiend3d.com) NTSC filter (c) Copyright 2006 - 2007 Shay Green GTK+ GUI code (c) Copyright 2004 - 2010 BearOso Win32 GUI code (c) Copyright 2003 - 2006 blip, funkyass, Matthew Kendora, Nach, nitsuja (c) Copyright 2009 - 2010 OV2 Mac OS GUI code (c) Copyright 1998 - 2001 John Stiles (c) Copyright 2001 - 2010 zones Specific ports contains the works of other authors. See headers in individual files. Snes9x homepage: http://www.snes9x.com/ Permission to use, copy, modify and/or distribute Snes9x in both binary and source form, for non-commercial purposes, is hereby granted without fee, providing that this license information and copyright notice appear with all copies and any derived work. This software is provided 'as-is', without any express or implied warranty. In no event shall the authors be held liable for any damages arising from the use of this software or it's derivatives. Snes9x is freeware for PERSONAL USE only. Commercial users should seek permission of the copyright holders first. Commercial use includes, but is not limited to, charging money for Snes9x or software derived from Snes9x, including Snes9x or derivatives in commercial game bundles, and/or using Snes9x as a promotion for your commercial product. The copyright holders request that bug fixes and improvements to the code should be forwarded to them so everyone can benefit from the modifications in future versions. Super NES and Super Nintendo Entertainment System are trademarks of Nintendo Co., Limited and its subsidiary companies. ***********************************************************************************/ /* Copyright (C) 1997-2006 ZSNES Team ( zsKnight, _Demo_, pagefault, Nach ) http://www.zsnes.com http://sourceforge.net/projects/zsnes This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License version 2 as published by the Free Software Foundation. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include "snes9x.h" #include "memmap.h" #ifdef DEBUGGER //#define DebugDSP1 #endif #ifdef DebugDSP1 #include <stdarg.h> static FILE *LogFile = NULL; #endif static const uint16 DSP1ROM[1024] = { 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0001, 0x0002, 0x0004, 0x0008, 0x0010, 0x0020, 0x0040, 0x0080, 0x0100, 0x0200, 0x0400, 0x0800, 0x1000, 0x2000, 0x4000, 0x7fff, 0x4000, 0x2000, 0x1000, 0x0800, 0x0400, 0x0200, 0x0100, 0x0080, 0x0040, 0x0020, 0x0001, 0x0008, 0x0004, 0x0002, 0x0001, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x8000, 0xffe5, 0x0100, 0x7fff, 0x7f02, 0x7e08, 0x7d12, 0x7c1f, 0x7b30, 0x7a45, 0x795d, 0x7878, 0x7797, 0x76ba, 0x75df, 0x7507, 0x7433, 0x7361, 0x7293, 0x71c7, 0x70fe, 0x7038, 0x6f75, 0x6eb4, 0x6df6, 0x6d3a, 0x6c81, 0x6bca, 0x6b16, 0x6a64, 0x69b4, 0x6907, 0x685b, 0x67b2, 0x670b, 0x6666, 0x65c4, 0x6523, 0x6484, 0x63e7, 0x634c, 0x62b3, 0x621c, 0x6186, 0x60f2, 0x6060, 0x5fd0, 0x5f41, 0x5eb5, 0x5e29, 0x5d9f, 0x5d17, 0x5c91, 0x5c0c, 0x5b88, 0x5b06, 0x5a85, 0x5a06, 0x5988, 0x590b, 0x5890, 0x5816, 0x579d, 0x5726, 0x56b0, 0x563b, 0x55c8, 0x5555, 0x54e4, 0x5474, 0x5405, 0x5398, 0x532b, 0x52bf, 0x5255, 0x51ec, 0x5183, 0x511c, 0x50b6, 0x5050, 0x4fec, 0x4f89, 0x4f26, 0x4ec5, 0x4e64, 0x4e05, 0x4da6, 0x4d48, 0x4cec, 0x4c90, 0x4c34, 0x4bda, 0x4b81, 0x4b28, 0x4ad0, 0x4a79, 0x4a23, 0x49cd, 0x4979, 0x4925, 0x48d1, 0x487f, 0x482d, 0x47dc, 0x478c, 0x473c, 0x46ed, 0x469f, 0x4651, 0x4604, 0x45b8, 0x456c, 0x4521, 0x44d7, 0x448d, 0x4444, 0x43fc, 0x43b4, 0x436d, 0x4326, 0x42e0, 0x429a, 0x4255, 0x4211, 0x41cd, 0x4189, 0x4146, 0x4104, 0x40c2, 0x4081, 0x4040, 0x3fff, 0x41f7, 0x43e1, 0x45bd, 0x478d, 0x4951, 0x4b0b, 0x4cbb, 0x4e61, 0x4fff, 0x5194, 0x5322, 0x54a9, 0x5628, 0x57a2, 0x5914, 0x5a81, 0x5be9, 0x5d4a, 0x5ea7, 0x5fff, 0x6152, 0x62a0, 0x63ea, 0x6530, 0x6672, 0x67b0, 0x68ea, 0x6a20, 0x6b53, 0x6c83, 0x6daf, 0x6ed9, 0x6fff, 0x7122, 0x7242, 0x735f, 0x747a, 0x7592, 0x76a7, 0x77ba, 0x78cb, 0x79d9, 0x7ae5, 0x7bee, 0x7cf5, 0x7dfa, 0x7efe, 0x7fff, 0x0000, 0x0324, 0x0647, 0x096a, 0x0c8b, 0x0fab, 0x12c8, 0x15e2, 0x18f8, 0x1c0b, 0x1f19, 0x2223, 0x2528, 0x2826, 0x2b1f, 0x2e11, 0x30fb, 0x33de, 0x36ba, 0x398c, 0x3c56, 0x3f17, 0x41ce, 0x447a, 0x471c, 0x49b4, 0x4c3f, 0x4ebf, 0x5133, 0x539b, 0x55f5, 0x5842, 0x5a82, 0x5cb4, 0x5ed7, 0x60ec, 0x62f2, 0x64e8, 0x66cf, 0x68a6, 0x6a6d, 0x6c24, 0x6dca, 0x6f5f, 0x70e2, 0x7255, 0x73b5, 0x7504, 0x7641, 0x776c, 0x7884, 0x798a, 0x7a7d, 0x7b5d, 0x7c29, 0x7ce3, 0x7d8a, 0x7e1d, 0x7e9d, 0x7f09, 0x7f62, 0x7fa7, 0x7fd8, 0x7ff6, 0x7fff, 0x7ff6, 0x7fd8, 0x7fa7, 0x7f62, 0x7f09, 0x7e9d, 0x7e1d, 0x7d8a, 0x7ce3, 0x7c29, 0x7b5d, 0x7a7d, 0x798a, 0x7884, 0x776c, 0x7641, 0x7504, 0x73b5, 0x7255, 0x70e2, 0x6f5f, 0x6dca, 0x6c24, 0x6a6d, 0x68a6, 0x66cf, 0x64e8, 0x62f2, 0x60ec, 0x5ed7, 0x5cb4, 0x5a82, 0x5842, 0x55f5, 0x539b, 0x5133, 0x4ebf, 0x4c3f, 0x49b4, 0x471c, 0x447a, 0x41ce, 0x3f17, 0x3c56, 0x398c, 0x36ba, 0x33de, 0x30fb, 0x2e11, 0x2b1f, 0x2826, 0x2528, 0x2223, 0x1f19, 0x1c0b, 0x18f8, 0x15e2, 0x12c8, 0x0fab, 0x0c8b, 0x096a, 0x0647, 0x0324, 0x7fff, 0x7ff6, 0x7fd8, 0x7fa7, 0x7f62, 0x7f09, 0x7e9d, 0x7e1d, 0x7d8a, 0x7ce3, 0x7c29, 0x7b5d, 0x7a7d, 0x798a, 0x7884, 0x776c, 0x7641, 0x7504, 0x73b5, 0x7255, 0x70e2, 0x6f5f, 0x6dca, 0x6c24, 0x6a6d, 0x68a6, 0x66cf, 0x64e8, 0x62f2, 0x60ec, 0x5ed7, 0x5cb4, 0x5a82, 0x5842, 0x55f5, 0x539b, 0x5133, 0x4ebf, 0x4c3f, 0x49b4, 0x471c, 0x447a, 0x41ce, 0x3f17, 0x3c56, 0x398c, 0x36ba, 0x33de, 0x30fb, 0x2e11, 0x2b1f, 0x2826, 0x2528, 0x2223, 0x1f19, 0x1c0b, 0x18f8, 0x15e2, 0x12c8, 0x0fab, 0x0c8b, 0x096a, 0x0647, 0x0324, 0x0000, 0xfcdc, 0xf9b9, 0xf696, 0xf375, 0xf055, 0xed38, 0xea1e, 0xe708, 0xe3f5, 0xe0e7, 0xdddd, 0xdad8, 0xd7da, 0xd4e1, 0xd1ef, 0xcf05, 0xcc22, 0xc946, 0xc674, 0xc3aa, 0xc0e9, 0xbe32, 0xbb86, 0xb8e4, 0xb64c, 0xb3c1, 0xb141, 0xaecd, 0xac65, 0xaa0b, 0xa7be, 0xa57e, 0xa34c, 0xa129, 0x9f14, 0x9d0e, 0x9b18, 0x9931, 0x975a, 0x9593, 0x93dc, 0x9236, 0x90a1, 0x8f1e, 0x8dab, 0x8c4b, 0x8afc, 0x89bf, 0x8894, 0x877c, 0x8676, 0x8583, 0x84a3, 0x83d7, 0x831d, 0x8276, 0x81e3, 0x8163, 0x80f7, 0x809e, 0x8059, 0x8028, 0x800a, 0x6488, 0x0080, 0x03ff, 0x0116, 0x0002, 0x0080, 0x4000, 0x3fd7, 0x3faf, 0x3f86, 0x3f5d, 0x3f34, 0x3f0c, 0x3ee3, 0x3eba, 0x3e91, 0x3e68, 0x3e40, 0x3e17, 0x3dee, 0x3dc5, 0x3d9c, 0x3d74, 0x3d4b, 0x3d22, 0x3cf9, 0x3cd0, 0x3ca7, 0x3c7f, 0x3c56, 0x3c2d, 0x3c04, 0x3bdb, 0x3bb2, 0x3b89, 0x3b60, 0x3b37, 0x3b0e, 0x3ae5, 0x3abc, 0x3a93, 0x3a69, 0x3a40, 0x3a17, 0x39ee, 0x39c5, 0x399c, 0x3972, 0x3949, 0x3920, 0x38f6, 0x38cd, 0x38a4, 0x387a, 0x3851, 0x3827, 0x37fe, 0x37d4, 0x37aa, 0x3781, 0x3757, 0x372d, 0x3704, 0x36da, 0x36b0, 0x3686, 0x365c, 0x3632, 0x3609, 0x35df, 0x35b4, 0x358a, 0x3560, 0x3536, 0x350c, 0x34e1, 0x34b7, 0x348d, 0x3462, 0x3438, 0x340d, 0x33e3, 0x33b8, 0x338d, 0x3363, 0x3338, 0x330d, 0x32e2, 0x32b7, 0x328c, 0x3261, 0x3236, 0x320b, 0x31df, 0x31b4, 0x3188, 0x315d, 0x3131, 0x3106, 0x30da, 0x30ae, 0x3083, 0x3057, 0x302b, 0x2fff, 0x2fd2, 0x2fa6, 0x2f7a, 0x2f4d, 0x2f21, 0x2ef4, 0x2ec8, 0x2e9b, 0x2e6e, 0x2e41, 0x2e14, 0x2de7, 0x2dba, 0x2d8d, 0x2d60, 0x2d32, 0x2d05, 0x2cd7, 0x2ca9, 0x2c7b, 0x2c4d, 0x2c1f, 0x2bf1, 0x2bc3, 0x2b94, 0x2b66, 0x2b37, 0x2b09, 0x2ada, 0x2aab, 0x2a7c, 0x2a4c, 0x2a1d, 0x29ed, 0x29be, 0x298e, 0x295e, 0x292e, 0x28fe, 0x28ce, 0x289d, 0x286d, 0x283c, 0x280b, 0x27da, 0x27a9, 0x2777, 0x2746, 0x2714, 0x26e2, 0x26b0, 0x267e, 0x264c, 0x2619, 0x25e7, 0x25b4, 0x2581, 0x254d, 0x251a, 0x24e6, 0x24b2, 0x247e, 0x244a, 0x2415, 0x23e1, 0x23ac, 0x2376, 0x2341, 0x230b, 0x22d6, 0x229f, 0x2269, 0x2232, 0x21fc, 0x21c4, 0x218d, 0x2155, 0x211d, 0x20e5, 0x20ad, 0x2074, 0x203b, 0x2001, 0x1fc7, 0x1f8d, 0x1f53, 0x1f18, 0x1edd, 0x1ea1, 0x1e66, 0x1e29, 0x1ded, 0x1db0, 0x1d72, 0x1d35, 0x1cf6, 0x1cb8, 0x1c79, 0x1c39, 0x1bf9, 0x1bb8, 0x1b77, 0x1b36, 0x1af4, 0x1ab1, 0x1a6e, 0x1a2a, 0x19e6, 0x19a1, 0x195c, 0x1915, 0x18ce, 0x1887, 0x183f, 0x17f5, 0x17ac, 0x1761, 0x1715, 0x16c9, 0x167c, 0x162e, 0x15df, 0x158e, 0x153d, 0x14eb, 0x1497, 0x1442, 0x13ec, 0x1395, 0x133c, 0x12e2, 0x1286, 0x1228, 0x11c9, 0x1167, 0x1104, 0x109e, 0x1036, 0x0fcc, 0x0f5f, 0x0eef, 0x0e7b, 0x0e04, 0x0d89, 0x0d0a, 0x0c86, 0x0bfd, 0x0b6d, 0x0ad6, 0x0a36, 0x098d, 0x08d7, 0x0811, 0x0736, 0x063e, 0x0519, 0x039a, 0x0000, 0x7fff, 0x0100, 0x0080, 0x021d, 0x00c8, 0x00ce, 0x0048, 0x0a26, 0x277a, 0x00ce, 0x6488, 0x14ac, 0x0001, 0x00f9, 0x00fc, 0x00ff, 0x00fc, 0x00f9, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff }; static const int16 DSP1_MulTable[256] = { 0x0000, 0x0003, 0x0006, 0x0009, 0x000c, 0x000f, 0x0012, 0x0015, 0x0019, 0x001c, 0x001f, 0x0022, 0x0025, 0x0028, 0x002b, 0x002f, 0x0032, 0x0035, 0x0038, 0x003b, 0x003e, 0x0041, 0x0045, 0x0048, 0x004b, 0x004e, 0x0051, 0x0054, 0x0057, 0x005b, 0x005e, 0x0061, 0x0064, 0x0067, 0x006a, 0x006d, 0x0071, 0x0074, 0x0077, 0x007a, 0x007d, 0x0080, 0x0083, 0x0087, 0x008a, 0x008d, 0x0090, 0x0093, 0x0096, 0x0099, 0x009d, 0x00a0, 0x00a3, 0x00a6, 0x00a9, 0x00ac, 0x00af, 0x00b3, 0x00b6, 0x00b9, 0x00bc, 0x00bf, 0x00c2, 0x00c5, 0x00c9, 0x00cc, 0x00cf, 0x00d2, 0x00d5, 0x00d8, 0x00db, 0x00df, 0x00e2, 0x00e5, 0x00e8, 0x00eb, 0x00ee, 0x00f1, 0x00f5, 0x00f8, 0x00fb, 0x00fe, 0x0101, 0x0104, 0x0107, 0x010b, 0x010e, 0x0111, 0x0114, 0x0117, 0x011a, 0x011d, 0x0121, 0x0124, 0x0127, 0x012a, 0x012d, 0x0130, 0x0133, 0x0137, 0x013a, 0x013d, 0x0140, 0x0143, 0x0146, 0x0149, 0x014d, 0x0150, 0x0153, 0x0156, 0x0159, 0x015c, 0x015f, 0x0163, 0x0166, 0x0169, 0x016c, 0x016f, 0x0172, 0x0175, 0x0178, 0x017c, 0x017f, 0x0182, 0x0185, 0x0188, 0x018b, 0x018e, 0x0192, 0x0195, 0x0198, 0x019b, 0x019e, 0x01a1, 0x01a4, 0x01a8, 0x01ab, 0x01ae, 0x01b1, 0x01b4, 0x01b7, 0x01ba, 0x01be, 0x01c1, 0x01c4, 0x01c7, 0x01ca, 0x01cd, 0x01d0, 0x01d4, 0x01d7, 0x01da, 0x01dd, 0x01e0, 0x01e3, 0x01e6, 0x01ea, 0x01ed, 0x01f0, 0x01f3, 0x01f6, 0x01f9, 0x01fc, 0x0200, 0x0203, 0x0206, 0x0209, 0x020c, 0x020f, 0x0212, 0x0216, 0x0219, 0x021c, 0x021f, 0x0222, 0x0225, 0x0228, 0x022c, 0x022f, 0x0232, 0x0235, 0x0238, 0x023b, 0x023e, 0x0242, 0x0245, 0x0248, 0x024b, 0x024e, 0x0251, 0x0254, 0x0258, 0x025b, 0x025e, 0x0261, 0x0264, 0x0267, 0x026a, 0x026e, 0x0271, 0x0274, 0x0277, 0x027a, 0x027d, 0x0280, 0x0284, 0x0287, 0x028a, 0x028d, 0x0290, 0x0293, 0x0296, 0x029a, 0x029d, 0x02a0, 0x02a3, 0x02a6, 0x02a9, 0x02ac, 0x02b0, 0x02b3, 0x02b6, 0x02b9, 0x02bc, 0x02bf, 0x02c2, 0x02c6, 0x02c9, 0x02cc, 0x02cf, 0x02d2, 0x02d5, 0x02d8, 0x02db, 0x02df, 0x02e2, 0x02e5, 0x02e8, 0x02eb, 0x02ee, 0x02f1, 0x02f5, 0x02f8, 0x02fb, 0x02fe, 0x0301, 0x0304, 0x0307, 0x030b, 0x030e, 0x0311, 0x0314, 0x0317, 0x031a, 0x031d, 0x0321 }; static const int16 DSP1_SinTable[256] = { 0x0000, 0x0324, 0x0647, 0x096a, 0x0c8b, 0x0fab, 0x12c8, 0x15e2, 0x18f8, 0x1c0b, 0x1f19, 0x2223, 0x2528, 0x2826, 0x2b1f, 0x2e11, 0x30fb, 0x33de, 0x36ba, 0x398c, 0x3c56, 0x3f17, 0x41ce, 0x447a, 0x471c, 0x49b4, 0x4c3f, 0x4ebf, 0x5133, 0x539b, 0x55f5, 0x5842, 0x5a82, 0x5cb4, 0x5ed7, 0x60ec, 0x62f2, 0x64e8, 0x66cf, 0x68a6, 0x6a6d, 0x6c24, 0x6dca, 0x6f5f, 0x70e2, 0x7255, 0x73b5, 0x7504, 0x7641, 0x776c, 0x7884, 0x798a, 0x7a7d, 0x7b5d, 0x7c29, 0x7ce3, 0x7d8a, 0x7e1d, 0x7e9d, 0x7f09, 0x7f62, 0x7fa7, 0x7fd8, 0x7ff6, 0x7fff, 0x7ff6, 0x7fd8, 0x7fa7, 0x7f62, 0x7f09, 0x7e9d, 0x7e1d, 0x7d8a, 0x7ce3, 0x7c29, 0x7b5d, 0x7a7d, 0x798a, 0x7884, 0x776c, 0x7641, 0x7504, 0x73b5, 0x7255, 0x70e2, 0x6f5f, 0x6dca, 0x6c24, 0x6a6d, 0x68a6, 0x66cf, 0x64e8, 0x62f2, 0x60ec, 0x5ed7, 0x5cb4, 0x5a82, 0x5842, 0x55f5, 0x539b, 0x5133, 0x4ebf, 0x4c3f, 0x49b4, 0x471c, 0x447a, 0x41ce, 0x3f17, 0x3c56, 0x398c, 0x36ba, 0x33de, 0x30fb, 0x2e11, 0x2b1f, 0x2826, 0x2528, 0x2223, 0x1f19, 0x1c0b, 0x18f8, 0x15e2, 0x12c8, 0x0fab, 0x0c8b, 0x096a, 0x0647, 0x0324, -0x0000, -0x0324, -0x0647, -0x096a, -0x0c8b, -0x0fab, -0x12c8, -0x15e2, -0x18f8, -0x1c0b, -0x1f19, -0x2223, -0x2528, -0x2826, -0x2b1f, -0x2e11, -0x30fb, -0x33de, -0x36ba, -0x398c, -0x3c56, -0x3f17, -0x41ce, -0x447a, -0x471c, -0x49b4, -0x4c3f, -0x4ebf, -0x5133, -0x539b, -0x55f5, -0x5842, -0x5a82, -0x5cb4, -0x5ed7, -0x60ec, -0x62f2, -0x64e8, -0x66cf, -0x68a6, -0x6a6d, -0x6c24, -0x6dca, -0x6f5f, -0x70e2, -0x7255, -0x73b5, -0x7504, -0x7641, -0x776c, -0x7884, -0x798a, -0x7a7d, -0x7b5d, -0x7c29, -0x7ce3, -0x7d8a, -0x7e1d, -0x7e9d, -0x7f09, -0x7f62, -0x7fa7, -0x7fd8, -0x7ff6, -0x7fff, -0x7ff6, -0x7fd8, -0x7fa7, -0x7f62, -0x7f09, -0x7e9d, -0x7e1d, -0x7d8a, -0x7ce3, -0x7c29, -0x7b5d, -0x7a7d, -0x798a, -0x7884, -0x776c, -0x7641, -0x7504, -0x73b5, -0x7255, -0x70e2, -0x6f5f, -0x6dca, -0x6c24, -0x6a6d, -0x68a6, -0x66cf, -0x64e8, -0x62f2, -0x60ec, -0x5ed7, -0x5cb4, -0x5a82, -0x5842, -0x55f5, -0x539b, -0x5133, -0x4ebf, -0x4c3f, -0x49b4, -0x471c, -0x447a, -0x41ce, -0x3f17, -0x3c56, -0x398c, -0x36ba, -0x33de, -0x30fb, -0x2e11, -0x2b1f, -0x2826, -0x2528, -0x2223, -0x1f19, -0x1c0b, -0x18f8, -0x15e2, -0x12c8, -0x0fab, -0x0c8b, -0x096a, -0x0647, -0x0324 }; #ifdef DebugDSP1 static void Log_Message (const char *Message, ...) { char Msg[400]; va_list ap; size_t ignore; va_start(ap, Message); vsprintf(Msg, Message, ap); va_end(ap); strcat(Msg, "\r\n\0"); ignore = fwrite(Msg, strlen(Msg), 1, LogFile); fflush(LogFile); } static void Start_Log (void) { LogFile = fopen("dsp1emu.log", "wb"); } static void Stop_Log (void) { if (LogFile) { fclose(LogFile); LogFile = NULL; } } #endif static void DSP1_Op00 (void) { DSP1.Op00Result = DSP1.Op00Multiplicand * DSP1.Op00Multiplier >> 15; #ifdef DebugDSP1 Log_Message("OP00 MULT %d*%d/32768=%d", DSP1.Op00Multiplicand, DSP1.Op00Multiplier, DSP1.Op00Result); #endif } static void DSP1_Op20 (void) { DSP1.Op20Result = DSP1.Op20Multiplicand * DSP1.Op20Multiplier >> 15; DSP1.Op20Result++; #ifdef DebugDSP1 Log_Message("OP20 MULT %d*%d/32768=%d", DSP1.Op20Multiplicand, DSP1.Op20Multiplier, DSP1.Op20Result); #endif } static void DSP1_Inverse (int16 Coefficient, int16 Exponent, int16 *iCoefficient, int16 *iExponent) { // Step One: Division by Zero if (Coefficient == 0x0000) { *iCoefficient = 0x7fff; *iExponent = 0x002f; } else { int16 Sign = 1; // Step Two: Remove Sign if (Coefficient < 0) { if (Coefficient < -32767) Coefficient = -32767; Coefficient = -Coefficient; Sign = -1; } // Step Three: Normalize while (Coefficient < 0x4000) { Coefficient <<= 1; Exponent--; } // Step Four: Special Case if (Coefficient == 0x4000) { if (Sign == 1) *iCoefficient = 0x7fff; else { *iCoefficient = -0x4000; Exponent--; } } else { // Step Five: Initial Guess int16 i = DSP1ROM[((Coefficient - 0x4000) >> 7) + 0x0065]; // Step Six: Iterate "estimated" Newton's Method i = (i + (-i * (Coefficient * i >> 15) >> 15)) << 1; i = (i + (-i * (Coefficient * i >> 15) >> 15)) << 1; *iCoefficient = i * Sign; } *iExponent = 1 - Exponent; } } static void DSP1_Op10 (void) { DSP1_Inverse(DSP1.Op10Coefficient, DSP1.Op10Exponent, &DSP1.Op10CoefficientR, &DSP1.Op10ExponentR); #ifdef DebugDSP1 Log_Message("OP10 INV %d*2^%d = %d*2^%d", DSP1.Op10Coefficient, DSP1.Op10Exponent, DSP1.Op10CoefficientR, DSP1.Op10ExponentR); #endif } static int16 DSP1_Sin (int16 Angle) { int32 S; if (Angle < 0) { if (Angle == -32768) return (0); return (-DSP1_Sin(-Angle)); } S = DSP1_SinTable[Angle >> 8] + (DSP1_MulTable[Angle & 0xff] * DSP1_SinTable[0x40 + (Angle >> 8)] >> 15); if (S > 32767) S = 32767; return ((int16) S); } static int16 DSP1_Cos (int16 Angle) { int32 S; if (Angle < 0) { if (Angle == -32768) return (-32768); Angle = -Angle; } S = DSP1_SinTable[0x40 + (Angle >> 8)] - (DSP1_MulTable[Angle & 0xff] * DSP1_SinTable[Angle >> 8] >> 15); if (S < -32768) S = -32767; return ((int16) S); } static void DSP1_Normalize (int16 m, int16 *Coefficient, int16 *Exponent) { int16 i = 0x4000; int16 e = 0; if (m < 0) { while ((m & i) && i) { i >>= 1; e++; } } else { while (!(m & i) && i) { i >>= 1; e++; } } if (e > 0) *Coefficient = m * DSP1ROM[0x21 + e] << 1; else *Coefficient = m; *Exponent -= e; } static void DSP1_NormalizeDouble (int32 Product, int16 *Coefficient, int16 *Exponent) { int16 n = Product & 0x7fff; int16 m = Product >> 15; int16 i = 0x4000; int16 e = 0; if (m < 0) { while ((m & i) && i) { i >>= 1; e++; } } else { while (!(m & i) && i) { i >>= 1; e++; } } if (e > 0) { *Coefficient = m * DSP1ROM[0x0021 + e] << 1; if (e < 15) *Coefficient += n * DSP1ROM[0x0040 - e] >> 15; else { i = 0x4000; if (m < 0) { while ((n & i) && i) { i >>= 1; e++; } } else { while (!(n & i) && i) { i >>= 1; e++; } } if (e > 15) *Coefficient = n * DSP1ROM[0x0012 + e] << 1; else *Coefficient += n; } } else *Coefficient = m; *Exponent = e; } static int16 DSP1_Truncate (int16 C, int16 E) { if (E > 0) { if (C > 0) return (32767); else if (C < 0) return (-32767); } else { if (E < 0) return (C * DSP1ROM[0x0031 + E] >> 15); } return (C); } static void DSP1_Op04 (void) { DSP1.Op04Sin = DSP1_Sin(DSP1.Op04Angle) * DSP1.Op04Radius >> 15; DSP1.Op04Cos = DSP1_Cos(DSP1.Op04Angle) * DSP1.Op04Radius >> 15; } static void DSP1_Op0C (void) { DSP1.Op0CX2 = (DSP1.Op0CY1 * DSP1_Sin(DSP1.Op0CA) >> 15) + (DSP1.Op0CX1 * DSP1_Cos(DSP1.Op0CA) >> 15); DSP1.Op0CY2 = (DSP1.Op0CY1 * DSP1_Cos(DSP1.Op0CA) >> 15) - (DSP1.Op0CX1 * DSP1_Sin(DSP1.Op0CA) >> 15); } static void DSP1_Parameter (int16 Fx, int16 Fy, int16 Fz, int16 Lfe, int16 Les, int16 Aas, int16 Azs, int16 *Vof, int16 *Vva, int16 *Cx, int16 *Cy) { const int16 MaxAZS_Exp[16] = { 0x38b4, 0x38b7, 0x38ba, 0x38be, 0x38c0, 0x38c4, 0x38c7, 0x38ca, 0x38ce, 0x38d0, 0x38d4, 0x38d7, 0x38da, 0x38dd, 0x38e0, 0x38e4 }; int16 CSec, C, E, MaxAZS, Aux; int16 LfeNx, LfeNy, LfeNz; int16 LesNx, LesNy, LesNz; int16 CentreZ; // Copy Zenith angle for clipping int16 AZS = Azs; // Store Sine and Cosine of Azimuth and Zenith angle DSP1.SinAas = DSP1_Sin(Aas); DSP1.CosAas = DSP1_Cos(Aas); DSP1.SinAzs = DSP1_Sin(Azs); DSP1.CosAzs = DSP1_Cos(Azs); DSP1.Nx = DSP1.SinAzs * -DSP1.SinAas >> 15; DSP1.Ny = DSP1.SinAzs * DSP1.CosAas >> 15; DSP1.Nz = DSP1.CosAzs * 0x7fff >> 15; LfeNx = Lfe * DSP1.Nx >> 15; LfeNy = Lfe * DSP1.Ny >> 15; LfeNz = Lfe * DSP1.Nz >> 15; // Center of Projection DSP1.CentreX = Fx + LfeNx; DSP1.CentreY = Fy + LfeNy; CentreZ = Fz + LfeNz; LesNx = Les * DSP1.Nx >> 15; LesNy = Les * DSP1.Ny >> 15; LesNz = Les * DSP1.Nz >> 15; DSP1.Gx = DSP1.CentreX - LesNx; DSP1.Gy = DSP1.CentreY - LesNy; DSP1.Gz = CentreZ - LesNz; DSP1.E_Les = 0; DSP1_Normalize(Les, &DSP1.C_Les, &DSP1.E_Les); DSP1.G_Les = Les; E = 0; DSP1_Normalize(CentreZ, &C, &E); DSP1.VPlane_C = C; DSP1.VPlane_E = E; // Determine clip boundary and clip Zenith angle if necessary MaxAZS = MaxAZS_Exp[-E]; if (AZS < 0) { MaxAZS = -MaxAZS; if (AZS < MaxAZS + 1) AZS = MaxAZS + 1; } else { if (AZS > MaxAZS) AZS = MaxAZS; } // Store Sine and Cosine of clipped Zenith angle DSP1.SinAZS = DSP1_Sin(AZS); DSP1.CosAZS = DSP1_Cos(AZS); DSP1_Inverse(DSP1.CosAZS, 0, &DSP1.SecAZS_C1, &DSP1.SecAZS_E1); DSP1_Normalize(C * DSP1.SecAZS_C1 >> 15, &C, &E); E += DSP1.SecAZS_E1; C = DSP1_Truncate(C, E) * DSP1.SinAZS >> 15; DSP1.CentreX += C * DSP1.SinAas >> 15; DSP1.CentreY -= C * DSP1.CosAas >> 15; *Cx = DSP1.CentreX; *Cy = DSP1.CentreY; // Raster number of imaginary center and horizontal line *Vof = 0; if ((Azs != AZS) || (Azs == MaxAZS)) { if (Azs == -32768) Azs = -32767; C = Azs - MaxAZS; if (C >= 0) C--; Aux = ~(C << 2); C = Aux * DSP1ROM[0x0328] >> 15; C = (C * Aux >> 15) + DSP1ROM[0x0327]; *Vof -= (C * Aux >> 15) * Les >> 15; C = Aux * Aux >> 15; Aux = (C * DSP1ROM[0x0324] >> 15) + DSP1ROM[0x0325]; DSP1.CosAZS += (C * Aux >> 15) * DSP1.CosAZS >> 15; } DSP1.VOffset = Les * DSP1.CosAZS >> 15; DSP1_Inverse(DSP1.SinAZS, 0, &CSec, &E); DSP1_Normalize(DSP1.VOffset, &C, &E); DSP1_Normalize(C * CSec >> 15, &C, &E); if (C == -32768) { C >>= 1; E++; } *Vva = DSP1_Truncate(-C, E); // Store Secant of clipped Zenith angle DSP1_Inverse(DSP1.CosAZS, 0, &DSP1.SecAZS_C2, &DSP1.SecAZS_E2); } static void DSP1_Raster (int16 Vs, int16 *An, int16 *Bn, int16 *Cn, int16 *Dn) { int16 C, E, C1, E1; DSP1_Inverse((Vs * DSP1.SinAzs >> 15) + DSP1.VOffset, 7, &C, &E); E += DSP1.VPlane_E; C1 = C * DSP1.VPlane_C >> 15; E1 = E + DSP1.SecAZS_E2; DSP1_Normalize(C1, &C, &E); C = DSP1_Truncate(C, E); *An = C * DSP1.CosAas >> 15; *Cn = C * DSP1.SinAas >> 15; DSP1_Normalize(C1 * DSP1.SecAZS_C2 >> 15, &C, &E1); C = DSP1_Truncate(C, E1); *Bn = C * -DSP1.SinAas >> 15; *Dn = C * DSP1.CosAas >> 15; } static void DSP1_Op02 (void) { DSP1_Parameter(DSP1.Op02FX, DSP1.Op02FY, DSP1.Op02FZ, DSP1.Op02LFE, DSP1.Op02LES, DSP1.Op02AAS, DSP1.Op02AZS, &DSP1.Op02VOF, &DSP1.Op02VVA, &DSP1.Op02CX, &DSP1.Op02CY); } static void DSP1_Op0A (void) { DSP1_Raster(DSP1.Op0AVS, &DSP1.Op0AA, &DSP1.Op0AB, &DSP1.Op0AC, &DSP1.Op0AD); DSP1.Op0AVS++; } static int16 DSP1_ShiftR (int16 C, int16 E) { return (C * DSP1ROM[0x0031 + E] >> 15); } static void DSP1_Project (int16 X, int16 Y, int16 Z, int16 *H, int16 *V, int16 *M) { int32 aux, aux4; int16 E, E2, E3, E4, E5, refE, E6, E7; int16 C2, C4, C6, C8, C9, C10, C11, C12, C16, C17, C18, C19, C20, C21, C22, C23, C24, C25, C26; int16 Px, Py, Pz; E4 = E3 = E2 = E = E5 = 0; DSP1_NormalizeDouble((int32) X - DSP1.Gx, &Px, &E4); DSP1_NormalizeDouble((int32) Y - DSP1.Gy, &Py, &E ); DSP1_NormalizeDouble((int32) Z - DSP1.Gz, &Pz, &E3); Px >>= 1; // to avoid overflows when calculating the scalar products E4--; Py >>= 1; E--; Pz >>= 1; E3--; refE = (E < E3) ? E : E3; refE = (refE < E4) ? refE : E4; Px = DSP1_ShiftR(Px, E4 - refE); // normalize them to the same exponent Py = DSP1_ShiftR(Py, E - refE); Pz = DSP1_ShiftR(Pz, E3 - refE); C11 =- (Px * DSP1.Nx >> 15); C8 =- (Py * DSP1.Ny >> 15); C9 =- (Pz * DSP1.Nz >> 15); C12 = C11 + C8 + C9; // this cannot overflow! aux4 = C12; // de-normalization with 32-bits arithmetic refE = 16 - refE; // refE can be up to 3 if (refE >= 0) aux4 <<= (refE); else aux4 >>= -(refE); if (aux4 == -1) aux4 = 0; // why? aux4 >>= 1; aux = ((uint16) DSP1.G_Les) + aux4; // Les - the scalar product of P with the normal vector of the screen DSP1_NormalizeDouble(aux, &C10, &E2); E2 = 15 - E2; DSP1_Inverse(C10, 0, &C4, &E4); C2 = C4 * DSP1.C_Les >> 15; // scale factor // H E7 = 0; C16 = Px * ( DSP1.CosAas * 0x7fff >> 15) >> 15; C20 = Py * ( DSP1.SinAas * 0x7fff >> 15) >> 15; C17 = C16 + C20; // scalar product of P with the normalized horizontal vector of the screen... C18 = C17 * C2 >> 15; // ... multiplied by the scale factor DSP1_Normalize(C18, &C19, &E7); *H = DSP1_Truncate(C19, DSP1.E_Les - E2 + refE + E7); // V E6 = 0; C21 = Px * ( DSP1.CosAzs * -DSP1.SinAas >> 15) >> 15; C22 = Py * ( DSP1.CosAzs * DSP1.CosAas >> 15) >> 15; C23 = Pz * (-DSP1.SinAzs * 0x7fff >> 15) >> 15; C24 = C21 + C22 + C23; // scalar product of P with the normalized vertical vector of the screen... C26 = C24 * C2 >> 15; // ... multiplied by the scale factor DSP1_Normalize(C26, &C25, &E6); *V = DSP1_Truncate(C25, DSP1.E_Les - E2 + refE + E6); // M DSP1_Normalize(C2, &C6, &E4); *M = DSP1_Truncate(C6, E4 + DSP1.E_Les - E2 - 7); // M is the scale factor divided by 2^7 } static void DSP1_Op06 (void) { DSP1_Project(DSP1.Op06X, DSP1.Op06Y, DSP1.Op06Z, &DSP1.Op06H, &DSP1.Op06V, &DSP1.Op06M); } static void DSP1_Op01 (void) { int16 SinAz = DSP1_Sin(DSP1.Op01Zr); int16 CosAz = DSP1_Cos(DSP1.Op01Zr); int16 SinAy = DSP1_Sin(DSP1.Op01Yr); int16 CosAy = DSP1_Cos(DSP1.Op01Yr); int16 SinAx = DSP1_Sin(DSP1.Op01Xr); int16 CosAx = DSP1_Cos(DSP1.Op01Xr); DSP1.Op01m >>= 1; DSP1.matrixA[0][0] = (DSP1.Op01m * CosAz >> 15) * CosAy >> 15; DSP1.matrixA[0][1] = -((DSP1.Op01m * SinAz >> 15) * CosAy >> 15); DSP1.matrixA[0][2] = DSP1.Op01m * SinAy >> 15; DSP1.matrixA[1][0] = ((DSP1.Op01m * SinAz >> 15) * CosAx >> 15) + (((DSP1.Op01m * CosAz >> 15) * SinAx >> 15) * SinAy >> 15); DSP1.matrixA[1][1] = ((DSP1.Op01m * CosAz >> 15) * CosAx >> 15) - (((DSP1.Op01m * SinAz >> 15) * SinAx >> 15) * SinAy >> 15); DSP1.matrixA[1][2] = -((DSP1.Op01m * SinAx >> 15) * CosAy >> 15); DSP1.matrixA[2][0] = ((DSP1.Op01m * SinAz >> 15) * SinAx >> 15) - (((DSP1.Op01m * CosAz >> 15) * CosAx >> 15) * SinAy >> 15); DSP1.matrixA[2][1] = ((DSP1.Op01m * CosAz >> 15) * SinAx >> 15) + (((DSP1.Op01m * SinAz >> 15) * CosAx >> 15) * SinAy >> 15); DSP1.matrixA[2][2] = (DSP1.Op01m * CosAx >> 15) * CosAy >> 15; } static void DSP1_Op11 (void) { int16 SinAz = DSP1_Sin(DSP1.Op11Zr); int16 CosAz = DSP1_Cos(DSP1.Op11Zr); int16 SinAy = DSP1_Sin(DSP1.Op11Yr); int16 CosAy = DSP1_Cos(DSP1.Op11Yr); int16 SinAx = DSP1_Sin(DSP1.Op11Xr); int16 CosAx = DSP1_Cos(DSP1.Op11Xr); DSP1.Op11m >>= 1; DSP1.matrixB[0][0] = (DSP1.Op11m * CosAz >> 15) * CosAy >> 15; DSP1.matrixB[0][1] = -((DSP1.Op11m * SinAz >> 15) * CosAy >> 15); DSP1.matrixB[0][2] = DSP1.Op11m * SinAy >> 15; DSP1.matrixB[1][0] = ((DSP1.Op11m * SinAz >> 15) * CosAx >> 15) + (((DSP1.Op11m * CosAz >> 15) * SinAx >> 15) * SinAy >> 15); DSP1.matrixB[1][1] = ((DSP1.Op11m * CosAz >> 15) * CosAx >> 15) - (((DSP1.Op11m * SinAz >> 15) * SinAx >> 15) * SinAy >> 15); DSP1.matrixB[1][2] = -((DSP1.Op11m * SinAx >> 15) * CosAy >> 15); DSP1.matrixB[2][0] = ((DSP1.Op11m * SinAz >> 15) * SinAx >> 15) - (((DSP1.Op11m * CosAz >> 15) * CosAx >> 15) * SinAy >> 15); DSP1.matrixB[2][1] = ((DSP1.Op11m * CosAz >> 15) * SinAx >> 15) + (((DSP1.Op11m * SinAz >> 15) * CosAx >> 15) * SinAy >> 15); DSP1.matrixB[2][2] = (DSP1.Op11m * CosAx >> 15) * CosAy >> 15; } static void DSP1_Op21 (void) { int16 SinAz = DSP1_Sin(DSP1.Op21Zr); int16 CosAz = DSP1_Cos(DSP1.Op21Zr); int16 SinAy = DSP1_Sin(DSP1.Op21Yr); int16 CosAy = DSP1_Cos(DSP1.Op21Yr); int16 SinAx = DSP1_Sin(DSP1.Op21Xr); int16 CosAx = DSP1_Cos(DSP1.Op21Xr); DSP1.Op21m >>= 1; DSP1.matrixC[0][0] = (DSP1.Op21m * CosAz >> 15) * CosAy >> 15; DSP1.matrixC[0][1] = -((DSP1.Op21m * SinAz >> 15) * CosAy >> 15); DSP1.matrixC[0][2] = DSP1.Op21m * SinAy >> 15; DSP1.matrixC[1][0] = ((DSP1.Op21m * SinAz >> 15) * CosAx >> 15) + (((DSP1.Op21m * CosAz >> 15) * SinAx >> 15) * SinAy >> 15); DSP1.matrixC[1][1] = ((DSP1.Op21m * CosAz >> 15) * CosAx >> 15) - (((DSP1.Op21m * SinAz >> 15) * SinAx >> 15) * SinAy >> 15); DSP1.matrixC[1][2] = -((DSP1.Op21m * SinAx >> 15) * CosAy >> 15); DSP1.matrixC[2][0] = ((DSP1.Op21m * SinAz >> 15) * SinAx >> 15) - (((DSP1.Op21m * CosAz >> 15) * CosAx >> 15) * SinAy >> 15); DSP1.matrixC[2][1] = ((DSP1.Op21m * CosAz >> 15) * SinAx >> 15) + (((DSP1.Op21m * SinAz >> 15) * CosAx >> 15) * SinAy >> 15); DSP1.matrixC[2][2] = (DSP1.Op21m * CosAx >> 15) * CosAy >> 15; } static void DSP1_Op0D (void) { DSP1.Op0DF = (DSP1.Op0DX * DSP1.matrixA[0][0] >> 15) + (DSP1.Op0DY * DSP1.matrixA[0][1] >> 15) + (DSP1.Op0DZ * DSP1.matrixA[0][2] >> 15); DSP1.Op0DL = (DSP1.Op0DX * DSP1.matrixA[1][0] >> 15) + (DSP1.Op0DY * DSP1.matrixA[1][1] >> 15) + (DSP1.Op0DZ * DSP1.matrixA[1][2] >> 15); DSP1.Op0DU = (DSP1.Op0DX * DSP1.matrixA[2][0] >> 15) + (DSP1.Op0DY * DSP1.matrixA[2][1] >> 15) + (DSP1.Op0DZ * DSP1.matrixA[2][2] >> 15); #ifdef DebugDSP1 Log_Message("OP0D X: %d Y: %d Z: %d / F: %d L: %d U: %d", DSP1.Op0DX, DSP1.Op0DY, DSP1.Op0DZ, DSP1.Op0DF, DSP1.Op0DL, DSP1.Op0DU); #endif } static void DSP1_Op1D (void) { DSP1.Op1DF = (DSP1.Op1DX * DSP1.matrixB[0][0] >> 15) + (DSP1.Op1DY * DSP1.matrixB[0][1] >> 15) + (DSP1.Op1DZ * DSP1.matrixB[0][2] >> 15); DSP1.Op1DL = (DSP1.Op1DX * DSP1.matrixB[1][0] >> 15) + (DSP1.Op1DY * DSP1.matrixB[1][1] >> 15) + (DSP1.Op1DZ * DSP1.matrixB[1][2] >> 15); DSP1.Op1DU = (DSP1.Op1DX * DSP1.matrixB[2][0] >> 15) + (DSP1.Op1DY * DSP1.matrixB[2][1] >> 15) + (DSP1.Op1DZ * DSP1.matrixB[2][2] >> 15); #ifdef DebugDSP1 Log_Message("OP1D X: %d Y: %d Z: %d / F: %d L: %d U: %d", DSP1.Op1DX, DSP1.Op1DY, DSP1.Op1DZ, DSP1.Op1DF, DSP1.Op1DL, DSP1.Op1DU); #endif } static void DSP1_Op2D (void) { DSP1.Op2DF = (DSP1.Op2DX * DSP1.matrixC[0][0] >> 15) + (DSP1.Op2DY * DSP1.matrixC[0][1] >> 15) + (DSP1.Op2DZ * DSP1.matrixC[0][2] >> 15); DSP1.Op2DL = (DSP1.Op2DX * DSP1.matrixC[1][0] >> 15) + (DSP1.Op2DY * DSP1.matrixC[1][1] >> 15) + (DSP1.Op2DZ * DSP1.matrixC[1][2] >> 15); DSP1.Op2DU = (DSP1.Op2DX * DSP1.matrixC[2][0] >> 15) + (DSP1.Op2DY * DSP1.matrixC[2][1] >> 15) + (DSP1.Op2DZ * DSP1.matrixC[2][2] >> 15); #ifdef DebugDSP1 Log_Message("OP2D X: %d Y: %d Z: %d / F: %d L: %d U: %d", DSP1.Op2DX, DSP1.Op2DY, DSP1.Op2DZ, DSP1.Op2DF, DSP1.Op2DL, DSP1.Op2DU); #endif } static void DSP1_Op03 (void) { DSP1.Op03X = (DSP1.Op03F * DSP1.matrixA[0][0] >> 15) + (DSP1.Op03L * DSP1.matrixA[1][0] >> 15) + (DSP1.Op03U * DSP1.matrixA[2][0] >> 15); DSP1.Op03Y = (DSP1.Op03F * DSP1.matrixA[0][1] >> 15) + (DSP1.Op03L * DSP1.matrixA[1][1] >> 15) + (DSP1.Op03U * DSP1.matrixA[2][1] >> 15); DSP1.Op03Z = (DSP1.Op03F * DSP1.matrixA[0][2] >> 15) + (DSP1.Op03L * DSP1.matrixA[1][2] >> 15) + (DSP1.Op03U * DSP1.matrixA[2][2] >> 15); #ifdef DebugDSP1 Log_Message("OP03 F: %d L: %d U: %d / X: %d Y: %d Z: %d", DSP1.Op03F, DSP1.Op03L, DSP1.Op03U, DSP1.Op03X, DSP1.Op03Y, DSP1.Op03Z); #endif } static void DSP1_Op13 (void) { DSP1.Op13X = (DSP1.Op13F * DSP1.matrixB[0][0] >> 15) + (DSP1.Op13L * DSP1.matrixB[1][0] >> 15) + (DSP1.Op13U * DSP1.matrixB[2][0] >> 15); DSP1.Op13Y = (DSP1.Op13F * DSP1.matrixB[0][1] >> 15) + (DSP1.Op13L * DSP1.matrixB[1][1] >> 15) + (DSP1.Op13U * DSP1.matrixB[2][1] >> 15); DSP1.Op13Z = (DSP1.Op13F * DSP1.matrixB[0][2] >> 15) + (DSP1.Op13L * DSP1.matrixB[1][2] >> 15) + (DSP1.Op13U * DSP1.matrixB[2][2] >> 15); #ifdef DebugDSP1 Log_Message("OP13 F: %d L: %d U: %d / X: %d Y: %d Z: %d", DSP1.Op13F, DSP1.Op13L, DSP1.Op13U, DSP1.Op13X, DSP1.Op13Y, DSP1.Op13Z); #endif } static void DSP1_Op23 (void) { DSP1.Op23X = (DSP1.Op23F * DSP1.matrixC[0][0] >> 15) + (DSP1.Op23L * DSP1.matrixC[1][0] >> 15) + (DSP1.Op23U * DSP1.matrixC[2][0] >> 15); DSP1.Op23Y = (DSP1.Op23F * DSP1.matrixC[0][1] >> 15) + (DSP1.Op23L * DSP1.matrixC[1][1] >> 15) + (DSP1.Op23U * DSP1.matrixC[2][1] >> 15); DSP1.Op23Z = (DSP1.Op23F * DSP1.matrixC[0][2] >> 15) + (DSP1.Op23L * DSP1.matrixC[1][2] >> 15) + (DSP1.Op23U * DSP1.matrixC[2][2] >> 15); #ifdef DebugDSP1 Log_Message("OP23 F: %d L: %d U: %d / X: %d Y: %d Z: %d", DSP1.Op23F, DSP1.Op23L, DSP1.Op23U, DSP1.Op23X, DSP1.Op23Y, DSP1.Op23Z); #endif } static void DSP1_Op14 (void) { int16 CSec, ESec, CTan, CSin, C, E; DSP1_Inverse(DSP1_Cos(DSP1.Op14Xr), 0, &CSec, &ESec); // Rotation Around Z DSP1_NormalizeDouble(DSP1.Op14U * DSP1_Cos(DSP1.Op14Yr) - DSP1.Op14F * DSP1_Sin(DSP1.Op14Yr), &C, &E); E = ESec - E; DSP1_Normalize(C * CSec >> 15, &C, &E); DSP1.Op14Zrr = DSP1.Op14Zr + DSP1_Truncate(C, E); // Rotation Around X DSP1.Op14Xrr = DSP1.Op14Xr + (DSP1.Op14U * DSP1_Sin(DSP1.Op14Yr) >> 15) + (DSP1.Op14F * DSP1_Cos(DSP1.Op14Yr) >> 15); // Rotation Around Y DSP1_NormalizeDouble(DSP1.Op14U * DSP1_Cos(DSP1.Op14Yr) + DSP1.Op14F * DSP1_Sin(DSP1.Op14Yr), &C, &E); E = ESec - E; DSP1_Normalize(DSP1_Sin(DSP1.Op14Xr), &CSin, &E); CTan = CSec * CSin >> 15; DSP1_Normalize(-(C * CTan >> 15), &C, &E); DSP1.Op14Yrr = DSP1.Op14Yr + DSP1_Truncate(C, E) + DSP1.Op14L; } static void DSP1_Target (int16 H, int16 V, int16 *X, int16 *Y) { int16 C, E, C1, E1; DSP1_Inverse((V * DSP1.SinAzs >> 15) + DSP1.VOffset, 8, &C, &E); E += DSP1.VPlane_E; C1 = C * DSP1.VPlane_C >> 15; E1 = E + DSP1.SecAZS_E1; H <<= 8; DSP1_Normalize(C1, &C, &E); C = DSP1_Truncate(C, E) * H >> 15; *X = DSP1.CentreX + (C * DSP1.CosAas >> 15); *Y = DSP1.CentreY - (C * DSP1.SinAas >> 15); V <<= 8; DSP1_Normalize(C1 * DSP1.SecAZS_C1 >> 15, &C, &E1); C = DSP1_Truncate(C, E1) * V >> 15; *X += C * -DSP1.SinAas >> 15; *Y += C * DSP1.CosAas >> 15; } static void DSP1_Op0E (void) { DSP1_Target(DSP1.Op0EH, DSP1.Op0EV, &DSP1.Op0EX, &DSP1.Op0EY); } static void DSP1_Op0B (void) { DSP1.Op0BS = (DSP1.Op0BX * DSP1.matrixA[0][0] + DSP1.Op0BY * DSP1.matrixA[0][1] + DSP1.Op0BZ * DSP1.matrixA[0][2]) >> 15; #ifdef DebugDSP1 Log_Message("OP0B"); #endif } static void DSP1_Op1B (void) { DSP1.Op1BS = (DSP1.Op1BX * DSP1.matrixB[0][0] + DSP1.Op1BY * DSP1.matrixB[0][1] + DSP1.Op1BZ * DSP1.matrixB[0][2]) >> 15; #ifdef DebugDSP1 Log_Message("OP1B X: %d Y: %d Z: %d S: %d", DSP1.Op1BX, DSP1.Op1BY, DSP1.Op1BZ, DSP1.Op1BS); Log_Message(" MX: %d MY: %d MZ: %d Scale: %d", (int16) (DSP1.matrixB[0][0] * 100), (int16) (DSP1.matrixB[0][1] * 100), (int16) (DSP1.matrixB[0][2] * 100), (int16) (DSP1.Op1BS * 100)); #endif } static void DSP1_Op2B (void) { DSP1.Op2BS = (DSP1.Op2BX * DSP1.matrixC[0][0] + DSP1.Op2BY * DSP1.matrixC[0][1] + DSP1.Op2BZ * DSP1.matrixC[0][2]) >> 15; #ifdef DebugDSP1 Log_Message("OP2B"); #endif } static void DSP1_Op08 (void) { int32 op08Size = (DSP1.Op08X * DSP1.Op08X + DSP1.Op08Y * DSP1.Op08Y + DSP1.Op08Z * DSP1.Op08Z) << 1; DSP1.Op08Ll = op08Size & 0xffff; DSP1.Op08Lh = (op08Size >> 16) & 0xffff; #ifdef DebugDSP1 Log_Message("OP08 %d,%d,%d", DSP1.Op08X, DSP1.Op08Y, DSP1.Op08Z); Log_Message("OP08 ((OP08X^2)+(OP08Y^2)+(OP08Z^2))=%x", op08Size); #endif } static void DSP1_Op18 (void) { DSP1.Op18D = (DSP1.Op18X * DSP1.Op18X + DSP1.Op18Y * DSP1.Op18Y + DSP1.Op18Z * DSP1.Op18Z - DSP1.Op18R * DSP1.Op18R) >> 15; #ifdef DebugDSP1 Log_Message("OP18 X: %d Y: %d Z: %d R: %D DIFF %d", DSP1.Op18X, DSP1.Op18Y, DSP1.Op38Z, DSP1.Op18D); #endif } static void DSP1_Op38 (void) { DSP1.Op38D = (DSP1.Op38X * DSP1.Op38X + DSP1.Op38Y * DSP1.Op38Y + DSP1.Op38Z * DSP1.Op38Z - DSP1.Op38R * DSP1.Op38R) >> 15; DSP1.Op38D++; #ifdef DebugDSP1 Log_Message("OP38 X: %d Y: %d Z: %d R: %D DIFF %d", DSP1.Op38X, DSP1.Op38Y, DSP1.Op38Z, DSP1.Op38D); #endif } static void DSP1_Op28 (void) { int32 Radius = DSP1.Op28X * DSP1.Op28X + DSP1.Op28Y * DSP1.Op28Y + DSP1.Op28Z * DSP1.Op28Z; if (Radius == 0) DSP1.Op28R = 0; else { int16 C, E, Pos, Node1, Node2; DSP1_NormalizeDouble(Radius, &C, &E); if (E & 1) C = C * 0x4000 >> 15; Pos = C * 0x0040 >> 15; Node1 = DSP1ROM[0x00d5 + Pos]; Node2 = DSP1ROM[0x00d6 + Pos]; DSP1.Op28R = ((Node2 - Node1) * (C & 0x1ff) >> 9) + Node1; DSP1.Op28R >>= (E >> 1); } #ifdef DebugDSP1 Log_Message("OP28 X:%d Y:%d Z:%d", DSP1.Op28X, DSP1.Op28Y, DSP1.Op28Z); Log_Message("OP28 Vector Length %d", DSP1.Op28R); #endif } static void DSP1_Op1C (void) { // Rotate Around Op1CZ1 DSP1.Op1CX1 = (DSP1.Op1CYBR * DSP1_Sin(DSP1.Op1CZ) >> 15) + (DSP1.Op1CXBR * DSP1_Cos(DSP1.Op1CZ) >> 15); DSP1.Op1CY1 = (DSP1.Op1CYBR * DSP1_Cos(DSP1.Op1CZ) >> 15) - (DSP1.Op1CXBR * DSP1_Sin(DSP1.Op1CZ) >> 15); DSP1.Op1CXBR = DSP1.Op1CX1; DSP1.Op1CYBR = DSP1.Op1CY1; // Rotate Around Op1CY1 DSP1.Op1CZ1 = (DSP1.Op1CXBR * DSP1_Sin(DSP1.Op1CY) >> 15) + (DSP1.Op1CZBR * DSP1_Cos(DSP1.Op1CY) >> 15); DSP1.Op1CX1 = (DSP1.Op1CXBR * DSP1_Cos(DSP1.Op1CY) >> 15) - (DSP1.Op1CZBR * DSP1_Sin(DSP1.Op1CY) >> 15); DSP1.Op1CXAR = DSP1.Op1CX1; DSP1.Op1CZBR = DSP1.Op1CZ1; // Rotate Around Op1CX1 DSP1.Op1CY1 = (DSP1.Op1CZBR * DSP1_Sin(DSP1.Op1CX) >> 15) + (DSP1.Op1CYBR * DSP1_Cos(DSP1.Op1CX) >> 15); DSP1.Op1CZ1 = (DSP1.Op1CZBR * DSP1_Cos(DSP1.Op1CX) >> 15) - (DSP1.Op1CYBR * DSP1_Sin(DSP1.Op1CX) >> 15); DSP1.Op1CYAR = DSP1.Op1CY1; DSP1.Op1CZAR = DSP1.Op1CZ1; #ifdef DebugDSP1 Log_Message("OP1C Apply Matrix CX:%d CY:%d CZ", DSP1.Op1CXAR, DSP1.Op1CYAR, DSP1.Op1CZAR); #endif } static void DSP1_Op0F (void) { DSP1.Op0FPass = 0x0000; #ifdef DebugDSP1 Log_Message("OP0F RAM Test Pass:%d", DSP1.Op0FPass); #endif } static void DSP1_Op2F (void) { DSP1.Op2FSize = 0x100; } void DSP1SetByte (uint8 byte, uint16 address) { if (address < DSP0.boundary) { if ((DSP1.command == 0x0A || DSP1.command == 0x1A) && DSP1.out_count != 0) { DSP1.out_count--; DSP1.out_index++; return; } else if (DSP1.waiting4command) { DSP1.command = byte; DSP1.in_index = 0; DSP1.waiting4command = FALSE; DSP1.first_parameter = TRUE; #ifdef DEBUGGER //printf("OP%02X\n",byte); #endif switch (byte) { case 0x00: DSP1.in_count = 2; break; case 0x30: case 0x10: DSP1.in_count = 2; break; case 0x20: DSP1.in_count = 2; break; case 0x24: case 0x04: DSP1.in_count = 2; break; case 0x08: DSP1.in_count = 3; break; case 0x18: DSP1.in_count = 4; break; case 0x28: DSP1.in_count = 3; break; case 0x38: DSP1.in_count = 4; break; case 0x2c: case 0x0c: DSP1.in_count = 3; break; case 0x3c: case 0x1c: DSP1.in_count = 6; break; case 0x32: case 0x22: case 0x12: case 0x02: DSP1.in_count = 7; break; case 0x0a: DSP1.in_count = 1; break; case 0x3a: case 0x2a: case 0x1a: DSP1.command = 0x1a; DSP1.in_count = 1; break; case 0x16: case 0x26: case 0x36: case 0x06: DSP1.in_count = 3; break; case 0x1e: case 0x2e: case 0x3e: case 0x0e: DSP1.in_count = 2; break; case 0x05: case 0x35: case 0x31: case 0x01: DSP1.in_count = 4; break; case 0x15: case 0x11: DSP1.in_count = 4; break; case 0x25: case 0x21: DSP1.in_count = 4; break; case 0x09: case 0x39: case 0x3d: case 0x0d: DSP1.in_count = 3; break; case 0x19: case 0x1d: DSP1.in_count = 3; break; case 0x29: case 0x2d: DSP1.in_count = 3; break; case 0x33: case 0x03: DSP1.in_count = 3; break; case 0x13: DSP1.in_count = 3; break; case 0x23: DSP1.in_count = 3; break; case 0x3b: case 0x0b: DSP1.in_count = 3; break; case 0x1b: DSP1.in_count = 3; break; case 0x2b: DSP1.in_count = 3; break; case 0x34: case 0x14: DSP1.in_count = 6; break; case 0x07: case 0x0f: DSP1.in_count = 1; break; case 0x27: case 0x2F: DSP1.in_count = 1; break; case 0x17: case 0x37: case 0x3F: DSP1.command = 0x1f; case 0x1f: DSP1.in_count = 1; break; default: #ifdef DEBUGGER //printf("OP%02X\n", byte); #endif case 0x80: DSP1.in_count = 0; DSP1.waiting4command = TRUE; DSP1.first_parameter = TRUE; break; } DSP1.in_count <<= 1; } else { DSP1.parameters[DSP1.in_index] = byte; DSP1.first_parameter = FALSE; DSP1.in_index++; } if (DSP1.waiting4command || (DSP1.first_parameter && byte == 0x80)) { DSP1.waiting4command = TRUE; DSP1.first_parameter = FALSE; } else if (DSP1.first_parameter && (DSP1.in_count != 0 || (DSP1.in_count == 0 && DSP1.in_index == 0))) ; else { if (DSP1.in_count) { if (--DSP1.in_count == 0) { // Actually execute the command DSP1.waiting4command = TRUE; DSP1.out_index = 0; switch (DSP1.command) { case 0x1f: DSP1.out_count = 2048; break; case 0x00: // Multiple DSP1.Op00Multiplicand = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op00Multiplier = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1_Op00(); DSP1.out_count = 2; DSP1.output[0] = DSP1.Op00Result & 0xFF; DSP1.output[1] = (DSP1.Op00Result >> 8) & 0xFF; break; case 0x20: // Multiple DSP1.Op20Multiplicand = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op20Multiplier = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1_Op20(); DSP1.out_count = 2; DSP1.output[0] = DSP1.Op20Result & 0xFF; DSP1.output[1] = (DSP1.Op20Result >> 8) & 0xFF; break; case 0x30: case 0x10: // Inverse DSP1.Op10Coefficient = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op10Exponent = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1_Op10(); DSP1.out_count = 4; DSP1.output[0] = (uint8) ( ((int16) DSP1.Op10CoefficientR) & 0xFF); DSP1.output[1] = (uint8) ((((int16) DSP1.Op10CoefficientR) >> 8) & 0xFF); DSP1.output[2] = (uint8) ( ((int16) DSP1.Op10ExponentR ) & 0xFF); DSP1.output[3] = (uint8) ((((int16) DSP1.Op10ExponentR ) >> 8) & 0xFF); break; case 0x24: case 0x04: // Sin and Cos of angle DSP1.Op04Angle = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op04Radius = (uint16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1_Op04(); DSP1.out_count = 4; DSP1.output[0] = (uint8) (DSP1.Op04Sin & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op04Sin >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op04Cos & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op04Cos >> 8) & 0xFF); break; case 0x08: // Radius DSP1.Op08X = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op08Y = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op08Z = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op08(); DSP1.out_count = 4; DSP1.output[0] = (uint8) ( ((int16) DSP1.Op08Ll) & 0xFF); DSP1.output[1] = (uint8) ((((int16) DSP1.Op08Ll) >> 8) & 0xFF); DSP1.output[2] = (uint8) ( ((int16) DSP1.Op08Lh) & 0xFF); DSP1.output[3] = (uint8) ((((int16) DSP1.Op08Lh) >> 8) & 0xFF); break; case 0x18: // Range DSP1.Op18X = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op18Y = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op18Z = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1.Op18R = (int16) (DSP1.parameters[6] | (DSP1.parameters[7] << 8)); DSP1_Op18(); DSP1.out_count = 2; DSP1.output[0] = (uint8) (DSP1.Op18D & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op18D >> 8) & 0xFF); break; case 0x38: // Range DSP1.Op38X = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op38Y = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op38Z = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1.Op38R = (int16) (DSP1.parameters[6] | (DSP1.parameters[7] << 8)); DSP1_Op38(); DSP1.out_count = 2; DSP1.output[0] = (uint8) (DSP1.Op38D & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op38D >> 8) & 0xFF); break; case 0x28: // Distance (vector length) DSP1.Op28X = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op28Y = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op28Z = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op28(); DSP1.out_count = 2; DSP1.output[0] = (uint8) (DSP1.Op28R & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op28R >> 8) & 0xFF); break; case 0x2c: case 0x0c: // Rotate (2D rotate) DSP1.Op0CA = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op0CX1 = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op0CY1 = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op0C(); DSP1.out_count = 4; DSP1.output[0] = (uint8) (DSP1.Op0CX2 & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op0CX2 >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op0CY2 & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op0CY2 >> 8) & 0xFF); break; case 0x3c: case 0x1c: // Polar (3D rotate) DSP1.Op1CZ = (DSP1.parameters[ 0] | (DSP1.parameters[ 1] << 8)); //MK: reversed X and Y on neviksti and John's advice. DSP1.Op1CY = (DSP1.parameters[ 2] | (DSP1.parameters[ 3] << 8)); DSP1.Op1CX = (DSP1.parameters[ 4] | (DSP1.parameters[ 5] << 8)); DSP1.Op1CXBR = (DSP1.parameters[ 6] | (DSP1.parameters[ 7] << 8)); DSP1.Op1CYBR = (DSP1.parameters[ 8] | (DSP1.parameters[ 9] << 8)); DSP1.Op1CZBR = (DSP1.parameters[10] | (DSP1.parameters[11] << 8)); DSP1_Op1C(); DSP1.out_count = 6; DSP1.output[0] = (uint8) (DSP1.Op1CXAR & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op1CXAR >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op1CYAR & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op1CYAR >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op1CZAR & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op1CZAR >> 8) & 0xFF); break; case 0x32: case 0x22: case 0x12: case 0x02: // Parameter (Projection) DSP1.Op02FX = (int16) (DSP1.parameters[ 0] | (DSP1.parameters[ 1] << 8)); DSP1.Op02FY = (int16) (DSP1.parameters[ 2] | (DSP1.parameters[ 3] << 8)); DSP1.Op02FZ = (int16) (DSP1.parameters[ 4] | (DSP1.parameters[ 5] << 8)); DSP1.Op02LFE = (int16) (DSP1.parameters[ 6] | (DSP1.parameters[ 7] << 8)); DSP1.Op02LES = (int16) (DSP1.parameters[ 8] | (DSP1.parameters[ 9] << 8)); DSP1.Op02AAS = (uint16) (DSP1.parameters[10] | (DSP1.parameters[11] << 8)); DSP1.Op02AZS = (uint16) (DSP1.parameters[12] | (DSP1.parameters[13] << 8)); DSP1_Op02(); DSP1.out_count = 8; DSP1.output[0] = (uint8) (DSP1.Op02VOF & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op02VOF >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op02VVA & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op02VVA >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op02CX & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op02CX >> 8) & 0xFF); DSP1.output[6] = (uint8) (DSP1.Op02CY & 0xFF); DSP1.output[7] = (uint8) ((DSP1.Op02CY >> 8) & 0xFF); break; case 0x3a: case 0x2a: case 0x1a: // Raster mode 7 matrix data case 0x0a: DSP1.Op0AVS = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1_Op0A(); DSP1.out_count = 8; DSP1.output[0] = (uint8) (DSP1.Op0AA & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op0AA >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op0AB & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op0AB >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op0AC & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op0AC >> 8) & 0xFF); DSP1.output[6] = (uint8) (DSP1.Op0AD & 0xFF); DSP1.output[7] = (uint8) ((DSP1.Op0AD >> 8) & 0xFF); DSP1.in_index = 0; break; case 0x16: case 0x26: case 0x36: case 0x06: // Project object DSP1.Op06X = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op06Y = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op06Z = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op06(); DSP1.out_count = 6; DSP1.output[0] = (uint8) (DSP1.Op06H & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op06H >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op06V & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op06V >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op06M & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op06M >> 8) & 0xFF); break; case 0x1e: case 0x2e: case 0x3e: case 0x0e: // Target DSP1.Op0EH = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op0EV = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1_Op0E(); DSP1.out_count = 4; DSP1.output[0] = (uint8) (DSP1.Op0EX & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op0EX >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op0EY & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op0EY >> 8) & 0xFF); break; // Extra commands used by Pilot Wings case 0x05: case 0x35: case 0x31: case 0x01: // Set attitude matrix A DSP1.Op01m = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op01Zr = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op01Yr = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1.Op01Xr = (int16) (DSP1.parameters[6] | (DSP1.parameters[7] << 8)); DSP1_Op01(); break; case 0x15: case 0x11: // Set attitude matrix B DSP1.Op11m = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op11Zr = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op11Yr = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1.Op11Xr = (int16) (DSP1.parameters[7] | (DSP1.parameters[7] << 8)); DSP1_Op11(); break; case 0x25: case 0x21: // Set attitude matrix C DSP1.Op21m = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op21Zr = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op21Yr = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1.Op21Xr = (int16) (DSP1.parameters[6] | (DSP1.parameters[7] << 8)); DSP1_Op21(); break; case 0x09: case 0x39: case 0x3d: case 0x0d: // Objective matrix A DSP1.Op0DX = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op0DY = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op0DZ = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op0D(); DSP1.out_count = 6; DSP1.output [0] = (uint8) (DSP1.Op0DF & 0xFF); DSP1.output [1] = (uint8) ((DSP1.Op0DF >> 8) & 0xFF); DSP1.output [2] = (uint8) (DSP1.Op0DL & 0xFF); DSP1.output [3] = (uint8) ((DSP1.Op0DL >> 8) & 0xFF); DSP1.output [4] = (uint8) (DSP1.Op0DU & 0xFF); DSP1.output [5] = (uint8) ((DSP1.Op0DU >> 8) & 0xFF); break; case 0x19: case 0x1d: // Objective matrix B DSP1.Op1DX = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op1DY = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op1DZ = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op1D(); DSP1.out_count = 6; DSP1.output[0] = (uint8) (DSP1.Op1DF & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op1DF >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op1DL & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op1DL >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op1DU & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op1DU >> 8) & 0xFF); break; case 0x29: case 0x2d: // Objective matrix C DSP1.Op2DX = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op2DY = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op2DZ = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op2D(); DSP1.out_count = 6; DSP1.output[0] = (uint8) (DSP1.Op2DF & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op2DF >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op2DL & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op2DL >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op2DU & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op2DU >> 8) & 0xFF); break; case 0x33: case 0x03: // Subjective matrix A DSP1.Op03F = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op03L = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op03U = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op03(); DSP1.out_count = 6; DSP1.output[0] = (uint8) (DSP1.Op03X & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op03X >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op03Y & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op03Y >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op03Z & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op03Z >> 8) & 0xFF); break; case 0x13: // Subjective matrix B DSP1.Op13F = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op13L = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op13U = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op13(); DSP1.out_count = 6; DSP1.output[0] = (uint8) (DSP1.Op13X & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op13X >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op13Y & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op13Y >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op13Z & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op13Z >> 8) & 0xFF); break; case 0x23: // Subjective matrix C DSP1.Op23F = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op23L = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op23U = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op23(); DSP1.out_count = 6; DSP1.output[0] = (uint8) (DSP1.Op23X & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op23X >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op23Y & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op23Y >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op23Z & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op23Z >> 8) & 0xFF); break; case 0x3b: case 0x0b: DSP1.Op0BX = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op0BY = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op0BZ = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op0B(); DSP1.out_count = 2; DSP1.output[0] = (uint8) (DSP1.Op0BS & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op0BS >> 8) & 0xFF); break; case 0x1b: DSP1.Op1BX = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op1BY = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op1BZ = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op1B(); DSP1.out_count = 2; DSP1.output[0] = (uint8) (DSP1.Op1BS & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op1BS >> 8) & 0xFF); break; case 0x2b: DSP1.Op2BX = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1.Op2BY = (int16) (DSP1.parameters[2] | (DSP1.parameters[3] << 8)); DSP1.Op2BZ = (int16) (DSP1.parameters[4] | (DSP1.parameters[5] << 8)); DSP1_Op2B(); DSP1.out_count = 2; DSP1.output[0] = (uint8) (DSP1.Op2BS & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op2BS >> 8) & 0xFF); break; case 0x34: case 0x14: DSP1.Op14Zr = (int16) (DSP1.parameters[ 0] | (DSP1.parameters[ 1] << 8)); DSP1.Op14Xr = (int16) (DSP1.parameters[ 2] | (DSP1.parameters[ 3] << 8)); DSP1.Op14Yr = (int16) (DSP1.parameters[ 4] | (DSP1.parameters[ 5] << 8)); DSP1.Op14U = (int16) (DSP1.parameters[ 6] | (DSP1.parameters[ 7] << 8)); DSP1.Op14F = (int16) (DSP1.parameters[ 8] | (DSP1.parameters[ 9] << 8)); DSP1.Op14L = (int16) (DSP1.parameters[10] | (DSP1.parameters[11] << 8)); DSP1_Op14(); DSP1.out_count = 6; DSP1.output[0] = (uint8) (DSP1.Op14Zrr & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op14Zrr >> 8) & 0xFF); DSP1.output[2] = (uint8) (DSP1.Op14Xrr & 0xFF); DSP1.output[3] = (uint8) ((DSP1.Op14Xrr >> 8) & 0xFF); DSP1.output[4] = (uint8) (DSP1.Op14Yrr & 0xFF); DSP1.output[5] = (uint8) ((DSP1.Op14Yrr >> 8) & 0xFF); break; case 0x27: case 0x2F: DSP1.Op2FUnknown = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1_Op2F(); DSP1.out_count = 2; DSP1.output[0] = (uint8) (DSP1.Op2FSize & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op2FSize >> 8) & 0xFF); break; case 0x07: case 0x0F: DSP1.Op0FRamsize = (int16) (DSP1.parameters[0] | (DSP1.parameters[1] << 8)); DSP1_Op0F(); DSP1.out_count = 2; DSP1.output[0] = (uint8) (DSP1.Op0FPass & 0xFF); DSP1.output[1] = (uint8) ((DSP1.Op0FPass >> 8) & 0xFF); break; default: break; } } } } } } uint8 DSP1GetByte (uint16 address) { uint8 t; if (address < DSP0.boundary) { if (DSP1.out_count) { t = (uint8) DSP1.output[DSP1.out_index]; DSP1.out_index++; if (--DSP1.out_count == 0) { if (DSP1.command == 0x1a || DSP1.command == 0x0a) { DSP1_Op0A(); DSP1.out_count = 8; DSP1.out_index = 0; DSP1.output[0] = DSP1.Op0AA & 0xFF; DSP1.output[1] = (DSP1.Op0AA >> 8) & 0xFF; DSP1.output[2] = DSP1.Op0AB & 0xFF; DSP1.output[3] = (DSP1.Op0AB >> 8) & 0xFF; DSP1.output[4] = DSP1.Op0AC & 0xFF; DSP1.output[5] = (DSP1.Op0AC >> 8) & 0xFF; DSP1.output[6] = DSP1.Op0AD & 0xFF; DSP1.output[7] = (DSP1.Op0AD >> 8) & 0xFF; } if (DSP1.command == 0x1f) { if ((DSP1.out_index % 2) != 0) t = (uint8) DSP1ROM[DSP1.out_index >> 1]; else t = DSP1ROM[DSP1.out_index >> 1] >> 8; } } DSP1.waiting4command = TRUE; } else t = 0xff; } else t = 0x80; return (t); }