Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

fix robot-moveit.l #252

Merged
merged 6 commits into from
Nov 2, 2016
Merged

fix robot-moveit.l #252

merged 6 commits into from
Nov 2, 2016

Conversation

k-okada
Copy link
Member

@k-okada k-okada commented Nov 1, 2016

@YoheiKakiuchi, please review. This PR incldues several changes in robot motion

  1. :angle-vector-motion-plan send trajectory not only joints incldues move-arm
  2. :angle-vector-motion-plan has new arguments, named :total time, which scales planned motion duration
  3. :add :start-offset-time, which adde start offet to trajecotry (for fetch)

(setq ret (send* self :angle-vector-make-trajectory av args))
(when ret
(setq traj (send ret :trajectory :joint_trajectory))
(when (< (send (send (car (last (send traj :points))) :time_from_start) :to-sec) 0.001)
(setq orig-total-time (send (send (car (last (send traj :points))) :time_from_start) :to-sec))
(when (< orig-total-time 0.001)
(unless reset-total-time
(ros::ros-error "Trajectory has very short duration")
(return-from :angle-vector-motion-plan nil))
(ros::ros-warn "reset Trajectory Total time")
Copy link
Member Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

@YoheiKakiuchi Do we need reset-total-time feature, if we have https://github.com/jsk-ros-pkg/jsk_pr2eus/pull/252/files#diff-113ce1b47d7cec61152334f1050188c1R479 feature? which always try to scale planned trajectory to use setting 'tm' value?

@k-okada k-okada merged commit 6040579 into jsk-ros-pkg:master Nov 2, 2016
@k-okada k-okada deleted the fix_moveit branch November 2, 2016 05:10
@708yamaguchi 708yamaguchi mentioned this pull request Feb 7, 2017
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

None yet

1 participant