mpc_dmp: added first version of additional control input for obstacle avoidance