[CF346D]Robot Control

本文深入探讨了SPFA算法在复杂图上的应用,详细解释了如何通过动态更新dp值来寻找从任意一点到目标点的最短路径,避免机器人在路径中因回路而爆炸。文章提供了代码实现,展示了如何构建反向图并使用SPFA算法进行搜索。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

看来我果然还是太菜,只能看看思路才能AC
  • 题意

    自己查...

  • solution

    设dp[x]为从x到t最小需要控制次数
    对于一个点,我们有两种选择:控制,或者不控制
    基于这个,dp方程或许很好推: \(dp[now]=min(max{dp[to]},min{dp[to]}+1)\) to为从x点所能到达的所有点
    那么问题来了,怎么更新dp值?
    因为图很复杂,你用来更新其他点的点,可能又会被其他点更新(即有其他策略),
    所以我们要采用一种类似spfa的方法,把更新过的点推进队列.
    如何更新:对于一个点,我们用它的值来更新原图上能直接到达它的点的min{dp[to]}+1,然后用原图上它能到达的点的值来更新它的max{dp[to]}
    而且我们要从t倒着搜到s,所以我们要建个反向图跑spfa
    但是还有一个问题,我们不能让机器人boom掉
    其实这个不难,因为机器人不走回路肯定比走回路优,所以dp避免了boom的情况
    贴个图理解一下

    5c7e10c59f6e4.png

    我们在t这一点用dpt来更新dp[3]使dp[3]=1(min{dp[to]}+1)
    在3这一点用dp[3]来更新dp[2]使dp[2]=2(min{dp[to]}+1)
    同在3这一点,我们发现此时max{dp[to]}=dp[2]=2,不能更新dp[3]
    但在2这一点,max{dp[to]}=dp[3]=1,把dp[2]更新成2
    dp更新的流程就是这样.
    • code
#include<iostream>
#include<cstdio>
#include<algorithm>
#include<vector>
#include<cstring>
#include<queue>
#define N 1000005
using namespace std;
vector<int> G[N],G2[N];
int f[N];
bool vis[N];
int n,m,s,t;
queue<int> q;
int main(){  
 scanf("%d%d",&n,&m);
 for(int i=1;i<=m;i++){
   int a,b;
   scanf("%d%d",&a,&b);
   G[a].push_back(b);
   G2[b].push_back(a);
   }
 scanf("%d%d",&s,&t);
 memset(f,0X3f,sizeof f);
 memset(vis,false,sizeof vis);
 q.push(t);
 f[t]=0;
 vis[t]=1; 
 while(!q.empty()){
   int now=q.front();
   q.pop();
   vis[now]=0;
   for(int i=0;i<G2[now].size();i++){
     int to=G2[now][i];
     if(f[to]>f[now]+1){
       f[to]=f[now]+1;
       if(!vis[to]){
         vis[to]=true;
         q.push(to);
         }
       }
     }
   int plk=0;
   for(int i=0;i<G[now].size();i++)plk=max(plk,f[G[now][i]]);
   if(plk<f[now]){
     f[now]=plk;
     if(!vis[now]){
       vis[now]=true;
       q.push(now);
       } 
     }
   }
 if(f[s]==0X3f3f3f3f)cout<<-1;
 else cout<<f[s];
 }

转载于:https://www.cnblogs.com/stepsys/p/10476426.html

(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
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值