Get box2d working and rendering matching up

Add debug draw for box2d