1 files changed, 411 insertions, 0 deletions
diff --git a/arm9/src/math_util.c b/arm9/src/math_util.c
new file mode 100644
index 00000000..3f6bdb79
--- /dev/null
+++ b/arm9/src/math_util.c
@@ -0,0 +1,411 @@
+#include "global.h"
+#include "math_util.h"
+
+extern const s16 UNK_020FFA38[]; // temporary until further notice
+
+/*
+ * Constant tables
+ */
+const s32 gSineTable[] =
+{
+    0x00000000, 0x00000047, 0x0000008F, 0x000000D6,
+    0x0000011E, 0x00000165, 0x000001AC, 0x000001F3,
+    0x0000023A, 0x00000281, 0x000002C7, 0x0000030E,
+    0x00000354, 0x00000399, 0x000003DF, 0x00000424,
+    0x00000469, 0x000004AE, 0x000004F2, 0x00000536,
+    0x00000579, 0x000005BC, 0x000005FE, 0x00000640,
+    0x00000682, 0x000006C3, 0x00000704, 0x00000744,
+    0x00000783, 0x000007C2, 0x00000800, 0x0000083E,
+    0x0000087B, 0x000008B7, 0x000008F2, 0x0000092D,
+    0x00000968, 0x000009A1, 0x000009DA, 0x00000A12,
+    0x00000A49, 0x00000A7F, 0x00000AB5, 0x00000AE9,
+    0x00000B1D, 0x00000B50, 0x00000B82, 0x00000BB4,
+    0x00000BE4, 0x00000C13, 0x00000C42, 0x00000C6F,
+    0x00000C9C, 0x00000CC7, 0x00000CF2, 0x00000D1B,
+    0x00000D44, 0x00000D6B, 0x00000D92, 0x00000DB7,
+    0x00000DDB, 0x00000DFE, 0x00000E21, 0x00000E42,
+    0x00000E61, 0x00000E80, 0x00000E9E, 0x00000EBA,
+    0x00000ED6, 0x00000EF0, 0x00000F09, 0x00000F21,
+    0x00000F38, 0x00000F4D, 0x00000F61, 0x00000F74,
+    0x00000F86, 0x00000F97, 0x00000FA6, 0x00000FB5,
+    0x00000FC2, 0x00000FCE, 0x00000FD8, 0x00000FE1,
+    0x00000FEA, 0x00000FF0, 0x00000FF6, 0x00000FFA,
+    0x00000FFE, 0x00000FFF, 0x00001000, 0x00000FFF,
+    0x00000FFE, 0x00000FFA, 0x00000FF6, 0x00000FF0,
+    0x00000FEA, 0x00000FE1, 0x00000FD8, 0x00000FCE,
+    0x00000FC2, 0x00000FB5, 0x00000FA6, 0x00000F97,
+    0x00000F86, 0x00000F74, 0x00000F61, 0x00000F4D,
+    0x00000F38, 0x00000F21, 0x00000F09, 0x00000EF0,
+    0x00000ED6, 0x00000EBA, 0x00000E9E, 0x00000E80,
+    0x00000E61, 0x00000E42, 0x00000E21, 0x00000DFE,
+    0x00000DDB, 0x00000DB7, 0x00000D92, 0x00000D6B,
+    0x00000D44, 0x00000D1B, 0x00000CF2, 0x00000CC7,
+    0x00000C9C, 0x00000C6F, 0x00000C42, 0x00000C13,
+    0x00000BE4, 0x00000BB4, 0x00000B82, 0x00000B50,
+    0x00000B1D, 0x00000AE9, 0x00000AB5, 0x00000A7F,
+    0x00000A49, 0x00000A12, 0x000009DA, 0x000009A1,
+    0x00000968, 0x0000092D, 0x000008F2, 0x000008B7,
+    0x0000087B, 0x0000083E, 0x00000800, 0x000007C2,
+    0x00000783, 0x00000744, 0x00000704, 0x000006C3,
+    0x00000682, 0x00000640, 0x000005FE, 0x000005BC,
+    0x00000579, 0x00000536, 0x000004F2, 0x000004AE,
+    0x00000469, 0x00000424, 0x000003DF, 0x00000399,
+    0x00000354, 0x0000030E, 0x000002C7, 0x00000281,
+    0x0000023A, 0x000001F3, 0x000001AC, 0x00000165,
+    0x0000011E, 0x000000D6, 0x0000008F, 0x00000047,
+    0x00000000, 0xFFFFFFB9, 0xFFFFFF71, 0xFFFFFF2A,
+    0xFFFFFEE2, 0xFFFFFE9B, 0xFFFFFE54, 0xFFFFFE0D,
+    0xFFFFFDC6, 0xFFFFFD7F, 0xFFFFFD39, 0xFFFFFCF2,
+    0xFFFFFCAC, 0xFFFFFC67, 0xFFFFFC21, 0xFFFFFBDC,
+    0xFFFFFB97, 0xFFFFFB52, 0xFFFFFB0E, 0xFFFFFACA,
+    0xFFFFFA87, 0xFFFFFA44, 0xFFFFFA02, 0xFFFFF9C0,
+    0xFFFFF97E, 0xFFFFF93D, 0xFFFFF8FC, 0xFFFFF8BC,
+    0xFFFFF87D, 0xFFFFF83E, 0xFFFFF800, 0xFFFFF7C2,
+    0xFFFFF785, 0xFFFFF749, 0xFFFFF70E, 0xFFFFF6D3,
+    0xFFFFF698, 0xFFFFF65F, 0xFFFFF626, 0xFFFFF5EE,
+    0xFFFFF5B7, 0xFFFFF581, 0xFFFFF54B, 0xFFFFF517,
+    0xFFFFF4E3, 0xFFFFF4B0, 0xFFFFF47E, 0xFFFFF44C,
+    0xFFFFF41C, 0xFFFFF3ED, 0xFFFFF3BE, 0xFFFFF391,
+    0xFFFFF364, 0xFFFFF339, 0xFFFFF30E, 0xFFFFF2E5,
+    0xFFFFF2BC, 0xFFFFF295, 0xFFFFF26E, 0xFFFFF249,
+    0xFFFFF225, 0xFFFFF202, 0xFFFFF1DF, 0xFFFFF1BE,
+    0xFFFFF19F, 0xFFFFF180, 0xFFFFF162, 0xFFFFF146,
+    0xFFFFF12A, 0xFFFFF110, 0xFFFFF0F7, 0xFFFFF0DF,
+    0xFFFFF0C8, 0xFFFFF0B3, 0xFFFFF09F, 0xFFFFF08C,
+    0xFFFFF07A, 0xFFFFF069, 0xFFFFF05A, 0xFFFFF04B,
+    0xFFFFF03E, 0xFFFFF032, 0xFFFFF028, 0xFFFFF01F,
+    0xFFFFF016, 0xFFFFF010, 0xFFFFF00A, 0xFFFFF006,
+    0xFFFFF002, 0xFFFFF001, 0xFFFFF000, 0xFFFFF001,
+    0xFFFFF002, 0xFFFFF006, 0xFFFFF00A, 0xFFFFF010,
+    0xFFFFF016, 0xFFFFF01F, 0xFFFFF028, 0xFFFFF032,
+    0xFFFFF03E, 0xFFFFF04B, 0xFFFFF05A, 0xFFFFF069,
+    0xFFFFF07A, 0xFFFFF08C, 0xFFFFF09F, 0xFFFFF0B3,
+    0xFFFFF0C8, 0xFFFFF0DF, 0xFFFFF0F7, 0xFFFFF110,
+    0xFFFFF12A, 0xFFFFF146, 0xFFFFF162, 0xFFFFF180,
+    0xFFFFF19F, 0xFFFFF1BE, 0xFFFFF1DF, 0xFFFFF202,
+    0xFFFFF225, 0xFFFFF249, 0xFFFFF26E, 0xFFFFF295,
+    0xFFFFF2BC, 0xFFFFF2E5, 0xFFFFF30E, 0xFFFFF339,
+    0xFFFFF364, 0xFFFFF391, 0xFFFFF3BE, 0xFFFFF3ED,
+    0xFFFFF41C, 0xFFFFF44C, 0xFFFFF47E, 0xFFFFF4B0,
+    0xFFFFF4E3, 0xFFFFF517, 0xFFFFF54B, 0xFFFFF581,
+    0xFFFFF5B7, 0xFFFFF5EE, 0xFFFFF626, 0xFFFFF65F,
+    0xFFFFF698, 0xFFFFF6D3, 0xFFFFF70E, 0xFFFFF749,
+    0xFFFFF785, 0xFFFFF7C2, 0xFFFFF800, 0xFFFFF83E,
+    0xFFFFF87D, 0xFFFFF8BC, 0xFFFFF8FC, 0xFFFFF93D,
+    0xFFFFF97E, 0xFFFFF9C0, 0xFFFFFA02, 0xFFFFFA44,
+    0xFFFFFA87, 0xFFFFFACA, 0xFFFFFB0E, 0xFFFFFB52,
+    0xFFFFFB97, 0xFFFFFBDC, 0xFFFFFC21, 0xFFFFFC67,
+    0xFFFFFCAC, 0xFFFFFCF2, 0xFFFFFD39, 0xFFFFFD7F,
+    0xFFFFFDC6, 0xFFFFFE0D, 0xFFFFFE54, 0xFFFFFE9B,
+    0xFFFFFEE2, 0xFFFFFF2A, 0xFFFFFF71, 0xFFFFFFB9,
+    0x00000000, 0x00000047, 0x0000008F, 0x000000D6,
+    0x0000011E, 0x00000165, 0x000001AC, 0x000001F3,
+    0x0000023A, 0x00000281, 0x000002C7, 0x0000030E,
+    0x00000354, 0x00000399, 0x000003DF, 0x00000424,
+    0x00000469, 0x000004AE, 0x000004F2, 0x00000536,
+    0x00000579, 0x000005BC, 0x000005FE, 0x00000640,
+    0x00000682, 0x000006C3, 0x00000704, 0x00000744,
+    0x00000783, 0x000007C2, 0x00000800, 0x0000083E,
+    0x0000087B, 0x000008B7, 0x000008F2, 0x0000092D,
+    0x00000968, 0x000009A1, 0x000009DA, 0x00000A12,
+    0x00000A49, 0x00000A7F, 0x00000AB5, 0x00000AE9,
+    0x00000B1D, 0x00000B50, 0x00000B82, 0x00000BB4,
+    0x00000BE4, 0x00000C13, 0x00000C42, 0x00000C6F,
+    0x00000C9C, 0x00000CC7, 0x00000CF2, 0x00000D1B,
+    0x00000D44, 0x00000D6B, 0x00000D92, 0x00000DB7,
+    0x00000DDB, 0x00000DFE, 0x00000E21, 0x00000E42,
+    0x00000E61, 0x00000E80, 0x00000E9E, 0x00000EBA,
+    0x00000ED6, 0x00000EF0, 0x00000F09, 0x00000F21,
+    0x00000F38, 0x00000F4D, 0x00000F61, 0x00000F74,
+    0x00000F86, 0x00000F97, 0x00000FA6, 0x00000FB5,
+    0x00000FC2, 0x00000FCE, 0x00000FD8, 0x00000FE1,
+    0x00000FEA, 0x00000FF0, 0x00000FF6, 0x00000FFA,
+    0x00000FFE, 0x00000FFF
+};
+
+const u16 UNK_020EDC7E[] = // rotations?
+{
+    0x0000, 0x00B7, 0x016D, 0x0223, 0x02D9, 0x038F, 0x0445, 0x04FB, 0x05B1, 0x0667,
+    0x071D, 0x07D3, 0x0889, 0x093F, 0x09F5, 0x0AAB, 0x0B61, 0x0C17, 0x0CCD, 0x0D83,
+    0x0E39, 0x0EEF, 0x0FA5, 0x105C, 0x1112, 0x11C8, 0x127E, 0x1334, 0x13EA, 0x14A0,
+    0x1556, 0x160C, 0x16C2, 0x1778, 0x182E, 0x18E4, 0x199A, 0x1A50, 0x1B06, 0x1BBC,
+    0x1C72, 0x1D28, 0x1DDE, 0x1E94, 0x1F4A, 0x2000, 0x20B7, 0x216D, 0x2223, 0x22D9,
+    0x238F, 0x2445, 0x24FB, 0x25B1, 0x2667, 0x271D, 0x27D3, 0x2889, 0x293F, 0x29F5,
+    0x2AAB, 0x2B61, 0x2C17, 0x2CCD, 0x2D83, 0x2E39, 0x2EEF, 0x2FA5, 0x305C, 0x3112,
+    0x31C8, 0x327E, 0x3334, 0x33EA, 0x34A0, 0x3556, 0x360C, 0x36C2, 0x3778, 0x382E,
+    0x38E4, 0x399A, 0x3A50, 0x3B06, 0x3BBC, 0x3C72, 0x3D28, 0x3DDE, 0x3E94, 0x3F4A,
+    0x4000, 0x40B7, 0x416D, 0x4223, 0x42D9, 0x438F, 0x4445, 0x44FB, 0x45B1, 0x4667,
+    0x471D, 0x47D3, 0x4889, 0x493F, 0x49F5, 0x4AAB, 0x4B61, 0x4C17, 0x4CCD, 0x4D83,
+    0x4E39, 0x4EEF, 0x4FA5, 0x505C, 0x5112, 0x51C8, 0x527E, 0x5334, 0x53EA, 0x54A0,
+    0x5556, 0x560C, 0x56C2, 0x5778, 0x582E, 0x58E4, 0x599A, 0x5A50, 0x5B06, 0x5BBC,
+    0x5C72, 0x5D28, 0x5DDE, 0x5E94, 0x5F4A, 0x6000, 0x60B7, 0x616D, 0x6223, 0x62D9,
+    0x638F, 0x6445, 0x64FB, 0x65B1, 0x6667, 0x671D, 0x67D3, 0x6889, 0x693F, 0x69F5,
+    0x6AAB, 0x6B61, 0x6C17, 0x6CCD, 0x6D83, 0x6E39, 0x6EEF, 0x6FA5, 0x705C, 0x7112,
+    0x71C8, 0x727E, 0x7334, 0x73EA, 0x74A0, 0x7556, 0x760C, 0x76C2, 0x7778, 0x782E,
+    0x78E4, 0x799A, 0x7A50, 0x7B06, 0x7BBC, 0x7C72, 0x7D28, 0x7DDE, 0x7E94, 0x7F4A,
+    0x8000, 0x80B7, 0x816D, 0x8223, 0x82D9, 0x838F, 0x8445, 0x84FB, 0x85B1, 0x8667,
+    0x871D, 0x87D3, 0x8889, 0x893F, 0x89F5, 0x8AAB, 0x8B61, 0x8C17, 0x8CCD, 0x8D83,
+    0x8E39, 0x8EEF, 0x8FA5, 0x905C, 0x9112, 0x91C8, 0x927E, 0x9334, 0x93EA, 0x94A0,
+    0x9556, 0x960C, 0x96C2, 0x9778, 0x982E, 0x98E4, 0x999A, 0x9A50, 0x9B06, 0x9BBC,
+    0x9C72, 0x9D28, 0x9DDE, 0x9E94, 0x9F4A, 0xA000, 0xA0B7, 0xA16D, 0xA223, 0xA2D9,
+    0xA38F, 0xA445, 0xA4FB, 0xA5B1, 0xA667, 0xA71D, 0xA7D3, 0xA889, 0xA93F, 0xA9F5,
+    0xAAAB, 0xAB61, 0xAC17, 0xACCD, 0xAD83, 0xAE39, 0xAEEF, 0xAFA5, 0xB05C, 0xB112,
+    0xB1C8, 0xB27E, 0xB334, 0xB3EA, 0xB4A0, 0xB556, 0xB60C, 0xB6C2, 0xB778, 0xB82E,
+    0xB8E4, 0xB99A, 0xBA50, 0xBB06, 0xBBBC, 0xBC72, 0xBD28, 0xBDDE, 0xBE94, 0xBF4A,
+    0xC000, 0xC0B7, 0xC16D, 0xC223, 0xC2D9, 0xC38F, 0xC445, 0xC4FB, 0xC5B1, 0xC667,
+    0xC71D, 0xC7D3, 0xC889, 0xC93F, 0xC9F5, 0xCAAB, 0xCB61, 0xCC17, 0xCCCD, 0xCD83,
+    0xCE39, 0xCEEF, 0xCFA5, 0xD05C, 0xD112, 0xD1C8, 0xD27E, 0xD334, 0xD3EA, 0xD4A0,
+    0xD556, 0xD60C, 0xD6C2, 0xD778, 0xD82E, 0xD8E4, 0xD99A, 0xDA50, 0xDB06, 0xDBBC,
+    0xDC72, 0xDD28, 0xDDDE, 0xDE94, 0xDF4A, 0xE000, 0xE0B7, 0xE16D, 0xE223, 0xE2D9,
+    0xE38F, 0xE445, 0xE4FB, 0xE5B1, 0xE667, 0xE71D, 0xE7D3, 0xE889, 0xE93F, 0xE9F5,
+    0xEAAB, 0xEB61, 0xEC17, 0xECCD, 0xED83, 0xEE39, 0xEEEF, 0xEFA5, 0xF05C, 0xF112,
+    0xF1C8, 0xF27E, 0xF334, 0xF3EA, 0xF4A0, 0xF556, 0xF60C, 0xF6C2, 0xF778, 0xF82E,
+    0xF8E4, 0xF99A, 0xFA50, 0xFB06, 0xFBBC, 0xFC72, 0xFD28, 0xFDDE, 0xFE94, 0xFF4A
+};
+
+const u16 UNK_020EDB80[] =
+{
+    0x169F, 0x0F14, 0x0B4F, 0x090C, 0x078A, 0x0676, 0x05A7, 0x0506,
+    0x0486, 0x041C, 0x03C5, 0x037A, 0x033B, 0x0304, 0x02D3, 0x02A9,
+    0x0283, 0x0261, 0x0243, 0x0227, 0x020E, 0x01F7, 0x01E2, 0x01CF,
+    0x01BD, 0x01AC, 0x019D, 0x018F, 0x0182, 0x0175, 0x0169, 0x015E,
+    0x0154, 0x014A, 0x0141, 0x0139, 0x0130, 0x0128, 0x0121, 0x011A,
+    0x0113, 0x010D, 0x0107, 0x0101, 0x00FB, 0x00F6, 0x00F1, 0x00EC,
+    0x00E7, 0x00E3, 0x00DE, 0x00DA, 0x00D6, 0x00D2, 0x00CE, 0x00CB,
+    0x00C7, 0x00C4, 0x00C1, 0x00BD, 0x00BA, 0x00B7, 0x00B4, 0x00B2,
+    0x00AF, 0x00AC, 0x00AA, 0x00A7, 0x00A5, 0x00A3, 0x00A0, 0x009E,
+    0x009C, 0x009A, 0x0098, 0x0096, 0x0094, 0x0092, 0x0090, 0x008E,
+    0x008D, 0x008B, 0x0089, 0x0088, 0x0086, 0x0085, 0x0083, 0x0082,
+    0x0080, 0x007F, 0x007D, 0x007C, 0x007B, 0x0079, 0x0078, 0x0077,
+    0x0076, 0x0074, 0x0073, 0x0072, 0x0071, 0x0070, 0x006F, 0x006E,
+    0x006D, 0x006C, 0x006B, 0x006A, 0x0069, 0x0068, 0x0067, 0x0066,
+    0x0065, 0x0064, 0x0063, 0x0062, 0x0062, 0x0061, 0x0060, 0x005F,
+    0x005E, 0x005E, 0x005D, 0x005C, 0x005B, 0x005B, 0x005A
+};
+
+/*
+ * Temporary prototypes; keep until all files using math_util are decompiled.
+ */
+THUMB_FUNC s32 Sin(u16 degrees);
+THUMB_FUNC s32 Cos(u16 degrees);
+THUMB_FUNC s32 Sin_Wrap(u16 degrees);
+THUMB_FUNC s32 Cos_Wrap(u16 degrees);
+THUMB_FUNC u16 MathUtil_0201B9A0(u16 x);
+THUMB_FUNC s32 Sin32(s32 degrees);
+
+THUMB_FUNC u32 GetLCRNGSeed();
+THUMB_FUNC void SetLCRNGSeed(u32 seed);
+THUMB_FUNC u16 LCRandom(void);
+
+THUMB_FUNC u32 PRandom(u32 seed);
+
+THUMB_FUNC void SetMTRNGSeed(u32 seed);
+THUMB_FUNC u32 MTRandom(void);
+
+THUMB_FUNC void MTX22_2DAffine(struct Mtx22 * mtx, u16 radians, fx32 x, fx32 y, u8 type);
+
+THUMB_FUNC s32 CircularDistance(s32 x1, s32 y1, s32 x2, s32 y2);
+THUMB_FUNC s32 MathUtil_0201BC84(u16 arg0, s32 arg1);
+
+/*
+ * Trigonometric functions
+ */
+// Returns the sine of a 16-bit unsigned degree value.
+THUMB_FUNC s32 Sin(u16 degrees)
+{
+    if (degrees >= 360)
+        return 0;
+    else
+        return gSineTable[degrees];
+}
+// Returns the cosine of a 16-bit unsigned degree value.
+THUMB_FUNC s32 Cos(u16 degrees)
+{
+    if (degrees >= 360)
+        return 0;
+    else
+        return gSineTable[degrees + 90];
+}
+
+// Returns the wrapped sine of a 16-bit unsigned degree value.
+THUMB_FUNC s32 Sin_Wrap(u16 degrees)
+{
+    return gSineTable[degrees % 360];
+}
+
+// Returns the wrapped cosine of a 16-bit unsigned degree value.
+THUMB_FUNC s32 Cos_Wrap(u16 degrees)
+{
+    return gSineTable[(degrees % 360) + 90];
+}
+
+// Purpose unknown.
+THUMB_FUNC u16 MathUtil_0201B9A0(u16 x)
+{
+    return UNK_020EDC7E[x % 360];
+}
+
+// Returns the sine of a 32-bit signed degree value.
+THUMB_FUNC s32 Sin32(s32 degrees)
+{
+    return gSineTable[(u16)(degrees >> 12) % 360];
+}
+
+/*
+ * Random number generators
+ */
+static u32 sMTRNG_State[624]; // Mersenne Twister seed storage/buffer
+static union
+{
+    u32 LC_State; // Linear-congruential seed storage/buffer
+    u32 MTRNG_State[]; // Don't bother asking why Game Freak did this. Just don't.
+} sRNGHack;
+
+// Returns the Linear-congruential buffer in full.
+THUMB_FUNC u32 GetLCRNGSeed()
+{
+    return sRNGHack.LC_State;
+}
+
+// Initializes the Linear-congruential buffer with a 32-bit seed.
+THUMB_FUNC void SetLCRNGSeed(u32 seed)
+{
+    sRNGHack.LC_State = seed;
+}
+
+// Calculates an unsigned 16-bit random integer using the Linear-congruential algorithm.
+THUMB_FUNC u16 LCRandom(void)
+{
+    // cycle the RNG
+    sRNGHack.LC_State *= 0x41C64E6D;
+    sRNGHack.LC_State += 0x6073;
+    return (u16)(sRNGHack.LC_State / 65536); // shut up the compiler
+}
+
+// Returns a cheap, psuedo-random unsigned 32-bit random integer from a seed.
+THUMB_FUNC u32 PRandom(u32 seed)
+{
+    return seed * 1812433253 + 1; // seed from Mersenne Twister algorithm
+}
+
+static s32 sMTRNG_Cycles = 625; // Mersenne Twister cycle counter, 625 default value
+static u32 sMTRNG_XOR[2] = {0, 0x9908b0df}; // Mersenne Twister XOR mask table
+
+// Initializes the Mersenne Twister buffer with a 32-bit seed.
+THUMB_FUNC void SetMTRNGSeed(u32 seed)
+{
+    sRNGHack.MTRNG_State[0+1] = seed;
+
+    for (sMTRNG_Cycles = 1; sMTRNG_Cycles < 624; sMTRNG_Cycles++)
+        sMTRNG_State[sMTRNG_Cycles] = 1812433253 * (sMTRNG_State[sMTRNG_Cycles - 1] ^ (sMTRNG_State[sMTRNG_Cycles - 1] >> 30)) + sMTRNG_Cycles;
+}
+
+// Calculates an unsigned 32-bit random integer using the Mersenne Twister algorithm.
+THUMB_FUNC u32 MTRandom(void)
+{
+    u32 val;
+    s32 i;
+
+    if (sMTRNG_Cycles >= 624)
+    {
+        if (sMTRNG_Cycles == 625)
+            SetMTRNGSeed(5489);
+ 
+        for (i = 0; i < 227; i++)
+        {
+            val = (sMTRNG_State[i] & 0x80000000) | (sMTRNG_State[i + 1] & 0x7fffffff);
+            sMTRNG_State[i] = sMTRNG_State[i + 397] ^ (val >> 1) ^ sMTRNG_XOR[val & 0x1];
+        }
+        for (; i < 623; i++)
+        {
+            val = (sMTRNG_State[i] & 0x80000000) | (sMTRNG_State[i + 1] & 0x7fffffff);
+            sMTRNG_State[i] = sMTRNG_State[i + -227] ^ (val >> 1) ^ sMTRNG_XOR[val & 0x1];
+        }
+ 
+        val = (sRNGHack.MTRNG_State[623+1] & 0x80000000) | (sRNGHack.MTRNG_State[0+1] & 0x7fffffff);
+        sRNGHack.MTRNG_State[623+1] = sRNGHack.MTRNG_State[396+1] ^ (val >> 1) ^ sMTRNG_XOR[val & 0x1];
+
+        sMTRNG_Cycles = 0;
+    }
+ 
+    val = sMTRNG_State[sMTRNG_Cycles++]; // has to be this way in order to match
+ 
+    val ^= val >> 11;
+    val ^= (val << 7) & 0x9d2c5680;
+    val ^= (val << 15) & 0xefc60000;
+    val ^= val >> 18;
+ 
+    return val;
+}
+
+/*
+ * Nitro FX specific functions
+ */
+// Rotates and scales a 2D plane by a number of degrees.
+THUMB_FUNC void MTX22_2DAffine(struct Mtx22 * mtx, u16 radians, fx32 x, fx32 y, u8 type)
+{
+    if (type == 1)
+        radians = (u16)((u32)(radians * 65535) >> 8); // shut up the compiler
+    else if (type == 2)
+        radians = (u16)((u32)(radians * 65535) / 360); // shut up the compiler
+
+    MTX_Rot22_(mtx,
+        UNK_020FFA38[((radians >> 4) * 2)], // TODO: macros
+        UNK_020FFA38[((radians >> 4) * 2) + 1]); // TODO: macros
+    MTX_ScaleApply22(mtx, mtx, x, y);
+}
+
+/*
+ * Vector functions
+ */
+// Calculates the circular distance between two vector coordinates.
+THUMB_FUNC s32 CircularDistance(s32 x1, s32 y1, s32 x2, s32 y2)
+{
+    struct Vecx32 v1, v2, v3, v4;
+    fx32 f1, f2;
+    s32 ret;
+
+    // TODO: Code looks like it could have been macroized.
+    v1.x = x1 << FX32_INT_SHIFT;
+    v1.y = y1 << FX32_INT_SHIFT;
+    v1.z = 0;
+
+    v2.x = x2 << FX32_INT_SHIFT;
+    v2.y = y2 << FX32_INT_SHIFT;
+    v2.z = 0;
+
+    v4.x = 0;
+    v4.y = 0;
+    v4.z = FX32_MUL(v1.x, v2.y) - FX32_MUL(v2.x, v1.y);
+
+    f1 = v4.x + v4.y + v4.z;
+
+    v1.x = y1 << FX32_INT_SHIFT;
+    v1.y = x1 << FX32_INT_SHIFT;
+    v1.z = 0;
+
+    VEC_Normalize(&v1, &v3);
+
+    v1.x = x1 << FX32_INT_SHIFT;
+    v1.y = y1 << FX32_INT_SHIFT;
+    v1.z = 0;
+
+    v2.x = x2 << FX32_INT_SHIFT;
+    v2.y = y2 << FX32_INT_SHIFT;
+    v2.z = 0;
+
+    VEC_Subtract(&v2, &v1, &v4);
+    f2 = VEC_DotProduct(&v3, &v4);
+    ret = f2 >> FX32_INT_SHIFT;
+	ret = (ret < 0) ? -ret : ret;
+
+    if (f1 <= 0)
+        ret *= -1;
+    return ret;
+}
+
+THUMB_FUNC s32 MathUtil_0201BC84(u16 arg0, s32 arg1)
+{
+    return (arg1 * 65535) /
+        (FX32_MUL((arg0 * 2) << FX32_INT_SHIFT, FX32_CONST(3.140f)) >> FX32_INT_SHIFT);
+}