Fixes and Minor Math update

Fixed the bad access error in the rendering loop in Scene.cpp.
(Hopefully)
Added some matrix functions (NYI)
System Update?