File tree 1 file changed +6
-3
lines changed
planning/freespace_planning_algorithms/src
1 file changed +6
-3
lines changed Original file line number Diff line number Diff line change @@ -259,10 +259,13 @@ bool AstarSearch::search()
259
259
}
260
260
261
261
geometry_msgs::msg::Pose relative_goal_pose;
262
- relative_goal_pose.position .x = goal_pose_.position .x - (next_pose.position .x - start_pose_.position .x );
263
- relative_goal_pose.position .y = goal_pose_.position .y - (next_pose.position .y - start_pose_.position .y );
262
+ relative_goal_pose.position .x =
263
+ goal_pose_.position .x - (next_pose.position .x - start_pose_.position .x );
264
+ relative_goal_pose.position .y =
265
+ goal_pose_.position .y - (next_pose.position .y - start_pose_.position .y );
264
266
relative_goal_pose.orientation = goal_pose_.orientation ;
265
- const auto relative_goal_index = pose2index (costmap_, relative_goal_pose, planner_common_param_.theta_size );
267
+ const auto relative_goal_index =
268
+ pose2index (costmap_, relative_goal_pose, planner_common_param_.theta_size );
266
269
267
270
const auto & vertex_indexes_2d = vertex_indexes_table_[relative_goal_index.theta ];
268
271
bool relative_goal_is_out_of_range = false ;
You can’t perform that action at this time.
0 commit comments