diff --git a/new_main.py b/new_main.py index e60b980..6fefef1 100644 --- a/new_main.py +++ b/new_main.py @@ -383,8 +383,17 @@ brick9after.orientation.z = 4.329780281177466e-17 brick9after.orientation.w = 4.329780281177467e-17 new_x = left_pnp.ik_request(brick9after) - left_pnp.send(new_x) +x = raw_input('Ready???') +brick9after2.position.x = 0.4664 +brick9after2.position.y = 0.349 +brick9after2.position.z = 0.6 +brick9after2.orientation.x = 0 +brick9after2.orientation.y = 0 +brick9after2.orientation.z = 0.707 +brick9after2.orientation.w = 0.707 +newest = left_pnp.ik_request(brick9after2) +left_pnp.send(newest) left_pnp.send(ta.H_pickup)