tangger/lerobot
1
0
Fork 1
Code Issues Pull Requests Actions 1 Packages Projects Releases Wiki Activity

Update feetech read_calibration

Browse Source
This commit is contained in:
Simon Alibert
2025-05-22 17:59:54 +02:00
parent 4bb965c283
commit cedaa83bce
1 changed files with 8 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
lerobot/common/motors/feetech/feetech.py
View File

@@ -250,20 +250,14 @@ class FeetechMotorsBus(MotorsBus):
return same_ranges and same_offsets return same_ranges and same_offsets
def read_calibration(self) -> dict[str, MotorCalibration]: def read_calibration(self) -> dict[str, MotorCalibration]:
if self.protocol_version == 0: offsets, mins, maxes = {}, {}, {}
offsets = self.sync_read("Homing_Offset", normalize=False) drive_modes = dict.fromkeys(self.motors, 0)
mins = self.sync_read("Min_Position_Limit", normalize=False) for motor in self.motors:
maxes = self.sync_read("Max_Position_Limit", normalize=False) mins[motor] = self.read("Min_Position_Limit", motor, normalize=False)
drive_modes = dict.fromkeys(self.motors, 0) maxes[motor] = self.read("Max_Position_Limit", motor, normalize=False)
else: offsets[motor] = (
offsets, mins, maxes, drive_modes = {}, {}, {}, {} self.read("Homing_Offset", motor, normalize=False) if self.protocol_version == 0 else 0
for motor in self.motors: )
offsets[motor] = 0
mins[motor] = self.read("Min_Position_Limit", motor, normalize=False)
maxes[motor] = self.read("Max_Position_Limit", motor, normalize=False)
drive_modes[motor] = 0
# TODO(aliberts): add set/get_drive_mode?
calibration = {} calibration = {}
for motor, m in self.motors.items(): for motor, m in self.motors.items():