fit_dmp: added some functions to evaluate the controllers
changed the max step of the ACADO fitting function to 4000