MoveGroupInterface::move() timeout on the second launch
Hi, there.
I'm new to ros2 and just complete ros2 and moveit2 tutorials. The purpose of my work in hand is to control abb-irb4600-40 robot in webots simulator and check the trajectory generated by moveit2 packages(via rviz or in webots scene). I have installed the webotsros2universalrobot packages since the "multirobotlaunch.py" contains the robot model (irb4600-40, however its srdf is incomplete compared to UR's).
My idea is to make controlling UR5e robot working first by modifying "robotlaunch.py" first and then construct my workcell scene of abb's robot later. After building my own node by using moveit2 tutorial code(changing 'pandaarm' to ur5e in https://moveit.picknik.ai/foxy/doc/move_group_interface/move_group_interface_tutorial.html#the-entire-code), and modifying the "robotlaunch.py" (in the repo:https://github.com/cyberbotics/webotsros2/wiki/Example-Universal-Robots), it seems I can launch my first trial.
The first run after build seems fine. However, I shutdown all the program and terminal, and the following launches all turned out failed. Although code running with rviz moving, the robot in webots got not controller from extern. Then I discovered that the first launch after system reboot is working. Maybe there are some unknown process or code left uncleared. The message in terminal showed that move_group timeout, as shown below. Would anyone help me with this issue? Any methods or tool to investigate the problem behind this are welcome. I saw nodes were cleared in rqt or using 'node list'.
[movegroup-10] [INFO] [1660369437.161656571] [moveitros.currentstatemonitor]: Didn't received robot state (joint angles) with recent timestamp within 1.000000 seconds. [move_group-10] Check clock synchronization if your are running ROS across multiple machines! [movegroup-10] [WARN] [1660369437.161680926] [moveitros.trajectoryexecutionmanager]: Failed to validate trajectory: couldn't receive full current joint state within 1s [movegroup-10] [INFO] [1660369437.161729205] [moveitmovegroupdefaultcapabilities.moveaction_capability]: Solution found but controller failed during execution [rviz2-9] [INFO] [1660369437.444203951] [movegroupinterface]: Plan and Execute request aborted [rviz2-9] [ERROR] [1660369437.544294260] [movegroupinterface]: MoveGroupInterface::move() failed or timeout reached
Asked by liangchatech on 2022-08-13 01:02:01 UTC
Comments