More cleanly decouple the high level controller from low level MPC

[LemonPi]

Currently the implementation bundles the high level controller and the low level MPPI together as a single class. The API should be cleaned up so any other low level MPC should be a drop-in replacement.