ydy0615/lerobot-clone
1
0
Fork 0
mirror of https://github.com/huggingface/lerobot.git synced 2026-06-03 04:11:24 +00:00
Code Issues Packages Projects Releases Wiki Activity

Subtract middle

Browse Source
This commit is contained in:
Pepijn
2025-07-01 18:09:36 +02:00
parent 63e2a2e129
commit 12d1629aae
2 changed files with 5 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

1
lerobot/common/motors/feetech/tables.py
View File

@@ -197,6 +197,7 @@ HLS_SERIES_CONTROL_TABLE = {
"Present_Load": (60, 2),
"Present_Voltage": (62, 1),
"Present_Current": (69, 2),
"Present_Bias": (73, 2),
# Factory
"Maximum_Velocity_Limit": (84, 1),
"Maximum_Acceleration": (85, 1),

6
lerobot/common/motors/motors_bus.py
View File

@@ -797,7 +797,8 @@ class MotorsBus(abc.ABC):
normalized_values[id_] = 100 - norm if drive_mode else norm
elif self.motors[motor].norm_mode is MotorNormMode.DEGREES:
deg = bounded_val * COUNT_TO_DEG
normalized_values[id_] = -deg if drive_mode else deg
deg_zero = deg - 180 # Subtract 180 degrees because 2047 (raw count) should be 0 degrees
normalized_values[id_] = -deg_zero if drive_mode else deg_zero
else:
raise NotImplementedError
@@ -826,7 +827,8 @@ class MotorsBus(abc.ABC):
unnormalized_values[id_] = int((bounded_val / 100) * (max_ - min_) + min_)
elif self.motors[motor].norm_mode is MotorNormMode.DEGREES:
val = -val if drive_mode else val
raw_counts = int(round(val / COUNT_TO_DEG))
deg = val + 180 # Add 180 degrees because 0 degrees should be 2047 (raw count)
raw_counts = int(round(deg / COUNT_TO_DEG))
unnormalized_values[id_] = raw_counts
else:
raise NotImplementedError