diff --git a/gello/agents/gello_agent.py b/gello/agents/gello_agent.py index 4d8e3e3..717251b 100644 --- a/gello/agents/gello_agent.py +++ b/gello/agents/gello_agent.py @@ -139,10 +139,10 @@ class GelloAgent(Agent): # print(current_gripper) if current_gripper < 0.2: - self._robot.set_torque_mode(False) + # self._robot.set_torque_mode(False) return obs["joint_positions"] else: - self._robot.set_torque_mode(False) + # self._robot.set_torque_mode(False) return dyna_joints def get_gello_joint_state(self) -> Tuple[np.ndarray, float]: diff --git a/gello/dynamixel/driver.py b/gello/dynamixel/driver.py index 8375814..d7d712d 100644 --- a/gello/dynamixel/driver.py +++ b/gello/dynamixel/driver.py @@ -140,10 +140,10 @@ class DynamixelDriver(DynamixelDriverProtocol): # Disable torque for each Dynamixel servo self._torque_enabled = False - try: - self.set_torque_mode(self._torque_enabled) - except Exception as e: - print(f"port: {port}, {e}") + # try: + # self.set_torque_mode(self._torque_enabled) + # except Exception as e: + # print(f"port: {port}, {e}") self._stop_thread = Event() self._start_reading_thread() @@ -283,7 +283,7 @@ def main(): print(f"Joint angles for IDs {ids}: {joint_angles}") # Test setting torque mode - driver.set_torque_mode(True) + # driver.set_torque_mode(True) # driver.set_torque_mode(False) # driver.move_single_joint(1, 4) diff --git a/gello/robots/dynamixel.py b/gello/robots/dynamixel.py index 9a221cb..15deb2c 100644 --- a/gello/robots/dynamixel.py +++ b/gello/robots/dynamixel.py @@ -73,7 +73,7 @@ class DynamixelRobot(Robot): if real: self._driver = DynamixelDriver(joint_ids, port=port, baudrate=baudrate) - self._driver.set_torque_mode(False) + # self._driver.set_torque_mode(False) else: self._driver = FakeDynamixelDriver(joint_ids) self._torque_on = False