Disable torque before applying calibration logic (#1889)
This commit is contained in:
@@ -110,6 +110,7 @@ class KochFollower(Robot):
|
|||||||
return self.bus.is_calibrated
|
return self.bus.is_calibrated
|
||||||
|
|
||||||
def calibrate(self) -> None:
|
def calibrate(self) -> None:
|
||||||
|
self.bus.disable_torque()
|
||||||
if self.calibration:
|
if self.calibration:
|
||||||
# Calibration file exists, ask user whether to use it or run new calibration
|
# Calibration file exists, ask user whether to use it or run new calibration
|
||||||
user_input = input(
|
user_input = input(
|
||||||
@@ -120,7 +121,6 @@ class KochFollower(Robot):
|
|||||||
self.bus.write_calibration(self.calibration)
|
self.bus.write_calibration(self.calibration)
|
||||||
return
|
return
|
||||||
logger.info(f"\nRunning calibration of {self}")
|
logger.info(f"\nRunning calibration of {self}")
|
||||||
self.bus.disable_torque()
|
|
||||||
for motor in self.bus.motors:
|
for motor in self.bus.motors:
|
||||||
self.bus.write("Operating_Mode", motor, OperatingMode.EXTENDED_POSITION.value)
|
self.bus.write("Operating_Mode", motor, OperatingMode.EXTENDED_POSITION.value)
|
||||||
|
|
||||||
|
|||||||
@@ -88,6 +88,7 @@ class KochLeader(Teleoperator):
|
|||||||
return self.bus.is_calibrated
|
return self.bus.is_calibrated
|
||||||
|
|
||||||
def calibrate(self) -> None:
|
def calibrate(self) -> None:
|
||||||
|
self.bus.disable_torque()
|
||||||
if self.calibration:
|
if self.calibration:
|
||||||
# Calibration file exists, ask user whether to use it or run new calibration
|
# Calibration file exists, ask user whether to use it or run new calibration
|
||||||
user_input = input(
|
user_input = input(
|
||||||
@@ -98,7 +99,6 @@ class KochLeader(Teleoperator):
|
|||||||
self.bus.write_calibration(self.calibration)
|
self.bus.write_calibration(self.calibration)
|
||||||
return
|
return
|
||||||
logger.info(f"\nRunning calibration of {self}")
|
logger.info(f"\nRunning calibration of {self}")
|
||||||
self.bus.disable_torque()
|
|
||||||
for motor in self.bus.motors:
|
for motor in self.bus.motors:
|
||||||
self.bus.write("Operating_Mode", motor, OperatingMode.EXTENDED_POSITION.value)
|
self.bus.write("Operating_Mode", motor, OperatingMode.EXTENDED_POSITION.value)
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user