diff --git a/src/VOSS/exit_conditions/ToleranceExitCondition.cpp b/src/VOSS/exit_conditions/ToleranceExitCondition.cpp index c04d826..3614cca 100644 --- a/src/VOSS/exit_conditions/ToleranceExitCondition.cpp +++ b/src/VOSS/exit_conditions/ToleranceExitCondition.cpp @@ -5,7 +5,7 @@ namespace voss::controller { bool ToleranceExitCondition::is_met(Pose pose, bool thru) { if (this->target_has_coordinate() && this->target_has_heading()) { - return ang_exit->is_met(pose, thru) && ang_exit->is_met(pose, thru); + return ang_exit->is_met(pose, thru) && lin_exit->is_met(pose, thru); } else if (this->target_has_coordinate()) { return lin_exit->is_met(pose, thru); } else if (this->target_has_heading()) {