rienIntegrator is now stepped with "step" instead of "run"
added testMheMpc.py which runs mpc/mhe on a simple second order system trying to track a sin wave