throw an error if the xind argument in addCost/addNonlinearConstraint/addBoundingBoxConstraint contains duplicate entries
The previous cost on ComDynamicsFullKinematics is incorrect when choosing the time interval, fix it
One gradient computation in SingleBodyDynamicsFullKinematics is incorrect