qpsolver_wrapper merged into simulation_loop.
MPC + WB control.