Added more Box2D functionality

+ B2D debug draw
+ Batch point and line drawing
+ Reliable body-contact management
+ Misc clean up