80 lines
2.7 KiB
Python
80 lines
2.7 KiB
Python
# Copyright 2024 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 typing import Protocol
|
|
|
|
from lerobot.common.robot_devices.motors.configs import (
|
|
DynamixelMotorsBusConfig,
|
|
FeetechMotorsBusConfig,
|
|
MotorsBusConfig,
|
|
)
|
|
|
|
|
|
class MotorsBus(Protocol):
|
|
def motor_names(self): ...
|
|
def set_calibration(self): ...
|
|
def apply_calibration(self): ...
|
|
def revert_calibration(self): ...
|
|
def read(self): ...
|
|
def write(self): ...
|
|
|
|
|
|
def make_motors_buses_from_configs(motors_bus_configs: dict[str, MotorsBusConfig]) -> list[MotorsBus]:
|
|
motors_buses = {}
|
|
|
|
for key, cfg in motors_bus_configs.items():
|
|
if cfg.type == "dynamixel":
|
|
from lerobot.common.robot_devices.motors.dynamixel import DynamixelMotorsBus
|
|
|
|
motors_buses[key] = DynamixelMotorsBus(cfg)
|
|
|
|
elif cfg.type == "feetech":
|
|
from lerobot.common.robot_devices.motors.feetech import FeetechMotorsBus
|
|
|
|
motors_buses[key] = FeetechMotorsBus(cfg)
|
|
|
|
elif cfg.type == "realman":
|
|
from lerobot.common.robot_devices.motors.realman import RealmanMotorsBus
|
|
|
|
motors_buses[key] = RealmanMotorsBus(cfg)
|
|
|
|
elif cfg.type == "realman_dual":
|
|
from lerobot.common.robot_devices.motors.realman_dual import RealmanDualMotorsBus
|
|
|
|
motors_buses[key] = RealmanDualMotorsBus(cfg)
|
|
else:
|
|
raise ValueError(f"The motor type '{cfg.type}' is not valid.")
|
|
|
|
return motors_buses
|
|
|
|
|
|
def make_motors_bus(motor_type: str, **kwargs) -> MotorsBus:
|
|
if motor_type == "dynamixel":
|
|
from lerobot.common.robot_devices.motors.dynamixel import DynamixelMotorsBus
|
|
|
|
config = DynamixelMotorsBusConfig(**kwargs)
|
|
return DynamixelMotorsBus(config)
|
|
|
|
elif motor_type == "feetech":
|
|
from lerobot.common.robot_devices.motors.feetech import FeetechMotorsBus
|
|
|
|
config = FeetechMotorsBusConfig(**kwargs)
|
|
return FeetechMotorsBus(config)
|
|
|
|
else:
|
|
raise ValueError(f"The motor type '{motor_type}' is not valid.")
|
|
|
|
|
|
def get_motor_names(arm: dict[str, MotorsBus]) -> list:
|
|
return [f"{arm}_{motor}" for arm, bus in arm.items() for motor in bus.motors] |