[C++] The method forwardKinematics now selects by itself the section of the right DoFs over a full vector