Matrix maths and helper functions. Needs MAJOR cleanup
Render test cube instead of triangle. Use view and perspective matrices