Added a test case to test only gravity and distance task separately.

It was necessary to refactor a bit the structure of the code, porting in each test case the addition of the tasks we are interested in.
Added a small rotation error in the base. This is necessary since the random models generated by iDynTree seem always planar.