void yarp2idyntree(const yarp::sig::Vector & yarpVector,
iDynTree::VectorDynSize & idyntreeVector)
{
idyntreeVector.resize(yarpVector.size());
for(size_t row=0; row < idyntreeVector.size(); row++)
{
idyntreeVector(row) = yarpVector(row);
}
return;
}
void floatingBaseEstimator_convertVectorFromDegreesToRadians(iDynTree::VectorDynSize & vector)
{
for(size_t i=0; i < vector.size(); i++)
{
vector(i) = floatingBaseEstimator_deg2rad(vector(i));
}
return;
}