Splitted method isRobotSimulator to test against gazebo and icubSim while waiting for a more correct implementation
small mods in controller
Merge branch 'rovereto' into simulink/paramInvDyn_forReal
Controller with parametric dynamics blocks tested