Added model matrix, box2d debug drawing