Port the math additions and changes from the Wii U sead repo

[leoetlino]

• https://github.com/aboood40091/sead/commit/473723efaf515c7958a70dc7fe83f0f98fc8c909
• https://github.com/aboood40091/sead/commit/082f4c76330a3936b8e68fea1a1363be51e6155b
• https://github.com/aboood40091/sead/commit/537cf2eaf8f1f0cb48e8300a4db424ecf12435c5 (only the math changes)
• https://github.com/aboood40091/sead/commit/de6bf0a4a0e68052c70205fa0a06207351a98685
• https://github.com/aboood40091/sead/commit/8fce6b69eb9f1d1944a11a22ecef855431ec91b7 (only the math changes)