Box2D Improvements

Cleaned up the source files, implemented more debug macros and properly
got some joint functions working.

I also implemented angular unit functions to my universal system scalar header that allow major systems to switch between degree and radian conversion to further eliminate casting.