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 @@ -260,10 +260,13 @@ bool AstarSearch::search()
260
260
}
261
261
262
262
geometry_msgs::msg::Pose relative_goal_pose;
263
- relative_goal_pose.position .x = goal_pose_.position .x - (next_pose.position .x - start_pose_.position .x );
264
- relative_goal_pose.position .y = goal_pose_.position .y - (next_pose.position .y - start_pose_.position .y );
263
+ relative_goal_pose.position .x =
264
+ goal_pose_.position .x - (next_pose.position .x - start_pose_.position .x );
265
+ relative_goal_pose.position .y =
266
+ goal_pose_.position .y - (next_pose.position .y - start_pose_.position .y );
265
267
relative_goal_pose.orientation = goal_pose_.orientation ;
266
- const auto relative_goal_index = pose2index (costmap_, relative_goal_pose, planner_common_param_.theta_size );
268
+ const auto relative_goal_index =
269
+ pose2index (costmap_, relative_goal_pose, planner_common_param_.theta_size );
267
270
268
271
const auto & vertex_indexes_2d = vertex_indexes_table_[relative_goal_index.theta ];
269
272
bool relative_goal_is_out_of_range = false ;
You can’t perform that action at this time.
0 commit comments