文件
Evo-RL/tests/teleoperators/test_so_leader.py

95 行
2.8 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 contextlib import contextmanager
from unittest.mock import MagicMock, patch
import pytest
from lerobot.teleoperators.so_leader import SO100Leader, SO100LeaderConfig
def _make_bus_mock() -> MagicMock:
bus = MagicMock(name="FeetechBusMock")
bus.is_connected = False
def _connect():
bus.is_connected = True
def _disconnect():
bus.is_connected = False
@contextmanager
def _dummy_cm():
yield
bus.connect.side_effect = _connect
bus.disconnect.side_effect = _disconnect
bus.torque_disabled.side_effect = _dummy_cm
return bus
@pytest.fixture
def leader():
bus_mock = _make_bus_mock()
def _bus_side_effect(*_args, **kwargs):
bus_mock.motors = kwargs["motors"]
motors_order: list[str] = list(bus_mock.motors)
bus_mock.sync_read.return_value = {motor: idx for idx, motor in enumerate(motors_order, 1)}
bus_mock.sync_write.return_value = None
bus_mock.write.return_value = None
bus_mock.disable_torque.return_value = None
bus_mock.is_calibrated = True
return bus_mock
with (
patch(
"lerobot.teleoperators.so_leader.so_leader.FeetechMotorsBus",
side_effect=_bus_side_effect,
),
patch.object(SO100Leader, "configure", lambda self: None),
):
cfg = SO100LeaderConfig(port="/dev/null")
teleop = SO100Leader(cfg)
yield teleop
if teleop.is_connected:
teleop.disconnect()
def test_connect_disconnect(leader):
assert not leader.is_connected
leader.connect()
assert leader.is_connected
leader.disconnect()
assert not leader.is_connected
def test_get_action(leader):
leader.connect()
action = leader.get_action()
expected_keys = {f"{m}.pos" for m in leader.bus.motors}
assert set(action.keys()) == expected_keys
def test_send_feedback(leader):
leader.connect()
feedback = {f"{m}.pos": i * 10 for i, m in enumerate(leader.bus.motors, 1)}
leader.send_feedback(feedback)
goal_pos = {m: (i + 1) * 10 for i, m in enumerate(leader.bus.motors)}
leader.bus.sync_write.assert_called_once_with("Goal_Position", goal_pos)