Added foot sensor and Box2D debug draw