adding final pose in analytic expansion to check (ros-navigation#4353)

Signed-off-by: stevedanomodolor <[email protected]>

Author: SteveMacenski

nav2_smac_planner/src/analytic_expansion.cpp

@@ -229,7 +229,7 @@ typename AnalyticExpansion<NodeT>::AnalyticExpansionNodes AnalyticExpansion<Node
   node_costs.reserve(num_intervals);
 
   // Check intermediary poses (non-goal, non-start)
-  for (float i = 1; i < num_intervals; i++) {
+  for (float i = 1; i <= num_intervals; i++) {
     state_space->interpolate(from(), to(), i / num_intervals, s());
     reals = s.reals();
     // Make sure in range [0, 2PI)