diff --git a/wpilibc/src/main/native/cpp/simulation/SingleJointedArmSim.cpp b/wpilibc/src/main/native/cpp/simulation/SingleJointedArmSim.cpp index d70dfb561a..88e45c6186 100644 --- a/wpilibc/src/main/native/cpp/simulation/SingleJointedArmSim.cpp +++ b/wpilibc/src/main/native/cpp/simulation/SingleJointedArmSim.cpp @@ -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 { diff --git a/wpilibj/src/main/java/edu/wpi/first/wpilibj/simulation/SingleJointedArmSim.java b/wpilibj/src/main/java/edu/wpi/first/wpilibj/simulation/SingleJointedArmSim.java index c64a434da4..b6a5e85dfb 100644 --- a/wpilibj/src/main/java/edu/wpi/first/wpilibj/simulation/SingleJointedArmSim.java +++ b/wpilibj/src/main/java/edu/wpi/first/wpilibj/simulation/SingleJointedArmSim.java @@ -177,7 +177,7 @@ public class SingleJointedArmSim extends LinearSystemSim { * @return Whether the arm would hit the lower limit. */ public boolean wouldHitLowerLimit(double currentAngleRads) { - return currentAngleRads < this.m_minAngle; + return currentAngleRads <= this.m_minAngle; } /** @@ -187,7 +187,7 @@ public class SingleJointedArmSim extends LinearSystemSim { * @return Whether the arm would hit the upper limit. */ public boolean wouldHitUpperLimit(double currentAngleRads) { - return currentAngleRads > this.m_maxAngle; + return currentAngleRads >= this.m_maxAngle; } /**