snapshot: sync mint main from current workspace 2026-03-03 16:32:56 +0800

这个提交包含在:
Elvin
2026-03-03 16:32:56 +08:00
当前提交 908eb4bbbc
共有 677 个文件被更改,包括 167208 次插入 和 0 次删除

查看文件

@ -0,0 +1,79 @@
#!/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)

查看文件

@ -0,0 +1,150 @@
#!/usr/bin/env python
# Copyright 2025 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.reachy2_teleoperator import (
REACHY2_ANTENNAS_JOINTS,
REACHY2_L_ARM_JOINTS,
REACHY2_NECK_JOINTS,
REACHY2_R_ARM_JOINTS,
REACHY2_VEL,
Reachy2Teleoperator,
Reachy2TeleoperatorConfig,
)
# {lerobot_keys: reachy2_sdk_keys}
REACHY2_JOINTS = {
**REACHY2_NECK_JOINTS,
**REACHY2_ANTENNAS_JOINTS,
**REACHY2_R_ARM_JOINTS,
**REACHY2_L_ARM_JOINTS,
}
PARAMS = [
{}, # default config
{"with_mobile_base": False},
{"with_mobile_base": False, "with_l_arm": False, "with_antennas": False},
{"with_r_arm": False, "with_neck": False, "with_antennas": False},
{"with_mobile_base": False, "with_neck": False},
{"use_present_position": True},
]
def _make_reachy2_sdk_mock():
r = MagicMock(name="ReachySDKMock")
r.is_connected.return_value = True
def _connect():
r.is_connected.return_value = True
def _disconnect():
r.is_connected.return_value = False
# Mock joints with some dummy positions
joints = {
k: MagicMock(
present_position=float(i),
goal_position=float(i) + 0.5,
)
for i, k in enumerate(REACHY2_JOINTS.values())
}
r.joints = joints
# Mock mobile base with some dummy odometry
r.mobile_base = MagicMock()
r.mobile_base.last_cmd_vel = {
"vx": -0.2,
"vy": 0.2,
"vtheta": 11.0,
}
r.mobile_base.odometry = {
"x": 1.0,
"y": 2.0,
"theta": 20.0,
"vx": 0.1,
"vy": -0.1,
"vtheta": 8.0,
}
r.connect = MagicMock(side_effect=_connect)
r.disconnect = MagicMock(side_effect=_disconnect)
return r
@pytest.fixture(params=PARAMS, ids=lambda p: "default" if not p else ",".join(p.keys()))
def reachy2(request):
with (
patch(
"lerobot.teleoperators.reachy2_teleoperator.reachy2_teleoperator.ReachySDK",
side_effect=lambda *a, **k: _make_reachy2_sdk_mock(),
),
):
overrides = request.param
cfg = Reachy2TeleoperatorConfig(ip_address="192.168.0.200", **overrides)
robot = Reachy2Teleoperator(cfg)
yield robot
if robot.is_connected:
robot.disconnect()
def test_connect_disconnect(reachy2):
assert not reachy2.is_connected
reachy2.connect()
assert reachy2.is_connected
reachy2.disconnect()
assert not reachy2.is_connected
reachy2.reachy.disconnect.assert_called_once()
def test_get_action(reachy2):
reachy2.connect()
action = reachy2.get_action()
expected_keys = set(reachy2.joints_dict)
expected_keys.update(f"{v}" for v in REACHY2_VEL if reachy2.config.with_mobile_base)
assert set(action.keys()) == expected_keys
for motor in reachy2.joints_dict:
if reachy2.config.use_present_position:
assert action[motor] == reachy2.reachy.joints[REACHY2_JOINTS[motor]].present_position
else:
assert action[motor] == reachy2.reachy.joints[REACHY2_JOINTS[motor]].goal_position
if reachy2.config.with_mobile_base:
if reachy2.config.use_present_position:
for vel in REACHY2_VEL:
assert action[vel] == reachy2.reachy.mobile_base.odometry[REACHY2_VEL[vel]]
else:
for vel in REACHY2_VEL:
assert action[vel] == reachy2.reachy.mobile_base.last_cmd_vel[REACHY2_VEL[vel]]
def test_no_part_declared():
with pytest.raises(ValueError):
_ = Reachy2TeleoperatorConfig(
ip_address="192.168.0.200",
with_mobile_base=False,
with_l_arm=False,
with_r_arm=False,
with_neck=False,
with_antennas=False,
)

查看文件

@ -0,0 +1,94 @@
#!/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)