Kinovarobotics / ros_kortex

ROS packages for KINOVA® KORTEX™ robotic arms
Other
160 stars 159 forks source link

kortex_driver.launch fails to start with ros_melodic #248

Closed Miya-imslab closed 2 years ago

Miya-imslab commented 2 years ago

Description

hello. When I try to launch kortex_driver.launch, I get an error message "Joint 'finger_joint' not found in model 'gen3'". I would appreciate it if you could tell me if there is any solution. Below is the error message

   ROS_MASTER_URI=http://localhost:11311

process[my_gen3/my_gen3_driver-1]: started with pid [18056]
process[my_gen3/move_group-2]: started with pid [18057]
process[my_gen3/joint_state_publisher-3]: started with pid [18058]
process[my_gen3/robot_state_publisher-4]: started with pid [18059]
[ WARN] [1659513133.519141736]: Shutdown request received.
[ WARN] [1659513133.531242933]: Reason given for shutdown: [[/my_gen3/robot_state_publisher] Reason: new node registered with same name]
[my_gen3/robot_state_publisher-4] process has finished cleanly
log file: /home/srt/.ros/log/172b7c46-12f4-11ed-98f4-347df6113820/my_gen3-robot_state_publisher-4*.log
[ WARN] [1659513133.879240542]: ROS parameter /use_sim_time is true : you may experience problems and you should set it to false and restart the driver.
[ INFO] [1659513133.882513296, 9.505000000]: Loading robot model 'gen3'...
[ INFO] [1659513133.895336366, 9.509000000]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ WARN] [1659513134.672841464, 9.723000000]: The root link base_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia.  As a workaround, you can add an extra dummy link to your URDF.
[ INFO] [1659513136.290582480, 10.219000000]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1659513136.304811874, 10.225000000]: MoveGroup debug mode is OFF
Starting planning scene monitors...
[ INFO] [1659513136.304905316, 10.225000000]: Starting planning scene monitor
[ INFO] [1659513136.316453305, 10.229000000]: Listening to '/my_gen3/planning_scene'
[ INFO] [1659513136.316542244, 10.229000000]: Starting world geometry update monitor for collision objects, attached objects, octomap updates.
[ INFO] [1659513136.338839684, 10.236000000]: Listening to '/my_gen3/collision_object'
[ INFO] [1659513136.379151960, 10.248000000]: Listening to '/my_gen3/planning_scene_world' for planning scene world geometry
[ WARN] [1659513136.383558171, 10.250000000]: Resolution not specified for Octomap. Assuming resolution = 0.1 instead
[ INFO] [1659513136.387308623, 10.250000000]: No 3D sensor plugin(s) defined for octomap updates
[ INFO] [1659513138.100649227, 10.910000000]: Listening to '/my_gen3/attached_collision_object' for attached collision objects
Planning scene monitors started.
[ERROR] [1659513138.218345150, 10.962000000]: Joint 'finger_joint' not found in model 'gen3'
[ERROR] [1659513138.278090524, 10.983000000]: Joint 'finger_joint' not found in model 'gen3'
[ INFO] [1659513138.286500140, 10.988000000]: Initializing OMPL interface using ROS parameters
[ERROR] [1659513138.315307482, 11.003000000]: Joint 'finger_joint' not found in model 'gen3'
[ERROR] [1659513138.375192987, 11.025000000]: Joint 'finger_joint' not found in model 'gen3'
[ERROR] [1659513138.425225086, 11.042000000]: Joint 'finger_joint' not found in model 'gen3'
[ INFO] [1659513138.446950875, 11.049000000]: Using planning interface 'OMPL'
[ INFO] [1659513138.472082614, 11.056000000]: Param 'default_workspace_bounds' was not set. Using default value: 10
[ INFO] [1659513138.478287175, 11.059000000]: Param 'start_state_max_bounds_error' was set to 0.1
[ INFO] [1659513138.480045148, 11.059000000]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1659513138.483271418, 11.059000000]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1659513138.486119232, 11.060000000]: Param 'jiggle_fraction' was set to 0.05
[ INFO] [1659513138.490601081, 11.060000000]: Param 'max_sampling_attempts' was not set. Using default value: 100
[ INFO] [1659513138.490958987, 11.060000000]: Using planning request adapter 'Add Time Parameterization'
[ INFO] [1659513138.491064835, 11.060000000]: Using planning request adapter 'Fix Workspace Bounds'
[ INFO] [1659513138.491116041, 11.060000000]: Using planning request adapter 'Fix Start State Bounds'
[ INFO] [1659513138.491170195, 11.060000000]: Using planning request adapter 'Fix Start State In Collision'
[ INFO] [1659513138.491257594, 11.060000000]: Using planning request adapter 'Fix Start State Path Constraints'
[ERROR] [1659513138.499323954, 11.063000000]: Joint 'finger_joint' not found in model 'gen3'
[ERROR] [1659513138.560311598, 11.082000000]: Joint 'finger_joint' not found in model 'gen3'
[ERROR] [1659513138.632608485, 11.102000000]: Joint 'finger_joint' not found in model 'gen3'
[ERROR] [1659513138.695053826, 11.122000000]: Joint 'finger_joint' not found in model 'gen3'
[ERROR] [1659513138.751421517, 11.142000000]: Joint 'finger_joint' not found in model 'gen3'
^C[my_gen3/joint_state_publisher-3] killing on exit
[my_gen3/move_group-2] killing on exit
[ERROR] [1659513138.808988313, 11.162000000]: Joint 'finger_joint' not found in model 'gen3'
[my_gen3/my_gen3_driver-1] killing on exit
Loading 'move_group/ApplyPlanningSceneService'...
Loading 'move_group/ClearOctomapService'...
Loading 'move_group/MoveGroupCartesianPathService'...
Loading 'move_group/MoveGroupExecuteTrajectoryAction'...
Loading 'move_group/MoveGroupGetPlanningSceneService'...
Loading 'move_group/MoveGroupKinematicsService'...
Loading 'move_group/MoveGroupMoveAction'...
Loading 'move_group/MoveGroupPickPlaceAction'...
Loading 'move_group/MoveGroupPlanService'...
Loading 'move_group/MoveGroupQueryPlannersService'...
Loading 'move_group/MoveGroupStateValidationService'...

You can start planning now!

[my_gen3/my_gen3_driver-1] escalating to SIGTERM
shutting down processing monitor...
... shutting down processing monitor complete
done
felixmaisonneuve commented 2 years ago

Hi @sleepysummer,

Can you give the exact command you are using? The first line you get is a warning that says "Shutdown request received.". This is not something I would expect. Are you running other ros nodes in the background?

Are you using a prefix? Did you change any .yaml or .lauch file?

Regards, Felix

Miya-imslab commented 2 years ago

使用しているコマンドは、 "roscore" "roslaunch kortex_gazebo spawn_kortex_robot.launch" "roslaunch uvc_camera camera_node.launch" "roslaunch kortex_examples kortex_driver.launch" の4つです。

プレフィックスは使用していません。また、.launchファイルのgripperの名前をrobotiq_2f_85に変更しました。

felixmaisonneuve commented 2 years ago

You are launching a gazebo simulation of the arm (roslaunch kortex_gazebo spawn_kortex_robot.launch) before launching your driver (roslaunch kortex_driver kortex_driver.launch). It might be problematic since they are both using the same namespace (if I remember correctly).

Could you try to try to launch your arm's driver without launching gazebo first?

Miya-imslab commented 2 years ago

ありがとうございます。ただ、"roslaunch kortex_driver kortex_driver.launch"を単独で起動しましたが、以下のエラーが出ました。 何か解決策はありますか?

NODES
  /my_gen3/
    joint_state_publisher (joint_state_publisher/joint_state_publisher)
    move_group (moveit_ros_move_group/move_group)
    my_gen3_driver (kortex_driver/kortex_arm_driver)
    robot_state_publisher (robot_state_publisher/robot_state_publisher)
    rviz (rviz/rviz)

ROS_MASTER_URI=http://localhost:11311

process[my_gen3/my_gen3_driver-1]: started with pid [16048]
process[my_gen3/move_group-2]: started with pid [16049]
process[my_gen3/joint_state_publisher-3]: started with pid [16050]
process[my_gen3/robot_state_publisher-4]: started with pid [16051]
process[my_gen3/rviz-5]: started with pid [16052]
[ WARN] [1659653253.150315489]: The root link base_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia.  As a workaround, you can add an extra dummy link to your URDF.
[ INFO] [1659653253.174526615]: Loading robot model 'gen3_robotiq_2f_85'...
[ INFO] [1659653253.175545153]: No root/virtual joint specified in SRDF. Assuming fixed joint
qt5ct: using qt5ct plugin
[ WARN] [1659653253.301944407]: Could not identify parent group for end-effector 'gripper'
[ WARN] [1659653253.348781070]: The root link base_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia.  As a workaround, you can add an extra dummy link to your URDF.
qt5ct: D-Bus global menu: no
[ INFO] [1659653253.412819051]: Session created successfully for TCP services
[ INFO] [1659653253.421673957]: Session created successfully for UDP services
[ERROR] [1659653253.431647995]: The gripper model specified in the launch file doesn't match the detected arm's gripper model, shutting down the node...
terminate called after throwing an instance of 'std::runtime_error*'
[my_gen3/my_gen3_driver-1] process has died [pid 16048, exit code -6, cmd /home/srt/catkin_ws/devel/lib/kortex_driver/kortex_arm_driver __name:=my_gen3_driver __log:=/home/srt/.ros/log/544e9f96-1442-11ed-8681-347df6113820/my_gen3-my_gen3_driver-1.log].
log file: /home/srt/.ros/log/544e9f96-1442-11ed-8681-347df6113820/my_gen3-my_gen3_driver-1*.log
felixmaisonneuve commented 2 years ago

You get this error because you have specified the "robotiq_2f_85" gripper in your launch file, but it is not present or not configured on your arm. To configure it, go to the Web App of the arm, "Configurations"->"Robot"->"Product"->"End Effector Type" and select "robotiq_2f_85"

image

Miya-imslab commented 2 years ago

その方法を試したらエラーを出さなくなり、グリッパーの動作が確認できました。丁寧に教えていただきありがとうございした。

felixmaisonneuve commented 2 years ago

Great!

I will close this issue then.

Best regards, Felix