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

trajectory speed is not constant, after sending cancel goal #33

Open
708yamaguchi opened this issue Sep 28, 2017 · 0 comments
Open

trajectory speed is not constant, after sending cancel goal #33

708yamaguchi opened this issue Sep 28, 2017 · 0 comments

Comments

@708yamaguchi
Copy link
Contributor

when we send TrajectoryGoal with 1 positions, send cancel during execution, wait few more seconds, and then send the Trajectory again, the robot moves very quickly.

point2 = JointTrajectoryPoint()
point2.positions = [0,0,0,-1.57,1.57,0,0]
point2.time_from_start = rospy.Duration(10)
goal2.trajectory.points.append(point2)


rospy.logwarn("send goal2")
action.send_goal(goal2)
# sleeep 2                                                                                                                       
rospy.sleep(rospy.Duration(3))
rospy.logwarn("send cancel")
action.cancel_goal()
#                                                                                                                                
rospy.sleep(rospy.Duration(10))
rospy.logwarn("sleep 10sec")

# send goal 2                                                                                                                    
rospy.logwarn("send goal2 again")
action.send_goal_and_wait(goal2)

script to reproduce this behavior is https://gist.github.com/708yamaguchi/324b7ef246175619cc3fe7fe7e4bac76

and joint position profile during this experiment is
image

Our first guess is something related to
https://github.com/fetchrobotics/robot_controllers/blob/indigo-devel/robot_controllers/src/follow_joint_trajectory.cpp#L400

Cc: @knorth55, @k-okada

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

No branches or pull requests

1 participant