hsr-project / hsrb_moveit_config Goto Github PK
View Code? Open in Web Editor NEWLicense: BSD 3-Clause Clear License
License: BSD 3-Clause Clear License
HI @yosuke @yuka-hashiguchi @davidhsrtoyota thank you for your file sharing.
i would like to report this following error when i run :
roslaunch hsrb_moveit_config hsrb_demo.launch
and also i could not see the interactive marker move the arm of HSR
please kindly help to solve this following error, thank you
kubota-lab@kubotalab-P960EF:~/ws_moveit$ roslaunch hsrb_moveit_config hsrb_demo.launch
... logging to /home/kubota-lab/.ros/log/71e55dc0-0912-11eb-9abb-5076afa87c35/roslaunch-kubotalab-P960EF-11711.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
WARN: unrecognized 'remap' tag in tag
started roslaunch server http://192.168.1.17:32807/
PARAMETERS
NODES
/
joint_state_publisher (joint_state_publisher/joint_state_publisher)
move_group (moveit_ros_move_group/move_group)
robot_state_publisher (robot_state_publisher/robot_state_publisher)
rviz_kubotalab_P960EF_11711_4224753817626408993 (rviz/rviz)
auto-starting new master
process[master]: started with pid [11725]
ROS_MASTER_URI=http://192.168.1.17:11311/
setting /run_id to 71e55dc0-0912-11eb-9abb-5076afa87c35
process[rosout-1]: started with pid [11738]
started core service [/rosout]
process[joint_state_publisher-2]: started with pid [11755]
process[robot_state_publisher-3]: started with pid [11756]
process[move_group-4]: started with pid [11757]
process[rviz_kubotalab_P960EF_11711_4224753817626408993-5]: started with pid [11759]
[ERROR] [1602126040.470079960]: Joint 'odom_x' declared as part of group 'base' is not known to the URDF
[ERROR] [1602126040.470142409]: Joint 'odom_y' declared as part of group 'base' is not known to the URDF
[ERROR] [1602126040.470151557]: Joint 'odom_r' declared as part of group 'base' is not known to the URDF
[ WARN] [1602126040.470159784]: Group 'base' is empty.
[ INFO] [1602126040.470493949]: Loading robot model 'hsrb'...
[ INFO] [1602126040.496490379]: rviz version 1.12.17
[ INFO] [1602126040.496520541]: compiled against Qt version 5.5.1
[ INFO] [1602126040.496527475]: compiled against OGRE version 1.9.0 (Ghadamon)
[ WARN] [1602126040.507498937]: Group 'base' must have at least one valid joint
[ WARN] [1602126040.507523456]: Failed to add group 'base'
[ WARN] [1602126040.507531843]: Could not process group 'whole_body' due to unmet subgroup dependencies
[ WARN] [1602126040.507537999]: Could not process group 'whole_body_weighted' due to unmet subgroup dependencies
[ WARN] [1602126040.507548737]: Could not process group 'whole_body_light' due to unmet subgroup dependencies
[ERROR] [1602126040.591352903]: The kinematics plugin (arm) failed to load. Error: According to the loaded plugin descriptions the class bio_ik/BioIKKinematicsPlugin with base class type kinematics::KinematicsBase does not exist. Declared types are cached_ik_kinematics_plugin/CachedKDLKinematicsPlugin cached_ik_kinematics_plugin/CachedSrvKinematicsPlugin kdl_kinematics_plugin/KDLKinematicsPlugin lma_kinematics_plugin/LMAKinematicsPlugin srv_kinematics_plugin/SrvKinematicsPlugin trac_ik_kinematics_plugin/TRAC_IKKinematicsPlugin
[ERROR] [1602126040.591386311]: Kinematics solver could not be instantiated for joint group arm.
[ INFO] [1602126040.609670113]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1602126040.611573311]: MoveGroup debug mode is ON
Starting context monitors...
[ INFO] [1602126040.611597116]: Starting scene monitor
[ INFO] [1602126040.613659714]: Listening to '/planning_scene'
[ INFO] [1602126040.613676920]: Starting world geometry monitor
[ INFO] [1602126040.615553338]: Listening to '/collision_object' using message notifier with target frame '/odom '
[ INFO] [1602126040.617724900]: Listening to '/planning_scene_world' for planning scene world geometry
[ INFO] [1602126040.631174882]: Listening to '/hsrb/head_depth_camera/depth_registered/rectified_points' using message filter with target frame '/odom '
[ INFO] [1602126040.634972996]: Listening to '/attached_collision_object' for attached collision objects
Context monitors started.
[ INFO] [1602126040.654987208]: Initializing OMPL interface using ROS parameters
[ INFO] [1602126040.679285250]: Using planning interface 'OMPL'
[ INFO] [1602126040.681487024]: Param 'default_workspace_bounds' was set to 2
[ INFO] [1602126040.681940169]: Param 'start_state_max_bounds_error' was set to 0.1
[ INFO] [1602126040.682342822]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1602126040.682701568]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1602126040.683117233]: Param 'jiggle_fraction' was set to 0.05
[ INFO] [1602126040.683457322]: Param 'max_sampling_attempts' was not set. Using default value: 100
[ INFO] [1602126040.683495967]: Using planning request adapter 'Add Time Parameterization'
[ INFO] [1602126040.683508004]: Using planning request adapter 'Fix Workspace Bounds'
[ INFO] [1602126040.683521772]: Using planning request adapter 'Fix Start State Bounds'
[ INFO] [1602126040.683534138]: Using planning request adapter 'Fix Start State In Collision'
[ INFO] [1602126040.683547690]: Using planning request adapter 'Fix Start State Path Constraints'
[FATAL] [1602126040.687532537]: Exception while loading controller manager 'hsrb_moveit_fake_controller_manager/MoveItFakeControllerManager': According to the loaded plugin descriptions the class hsrb_moveit_fake_controller_manager/MoveItFakeControllerManager with base class type moveit_controller_manager::MoveItControllerManager does not exist. Declared types are moveit_fake_controller_manager/MoveItFakeControllerManager moveit_ros_control_interface::MoveItControllerManager moveit_ros_control_interface::MoveItMultiControllerManager moveit_simple_controller_manager/MoveItSimpleControllerManager
[ INFO] [1602126040.700502421]: Trajectory execution is managing controllers
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'...
[ WARN] [1602126040.749500132]: Unable to update multi-DOF joint 'world_joint': TF has no common time between '/odom' and 'base_footprint':
Loading 'move_group/MoveGroupPlanService'...
Loading 'move_group/MoveGroupQueryPlannersService'...
Loading 'move_group/MoveGroupStateValidationService'...
[ INFO] [1602126040.761285162]:
- ApplyPlanningSceneService
- ClearOctomapService
- CartesianPathService
- ExecuteTrajectoryAction
- GetPlanningSceneService
- KinematicsService
- MoveAction
- PickPlaceAction
- MotionPlanService
- QueryPlannersService
- StateValidationService
[ INFO] [1602126040.761331486]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
[ INFO] [1602126040.761343723]: MoveGroup context initialization complete
You can start planning now!
[ INFO] [1602126041.319044218]: Stereo is NOT SUPPORTED
[ INFO] [1602126041.319109165]: OpenGl version: 4.6 (GLSL 4.6).
0x2d819d0 void QWindowPrivate::setTopLevelScreen(QScreen*, bool) ( QScreen(0x2033540) ): Attempt to set a screen on a child window.
0x2d82570 void QWindowPrivate::setTopLevelScreen(QScreen*, bool) ( QScreen(0x2033540) ): Attempt to set a screen on a child window.
0x2d808e0 void QWindowPrivate::setTopLevelScreen(QScreen*, bool) ( QScreen(0x2033540) ): Attempt to set a screen on a child window.
0x2d836a0 void QWindowPrivate::setTopLevelScreen(QScreen*, bool) ( QScreen(0x2033540) ): Attempt to set a screen on a child window.
[ERROR] [1602126044.669693908]: Joint 'odom_x' declared as part of group 'base' is not known to the URDF
[ERROR] [1602126044.669722068]: Joint 'odom_y' declared as part of group 'base' is not known to the URDF
[ERROR] [1602126044.669729232]: Joint 'odom_r' declared as part of group 'base' is not known to the URDF
[ WARN] [1602126044.669766746]: Group 'base' is empty.
[ INFO] [1602126044.670239994]: Loading robot model 'hsrb'...
[ WARN] [1602126044.676125813]: Group 'base' must have at least one valid joint
[ WARN] [1602126044.676142069]: Failed to add group 'base'
[ WARN] [1602126044.676150900]: Could not process group 'whole_body' due to unmet subgroup dependencies
[ WARN] [1602126044.676157655]: Could not process group 'whole_body_weighted' due to unmet subgroup dependencies
[ WARN] [1602126044.676163708]: Could not process group 'whole_body_light' due to unmet subgroup dependencies
[ERROR] [1602126044.756528589]: The kinematics plugin (arm) failed to load. Error: According to the loaded plugin descriptions the class bio_ik/BioIKKinematicsPlugin with base class type kinematics::KinematicsBase does not exist. Declared types are cached_ik_kinematics_plugin/CachedKDLKinematicsPlugin cached_ik_kinematics_plugin/CachedSrvKinematicsPlugin kdl_kinematics_plugin/KDLKinematicsPlugin lma_kinematics_plugin/LMAKinematicsPlugin srv_kinematics_plugin/SrvKinematicsPlugin trac_ik_kinematics_plugin/TRAC_IKKinematicsPlugin
[ERROR] [1602126044.756565493]: Kinematics solver could not be instantiated for joint group arm.
[ INFO] [1602126044.786338996]: Starting scene monitor
[ INFO] [1602126044.788872759]: Listening to '/move_group/monitored_planning_scene'
[ INFO] [1602126045.126034170]: No active joints or end effectors found for group 'arm'. Make sure that kinematics.yaml is loaded in this node's namespace.
[ INFO] [1602126045.128590984]: Constructing new MoveGroup connection for group 'arm' in namespace ''
[ INFO] [1602126046.106728688]: Ready to take commands for planning group arm.
[ INFO] [1602126046.106870877]: Looking around: no
[ INFO] [1602126046.106941182]: Replanning: no
[ERROR] [1602126064.008353543]: Could not find parameter for database plugin name
[ INFO] [1602126090.626406314]: Clearing octomap...
[ INFO] [1602126090.626505775]: Octomap cleared.
[ INFO] [1602126178.691375399]: No active joints or end effectors found for group 'arm'. Make sure that kinematics.yaml is loaded in this node's namespace.
I am initiating all the modules as described in
https://github.com/hsr-project/hsrb_wrs_gazebo_launch/blob/master/launch/include/wrs_common.xml#L92
I set the pose to a feasible point using the following code.
end_effector_value = groupArm.get_current_pose().pose
print(end_effector_value)
end_effector_value.position.x = end_effector_value.position.x
end_effector_value.position.y = end_effector_value.position.y
end_effector_value.position.z = end_effector_value.position.z
end_effector_value.orientation.x = end_effector_value.orientation.x
end_effector_value.orientation.y = end_effector_value.orientation.y
end_effector_value.orientation.z = end_effector_value.orientation.z
end_effector_value.orientation.w = end_effector_value.orientation.w
groupArm.clear_pose_targets()
groupArm.set_pose_target(end_effector_value)
plan= groupArm.plan()
groupArm.execute(plan,wait=True)
groupArm.clear_pose_targets()
However I get the following error
[ERROR] [1615996093.753071226, 792.882000000]: Unable to construct goal representation
The complete terminal output
... logging to /home/developer/.ros/log/2b4ff828-8727-11eb-a110-0242ac120003/roslaunch-ae8a6f2fa715-77806.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
started roslaunch server http://ae8a6f2fa715:33753/
PARAMETERS
NODES
/
Init (manipulation/tools.py)
move_group (moveit_ros_move_group/move_group)
ROS_MASTER_URI=http://simulator:11311/
process[move_group-1]: started with pid [77864]
process[Init-2]: started with pid [77865]
[ERROR] [1615996077.837591985]: Joint 'odom_x' declared as part of group 'base' is not known to the URDF
[ERROR] [1615996077.839337950]: Joint 'odom_y' declared as part of group 'base' is not known to the URDF
[ERROR] [1615996077.839365039]: Joint 'odom_r' declared as part of group 'base' is not known to the URDF
[ WARN] [1615996077.839379053]: Group 'base' is empty.
[ INFO] [1615996077.840047567]: Loading robot model 'hsrb'...
[ WARN] [1615996078.241477890, 791.073000000]: Group 'base' must have at least one valid joint
[ WARN] [1615996078.241657452, 791.073000000]: Failed to add group 'base'
[ WARN] [1615996078.242344504, 791.073000000]: Could not process group 'whole_body' due to unmet subgroup dependencies
[ WARN] [1615996078.242528598, 791.073000000]: Could not process group 'whole_body_weighted' due to unmet subgroup dependencies
[ WARN] [1615996078.242621601, 791.073000000]: Could not process group 'whole_body_light' due to unmet subgroup dependencies
[ WARN] [1615996079.200747702, 791.205000000]: Kinematics solver doesn't support #attempts anymore, but only a timeout.
Please remove the parameter '/robot_description_kinematics/arm/kinematics_solver_attempts' from your configuration.
[ERROR] [1615996079.511457922, 791.223000000]: The kinematics plugin (arm) failed to load. Error: Failed to load library /opt/ros/melodic/lib//libbio_ik.so. Make sure that you are calling the PLUGINLIB_EXPORT_CLASS macro in the library code, and that names are consistent between this macro and your XML. Error string: Could not load library (Poco exception = libmoveit_rdf_loader.so.1.0.6: cannot open shared object file: No such file or directory)
[ERROR] [1615996079.513901143, 791.223000000]: Kinematics solver could not be instantiated for joint group arm.
[ INFO] [1615996079.840813552, 791.244000000]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1615996079.864380443, 791.244000000]: MoveGroup debug mode is OFF
Starting planning scene monitors...
[ INFO] [1615996079.864491423, 791.244000000]: Starting planning scene monitor
[ INFO] [1615996079.914111444, 791.247000000]: Listening to '/planning_scene'
[ INFO] [1615996079.914186705, 791.247000000]: Starting world geometry update monitor for collision objects, attached objects, octomap updates.
[ INFO] [1615996079.963102331, 791.247000000]: Listening to '/collision_object'
[ INFO] [1615996079.999843876, 791.247000000]: Listening to '/planning_scene_world' for planning scene world geometry
[ INFO] [1615996080.173781446, 791.265000000]: Listening to '/hsrb/head_depth_camera/depth_registered/rectified_points' using message filter with target frame 'odom '
[ WARN] [1615996080.186157787, 791.265000000]: Unable to update multi-DOF joint 'world_joint': Failure to lookup transform between 'odom' and 'base_footprint' with TF exception: "odom" passed to lookupTransform argument target_frame does not exist.
[ INFO] [1615996080.198525530, 791.265000000]: Listening to '/attached_collision_object' for attached collision objects
Planning scene monitors started.
[ INFO] [1615996080.311956913, 791.280000000]: Initializing OMPL interface using ROS parameters
[ INFO] [1615996080.598509118, 791.298000000]: Using planning interface 'OMPL'
[ INFO] [1615996080.620433207, 791.298000000]: Param 'default_workspace_bounds' was set to 2
[ INFO] [1615996080.622715678, 791.298000000]: Param 'start_state_max_bounds_error' was set to 0.1
[ INFO] [1615996080.623322459, 791.298000000]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1615996080.623898216, 791.298000000]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1615996080.624418591, 791.298000000]: Param 'jiggle_fraction' was set to 0.05
[ INFO] [1615996080.626677583, 791.298000000]: Param 'max_sampling_attempts' was not set. Using default value: 100
[ INFO] [1615996080.626898461, 791.298000000]: Using planning request adapter 'Add Time Parameterization'
[ INFO] [1615996080.627008261, 791.298000000]: Using planning request adapter 'Fix Workspace Bounds'
[ INFO] [1615996080.627095376, 791.298000000]: Using planning request adapter 'Fix Start State Bounds'
[ INFO] [1615996080.627175129, 791.298000000]: Using planning request adapter 'Fix Start State In Collision'
[ INFO] [1615996080.627254243, 791.298000000]: Using planning request adapter 'Fix Start State Path Constraints'
[ INFO] [1615996081.065614519, 791.325000000]: Added FollowJointTrajectory controller for hsrb/arm_trajectory_controller
[ INFO] [1615996081.628094118, 791.394000000]: Added FollowJointTrajectory controller for hsrb/omni_trajectory_controller
[ INFO] [1615996082.098170695, 791.421000000]: Added FollowJointTrajectory controller for hsrb/gripper_controller
[ INFO] [1615996082.588544776, 791.490000000]: Added FollowJointTrajectory controller for hsrb/head_trajectory_controller
[ INFO] [1615996082.588882536, 791.490000000]: Returned 4 controllers in list
[ INFO] [1615996082.693487043, 791.493000000]: Trajectory execution is managing controllers
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'...
[ INFO] [1615996083.506341307, 791.568000000]:
- ApplyPlanningSceneService
- ClearOctomapService
- CartesianPathService
- ExecuteTrajectoryAction
- GetPlanningSceneService
- KinematicsService
- MoveAction
- PickPlaceAction
- MotionPlanService
- QueryPlannersService
- StateValidationService
[ INFO] [1615996083.507789520, 791.568000000]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
[ INFO] [1615996083.508011133, 791.568000000]: MoveGroup context initialization complete
You can start planning now!
[ERROR] [1615996087.084147511]: Joint 'odom_x' declared as part of group 'base' is not known to the URDF
[ERROR] [1615996087.094057898]: Joint 'odom_y' declared as part of group 'base' is not known to the URDF
[ERROR] [1615996087.094172532]: Joint 'odom_r' declared as part of group 'base' is not known to the URDF
[ WARN] [1615996087.094247121]: Group 'base' is empty.
[ INFO] [1615996087.094996059]: Loading robot model 'hsrb'...
[ WARN] [1615996087.355907593, 792.060000000]: Group 'base' must have at least one valid joint
[ WARN] [1615996087.356067809, 792.060000000]: Failed to add group 'base'
[ WARN] [1615996087.356164136, 792.060000000]: Could not process group 'whole_body' due to unmet subgroup dependencies
[ WARN] [1615996087.356238533, 792.060000000]: Could not process group 'whole_body_weighted' due to unmet subgroup dependencies
[ WARN] [1615996087.356391185, 792.060000000]: Could not process group 'whole_body_light' due to unmet subgroup dependencies
[ WARN] [1615996088.015859659, 792.156000000]: Kinematics solver doesn't support #attempts anymore, but only a timeout.
Please remove the parameter '/robot_description_kinematics/arm/kinematics_solver_attempts' from your configuration.
[ERROR] [1615996088.193350896, 792.183000000]: The kinematics plugin (arm) failed to load. Error: Failed to load library /opt/ros/melodic/lib//libbio_ik.so. Make sure that you are calling the PLUGINLIB_EXPORT_CLASS macro in the library code, and that names are consistent between this macro and your XML. Error string: Could not load library (Poco exception = libmoveit_rdf_loader.so.1.0.6: cannot open shared object file: No such file or directory)
[ERROR] [1615996088.193472987, 792.183000000]: Kinematics solver could not be instantiated for joint group arm.
[ INFO] [1615996089.812784625, 792.372000000]: Ready to take commands for planning group gripper.
Connected to commander gripper
[ INFO] [1615996092.740159303, 792.729000000]: Ready to take commands for planning group arm.
Connected to commander arm
[ INFO] [1615996093.741747347, 792.879000000]: Didn't received robot state (joint angles) with recent timestamp within 1 seconds.
Check clock synchronization if your are running ROS across multiple machines!
[ WARN] [1615996093.742131428, 792.879000000]: Failed to fetch current robot state.
[ WARN] [1615996093.742265345, 792.879000000]: Unable to transform object from frame 'head_rgbd_sensor_rgb_frame' to planning frame 'odom' ("odom" passed to lookupTransform argument target_frame does not exist. )
[ WARN] [1615996093.742977170, 792.879000000]: Unable to transform object from frame 'head_l_stereo_camera_frame' to planning frame 'odom' ("odom" passed to lookupTransform argument target_frame does not exist. )
[ WARN] [1615996093.743450940, 792.879000000]: Unable to transform object from frame 'head_r_stereo_camera_frame' to planning frame 'odom' ("odom" passed to lookupTransform argument target_frame does not exist. )
[ WARN] [1615996093.743605091, 792.879000000]: Unable to transform object from frame 'head_rgbd_sensor_depth_frame' to planning frame 'odom' ("odom" passed to lookupTransform argument target_frame does not exist. )
[ INFO] [1615996093.744062765, 792.879000000]: Combined planning and execution request received for MoveGroup action. Forwarding to planning and execution pipeline.
[ INFO] [1615996093.745266289, 792.879000000]: Planning attempt 1 of at most 1
[ERROR] [1615996093.753071226, 792.882000000]: Unable to construct goal representation
[ INFO] [1615996093.760149434, 792.882000000]: ABORTED: Catastrophic failure
A declarative, efficient, and flexible JavaScript library for building user interfaces.
๐ Vue.js is a progressive, incrementally-adoptable JavaScript framework for building UI on the web.
TypeScript is a superset of JavaScript that compiles to clean JavaScript output.
An Open Source Machine Learning Framework for Everyone
The Web framework for perfectionists with deadlines.
A PHP framework for web artisans
Bring data to life with SVG, Canvas and HTML. ๐๐๐
JavaScript (JS) is a lightweight interpreted programming language with first-class functions.
Some thing interesting about web. New door for the world.
A server is a program made to process requests and deliver data to clients.
Machine learning is a way of modeling and interpreting data that allows a piece of software to respond intelligently.
Some thing interesting about visualization, use data art
Some thing interesting about game, make everyone happy.
We are working to build community through open source technology. NB: members must have two-factor auth.
Open source projects and samples from Microsoft.
Google โค๏ธ Open Source for everyone.
Alibaba Open Source for everyone
Data-Driven Documents codes.
China tencent open source team.