RoboMaster/RoboRTS

RoboRTS/roborts_planning/local_planner/timed_elastic_band/src/teb_local_planner.cpp 中 GetPlan() SetPlan() 无返回值造成内存异常

Opened this issue · 0 comments

RoboRTS/roborts_planning/local_planner/timed_elastic_band/src/teb_local_planner.cpp 的第238-255行两个方法无返回值,运行时内存异常。
bool TebLocalPlanner::SetPlan(const nav_msgs::Path& plan, const geometry_msgs::PoseStamped& goal) {
if (plan_mutex_.try_lock()) {
ROS_INFO("set plan");
if (plan.poses.empty()) {
temp_plan_.poses.push_back(goal);
} else {
temp_plan_ = plan;
}
plan_mutex_.unlock();
}}
bool TebLocalPlanner::GetPlan(const nav_msgs::Path& plan) {
if (plan_mutex_.try_lock()) {
global_plan_ = plan;
plan_mutex_.unlock();
}}

(本人入门小白,如有误报,敬请原谅。)