New set of gains for MPCs (for h_ref), new velocities tests in joystick, scripts to eval RMSE, small fix in control cycle eval scripts