Added new test to check setFloatingBaseLink
Updated parametric test to check CoM consistency between models by adding KDL and YARP versions of getCOM