Skip to content

Instantly share code, notes, and snippets.

@knorth55

knorth55/pr2-reset-pose.l

Last active November 7, 2019 15:35
Show Gist options
  • Save knorth55/0eb015cae0d0b46cef2a4cfa425df163 to your computer and use it in GitHub Desktop.
Save knorth55/0eb015cae0d0b46cef2a4cfa425df163 to your computer and use it in GitHub Desktop.
Download ZIP
Raw
pr2-reset-pose.l
(load "package://pr2eus/pr2-interface.l")
(pr2-init)
(pr2-tuckarm-pose)
(setq avs
(list
#f(50 0 64 70 -122 50 -115 -20 -4 74 -105 -90 70 -5 20 0 0)
#f(50 6 9 106 -77 35 -124 -20 -4 75 -104 -89 70 0 20 0 0)
#f(50 25 0 0 -121 0 -6 0 -4 75 -104 -89 70 0 20 0 0)
#f(50 25 0 0 -121 0 -6 0 -25 0 0 -121 0 -6 0 0 0)
#f(50 60 74 70 -120 20 -30 180 -25 0 0 -121 0 -6 0 0 0)
#f(50 60 74 70 -120 20 -30 180 -60 74 -70 -120 -20 -30 180 0 0)))
(setq tms (make-list (length avs) :initial-element 2000))
(send *ri* :angle-vector-sequence avs tms)
@knorth55
Copy link
Author

knorth55 commented Nov 7, 2019

pr2_reset_pose

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment