Skip to content

Commit

Permalink
[jsk_fetch_startup]Fix report in kitchen demo
Browse files Browse the repository at this point in the history
  • Loading branch information
nakane11 authored and knorth55 committed Sep 1, 2022
1 parent 7def554 commit 98b3f14
Showing 1 changed file with 3 additions and 3 deletions.
6 changes: 3 additions & 3 deletions jsk_fetch_robot/jsk_fetch_startup/euslisp/navigation-utils.l
Original file line number Diff line number Diff line change
Expand Up @@ -561,7 +561,7 @@ Args:
(ros::publish "/photo_taken" img)))))

(defun inspect-desk-back (&key (tweet t))
(report-move-to-tv-desk)
(report-move-to-desk-back)
(send *fetch* :angle-vector #f(21.5684 75.5832 80.1877 -11.4819 93.608 -0.04749 95.2016 -0.072829 -1.45585 10.8727))
(send *ri* :angle-vector-raw (send *fetch* :angle-vector) 3000 :head-controller)
(send *ri* :wait-interpolation)
Expand All @@ -573,7 +573,7 @@ Args:
(ros::publish "/photo_taken" img)))))

(defun inspect-desk-front (&key (tweet t))
(report-move-to-tv-desk)
(report-move-to-desk-front)
(send *fetch* :angle-vector #f(21.5761 75.5173 80.2097 -11.5478 93.6519 -0.04749 95.1796 -0.006954 -1.11597 10.8288))
(send *ri* :angle-vector-raw (send *fetch* :angle-vector) 3000 :head-controller)
(send *ri* :wait-interpolation)
Expand All @@ -585,7 +585,7 @@ Args:
(ros::publish "/photo_taken" img)))))

(defun inspect-kitchen-door-front (&key (tweet t))
(report-move-to-tv-desk)
(report-move-to-kitchen-door-front)
(send *fetch* :angle-vector #f(21.5608 75.5612 80.2316 -11.5039 93.586 -0.04749 95.1576 -0.050857 3.17796 16.3219))
(send *ri* :angle-vector-raw (send *fetch* :angle-vector) 3000 :head-controller)
(send *ri* :wait-interpolation)
Expand Down

0 comments on commit 98b3f14

Please sign in to comment.