added the vx vy from linear and angular velocity