Working on b2DebugDraw