Skip to content

Commit

Permalink
Merge pull request #472 from shmpwk/fix/lookat
Browse files Browse the repository at this point in the history
[pr2eus_tutorials] fix look-at-hand
  • Loading branch information
k-okada committed Jan 9, 2022
2 parents 990f974 + 6e74541 commit 27066da
Showing 1 changed file with 3 additions and 3 deletions.
6 changes: 3 additions & 3 deletions pr2eus_tutorials/euslisp/pr2-tabletop-object-grasp.l
Original file line number Diff line number Diff line change
Expand Up @@ -155,15 +155,15 @@
(publish-grasp-state)
(publish-info "pre grasp pose...")
(send *ri* :stop-grasp *arm* :wait t)
(send *pr2* :head :look-at-hand *arm*)
(send *pr2* :look-at-hand *arm*)
(send *ri* :angle-vector (send *pr2* :angle-vector) 6000)
(send *ri* :wait-interpolation)

(setq *grasp-state* "grasp-approaching")
(publish-grasp-state)
(publish-info "reaching...")
(send *pr2* *arm* :move-end-pos #f(160 0 0) :world)
(send *pr2* :head :look-at-hand *arm*)
(send *pr2* :look-at-hand *arm*)
(send *ri* :angle-vector (send *pr2* :angle-vector) 3000)
(send *ri* :wait-interpolation)

Expand All @@ -183,7 +183,7 @@
(publish-grasp-state)
(publish-info "picking up...")
(send *pr2* *arm* :move-end-pos #f(0 0 150) :world)
(send *pr2* :head :look-at-hand *arm*)
(send *pr2* :look-at-hand *arm*)
(send *ri* :angle-vector (send *pr2* :angle-vector) 2000)
(send *ri* :wait-interpolation)
(publish-info "grasp succeeded!")
Expand Down

0 comments on commit 27066da

Please sign in to comment.