How to increase CHOMP trajectory way-points?
Running ROS Melodic on Ubuntu 18.04. I would like to increase the amount of way-points generated by CHOMP during the path planning pipeline in MoveIt. For example, say I use CHOMP to plan a path between a start and goal state. If I listen to the /joint_states topic during the trajectory execution, I get n states between the start state and the goal state for each joint. I have tried increasing the publishing frequency of the /joint_states topic, but that only yields multiples of the original states. Is there a way to decrease the discretization step size of the trajectory when CHOMP processes a trajectory? I don't see any options in the chomp_planning_config.yaml file for decreasing discretization step size. Thank you!
if this is a real robot (or simulated hw, not MoveIt's kinematic play-out), then the nr of
JointState
messages typically has no correlation with the nr ofJointTrajectoryPoint
s in yourJointTrajectory
.This is not a real robot or simulated HW, it is a kinematic representation of a robot. I am using MoveIt to generate a trajectory using various motion planners and extracting the trajectory states for analysis. I do not have a JointTrajectoryPoints or JointTrajectory topic to my knowledge.
I'm not sure I follow.
If you are using MoveIt to plan a trajectory, wouldn't the resulting
Plan
contain your trajectory -- which containsJointTrajectoryPoint
s?Why would you want to "extract trajectory states" from the
joint_states
topic?Where is plan located? My current action sequence is as follows:
Is there an easier way to extract the trajectory? Also, even when I increase the publishing rate of /joint_states, the increased frequency just captures duplicate states, almost like a ZOH signal, leading me to believe the trajectory generation is discretized elsewhere.
are you pressing buttons in RViz, or using the MoveIt MoveGroup API?
If the first: the plan is 'nowhere' (only internal to RViz). If the second: the result of the planning request is "the plan".
Using RViz as your main entry point to MoveIt is not really the most efficient way to go about this.
You may want to consult the MoveIt tutorials.
I am not pressing any buttons in Rviz, I am using the MoveIt MoveGroup API to execute the motion and then visualizing the result in Rviz. I followed the MoveIt tutorials but have been unable to locate "where" the trajectory is stored and how I can access it. I figured the best way would be to monitor the joint state topic, but it lacks the resolution I desire.
The Move Group C++ Interface tutorial has some information on this. Refer to the Planning to a Pose goal section.