Removed duplication in the constraint evaluation in multiple shooting.
Removed duplication in the constraint evaluation in multiple shooting.

robotology/idyntree,robotology/idyntree,robotology/idyntree,robotology/idyntree,robotology/idyntree