diff --git a/joint_trajectory_controller/include/joint_trajectory_controller/trajectory.hpp b/joint_trajectory_controller/include/joint_trajectory_controller/trajectory.hpp index a994b7fe5e..b00d79481c 100644 --- a/joint_trajectory_controller/include/joint_trajectory_controller/trajectory.hpp +++ b/joint_trajectory_controller/include/joint_trajectory_controller/trajectory.hpp @@ -58,18 +58,6 @@ class Trajectory const trajectory_msgs::msg::JointTrajectoryPoint & current_point, const std::vector & joints_angle_wraparound = std::vector()); - /** - * \param current_position The current position given from the controller, which will be adapted. - * \param next_position Next position from which to compute the wraparound offset, i.e., - * the first trajectory point - * \param joints_angle_wraparound Vector of boolean where true value corresponds to a joint that - * wrap around (ie. is continuous). - */ - JOINT_TRAJECTORY_CONTROLLER_PUBLIC - void wraparound_joint( - std::vector & current_position, const std::vector next_position, - const std::vector & joints_angle_wraparound); - JOINT_TRAJECTORY_CONTROLLER_PUBLIC void update(std::shared_ptr joint_trajectory); @@ -206,6 +194,17 @@ inline std::vector mapping(const T & t1, const T & t2) return mapping_vector; } +/** + * \param current_position The current position given from the controller, which will be adapted. + * \param next_position Next position from which to compute the wraparound offset, i.e., + * the first trajectory point + * \param joints_angle_wraparound Vector of boolean where true value corresponds to a joint that + * wrap around (ie. is continuous). + */ +void wraparound_joint( + std::vector & current_position, const std::vector next_position, + const std::vector & joints_angle_wraparound); + } // namespace joint_trajectory_controller #endif // JOINT_TRAJECTORY_CONTROLLER__TRAJECTORY_HPP_ diff --git a/joint_trajectory_controller/src/trajectory.cpp b/joint_trajectory_controller/src/trajectory.cpp index 143d547a55..0ed7f2ff13 100644 --- a/joint_trajectory_controller/src/trajectory.cpp +++ b/joint_trajectory_controller/src/trajectory.cpp @@ -57,7 +57,7 @@ void Trajectory::set_point_before_trajectory_msg( joints_angle_wraparound); } -void Trajectory::wraparound_joint( +void wraparound_joint( std::vector & current_position, const std::vector next_position, const std::vector & joints_angle_wraparound) {