[C++] Add test inside CoM unittest
[C++] Add test inside CoM unittest

fvalenza/pinocchio,aelkhour/pinocchio,aelkhour/pinocchio,fvalenza/pinocchio,fvalenza/pinocchio,aelkhour/pinocchio,fvalenza/pinocchio,aelkhour/pinocchio