Moveit2 CHOMP: Only joint-space goals are supported
I am trying to use the CHOMP planner in Moveit2. I have managed to configure it in the pipeline and I can use it from the RViz interface. From move group I can also make it go to saved positions by
move_group_.setNamedTarget("SCAN_1");
the problem is when I try to reach a target position using:
ove_group_.setPoseTarget(target_pose, "hand_press");
or
move_group_.setJointValueTarget(target_pose, "hand_press");
I get the following error:
[chomp_planner] [ERROR] Only joint-space goals are supported
Hi, What is your target_pose? Is it x,y,z location or joint values? You cant use setPoseTarget with chomp planner, as it uses only joint values.
My target_pose is geometry_msgs::msg::PoseStamped with the x,y,z and orientation
Yes, that will not work with chomp planner. It needs joint values as input. Here you cant use "move_group_.setPoseTarget(target_pose, "hand_press");"
You will have to use "move_group_.setJointValueTarget(target_pose, "hand_press");". And here you will have to use 'joint_values' instead of 'target_pose'. Where 'joint_values' is of type "std::vector<double>". You can define 'joint_values' as: joint_values = {0.467856549620054, -1.3451591625519976, -0.49588841470121653, 0.8398919287470068}; (values inside the vectors are joint angles or values of all of your joints).
I also tried many times before and have reached the conclusion that the chomp planner in moveit2 is only capable of forward kinematics and not inverse kinematics. So if you will give a pose as an input (inverse kinematics), it won't work. You will have to give joint values of all joints as input (forward kinematics).
thank you very much. is there any way to get the inverse kinematics from a position and then pass it to CHOMP? Is it easy from move group inteface?
You can use a different planner like OMPL. That works properly for moveit2. You can use inverse and forward kinematics both with OMPL planner.
It was what I used in the past with bad results. Have you tried using CHOMP as a post-processor adapter for OMPL, as described here?