Start off from #183 - [ ] tune gains and show improved tracking and/or failure avoidance with MPC vs. reactive - [ ] tune dt, N more