Fixed bug in box2d, added TODO.