Skip to content

Commit 725b33e

Browse files
committed
Much simplier version of creating the arm_joint_command using an already provided function
1 parent 6bd115d commit 725b33e

File tree

1 file changed

+1
-8
lines changed

1 file changed

+1
-8
lines changed

spot_wrapper/wrapper.py

Lines changed: 1 addition & 8 deletions
Original file line numberDiff line numberDiff line change
@@ -1329,14 +1329,7 @@ def velocity_cmd(
13291329
def arm_joint_cmd(
13301330
self, *, sh0: float, sh1: float, el0: float, el1: float, wr0: float, wr1: float
13311331
) -> typing.Tuple[bool, str]:
1332-
traj_point = RobotCommandBuilder.create_arm_joint_trajectory_point(sh0, sh1, el0, el1, wr0, wr1)
1333-
arm_joint_traj = arm_command_pb2.ArmJointTrajectory(points=[traj_point])
1334-
1335-
joint_move_command = arm_command_pb2.ArmJointMoveCommand.Request(trajectory=arm_joint_traj)
1336-
arm_command = arm_command_pb2.ArmCommand.Request(arm_joint_move_command=joint_move_command)
1337-
sync_arm_command = synchronized_command_pb2.SynchronizedCommand.Request(arm_command=arm_command)
1338-
arm_sync_robot_cmd = robot_command_pb2.RobotCommand(synchronized_command=sync_arm_command)
1339-
robot_command = RobotCommandBuilder.build_synchro_command(arm_sync_robot_cmd)
1332+
robot_command = RobotCommandBuilder.arm_joint_command(sh0, sh1, el0, el1, wr0, wr1)
13401333
response = self._robot_command(robot_command)
13411334
return response[0], response[1]
13421335

0 commit comments

Comments
 (0)