This commit is contained in:
Max Hunt 2020-03-01 22:20:34 +00:00
parent db9906a19f
commit 6362a2e5d4

View File

@ -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)