updated NMPC and mpc-mhe loop, added some useful functions for the mpc-mhe loop
don't scale time twice in ocp export