feat: 发布同周期ACT控制样本

This commit is contained in:
2026-08-10 18:01:05 +08:00
parent 043d3d0533
commit e60d620dfe
3 changed files with 398 additions and 7 deletions
+4 -2
View File
@@ -686,9 +686,10 @@ def test_qp_failure_returns_last_known_good_target() -> None:
teleop._arm_name = "right_rm75"
teleop.get_logger = lambda: FakeLogger()
target = teleop._solve_joint_target(np.eye(4))
target, qp_success = teleop._solve_joint_target(np.eye(4))
assert target == pytest.approx([0.1] * 7)
assert not qp_success
assert teleop._last_valid_joint_target == pytest.approx([0.1] * 7)
@@ -704,9 +705,10 @@ def test_qp_success_updates_last_known_good_target() -> None:
teleop._arm_name = "left_rm75"
teleop.get_logger = lambda: FakeLogger()
target = teleop._solve_joint_target(np.eye(4))
target, qp_success = teleop._solve_joint_target(np.eye(4))
assert target == pytest.approx([0.2] * 7)
assert qp_success
assert teleop._last_valid_joint_target == pytest.approx([0.2] * 7)