|
|
@ -345,7 +345,7 @@ class KeyboardTeleopNode: |
|
|
|
if joint_name == "joint_gripper_finger_left": |
|
|
|
trajectory_goal.trajectory.joint_names = ['joint_gripper_finger_left', 'joint_gripper_finger_right'] |
|
|
|
else: |
|
|
|
trajectory_goal.trajectory.joint_names = ['joint_arm_l1', 'joint_arm_l2', 'joint_arm_l3'] |
|
|
|
trajectory_goal.trajectory.joint_names = ['joint_arm_l0','joint_arm_l1', 'joint_arm_l2', 'joint_arm_l3'] |
|
|
|
positions = [] |
|
|
|
for j_name in trajectory_goal.trajectory.joint_names: |
|
|
|
joint_index = joint_state.name.index(j_name) |
|
|
|