'How to get joint_position_command_ with velocity_controllers/JointTrajectoryController

I'm currently trying to move my robot by using ros_control with velocity_controllers/JointTrajectoryController I'm using the ros_control_boilerplate as a template.

I wanted to send joint_position_command_ to my robot, but velocity_controllers/JointTrajectoryController just sends joint_velocity_command_

I tried following the method here by deriving joint_position_command_ from joint_velocity_command_

but because of the steady-state error, joint_velocity_command_ is not 0, thus causing the joint_position_ to keep increasing/decreasing over time.

I'm currently thinking of getting the goal position values from /follow_joint_trajectory/goal (I'm guessing this is from MoveIt) May I know how could I access the value from this topic and store it into joint_position_command_?

or is there any other better method to get joint_position_command_ with velocity_controllers/JointTrajectoryController?

rosmoveit


Sources

This article follows the attribution requirements of Stack Overflow and is licensed under CC BY-SA 3.0.

Source: Stack Overflow

Solution Source

Related Questions