[wpilib] SingleJointedArmSim: Check angle equals limit on wouldHit (#4567)

This commit is contained in:
amquake
2022-11-04 17:14:46 -07:00
committed by GitHub
parent 64a7136e08
commit 2c20fd0d09
2 changed files with 4 additions and 4 deletions

View File

@@ -40,11 +40,11 @@ SingleJointedArmSim::SingleJointedArmSim(
simulateGravity, measurementStdDevs) {}
bool SingleJointedArmSim::WouldHitLowerLimit(units::radian_t armAngle) const {
return armAngle < m_minAngle;
return armAngle <= m_minAngle;
}
bool SingleJointedArmSim::WouldHitUpperLimit(units::radian_t armAngle) const {
return armAngle > m_maxAngle;
return armAngle >= m_maxAngle;
}
bool SingleJointedArmSim::HasHitLowerLimit() const {