ROS 机器人源码分析之 self._launch_core_nodes() rosout/rosout

<pre class="python" name="code">    def _launch_core_nodes(self):
        """
        launch any core services that are not already running. master must
        be already running
        @raise RLException: if core launches fail
        """
        config = self.config
        master = config.master.get()
        tolaunch = []
        for node in config.nodes_core:
            node_name = rosgraph.names.ns_join(node.namespace, node.name)
            code, msg, _ = master.lookupNode(_ID, node_name)
            if code == -1:
                tolaunch.append(node)
            elif code == 1:
                print("core service [%s] found" % node_name)
            else:
                print("WARN: master is not behaving well (unexpected return value when looking up node)", file=sys.stderr)
                self.logger.error("ERROR: master return [%s][%s] on lookupNode call"%(code,msg))
                
        for node in tolaunch:
            node_name = rosgraph.names.ns_join(node.namespace, node.name)
            name, success = self.launch_node(node, core=True)
            if success:
                print("started core service [%s]" % node_name)
            else:
                raise RLException("failed to start core service [%s]"%node_name)


 

 ../../roslaunch/nodeprocess.py(290)start()
self.popen = subprocess.Popen(self.args, cwd=cwd, stdout=logfileout, stderr=logfileerr, env=full_env, close_fds=True, preexec_fn=os.setsid)

self.args:

[u'/../../rosout/rosout', u'__name:=rosout', u'__log:=/../../.ros/log/845a5a02-69dc-11e6-8965-000c290414d4/rosout-1.log']

jiaowone@pg0:~/gazeb$ roslaunch robot scout_gazebo.launch ... logging to /home/jiaowone/.ros/log/32032c4e-7c28-11f0-9f16-32c03969c6a0/roslaunch-pg0-5644.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://pg0:36021/ SUMMARY ======== PARAMETERS * /gazebo/enable_ros_network: True * /robot_description: <?xml version="1.... * /rosdistro: melodic * /rosversion: 1.14.13 * /use_sim_time: True NODES / gazebo (gazebo_ros/gzserver) gazebo_gui (gazebo_ros/gzclient) joint_state_publisher (joint_state_publisher_gui/joint_state_publisher_gui) model (gazebo_ros/spawn_model) robot_state_publisher (robot_state_publisher/robot_state_publisher) rviz (rviz/rviz) auto-starting new master process[master]: started with pid [5679] ROS_MASTER_URI=http://localhost:11311 setting /run_id to 32032c4e-7c28-11f0-9f16-32c03969c6a0 process[rosout-1]: started with pid [5709] started core service [/rosout] process[joint_state_publisher-2]: started with pid [5716] process[robot_state_publisher-3]: started with pid [5717] process[rviz-4]: started with pid [5718] process[gazebo-5]: started with pid [5719] process[gazebo_gui-6]: started with pid [5729] process[model-7]: started with pid [5735] /usr/lib/x86_64-linux-gnu/libgnutls.so.30: version `GNUTLS_3_6_3' not found (required by /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognutls.so) Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognutls.so /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognomeproxy.so: undefined symbol: g_task_set_name Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognomeproxy.so /home/jiaowone/snap/code/common/.cache/gio-modules/libgiolibproxy.so: undefined symbol: g_task_set_name Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiolibproxy.so [ INFO] [1755517254.316363889]: Finished loading Gazebo ROS API Plugin. [ INFO] [1755517254.317430353]: waitForService: Service [/gazebo_gui/set_physics_properties] has not been advertised, waiting... [gazebo-5] process has died [pid 5719, exit code 255, cmd /opt/ros/melodic/lib/gazebo_ros/gzserver -e ode /home/jiaowone/gazeb/src/robot/worlds/lab.world __name:=gazebo __log:=/home/jiaowone/.ros/log/32032c4e-7c28-11f0-9f16-32c03969c6a0/gazebo-5.log]. log file: /home/jiaowone/.ros/log/32032c4e-7c28-11f0-9f16-32c03969c6a0/gazebo-5*.log /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognutls.so: undefined symbol: g_task_set_name Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognutls.so /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognomeproxy.so: undefined symbol: g_task_set_name Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognomeproxy.so /home/jiaowone/snap/code/common/.cache/gio-modules/libgiolibproxy.so: undefined symbol: g_task_set_name Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiolibproxy.so the rosdep view is empty: call 'sudo rosdep init' and 'rosdep update' /usr/lib/x86_64-linux-gnu/libgnutls.so.30: version `GNUTLS_3_6_3' not found (required by /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognutls.so) Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognutls.so /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognomeproxy.so: undefined symbol: g_task_set_name Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiognomeproxy.so /home/jiaowone/snap/code/common/.cache/gio-modules/libgiolibproxy.so: undefined symbol: g_task_set_name Failed to load module: /home/jiaowone/snap/code/common/.cache/gio-modules/libgiolibproxy.so ^C[model-7] killing on exit [gazebo_gui-6] killing on exit [rviz-4] killing on exit [robot_state_publisher-3] killing on exit [joint_state_publisher-2] killing on exit Traceback (most recent call last): File "/opt/ros/melodic/lib/gazebo_ros/spawn_model", line 239, in <module> exit_code = sm.run() File "/opt/ros/melodic/lib/gazebo_ros/spawn_model", line 185, in run self.args.gazebo_namespace) File "/opt/ros/melodic/lib/python2.7/dist-packages/gazebo_ros/gazebo_interface.py", line 28, in spawn_urdf_model_client rospy.wait_for_service(gazebo_namespace+'/spawn_urdf_model') File "/opt/ros/melodic/lib/python2.7/dist-packages/rospy/impl/tcpros_service.py", line 166, in wait_for_service raise ROSInterruptException("rospy shutdown") rospy.exceptions.ROSInterruptException: rospy shutdow
08-19
(rosenv) whyros@ubuntu:~/爱死机战队-汪辉耀-何海-朱睿程/ros_ws$ roslaunch mini2_description gazebo_room.launch ... logging to /home/whyros/.ros/log/4051dbf6-56a8-11f0-8dcd-81cf0e965cb7/roslaunch-ubuntu-348341.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://ubuntu:37833/ SUMMARY ======== PARAMETERS * /gazebo/enable_ros_network: True * /joint_state_publisher/source_list: ['/joint_states1'] * /mini2/mini2/11_Joint_controller/gravity_compensation: True * /mini2/mini2/11_Joint_controller/joint: 11_Joint * /mini2/mini2/11_Joint_controller/pid/d: 50.0 * /mini2/mini2/11_Joint_controller/pid/i: 0.1 * /mini2/mini2/11_Joint_controller/pid/p: 1000.0 * /mini2/mini2/11_Joint_controller/type: position_controll... * /mini2/mini2/11_Joint_controller/update_rate: 1000 * /mini2/mini2/12_Joint_controller/gravity_compensation: True * /mini2/mini2/12_Joint_controller/joint: 12_Joint * /mini2/mini2/12_Joint_controller/pid/d: 40.0 * /mini2/mini2/12_Joint_controller/pid/i: 0.1 * /mini2/mini2/12_Joint_controller/pid/p: 800.0 * /mini2/mini2/12_Joint_controller/type: position_controll... * /mini2/mini2/12_Joint_controller/update_rate: 1000 * /mini2/mini2/13_Joint_controller/gravity_compensation: True * /mini2/mini2/13_Joint_controller/joint: 13_Joint * /mini2/mini2/13_Joint_controller/pid/d: 60.0 * /mini2/mini2/13_Joint_controller/pid/i: 0.1 * /mini2/mini2/13_Joint_controller/pid/p: 1200.0 * /mini2/mini2/13_Joint_controller/type: position_controll... * /mini2/mini2/13_Joint_controller/update_rate: 1000 * /mini2/mini2/21_Joint_controller/gravity_compensation: True * /mini2/mini2/21_Joint_controller/joint: 21_Joint * /mini2/mini2/21_Joint_controller/pid/d: 20.0 * /mini2/mini2/21_Joint_controller/pid/i: 0.1 * /mini2/mini2/21_Joint_controller/pid/p: 400.0 * /mini2/mini2/21_Joint_controller/type: position_controll... * /mini2/mini2/21_Joint_controller/update_rate: 1000 * /mini2/mini2/22_Joint_controller/gravity_compensation: True * /mini2/mini2/22_Joint_controller/joint: 22_Joint * /mini2/mini2/22_Joint_controller/pid/d: 20.0 * /mini2/mini2/22_Joint_controller/pid/i: 0.1 * /mini2/mini2/22_Joint_controller/pid/p: 400.0 * /mini2/mini2/22_Joint_controller/type: position_controll... * /mini2/mini2/22_Joint_controller/update_rate: 1000 * /mini2/mini2/23_Joint_controller/gravity_compensation: True * /mini2/mini2/23_Joint_controller/joint: 23_Joint * /mini2/mini2/23_Joint_controller/pid/d: 20.0 * /mini2/mini2/23_Joint_controller/pid/i: 0.1 * /mini2/mini2/23_Joint_controller/pid/p: 400.0 * /mini2/mini2/23_Joint_controller/type: position_controll... * /mini2/mini2/23_Joint_controller/update_rate: 1000 * /mini2/mini2/31_Joint_controller/gravity_compensation: True * /mini2/mini2/31_Joint_controller/joint: 31_Joint * /mini2/mini2/31_Joint_controller/pid/d: 20.0 * /mini2/mini2/31_Joint_controller/pid/i: 0.5 * /mini2/mini2/31_Joint_controller/pid/p: 400.0 * /mini2/mini2/31_Joint_controller/type: position_controll... * /mini2/mini2/31_Joint_controller/update_rate: 1000 * /mini2/mini2/32_Joint_controller/gravity_compensation: True * /mini2/mini2/32_Joint_controller/joint: 32_Joint * /mini2/mini2/32_Joint_controller/pid/d: 20.0 * /mini2/mini2/32_Joint_controller/pid/i: 0.1 * /mini2/mini2/32_Joint_controller/pid/p: 400.0 * /mini2/mini2/32_Joint_controller/type: position_controll... * /mini2/mini2/32_Joint_controller/update_rate: 1000 * /mini2/mini2/33_Joint_controller/gravity_compensation: True * /mini2/mini2/33_Joint_controller/joint: 33_Joint * /mini2/mini2/33_Joint_controller/pid/d: 20.0 * /mini2/mini2/33_Joint_controller/pid/i: 0.1 * /mini2/mini2/33_Joint_controller/pid/p: 400.0 * /mini2/mini2/33_Joint_controller/type: position_controll... * /mini2/mini2/33_Joint_controller/update_rate: 1000 * /mini2/mini2/41_Joint_controller/gravity_compensation: True * /mini2/mini2/41_Joint_controller/joint: 41_Joint * /mini2/mini2/41_Joint_controller/pid/d: 20.0 * /mini2/mini2/41_Joint_controller/pid/i: 0.5 * /mini2/mini2/41_Joint_controller/pid/p: 400.0 * /mini2/mini2/41_Joint_controller/type: position_controll... * /mini2/mini2/41_Joint_controller/update_rate: 1000 * /mini2/mini2/42_Joint_controller/gravity_compensation: True * /mini2/mini2/42_Joint_controller/joint: 42_Joint * /mini2/mini2/42_Joint_controller/pid/d: 20.0 * /mini2/mini2/42_Joint_controller/pid/i: 0.5 * /mini2/mini2/42_Joint_controller/pid/p: 400.0 * /mini2/mini2/42_Joint_controller/type: position_controll... * /mini2/mini2/42_Joint_controller/update_rate: 1000 * /mini2/mini2/43_Joint_controller/gravity_compensation: True * /mini2/mini2/43_Joint_controller/joint: 43_Joint * /mini2/mini2/43_Joint_controller/pid/d: 20.0 * /mini2/mini2/43_Joint_controller/pid/i: 0.5 * /mini2/mini2/43_Joint_controller/pid/p: 400.0 * /mini2/mini2/43_Joint_controller/type: position_controll... * /mini2/mini2/43_Joint_controller/update_rate: 1000 * /mini2/mini2/500_Joint_controller/gravity_compensation: True * /mini2/mini2/500_Joint_controller/joint: 500_Joint * /mini2/mini2/500_Joint_controller/pid/d: 20.0 * /mini2/mini2/500_Joint_controller/pid/i: 0.5 * /mini2/mini2/500_Joint_controller/pid/p: 400.0 * /mini2/mini2/500_Joint_controller/type: position_controll... * /mini2/mini2/500_Joint_controller/update_rate: 1000 * /mini2/mini2/50_Joint_controller/gravity_compensation: True * /mini2/mini2/50_Joint_controller/joint: 50_Joint * /mini2/mini2/50_Joint_controller/pid/d: 20.0 * /mini2/mini2/50_Joint_controller/pid/i: 0.5 * /mini2/mini2/50_Joint_controller/pid/p: 400.0 * /mini2/mini2/50_Joint_controller/type: position_controll... * /mini2/mini2/50_Joint_controller/update_rate: 1000 * /mini2/mini2/51_Joint_controller/gravity_compensation: True * /mini2/mini2/51_Joint_controller/joint: 51_Joint * /mini2/mini2/51_Joint_controller/pid/d: 20.0 * /mini2/mini2/51_Joint_controller/pid/i: 0.5 * /mini2/mini2/51_Joint_controller/pid/p: 400.0 * /mini2/mini2/51_Joint_controller/type: position_controll... * /mini2/mini2/51_Joint_controller/update_rate: 1000 * /mini2/mini2/52_Joint_controller/gravity_compensation: True * /mini2/mini2/52_Joint_controller/joint: 52_Joint * /mini2/mini2/52_Joint_controller/pid/d: 30.0 * /mini2/mini2/52_Joint_controller/pid/i: 0.1 * /mini2/mini2/52_Joint_controller/pid/p: 500.0 * /mini2/mini2/52_Joint_controller/type: position_controll... * /mini2/mini2/52_Joint_controller/update_rate: 1000 * /mini2/mini2/53_Joint_controller/gravity_compensation: True * /mini2/mini2/53_Joint_controller/joint: 53_Joint * /mini2/mini2/53_Joint_controller/pid/d: 20.0 * /mini2/mini2/53_Joint_controller/pid/i: 0.5 * /mini2/mini2/53_Joint_controller/pid/p: 400.0 * /mini2/mini2/53_Joint_controller/type: position_controll... * /mini2/mini2/53_Joint_controller/update_rate: 1000 * /mini2/mini2/joint_state_controller/publish_rate: 50 * /mini2/mini2/joint_state_controller/type: joint_state_contr... * /robot_description: <?xml version="1.... * /rosdistro: noetic * /rosversion: 1.17.3 * /use_sim_time: True NODES / gazebo (gazebo_ros/gzserver) gazebo_gui (gazebo_ros/gzclient) joint_control (mini2_description/joint_control.py) joint_state_publisher (joint_state_publisher/joint_state_publisher) robot_state_publisher (robot_state_publisher/robot_state_publisher) /mini2/ controller_spawner (controller_manager/spawner) spawn_urdf (gazebo_ros/spawn_model) auto-starting new master process[master]: started with pid [348349] ROS_MASTER_URI=http://localhost:11311 setting /run_id to 4051dbf6-56a8-11f0-8dcd-81cf0e965cb7 process[rosout-1]: started with pid [348359] started core service [/rosout] process[gazebo-2]: started with pid [348367] process[gazebo_gui-3]: started with pid [348370] process[mini2/spawn_urdf-4]: started with pid [348375] process[mini2/controller_spawner-5]: started with pid [348378] process[robot_state_publisher-6]: started with pid [348379] process[joint_state_publisher-7]: started with pid [348380] process[joint_control-8]: started with pid [348385] [WARN] [1751394109.302342, 0.000000]: DEPRECATION warning: --shutdown-timeout has no effect. [INFO] [1751394109.303728, 0.000000]: Controller Spawner: Waiting for service controller_manager/load_controller [INFO] [1751394109.332422, 0.000000]: Loading model XML from ros parameter robot_description [INFO] [1751394109.521168280]: Finished loading Gazebo ROS API Plugin. [INFO] [1751394109.523086673]: Finished loading Gazebo ROS API Plugin. [INFO] [1751394109.523249881]: waitForService: Service [/gazebo/set_physics_properties] has not been advertised, waiting... [INFO] [1751394109.524751521]: waitForService: Service [/gazebo_gui/set_physics_properties] has not been advertised, waiting... Traceback (most recent call last): File "/opt/ros/noetic/lib/gazebo_ros/spawn_model", line 239, in <module> exit_code = sm.run() File "/opt/ros/noetic/lib/gazebo_ros/spawn_model", line 132, in run model_xml = rospy.get_param(self.args.param) File "/opt/ros/noetic/lib/python3/dist-packages/rospy/client.py", line 468, in get_param return _param_server[param_name] #MasterProxy does all the magic for us File "/opt/ros/noetic/lib/python3/dist-packages/rospy/msproxy.py", line 123, in __getitem__ raise KeyError(key) KeyError: 'robot_description' [INFO] [1751394110.040706553]: waitForService: Service [/gazebo/set_physics_properties] is now available. [INFO] [1751394110.089876775, 0.001000000]: Physics dynamic reconfigure ready. [mini2/spawn_urdf-4] process has died [pid 348375, exit code 1, cmd /opt/ros/noetic/lib/gazebo_ros/spawn_model -urdf -model mini2_description -param robot_description -x 0.0244236973111199 -y -0.00001185 -z 0.00216909321295 -R 0 -P 0 -Y 0 -unpause __name:=spawn_urdf __log:=/home/whyros/.ros/log/4051dbf6-56a8-11f0-8dcd-81cf0e965cb7/mini2-spawn_urdf-4.log]. log file: /home/whyros/.ros/log/4051dbf6-56a8-11f0-8dcd-81cf0e965cb7/mini2-spawn_urdf-4*.log context mismatch in svga_surface_destroy context mismatch in svga_surface_destroy [WARN] [1751394139.451305, 2.934000]: Controller Spawner couldn't find the expected controller_manager ROS interface. [mini2/controller_spawner-5] process has finished cleanly log file: /home/whyros/.ros/log/4051dbf6-56a8-11f0-8dcd-81cf0e965cb7/mini2-controller_spawner-5*.log ^C[joint_control-8] killing on exit [joint_state_publisher-7] killing on exit [robot_state_publisher-6] killing on exit [gazebo_gui-3] killing on exit [gazebo-2] killing on exit ^C[gazebo_gui-3] escalating to SIGTERM [rosout-1] killing on exit [master] killing on exit shutting down processing monitor... ... shutting down processing monitor complete done (rosenv) whyros@ubuntu:~/爱死机战队-汪辉耀-何海-朱睿程/ros_ws$ roslaunch mini2_description gazebo_room.launch ... logging to /home/whyros/.ros/log/3fc93650-56aa-11f0-8dcd-81cf0e965cb7/roslaunch-ubuntu-361713.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://ubuntu:36143/ SUMMARY ======== PARAMETERS * /gazebo/enable_ros_network: True * /joint_state_publisher/source_list: ['/joint_states1'] * /mini2/arm_controller/constraints/goal_time: 0.6 * /mini2/arm_controller/constraints/joints/11_Joint/goal: True * /mini2/arm_controller/constraints/joints/11_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/12_Joint/goal: True * /mini2/arm_controller/constraints/joints/12_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/13_Joint/goal: True * /mini2/arm_controller/constraints/joints/13_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/21_Joint/goal: True * /mini2/arm_controller/constraints/joints/21_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/22_Joint/goal: True * /mini2/arm_controller/constraints/joints/22_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/23_Joint/goal: True * /mini2/arm_controller/constraints/joints/23_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/31_Joint/goal: True * /mini2/arm_controller/constraints/joints/31_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/32_Joint/goal: True * /mini2/arm_controller/constraints/joints/32_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/33_Joint/goal: True * /mini2/arm_controller/constraints/joints/33_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/41_Joint/goal: True * /mini2/arm_controller/constraints/joints/41_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/42_Joint/goal: True * /mini2/arm_controller/constraints/joints/42_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/43_Joint/goal: True * /mini2/arm_controller/constraints/joints/43_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/500_Joint/goal: True * /mini2/arm_controller/constraints/joints/500_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/50_Joint/goal: True * /mini2/arm_controller/constraints/joints/50_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/51_Joint/goal: True * /mini2/arm_controller/constraints/joints/51_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/52_Joint/goal: True * /mini2/arm_controller/constraints/joints/52_Joint/trajectory: True * /mini2/arm_controller/constraints/joints/53_Joint/goal: True * /mini2/arm_controller/constraints/joints/53_Joint/trajectory: True * /mini2/arm_controller/constraints/stopping_trajectory_duration: 0.5 * /mini2/arm_controller/joints: ['11_Joint', '12_... * /mini2/arm_controller/pid_gains/11_Joint/d: 50.0 * /mini2/arm_controller/pid_gains/11_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/11_Joint/p: 1000.0 * /mini2/arm_controller/pid_gains/12_Joint/d: 40.0 * /mini2/arm_controller/pid_gains/12_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/12_Joint/p: 800.0 * /mini2/arm_controller/pid_gains/13_Joint/d: 60.0 * /mini2/arm_controller/pid_gains/13_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/13_Joint/p: 1200.0 * /mini2/arm_controller/pid_gains/21_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/21_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/21_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/22_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/22_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/22_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/23_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/23_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/23_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/31_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/31_Joint/i: 0.5 * /mini2/arm_controller/pid_gains/31_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/32_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/32_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/32_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/33_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/33_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/33_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/41_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/41_Joint/i: 0.5 * /mini2/arm_controller/pid_gains/41_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/42_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/42_Joint/i: 0.5 * /mini2/arm_controller/pid_gains/42_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/43_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/43_Joint/i: 0.5 * /mini2/arm_controller/pid_gains/43_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/500_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/500_Joint/i: 0.5 * /mini2/arm_controller/pid_gains/500_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/50_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/50_Joint/i: 0.5 * /mini2/arm_controller/pid_gains/50_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/51_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/51_Joint/i: 0.5 * /mini2/arm_controller/pid_gains/51_Joint/p: 400.0 * /mini2/arm_controller/pid_gains/52_Joint/d: 30.0 * /mini2/arm_controller/pid_gains/52_Joint/i: 0.1 * /mini2/arm_controller/pid_gains/52_Joint/p: 500.0 * /mini2/arm_controller/pid_gains/53_Joint/d: 20.0 * /mini2/arm_controller/pid_gains/53_Joint/i: 0.5 * /mini2/arm_controller/pid_gains/53_Joint/p: 400.0 * /mini2/arm_controller/type: effort_controller... * /mini2/joint_state_controller/publish_rate: 50 * /mini2/joint_state_controller/type: joint_state_contr... * /robot_description: <?xml version="1.... * /rosdistro: noetic * /rosversion: 1.17.3 * /use_sim_time: True NODES / gazebo (gazebo_ros/gzserver) gazebo_gui (gazebo_ros/gzclient) joint_control (mini2_description/joint_control.py) joint_state_publisher (joint_state_publisher/joint_state_publisher) robot_state_publisher (robot_state_publisher/robot_state_publisher) /mini2/ controller_spawner (controller_manager/spawner) spawn_urdf (gazebo_ros/spawn_model) auto-starting new master process[master]: started with pid [361721] ROS_MASTER_URI=http://localhost:11311 setting /run_id to 3fc93650-56aa-11f0-8dcd-81cf0e965cb7 process[rosout-1]: started with pid [361732] started core service [/rosout] process[gazebo-2]: started with pid [361742] process[gazebo_gui-3]: started with pid [361745] process[mini2/spawn_urdf-4]: started with pid [361750] process[mini2/controller_spawner-5]: started with pid [361753] process[robot_state_publisher-6]: started with pid [361754] process[joint_state_publisher-7]: started with pid [361755] process[joint_control-8]: started with pid [361760] [WARN] [1751394967.320296, 0.000000]: DEPRECATION warning: --shutdown-timeout has no effect. [INFO] [1751394967.322947, 0.000000]: Controller Spawner: Waiting for service /mini2/controller_manager/load_controller [INFO] [1751394967.360534, 0.000000]: Loading model XML from ros parameter /robot_description [INFO] [1751394967.367955, 0.000000]: Waiting for service /gazebo/spawn_urdf_model [INFO] [1751394967.591428043]: Finished loading Gazebo ROS API Plugin. [INFO] [1751394967.592695892]: waitForService: Service [/gazebo/set_physics_properties] has not been advertised, waiting... [INFO] [1751394967.712372708]: Finished loading Gazebo ROS API Plugin. [INFO] [1751394967.714188401]: waitForService: Service [/gazebo_gui/set_physics_properties] has not been advertised, waiting... [INFO] [1751394968.111488158]: waitForService: Service [/gazebo/set_physics_properties] is now available. [INFO] [1751394968.144013226, 0.003000000]: Physics dynamic reconfigure ready. [INFO] [1751394968.274723, 0.016000]: Calling service /gazebo/spawn_urdf_model [INFO] [1751394968.639988, 0.036000]: Spawn status: SpawnModel: Successfully spawned entity [INFO] [1751394968.641505, 0.036000]: Unpausing physics [mini2/spawn_urdf-4] process has finished cleanly log file: /home/whyros/.ros/log/3fc93650-56aa-11f0-8dcd-81cf0e965cb7/mini2-spawn_urdf-4*.log [INFO] [1751394972.082549432, 0.036000000]: Loading gazebo_ros_control plugin [INFO] [1751394972.082927631, 0.036000000]: Starting gazebo_ros_control plugin in namespace: /mini2 [INFO] [1751394972.083688984, 0.036000000]: gazebo_ros_control plugin is waiting for model URDF in parameter [/robot_description] on the ROS param server. [INFO] [1751394972.197588955, 0.036000000]: Loaded gazebo_ros_control. [INFO] [1751394972.419081, 0.058000]: Controller Spawner: Waiting for service /mini2/controller_manager/switch_controller [INFO] [1751394972.422287, 0.058000]: Controller Spawner: Waiting for service /mini2/controller_manager/unload_controller [INFO] [1751394972.424556, 0.059000]: Loading controller: joint_state_controller [INFO] [1751394972.443607, 0.061000]: Loading controller: arm_controller [ERROR] [1751394972.448703925, 0.061000000]: Could not load controller 'arm_controller' because controller type 'effort_controllers/JointTrajectoryController' does not exist. [ERROR] [1751394972.448778446, 0.061000000]: Use 'rosservice call controller_manager/list_controller_types' to get the available types context mismatch in svga_surface_destroy context mismatch in svga_surface_destroy [ERROR] [1751394973.449190, 0.161000]: Failed to load arm_controller [INFO] [1751394973.450581, 0.161000]: Controller Spawner: Loaded controllers: joint_state_controller [INFO] [1751394973.456978, 0.162000]: Started controllers: joint_state_controller
07-03
[ WARN] [1762076634.614271498]: Skipping virtual joint 'base_link' because its child frame 'base_link' does not match the URDF frame 'world' [ INFO] [1762076634.614330146]: No root/virtual joint specified in SRDF. Assuming fixed joint [ INFO] [1762076635.805948068]: Ready to take commands for planning group manipulator_i5. [INFO] [1762076635.806458]: AUBO安全控制器初始化完成 [INFO] [1762076635.813104]: 使用保守参数: 速度=0.1, 加速度=0.1 roslaunch aubo_i5_moveit_config moveit_planning_execution.launch sim:=false robot_ip:=192.168.192.10 ... logging to /root/.ros/log/69be2d1c-b7d0-11f0-a111-2c9464039e34/roslaunch-tian-28357.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. xacro: in-order processing became default in ROS Melodic. You can drop the option. started roslaunch server http://tian:34027/ SUMMARY ======== PARAMETERS * /aubo_driver/server_host: 192.168.192.10 * /controller_joint_names: ['shoulder_joint'... * /move_group/allow_trajectory_execution: True * /move_group/capabilities: * /move_group/controller_list: [{'default': True... * /move_group/disable_capabilities: * /move_group/jiggle_fraction: 0.05 * /move_group/manipulator_i5/default_planner_config: RRTConnect * /move_group/manipulator_i5/longest_valid_segment_fraction: 0.005 * /move_group/manipulator_i5/planner_configs: ['SBL', 'EST', 'L... * /move_group/manipulator_i5/projection_evaluator: joints(shoulder_j... * /move_group/max_range: 5.0 * /move_group/max_safe_path_cost: 1 * /move_group/moveit_controller_manager: moveit_simple_con... * /move_group/moveit_manage_controllers: True * /move_group/octomap_resolution: 0.025 * /move_group/planner_configs/BFMT/balanced: 0 * /move_group/planner_configs/BFMT/cache_cc: 1 * /move_group/planner_configs/BFMT/extended_fmt: 1 * /move_group/planner_configs/BFMT/heuristics: 1 * /move_group/planner_configs/BFMT/nearest_k: 1 * /move_group/planner_configs/BFMT/num_samples: 1000 * /move_group/planner_configs/BFMT/optimality: 1 * /move_group/planner_configs/BFMT/radius_multiplier: 1.0 * /move_group/planner_configs/BFMT/type: geometric::BFMT * /move_group/planner_configs/BKPIECE/border_fraction: 0.9 * /move_group/planner_configs/BKPIECE/failed_expansion_score_factor: 0.5 * /move_group/planner_configs/BKPIECE/min_valid_path_fraction: 0.5 * /move_group/planner_configs/BKPIECE/range: 0.0 * /move_group/planner_configs/BKPIECE/type: geometric::BKPIECE * /move_group/planner_configs/BiEST/range: 0.0 * /move_group/planner_configs/BiEST/type: geometric::BiEST * /move_group/planner_configs/BiTRRT/cost_threshold: 1e300 * /move_group/planner_configs/BiTRRT/frountier_node_ratio: 0.1 * /move_group/planner_configs/BiTRRT/frountier_threshold: 0.0 * /move_group/planner_configs/BiTRRT/init_temperature: 100 * /move_group/planner_configs/BiTRRT/range: 0.0 * /move_group/planner_configs/BiTRRT/temp_change_factor: 0.1 * /move_group/planner_configs/BiTRRT/type: geometric::BiTRRT * /move_group/planner_configs/EST/goal_bias: 0.05 * /move_group/planner_configs/EST/range: 0.0 * /move_group/planner_configs/EST/type: geometric::EST * /move_group/planner_configs/FMT/cache_cc: 1 * /move_group/planner_configs/FMT/extended_fmt: 1 * /move_group/planner_configs/FMT/heuristics: 0 * /move_group/planner_configs/FMT/nearest_k: 1 * /move_group/planner_configs/FMT/num_samples: 1000 * /move_group/planner_configs/FMT/radius_multiplier: 1.1 * /move_group/planner_configs/FMT/type: geometric::FMT * /move_group/planner_configs/KPIECE/border_fraction: 0.9 * /move_group/planner_configs/KPIECE/failed_expansion_score_factor: 0.5 * /move_group/planner_configs/KPIECE/goal_bias: 0.05 * /move_group/planner_configs/KPIECE/min_valid_path_fraction: 0.5 * /move_group/planner_configs/KPIECE/range: 0.0 * /move_group/planner_configs/KPIECE/type: geometric::KPIECE * /move_group/planner_configs/LBKPIECE/border_fraction: 0.9 * /move_group/planner_configs/LBKPIECE/min_valid_path_fraction: 0.5 * /move_group/planner_configs/LBKPIECE/range: 0.0 * /move_group/planner_configs/LBKPIECE/type: geometric::LBKPIECE * /move_group/planner_configs/LBTRRT/epsilon: 0.4 * /move_group/planner_configs/LBTRRT/goal_bias: 0.05 * /move_group/planner_configs/LBTRRT/range: 0.0 * /move_group/planner_configs/LBTRRT/type: geometric::LBTRRT * /move_group/planner_configs/LazyPRM/range: 0.0 * /move_group/planner_configs/LazyPRM/type: geometric::LazyPRM * /move_group/planner_configs/LazyPRMstar/type: geometric::LazyPR... * /move_group/planner_configs/PDST/type: geometric::PDST * /move_group/planner_configs/PRM/max_nearest_neighbors: 10 * /move_group/planner_configs/PRM/type: geometric::PRM * /move_group/planner_configs/PRMstar/type: geometric::PRMstar * /move_group/planner_configs/ProjEST/goal_bias: 0.05 * /move_group/planner_configs/ProjEST/range: 0.0 * /move_group/planner_configs/ProjEST/type: geometric::ProjEST * /move_group/planner_configs/RRT/goal_bias: 0.05 * /move_group/planner_configs/RRT/range: 0.0 * /move_group/planner_configs/RRT/type: geometric::RRT * /move_group/planner_configs/RRTConnect/range: 0.0 * /move_group/planner_configs/RRTConnect/type: geometric::RRTCon... * /move_group/planner_configs/RRTstar/delay_collision_checking: 1 * /move_group/planner_configs/RRTstar/goal_bias: 0.05 * /move_group/planner_configs/RRTstar/range: 0.0 * /move_group/planner_configs/RRTstar/type: geometric::RRTstar * /move_group/planner_configs/SBL/range: 0.0 * /move_group/planner_configs/SBL/type: geometric::SBL * /move_group/planner_configs/SPARS/dense_delta_fraction: 0.001 * /move_group/planner_configs/SPARS/max_failures: 1000 * /move_group/planner_configs/SPARS/sparse_delta_fraction: 0.25 * /move_group/planner_configs/SPARS/stretch_factor: 3.0 * /move_group/planner_configs/SPARS/type: geometric::SPARS * /move_group/planner_configs/SPARStwo/dense_delta_fraction: 0.001 * /move_group/planner_configs/SPARStwo/max_failures: 5000 * /move_group/planner_configs/SPARStwo/sparse_delta_fraction: 0.25 * /move_group/planner_configs/SPARStwo/stretch_factor: 3.0 * /move_group/planner_configs/SPARStwo/type: geometric::SPARStwo * /move_group/planner_configs/STRIDE/degree: 16 * /move_group/planner_configs/STRIDE/estimated_dimension: 0.0 * /move_group/planner_configs/STRIDE/goal_bias: 0.05 * /move_group/planner_configs/STRIDE/max_degree: 18 * /move_group/planner_configs/STRIDE/max_pts_per_leaf: 6 * /move_group/planner_configs/STRIDE/min_degree: 12 * /move_group/planner_configs/STRIDE/min_valid_path_fraction: 0.2 * /move_group/planner_configs/STRIDE/range: 0.0 * /move_group/planner_configs/STRIDE/type: geometric::STRIDE * /move_group/planner_configs/STRIDE/use_projected_distance: 0 * /move_group/planner_configs/TRRT/frountierNodeRatio: 0.1 * /move_group/planner_configs/TRRT/frountier_threshold: 0.0 * /move_group/planner_configs/TRRT/goal_bias: 0.05 * /move_group/planner_configs/TRRT/init_temperature: 10e-6 * /move_group/planner_configs/TRRT/k_constant: 0.0 * /move_group/planner_configs/TRRT/max_states_failed: 10 * /move_group/planner_configs/TRRT/min_temperature: 10e-10 * /move_group/planner_configs/TRRT/range: 0.0 * /move_group/planner_configs/TRRT/temp_change_factor: 2.0 * /move_group/planner_configs/TRRT/type: geometric::TRRT * /move_group/planning_plugin: ompl_interface/OM... * /move_group/planning_scene_monitor/publish_geometry_updates: True * /move_group/planning_scene_monitor/publish_planning_scene: True * /move_group/planning_scene_monitor/publish_state_updates: True * /move_group/planning_scene_monitor/publish_transforms_updates: True * /move_group/request_adapters: industrial_trajec... * /move_group/sample_duration: 0.005 * /move_group/sensors: [{'point_subsampl... * /move_group/start_state_max_bounds_error: 0.1 * /move_group/trajectory_execution/allowed_execution_duration_scaling: 4.0 * /move_group/trajectory_execution/allowed_goal_duration_margin: 0.5 * /move_group/trajectory_execution/allowed_start_tolerance: 0.01 * /move_group/trajectory_execution/execution_duration_monitoring: False * /robot_description: <?xml version="1.... * /robot_description_kinematics/manipulator_i5/kinematics_solver: kdl_kinematics_pl... * /robot_description_kinematics/manipulator_i5/kinematics_solver_search_resolution: 0.005 * /robot_description_kinematics/manipulator_i5/kinematics_solver_timeout: 0.005 * /robot_description_planning/joint_limits/foreArm_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/foreArm_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/foreArm_joint/max_acceleration: 30 * /robot_description_planning/joint_limits/foreArm_joint/max_velocity: 3.14 * /robot_description_planning/joint_limits/shoulder_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/shoulder_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/shoulder_joint/max_acceleration: 30 * /robot_description_planning/joint_limits/shoulder_joint/max_velocity: 3.14 * /robot_description_planning/joint_limits/upperArm_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/upperArm_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/upperArm_joint/max_acceleration: 30 * /robot_description_planning/joint_limits/upperArm_joint/max_velocity: 3.14 * /robot_description_planning/joint_limits/wrist1_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/wrist1_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/wrist1_joint/max_acceleration: 25 * /robot_description_planning/joint_limits/wrist1_joint/max_velocity: 2.6 * /robot_description_planning/joint_limits/wrist2_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/wrist2_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/wrist2_joint/max_acceleration: 25 * /robot_description_planning/joint_limits/wrist2_joint/max_velocity: 2.6 * /robot_description_planning/joint_limits/wrist3_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/wrist3_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/wrist3_joint/max_acceleration: 25 * /robot_description_planning/joint_limits/wrist3_joint/max_velocity: 2.6 * /robot_description_semantic: <?xml version="1.... * /robot_name: aubo_i5 * /rosdistro: melodic * /rosversion: 1.14.13 * /rviz_tian_28357_5613264337159122920/manipulator_i5/kinematics_solver: kdl_kinematics_pl... * /rviz_tian_28357_5613264337159122920/manipulator_i5/kinematics_solver_search_resolution: 0.005 * /rviz_tian_28357_5613264337159122920/manipulator_i5/kinematics_solver_timeout: 0.005 NODES / aubo_driver (aubo_driver/aubo_driver) aubo_joint_trajectory_action (aubo_controller/aubo_joint_trajectory_action) aubo_robot_simulator (aubo_controller/aubo_robot_simulator) move_group (moveit_ros_move_group/move_group) robot_state_publisher (robot_state_publisher/robot_state_publisher) rviz_tian_28357_5613264337159122920 (rviz/rviz) auto-starting new master process[master]: started with pid [28371] ROS_MASTER_URI=http://localhost:11311 setting /run_id to 69be2d1c-b7d0-11f0-a111-2c9464039e34 process[rosout-1]: started with pid [28382] started core service [/rosout] process[aubo_robot_simulator-2]: started with pid [28389] process[aubo_joint_trajectory_action-3]: started with pid [28390] process[aubo_driver-4]: started with pid [28391] process[robot_state_publisher-5]: started with pid [28393] [ INFO] [1762076620.975289494]: Adding shoulder_joint to list parameter [ INFO] [1762076620.976437205]: Adding upperArm_joint to list parameter [ INFO] [1762076620.976450447]: Adding foreArm_joint to list parameter [ INFO] [1762076620.976461219]: Adding wrist1_joint to list parameter [ INFO] [1762076620.976468429]: Adding wrist2_joint to list parameter [ INFO] [1762076620.976475474]: Adding wrist3_joint to list parameter [ INFO] [1762076620.976499775]: Found user-specified joint names in 'controller_joint_names': [shoulder_joint, upperArm_joint, foreArm_joint, wrist1_joint, wrist2_joint, wrist3_joint] [ INFO] [1762076620.976511379]: Filtered joint names to 6 joints process[move_group-6]: started with pid [28402] process[rviz_tian_28357_5613264337159122920-7]: started with pid [28412] log4cplus:ERROR could not open file ./config/tracelog.properties log4cplus:ERROR No appenders could be found for logger (ourrobottrace). log4cplus:ERROR Please initialize the log4cplus system properly. [ INFO] [1762076621.017125306]: Loading robot model 'aubo_i5'... [ WARN] [1762076621.017989247]: Skipping virtual joint 'base_link' because its child frame 'base_link' does not match the URDF frame 'world' [ INFO] [1762076621.018004978]: No root/virtual joint specified in SRDF. Assuming fixed joint [ INFO] [1762076621.068145876]: rviz version 1.13.30 [ INFO] [1762076621.068293956]: compiled against Qt version 5.9.5 [ INFO] [1762076621.068302158]: compiled against OGRE version 1.9.0 (Ghadamon) [ INFO] [1762076621.071714956]: Forcing OpenGl version 0. [INFO] [1762076621.293396]: Setting publish rate (hz) based on parameter: 50.000000 [INFO] [1762076621.294459]: Simulating manipulator with 6 joints: shoulder_joint, upperArm_joint, foreArm_joint, wrist1_joint, wrist2_joint, wrist3_joint [INFO] [1762076621.295511]: Setting motion update rate (hz): 200.000000 [WARN] [1762076621.296947]: Invalid initial_joint_state parameter, defaulting to all-zeros [INFO] [1762076621.297546]: Using initial joint state: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0] [INFO] [1762076621.302005]: Starting motion worker in motion controller simulator [INFO] [1762076621.303133]: The velocity scale factor of the trajetory is: 1.000000 [INFO] [1762076621.306835]: Creating joint trajectory subscriber [INFO] [1762076621.308616]: Enable Switch [INFO] [1762076621.354461]: Clean up init [ INFO] [1762076621.490932917]: Stereo is NOT SUPPORTED [ INFO] [1762076621.490982853]: OpenGL device: NVIDIA GeForce GTX 1050 Ti/PCIe/SSE2 [ INFO] [1762076621.490998617]: OpenGl version: 4.6 (GLSL 4.6). [ INFO] [1762076621.527283296]: Publishing maintained planning scene on 'monitored_planning_scene' [ INFO] [1762076621.528627766]: MoveGroup debug mode is OFF Starting planning scene monitors... [ INFO] [1762076621.528645797]: Starting planning scene monitor [ INFO] [1762076621.529857849]: Listening to '/planning_scene' [ INFO] [1762076621.529872699]: Starting world geometry update monitor for collision objects, attached objects, octomap updates. [ INFO] [1762076621.530897643]: Listening to '/collision_object' [ INFO] [1762076621.531963313]: Listening to '/planning_scene_world' for planning scene world geometry [ INFO] [1762076622.535972708]: Listening to '/head_mount_kinect/depth_registered/points' using message filter with target frame 'world ' [ INFO] [1762076622.538405886]: Listening to '/attached_collision_object' for attached collision objects Planning scene monitors started. [ INFO] [1762076622.554456326]: Initializing OMPL interface using ROS parameters [ INFO] [1762076622.565566122]: Using planning interface 'OMPL' [ INFO] [1762076622.567477284]: Constructing N point filter [ INFO] [1762076622.568748991]: Param 'default_workspace_bounds' was not set. Using default value: 10 [ INFO] [1762076622.569256661]: Param 'start_state_max_bounds_error' was set to 0.1 [ INFO] [1762076622.569523339]: Param 'start_state_max_dt' was not set. Using default value: 0.5 [ INFO] [1762076622.570007206]: Param 'start_state_max_dt' was not set. Using default value: 0.5 [ INFO] [1762076622.570270603]: Param 'jiggle_fraction' was set to 0.05 [ INFO] [1762076622.570527226]: Param 'max_sampling_attempts' was not set. Using default value: 100 [ INFO] [1762076622.570586021]: Using planning request adapter 'Trajectory filter 'UniformSampleFilter' of type 'UniformSampleFilter'' [ INFO] [1762076622.570597617]: Using planning request adapter 'Add Time Parameterization' [ INFO] [1762076622.570606717]: Using planning request adapter 'Fix Workspace Bounds' [ INFO] [1762076622.570622499]: Using planning request adapter 'Fix Start State Bounds' [ INFO] [1762076622.570642885]: Using planning request adapter 'Fix Start State In Collision' [ INFO] [1762076622.570662345]: Using planning request adapter 'Fix Start State Path Constraints' [ INFO] [1762076622.867106380]: Added FollowJointTrajectory controller for aubo_i5_controller [ INFO] [1762076622.867371382]: Returned 1 controllers in list [ INFO] [1762076622.900353684]: 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] [1762076622.955447007]: ******************************************************** * MoveGroup using: * - ApplyPlanningSceneService * - ClearOctomapService * - CartesianPathService * - ExecuteTrajectoryAction * - GetPlanningSceneService * - KinematicsService * - MoveAction * - PickPlaceAction * - MotionPlanService * - QueryPlannersService * - StateValidationService ******************************************************** [ INFO] [1762076622.955481294]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner [ INFO] [1762076622.955495059]: MoveGroup context initialization complete You can start planning now! [ INFO] [1762076624.756700336]: Loading robot model 'aubo_i5'... [ WARN] [1762076624.756746443]: Skipping virtual joint 'base_link' because its child frame 'base_link' does not match the URDF frame 'world' [ INFO] [1762076624.756771581]: No root/virtual joint specified in SRDF. Assuming fixed joint [ INFO] [1762076625.264448710]: Starting planning scene monitor [ INFO] [1762076625.266530944]: Listening to '/move_group/monitored_planning_scene' [ INFO] [1762076625.686336464]: Constructing new MoveGroup connection for group 'manipulator_i5' in namespace '' [ INFO] [1762076626.877045917]: Ready to take commands for planning group manipulator_i5. [ INFO] [1762076626.877183789]: Looking around: no [ INFO] [1762076626.877245273]: Replanning: no [ INFO] [1762076643.174830115]: Combined planning and execution request received for MoveGroup action. Forwarding to planning and execution pipeline. [ INFO] [1762076643.175277031]: Planning attempt 1 of at most 1 [ INFO] [1762076643.176738253]: Using a sample_duration value of 0.005 [ INFO] [1762076643.180184117]: Planner configuration 'manipulator_i5' will use planner 'geometric::RRTConnect'. Additional configuration parameters will be set when the planner is constructed. [ INFO] [1762076643.182625931]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.182831809]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.182985284]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.183155704]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.196664477]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076643.196880812]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076643.197507341]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076643.197718645]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076643.198230738]: ParallelPlan::solve(): Solution found by one or more threads in 0.016307 seconds [ INFO] [1762076643.199047044]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.199217949]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.199394720]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.199539848]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.203516801]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076643.203977054]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076643.204789531]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076643.205275657]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076643.205579430]: ParallelPlan::solve(): Solution found by one or more threads in 0.006801 seconds [ INFO] [1762076643.206133622]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.206314425]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076643.210023941]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076643.210188376]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076643.210713824]: ParallelPlan::solve(): Solution found by one or more threads in 0.004754 seconds [ INFO] [1762076643.226914630]: SimpleSetup: Path simplification took 0.015846 seconds and changed from 3 to 2 states [ INFO] [1762076643.229838490]: Interpolated time exceeds original trajectory (quitting), original: 1.64812 final interpolated time: 1.65 [ INFO] [1762076643.229965778]: Uniform sampling, resample duraction: 0.005 input traj. size: 4 output traj. size: 331 [ INFO] [1762076643.241589040]: Disabling trajectory recording [ INFO] [1762076643.249267809]: Received new goal [ INFO] [1762076643.249383221]: Publishing trajectory [INFO] [1762076643.254872]: Received trajectory with 331 points [INFO] [1762076643.257125]: Velocity scale factor: 1.0 [ERROR] [1762076643.263622]: Unexpected exception: int() argument must be a string, a bytes-like object or a number, not 'Duration' [INFO] [1762076643.284360]: Added new trajectory with 331 points [ INFO] [1762076645.072204824]: Inside goal constraints, stopped moving, return success for action [ INFO] [1762076645.073066959]: Controller aubo_i5_controller successfully finished [ INFO] [1762076645.131429419]: Completed trajectory execution with status SUCCEEDED ... [ INFO] [1762076645.141135973]: trajectory execution status: stop1 [ INFO] [1762076645.141144669]: Received event 'stop' [ERROR] [1762076645.141260396]: To transition to an aborted state, the goal must be in a preempting or active state, it is currently in state: 3 [ INFO] [1762076645.390044200]: Combined planning and execution request received for MoveGroup action. Forwarding to planning and execution pipeline. [ INFO] [1762076645.390232795]: Planning attempt 1 of at most 1 [ INFO] [1762076645.391435158]: Planner configuration 'manipulator_i5' will use planner 'geometric::RRTConnect'. Additional configuration parameters will be set when the planner is constructed. [ INFO] [1762076645.392501038]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.392765325]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.392996916]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.393232737]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.405152731]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076645.406623163]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076645.407075831]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076645.407262705]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076645.407673599]: ParallelPlan::solve(): Solution found by one or more threads in 0.015443 seconds [ INFO] [1762076645.408471126]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.408854773]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.409019127]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.409187565]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.410172203]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076645.414208863]: RRTConnect: Created 4 states (2 start + 2 goal) [ INFO] [1762076645.414576171]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076645.415038020]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076645.415411858]: ParallelPlan::solve(): Solution found by one or more threads in 0.007207 seconds [ INFO] [1762076645.415915443]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.416264033]: RRTConnect: Starting planning with 1 states already in datastructure [ INFO] [1762076645.420120818]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076645.420431203]: RRTConnect: Created 5 states (2 start + 3 goal) [ INFO] [1762076645.420816818]: ParallelPlan::solve(): Solution found by one or more threads in 0.005031 seconds [ INFO] [1762076645.428721527]: SimpleSetup: Path simplification took 0.007722 seconds and changed from 3 to 2 states [ INFO] [1762076645.431648243]: Interpolated time exceeds original trajectory (quitting), original: 2.78717 final interpolated time: 2.79 [ INFO] [1762076645.431751832]: Uniform sampling, resample duraction: 0.005 input traj. size: 4 output traj. size: 559 [ INFO] [1762076645.450663603]: Received new goal [ INFO] [1762076645.450732490]: Publishing trajectory [INFO] [1762076645.467334]: Received trajectory with 559 points [INFO] [1762076645.469154]: Velocity scale factor: 1.0 [ERROR] [1762076645.480497]: Unexpected exception: int() argument must be a string, a bytes-like object or a number, not 'Duration' [ERROR] [1762076645.492113]: Unexpected exception: int() argument must be a string, a bytes-like object or a number, not 'Duration' [INFO] [1762076645.493956]: Added new trajectory with 559 points [ERROR] [1762076645.494570]: Unexpected exception: int() argument must be a string, a bytes-like object or a number, not 'Duration'
最新发布
11-03
zhf@ubuntu20:~/unitree_go2_yu$ . install/setup.bash zhf@ubuntu20:~/unitree_go2_yu$ ros2 launch go2_driver driver.launch.py [INFO] [launch]: All log files can be found below /home/zhf/.ros/log/2025-06-26-16-21-14-895483-ubuntu20-25112 [INFO] [launch]: Default logging verbosity is set to INFO Task exception was never retrieved future: <Task finished name='Task-2' coro=<LaunchService._process_one_event() done, defined at /opt/ros/foxy/lib/python3.8/site-packages/launch/launch_service.py:226> exception=InvalidLaunchFileError('py')> Traceback (most recent call last): File "/opt/ros/foxy/lib/python3.8/site-packages/launch/launch_description_sources/any_launch_file_utilities.py", line 53, in get_launch_description_from_any_launch_file return loader(launch_file_path) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/launch_description_sources/python_launch_file_utilities.py", line 62, in get_launch_description_from_python_launch_file launch_file_module = load_python_launch_file_as_module(python_launch_file_path) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/launch_description_sources/python_launch_file_utilities.py", line 37, in load_python_launch_file_as_module loader.exec_module(mod) File "<frozen importlib._bootstrap_external>", line 844, in exec_module File "<frozen importlib._bootstrap_external>", line 981, in get_code File "<frozen importlib._bootstrap_external>", line 911, in source_to_code File "<frozen importlib._bootstrap>", line 219, in _call_with_frames_removed File "/home/zhf/unitree_go2_yu/install/go2_driver/share/go2_driver/launch/driver.launch.py", line 26 Node( ^ SyntaxError: invalid syntax The above exception was the direct cause of the following exception: Traceback (most recent call last): File "/opt/ros/foxy/lib/python3.8/site-packages/launch/launch_service.py", line 228, in _process_one_event await self.__process_event(next_event) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/launch_service.py", line 248, in __process_event visit_all_entities_and_collect_futures(entity, self.__context)) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/utilities/visit_all_entities_and_collect_futures_impl.py", line 45, in visit_all_entities_and_collect_futures futures_to_return += visit_all_entities_and_collect_futures(sub_entity, context) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/utilities/visit_all_entities_and_collect_futures_impl.py", line 45, in visit_all_entities_and_collect_futures futures_to_return += visit_all_entities_and_collect_futures(sub_entity, context) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/utilities/visit_all_entities_and_collect_futures_impl.py", line 38, in visit_all_entities_and_collect_futures sub_entities = entity.visit(context) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/action.py", line 108, in visit return self.execute(context) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/actions/include_launch_description.py", line 130, in execute launch_description = self.__launch_description_source.get_launch_description(context) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/launch_description_source.py", line 84, in get_launch_description self._get_launch_description(self.__expanded_location) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/launch_description_sources/any_launch_description_source.py", line 53, in _get_launch_description return get_launch_description_from_any_launch_file(location) File "/opt/ros/foxy/lib/python3.8/site-packages/launch/launch_description_sources/any_launch_file_utilities.py", line 56, in get_launch_description_from_any_launch_file raise InvalidLaunchFileError(extension, likely_errors=exceptions) launch.invalid_launch_file_error.InvalidLaunchFileError: Caught exception when trying to load file of format [py]: invalid syntax (driver.launch.py, line 26)
06-27
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值