Fixed bug in RigidBody2D.cpp