diff --git a/tests/test_rev_kinematics.py b/tests/test_rev_kinematics.py index 9072490..8eeac3f 100644 --- a/tests/test_rev_kinematics.py +++ b/tests/test_rev_kinematics.py @@ -43,6 +43,8 @@ def test_two_arms(): print(f"End-effector position: {tg.read_value(effector)}") print(f"quadratic error = {tg.read_value(error)}") + assert tg.read_value(error) < 1e-6 + if __name__ == '__main__': test_two_arms() \ No newline at end of file