More math...

I finished some more math for the engine, and have been looking into
shaders and stuff, i guess that should be my priority, getting some
graphics going but i will continue the physics part from now on.