镜像自地址
https://github.com/MINT-SJTU/Evo-RL.git
已同步 2026-11-20 18:17:06 +00:00
80 行
2.4 KiB
Python
80 行
2.4 KiB
Python
#!/usr/bin/env python
|
|
|
|
# Copyright 2026 The HuggingFace Inc. team. All rights reserved.
|
|
#
|
|
# Licensed under the Apache License, Version 2.0 (the "License");
|
|
# you may not use this file except in compliance with the License.
|
|
# You may obtain a copy of the License at
|
|
#
|
|
# http://www.apache.org/licenses/LICENSE-2.0
|
|
#
|
|
# Unless required by applicable law or agreed to in writing, software
|
|
# distributed under the License is distributed on an "AS IS" BASIS,
|
|
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
# See the License for the specific language governing permissions and
|
|
# limitations under the License.
|
|
|
|
from unittest.mock import MagicMock, patch
|
|
|
|
import pytest
|
|
|
|
from lerobot.teleoperators.bi_so_leader import BiSOLeader, BiSOLeaderConfig
|
|
from lerobot.teleoperators.so_leader import SOLeaderConfig
|
|
from lerobot.utils.errors import DeviceNotConnectedError
|
|
|
|
|
|
def _make_arm_mock(name: str) -> MagicMock:
|
|
arm = MagicMock(name=name)
|
|
arm.is_connected = False
|
|
arm.is_calibrated = True
|
|
arm.action_features = {"joint.pos": float}
|
|
|
|
def _connect(*_args, **_kwargs):
|
|
arm.is_connected = True
|
|
|
|
def _disconnect():
|
|
arm.is_connected = False
|
|
|
|
arm.connect.side_effect = _connect
|
|
arm.disconnect.side_effect = _disconnect
|
|
arm.get_action.return_value = {"joint.pos": 0.0}
|
|
return arm
|
|
|
|
|
|
@pytest.fixture
|
|
def bi_leader():
|
|
left_arm = _make_arm_mock("left_arm")
|
|
right_arm = _make_arm_mock("right_arm")
|
|
|
|
with patch(
|
|
"lerobot.teleoperators.bi_so_leader.bi_so_leader.SOLeader",
|
|
side_effect=[left_arm, right_arm],
|
|
):
|
|
teleop = BiSOLeader(
|
|
BiSOLeaderConfig(
|
|
left_arm_config=SOLeaderConfig(port="/dev/left"),
|
|
right_arm_config=SOLeaderConfig(port="/dev/right"),
|
|
)
|
|
)
|
|
yield teleop, left_arm, right_arm
|
|
|
|
|
|
def test_set_manual_control_requires_connection(bi_leader):
|
|
teleop, _, _ = bi_leader
|
|
|
|
with pytest.raises(DeviceNotConnectedError):
|
|
teleop.set_manual_control(True)
|
|
|
|
|
|
def test_set_manual_control_forwards_to_both_arms(bi_leader):
|
|
teleop, left_arm, right_arm = bi_leader
|
|
teleop.connect()
|
|
|
|
teleop.set_manual_control(True)
|
|
teleop.set_manual_control(False)
|
|
|
|
left_arm.set_manual_control.assert_any_call(True)
|
|
left_arm.set_manual_control.assert_any_call(False)
|
|
right_arm.set_manual_control.assert_any_call(True)
|
|
right_arm.set_manual_control.assert_any_call(False)
|