reset motion model (#5149)

Signed-off-by: Adi Vardi <[email protected]>

Author: adivardi

nav2_mppi_controller/src/optimizer.cpp

@@ -147,6 +147,8 @@ void Optimizer::reset()
   generated_trajectories_.reset(settings_.batch_size, settings_.time_steps);
 
   noise_generator_.reset(settings_, isHolonomic());
+  motion_model_->initialize(settings_.constraints, settings_.model_dt);
+
   RCLCPP_INFO(logger_, "Optimizer reset");
 }