Added test/tutorial for consistency between iDyn and iDynTree