Add functions

Evaluated from: https://github.com/ThuCommix/Sharpex.GameLibrary/blob/master/Sharpex.GameLibrary/Framework/Math/MathHelper.cs