MPPI Controller for Nav2