Robotics StackExchange | Archived questions

Moveit ROS2 Foxy Unable to identify any set of controllers

Hi everyone, I am trying to convert the configuration files (Kuka KR3) created by moveit2 setup assistant using ROS2 Humble to work with moveit in ROS2 Foxy. So far I am able to load the configuration in Rviz, but when I try to plan and execute a command I get the following error:

[move_group-4] [ERROR] [1682011288.218465041] [moveit_ros.trajectory_execution_manager]: Unable to identify any set of controllers that can actuate the specified joints: [ joint_a1 joint_a2 joint_a3 joint_a4 joint_a5 joint_a6 ]
[move_group-4] [ERROR] [1682011288.218482304] [moveit_ros.plan_execution]: Apparently trajectory initialization failed
[move_group-4] [INFO] [1682011288.218548900] [moveit_move_group_default_capabilities.move_action_capability]: Solution found but controller failed during execution
[move_group-4] [INFO] [1682011288.218548900] [moveit_move_group_default_capabilities.move_action_capability]: Solution found but controller failed during execution
[rviz2-1] [INFO] [1682011288.479528649] [move_group_interface]: Plan and Execute request aborted
[rviz2-1] [ERROR] [1682011288.579704635] [move_group_interface]: MoveGroupInterface::move() failed or timeout reached

Here is the ros2_controller.yaml:

# This config file is used by ros2_control
controller_manager:
  ros__parameters:
    update_rate: 100  # Hz

    arm_controller:
      type: joint_trajectory_controller/JointTrajectoryController


    hand_controller:
      type: joint_trajectory_controller/JointTrajectoryController


    joint_state_broadcaster:
      type: joint_state_broadcaster/JointStateBroadcaster

arm_controller:
  ros__parameters:
    joints:
      - joint_a1
      - joint_a2
      - joint_a3
      - joint_a4
      - joint_a5
      - joint_a6
    command_interfaces:
      - position
    state_interfaces:
      - position
      - velocity
hand_controller:
  ros__parameters:
    joints:
      - joint_left
      - joint_right
    command_interfaces:
      - position
    state_interfaces:
      - position
      - velocity

And moveit_controller.yaml:

moveit_controller_manager: moveit_simple_controller_manager/MoveItSimpleControllerManager

moveit_simple_controller_manager:
  controller_names:
    - arm_controller
    - hand_controller

  arm_controller:
    type: FollowJointTrajectory
    action_ns: follow_joint_trajectory
    default: true
    joints:
      - joint_a1
      - joint_a2
      - joint_a3
      - joint_a4
      - joint_a5
      - joint_a6
  hand_controller:
    type: FollowJointTrajectory
    action_ns: follow_joint_trajectory
    default: true
    joints:
      - joint_left
      - joint_right

I have all the controllers installed and I am able to run the example with the franka arm provided in moveit2 tutorials.

Any input would be highly appreciated!

Thank you!

Asked by AndreiV on 2023-04-20 12:39:31 UTC

Comments

Answers