Lite 6 - moveit_servo - Ros2 Humble #97
Comments
|
Hi @lu4k87 we will be working on this issue and hopefully will fix it next week. |
|
hey, thanks for the reply. it would be very nice if it would work somehow... i need the xbox control for my thesis at the end of the month :/ the following steps work so far: if you get this fixed, can you please include a short detailed step by step guide where every single step is listed? for a freshly set up ros2 humble system. many thanks and good luck, hope as soon as possible |
|
Hi @lu4k87 please update the latest code and try again. As for your doc request, we do have other development tasks going on recently, and we will optimize our doc for more details when we got time for it, thanks for your understanding. |
|
Hey penglongxiang |
if i want to set up the whole setup from scratch as described here in the git, the cmds:
and also
dont works.
what do i have to do after i have gone through the complete instructions. which files and parameters do i have to change so that i can control both the fake arm and the real robot with the xbox controller on a freshly installed ros2 system?
Please tell me, which steps i have to do, after a fresh and clear installation of (ros2 humble - Ubuntu (deb packages) + moveit2 + gazebo + gazebo-ros xarm_sdk in "dev_ws/src/xarm_ros2"
build + source.
Is it necessary to intall the whole "ws_moveit2"?
if yes, should i put the "ws_moveit2" in the "dev_ws_/src" like "xarm_ros2" or "home/dev_ws" and "home/ws_moveit2"?
And how to mangage the files from: "ws_moveit2" to "xarm_ros2/moveit_servo" and "xarm_moveit_config" ?
maybe i need to do the moveit setup assistant? but the setup assistant i can only found in "ws_moveit2" ?
thanks for help!
I run: >> ros2 launch xarm_moveit_servo lite6_moveit_servo_fake.launch.py joystick_type:=1
labadmin@MacPro:$ ros2 launch xarm_moveit_servo lite6_moveit_servo_fake.launch.py joystick_type:=1
[INFO] [launch]: All log files can be found below /home/labadmin/.ros/log/2024-09-13-12-33-59-114189-MacPro-21858
[INFO] [launch]: Default logging verbosity is set to INFO
[INFO] [rviz2-1]: process started with pid [21859]
[INFO] [spawner-2]: process started with pid [21861]
[INFO] [ros2_control_node-3]: process started with pid [21863]
[INFO] [spawner-4]: process started with pid [21865]
[ros2_control_node-3] [WARN] [1726223639.502481372] [controller_manager]: [Deprecated] Passing the robot description parameter directly to the control_manager node is deprecated. Use '/robot_description' topic from 'robot_state_publisher' instead.
[ros2_control_node-3] [INFO] [1726223639.502737967] [resource_manager]: Loading hardware 'uf_robot_hardware/UFRobotFakeSystemHardware'
[ros2_control_node-3] [INFO] [1726223639.510267751] [resource_manager]: Initialize hardware 'uf_robot_hardware/UFRobotFakeSystemHardware'
[ros2_control_node-3] [WARN] [1726223639.510305255] [mock_generic_system]: Parsing of optional initial interface values failed or uses a deprecated format. Add initial values for every state interface in the ros2_control.xacro. For example:
[ros2_control_node-3] <state_interface name="velocity">
[ros2_control_node-3] 0.0
[ros2_control_node-3] </state_interface>
[ros2_control_node-3] [INFO] [1726223639.510317014] [resource_manager]: Successful initialization of hardware 'uf_robot_hardware/UFRobotFakeSystemHardware'
[ros2_control_node-3] [INFO] [1726223639.510364229] [resource_manager]: 'configure' hardware 'uf_robot_hardware/UFRobotFakeSystemHardware'
[ros2_control_node-3] [INFO] [1726223639.510371931] [resource_manager]: Successful 'configure' of hardware 'uf_robot_hardware/UFRobotFakeSystemHardware'
[ros2_control_node-3] [INFO] [1726223639.510378465] [resource_manager]: 'activate' hardware 'uf_robot_hardware/UFRobotFakeSystemHardware'
[ros2_control_node-3] [INFO] [1726223639.510383611] [resource_manager]: Successful 'activate' of hardware 'uf_robot_hardware/UFRobotFakeSystemHardware'
[ros2_control_node-3] [INFO] [1726223639.513774900] [controller_manager]: update rate is 150 Hz
[ros2_control_node-3] [INFO] [1726223639.514617153] [controller_manager]: Successful set up FIFO RT scheduling policy with priority 50.
[spawner-4] [INFO] [1726223639.772828376] [spawner_lite6_traj_controller]: waiting for service /controller_manager/list_controllers to become available...
[spawner-2] [INFO] [1726223639.791344845] [spawner_joint_state_broadcaster]: waiting for service /controller_manager/list_controllers to become available...
[ros2_control_node-3] [INFO] [1726223640.024254236] [controller_manager]: Loading controller 'lite6_traj_controller'
[ros2_control_node-3] [WARN] [1726223640.031727924] [lite6_traj_controller]: [Deprecated]: "allow_nonzero_velocity_at_trajectory_end" is set to true. The default behavior will change to false.
[spawner-4] [INFO] [1726223640.035579400] [spawner_lite6_traj_controller]: Loaded lite6_traj_controller
[ros2_control_node-3] [INFO] [1726223640.043245699] [controller_manager]: Loading controller 'joint_state_broadcaster'
[spawner-2] [INFO] [1726223640.048972122] [spawner_joint_state_broadcaster]: Loaded joint_state_broadcaster
[ros2_control_node-3] [INFO] [1726223640.049557413] [controller_manager]: Configuring controller 'joint_state_broadcaster'
[ros2_control_node-3] [INFO] [1726223640.049629127] [joint_state_broadcaster]: 'joints' or 'interfaces' parameter is empty. All available state interfaces will be published
[spawner-2] [INFO] [1726223640.068932167] [spawner_joint_state_broadcaster]: Configured and activated joint_state_broadcaster
[rviz2-1] [INFO] [1726223640.110008526] [rviz2]: Stereo is NOT SUPPORTED
[rviz2-1] [INFO] [1726223640.110118528] [rviz2]: OpenGl version: 4.6 (GLSL 4.6)
[ros2_control_node-3] [INFO] [1726223640.117252898] [controller_manager]: Configuring controller 'lite6_traj_controller'
[ros2_control_node-3] [INFO] [1726223640.117377778] [lite6_traj_controller]: No specific joint names are used for command interfaces. Using 'joints' parameter.
[ros2_control_node-3] [INFO] [1726223640.117394114] [lite6_traj_controller]: Command interfaces are [position velocity] and state interfaces are [position velocity].
[ros2_control_node-3] [INFO] [1726223640.117409874] [lite6_traj_controller]: Using 'splines' interpolation method.
[ros2_control_node-3] [INFO] [1726223640.117977484] [lite6_traj_controller]: Controller state will be published at 25.00 Hz.
[ros2_control_node-3] [INFO] [1726223640.119080577] [lite6_traj_controller]: Action status changes will be monitored at 10.00 Hz.
[spawner-4] [INFO] [1726223640.142113382] [spawner_lite6_traj_controller]: Configured and activated lite6_traj_controller
[INFO] [spawner-2]: process has finished cleanly [pid 21861]
[rviz2-1] [INFO] [1726223640.220417158] [rviz2]: Stereo is NOT SUPPORTED
[INFO] [spawner-4]: process has finished cleanly [pid 21865]
[rviz2-1] Warning: class_loader.impl: SEVERE WARNING!!! A namespace collision has occurred with plugin factory for class rviz_default_plugins::displays::InteractiveMarkerDisplay. New factory will OVERWRITE existing one. This situation occurs when libraries containing plugins are directly linked against an executable (the one running right now generating this message). Please separate plugins out into their own library or just don't link against the library and use either class_loader::ClassLoader/MultiLibraryClassLoader to open.
[rviz2-1] at line 253 in /opt/ros/humble/include/class_loader/class_loader/class_loader_core.hpp
[INFO] [component_container-5]: process started with pid [21931]
[component_container-5] [INFO] [1726223640.618613238] [xarm_moveit_servo_container]: Load Library: /opt/ros/humble/lib/librobot_state_publisher_node.so
[component_container-5] [INFO] [1726223640.621568574] [xarm_moveit_servo_container]: Found class: rclcpp_components::NodeFactoryTemplate<robot_state_publisher::RobotStatePublisher>
[component_container-5] [INFO] [1726223640.621590796] [xarm_moveit_servo_container]: Instantiate class: rclcpp_components::NodeFactoryTemplate<robot_state_publisher::RobotStatePublisher>
[component_container-5] [INFO] [1726223640.629406155] [robot_state_publisher]: got segment link1
[component_container-5] [INFO] [1726223640.629432836] [robot_state_publisher]: got segment link2
[component_container-5] [INFO] [1726223640.629439745] [robot_state_publisher]: got segment link3
[component_container-5] [INFO] [1726223640.629445007] [robot_state_publisher]: got segment link4
[component_container-5] [INFO] [1726223640.629450154] [robot_state_publisher]: got segment link5
[component_container-5] [INFO] [1726223640.629455226] [robot_state_publisher]: got segment link6
[component_container-5] [INFO] [1726223640.629460307] [robot_state_publisher]: got segment link_base
[component_container-5] [INFO] [1726223640.629465564] [robot_state_publisher]: got segment link_eef
[component_container-5] [INFO] [1726223640.629470737] [robot_state_publisher]: got segment world
[INFO] [launch_ros.actions.load_composable_nodes]: Loaded node '/robot_state_publisher' in container '/xarm_moveit_servo_container'
[component_container-5] [INFO] [1726223640.632278356] [xarm_moveit_servo_container]: Load Library: /opt/ros/humble/lib/libstatic_transform_broadcaster_node.so
[component_container-5] [INFO] [1726223640.632533489] [xarm_moveit_servo_container]: Found class: rclcpp_components::NodeFactoryTemplate<tf2_ros::StaticTransformBroadcasterNode>
[component_container-5] [INFO] [1726223640.632548234] [xarm_moveit_servo_container]: Instantiate class: rclcpp_components::NodeFactoryTemplate<tf2_ros::StaticTransformBroadcasterNode>
[INFO] [launch_ros.actions.load_composable_nodes]: Loaded node '/static_tf2_broadcaster' in container '/xarm_moveit_servo_container'
[component_container-5] [ERROR] [1726223640.638635664] [xarm_moveit_servo_container]: Failed to find class with the requested plugin name 'moveit_servo::ServoServer' in the loaded library
[ERROR] [launch_ros.actions.load_composable_nodes]: Failed to load node 'servo_server' of type 'moveit_servo::ServoServer' in container '/xarm_moveit_servo_container': Failed to find class with the requested plugin name.
[component_container-5] [INFO] [1726223640.640253951] [xarm_moveit_servo_container]: Load Library: /home/labadmin/dev_ws/install/xarm_moveit_servo/lib/libxarm_joystick_input.so
[component_container-5] [INFO] [1726223640.641867855] [xarm_moveit_servo_container]: Found class: rclcpp_components::NodeFactoryTemplate<xarm_moveit_servo::JoyToServoPub>
[component_container-5] [INFO] [1726223640.641887989] [xarm_moveit_servo_container]: Instantiate class: rclcpp_components::NodeFactoryTemplate<xarm_moveit_servo::JoyToServoPub>
[component_container-5] [INFO] [1726223640.644800077] [joy_to_servo_node]: Found parameter - dof: 6
[component_container-5] [INFO] [1726223640.644856162] [joy_to_servo_node]: Found parameter - ros_queue_size: 10
[component_container-5] [INFO] [1726223640.644887771] [joy_to_servo_node]: Found parameter - joystick_type: 1
[component_container-5] [INFO] [1726223640.644925802] [joy_to_servo_node]: Found parameter - joy_topic: /joy
[component_container-5] [INFO] [1726223640.644959248] [joy_to_servo_node]: Found parameter - moveit_servo.cartesian_command_in_topic: ~/delta_twist_cmds
[component_container-5] [INFO] [1726223640.644992158] [joy_to_servo_node]: Found parameter - moveit_servo.joint_command_in_topic: ~/delta_joint_cmds
[component_container-5] [INFO] [1726223640.645027038] [joy_to_servo_node]: Found parameter - moveit_servo.robot_link_command_frame: link_base
[component_container-5] [INFO] [1726223640.645053392] [joy_to_servo_node]: Found parameter - moveit_servo.ee_frame_name: link_eef
[component_container-5] [INFO] [1726223640.645081269] [joy_to_servo_node]: Found parameter - moveit_servo.planning_frame: link_base
[INFO] [launch_ros.actions.load_composable_nodes]: Loaded node '/joy_to_servo_node' in container '/xarm_moveit_servo_container'
[component_container-5] [INFO] [1726223641.650682656] [xarm_moveit_servo_container]: Load Library: /opt/ros/humble/lib/libjoy.so
[component_container-5] [INFO] [1726223641.659802523] [xarm_moveit_servo_container]: Found class: rclcpp_components::NodeFactoryTemplatejoy::Joy
[component_container-5] [INFO] [1726223641.659831330] [xarm_moveit_servo_container]: Instantiate class: rclcpp_components::NodeFactoryTemplatejoy::Joy
[INFO] [launch_ros.actions.load_composable_nodes]: Loaded node '/joy_node' in container '/xarm_moveit_servo_container'
[component_container-5] [INFO] [1726223641.736408943] [joy_node]: Opened joystick: Xbox One S Controller. deadzone: 0.050000
[rviz2-1] [ERROR] [1726223643.346331270] [moveit_ros_visualization.motion_planning_frame]: Action server: /recognize_objects not available
[rviz2-1] [INFO] [1726223643.354769829] [moveit_ros_visualization.motion_planning_frame]: MoveGroup namespace changed: / -> . Reloading params.
[rviz2-1] [ERROR] [1726223643.503219304] [rviz2]: The link is static or has unrealistic inertia, so the equivalent inertia box will not be shown.
[rviz2-1]
[rviz2-1] [INFO] [1726223643.508627503] [moveit_rdf_loader.rdf_loader]: Loaded robot model in 0.00335508 seconds
[rviz2-1] [INFO] [1726223643.508663943] [moveit_robot_model.robot_model]: Loading robot model 'UF_ROBOT'...
[rviz2-1] [INFO] [1726223643.508676630] [moveit_robot_model.robot_model]: No root/virtual joint specified in SRDF. Assuming fixed joint
[rviz2-1] [INFO] [1726223643.608916920] [moveit_ros.planning_scene_monitor.planning_scene_monitor]: Starting planning scene monitor
[rviz2-1] [INFO] [1726223643.609376546] [moveit_ros.planning_scene_monitor.planning_scene_monitor]: Listening to '/monitored_planning_scene'
[rviz2-1] [ERROR] [1726223643.610306720] [rviz2]: The link is static or has unrealistic inertia, so the equivalent inertia box will not be shown.
[rviz2-1]
[rviz2-1] [ERROR] [1726223643.611978853] [rviz2]: The link is static or has unrealistic inertia, so the equivalent inertia box will not be shown.
[rviz2-1]
[rviz2-1] [INFO] [1726223643.614999805] [interactive_marker_display_96019329619392]: Connected on namespace: /rviz_moveit_motion_planning_display/robot_interaction_interactive_marker_topic
[rviz2-1] [ERROR] [1726223643.616448927] [rviz2]: The link is static or has unrealistic inertia, so the equivalent inertia box will not be shown.
[rviz2-1]
[rviz2-1] [ERROR] [1726223643.617993567] [rviz2]: The link is static or has unrealistic inertia, so the equivalent inertia box will not be shown.
[rviz2-1]
[rviz2-1] [INFO] [1726223643.640723510] [interactive_marker_display_96019329619392]: Sending request for interactive markers
[rviz2-1] [INFO] [1726223643.673028729] [interactive_marker_display_96019329619392]: Service response received for initialization
[rviz2-1] [INFO] [1726223648.621356082] [moveit_ros.planning_scene_monitor.planning_scene_monitor]: Failed to call service get_planning_scene, have you launched move_group or called psm.providePlanningSceneService()?
[rviz2-1] [INFO] [1726223648.621407446] [moveit_ros_visualization.motion_planning_frame]: group lite6
[rviz2-1] [INFO] [1726223648.621415115] [moveit_ros_visualization.motion_planning_frame]: Constructing new MoveGroup connection for group 'lite6' in namespace ''
[rviz2-1] [INFO] [1726223708.626356225] [move_group_interface]: Ready to take commands for planning group lite6.
The text was updated successfully, but these errors were encountered: