diff --git a/main.py b/main.py index e0551f4..88b3c54 100755 --- a/main.py +++ b/main.py @@ -255,15 +255,15 @@ if __name__ == "__main__": left_pick = otc.tf_lookup('a3') left_pnp.pick(left_pick) - left_place_pre = otc.tf_lookup('t1') + left_place_pre = otc.tf_lookup('a1') xpos = brick_targets[0] zqtr = quaternion_from_euler(xpos['roll'], xpos['pitch'], xpos['yaw']) left_place_pos = Pose() - left_place_pos.position.x = left_place_pre.position.x + xpos['x'] - left_place_pos.position.y = left_place_pre.position.y + xpos['y'] - left_place_pos.position.z = left_place_pre.position.z + xpos['z'] + left_place_pos.position.x = left_place_pre.position.x + 0.1 #xpos['x'] + left_place_pos.position.y = left_place_pre.position.y + 0.1 #xpos['y'] + left_place_pos.position.z = left_place_pre.position.z + 0.1 #xpos['z'] left_place_pos.orientation.x = left_place_pre.orientation.x #+ zqtr[0] left_place_pos.orientation.y = left_place_pre.orientation.y #+ zqtr[1] left_place_pos.orientation.z = left_place_pre.orientation.z #+ zqtr[2]