diff --git a/robots/ninja/include/ninja/ninja_navigation.h b/robots/ninja/include/ninja/ninja_navigation.h index 65f2f3f75..38496fc47 100644 --- a/robots/ninja/include/ninja/ninja_navigation.h +++ b/robots/ninja/include/ninja/ninja_navigation.h @@ -94,6 +94,9 @@ namespace aerial_robot_navigation map module_joints_subs_; tf::Vector3 target_vel_candidate_; + double asm_vel_nav_threshold_; + int asm_xy_control_mode_; + int asm_vel_based_waypoint_; std::map assembled_modules_data_; std::vector joint_pos_errs_; diff --git a/robots/ninja/src/ninja_navigation.cpp b/robots/ninja/src/ninja_navigation.cpp index 43bf47baf..b93df934a 100644 --- a/robots/ninja/src/ninja_navigation.cpp +++ b/robots/ninja/src/ninja_navigation.cpp @@ -707,7 +707,7 @@ void NinjaNavigator::assemblyNavCallback(const aerial_robot_msgs::FlightNavConst tf::Vector3 target_delta = getTargetPosCand() - target_cog_pos; target_delta.setZ(0); - if(target_delta.length() > vel_nav_threshold_) + if(target_delta.length() > asm_vel_nav_threshold_) { ROS_WARN("start vel nav control for waypoint"); vel_based_waypoint_ = true;