diff --git a/tesseract_command_language/src/poly/cartesian_waypoint_poly.cpp b/tesseract_command_language/src/poly/cartesian_waypoint_poly.cpp index e2041861f4..c10b822506 100644 --- a/tesseract_command_language/src/poly/cartesian_waypoint_poly.cpp +++ b/tesseract_command_language/src/poly/cartesian_waypoint_poly.cpp @@ -97,7 +97,8 @@ void tesseract_planning::CartesianWaypointPoly::print(const std::string& prefix) bool tesseract_planning::CartesianWaypointPoly::hasSeed() const { const auto& seed = getInterface().getSeed(); - return (seed.position.size() != 0 && !seed.joint_names.empty() && static_cast(seed.position.size()) == seed.joint_names.size()); + return (seed.position.size() != 0 && !seed.joint_names.empty() && + static_cast(seed.position.size()) == seed.joint_names.size()); } void tesseract_planning::CartesianWaypointPoly::clearSeed() { getInterface().setSeed(tesseract_common::JointState()); } diff --git a/tesseract_time_parameterization/ruckig/src/ruckig_trajectory_smoothing.cpp b/tesseract_time_parameterization/ruckig/src/ruckig_trajectory_smoothing.cpp index cdca10b7c5..977e9bdb3a 100644 --- a/tesseract_time_parameterization/ruckig/src/ruckig_trajectory_smoothing.cpp +++ b/tesseract_time_parameterization/ruckig/src/ruckig_trajectory_smoothing.cpp @@ -310,7 +310,8 @@ bool RuckigTrajectorySmoothing::compute(TrajectoryContainer& trajectory, Eigen::VectorXd new_duration_from_previous = original_duration_from_previous; double time_from_start = original_duration_from_previous(0); - for (Eigen::Index time_stretch_idx = 1; time_stretch_idx < static_cast(num_waypoints); ++time_stretch_idx) + for (Eigen::Index time_stretch_idx = 1; time_stretch_idx < static_cast(num_waypoints); + ++time_stretch_idx) { assert(time_stretch_idx < original_duration_from_previous.rows()); const double duration_from_previous =