gazebo中怎么实现避障行进
这篇文章将为大家详细讲解有关gazebo中怎么实现避障行进，文章内容质量较高，因此小编分享给大家做个参考，希望大家阅读完这篇文章后对相关知识有一定的了解。
%% 修改成虚拟机IP地址
ipaddress = '192.168.137.129';
%% 初始化
rosinit(ipaddress)
%% 获取gazebo元素
gazebo = ExampleHelperGazeboCommunicator();
%% 新建并添加一堵墙
wall = ExampleHelperGazeboModel('grey_wall','gazeboDB');
spawnModel(gazebo,wall,[-2 4 0]);
%% 获取robot后设定其姿态
kobuki = ExampleHelperGazeboSpawnedModel('mobile_base',gazebo);
setState(kobuki,'orientation',[0 0 pi/2]);
%% 新建全局变量
global robot
global velmsg
%% 获取robot的速度信息
robot = rospublisher('/mobile_base/commands/velocity');
velmsg = rosmessage(robot);
%% 获取robot的避障雷达什么的
timerHandles.sub = rossubscriber('/scan');
%% 设置避障
t = timer('TimerFcn',{@exampleHelperGazeboAvoidanceTimer,timerHandles},'Period',0.1,'ExecutionMode','fixedSpacing');
%% 开始避障行进
start(t);
%% 再添加一堵墙
spawnModel(gazebo,wall,[-5.85 0.15 0],[0, 0, pi/2]);
%% 程序等待20秒
pause(20);
%% 结束避障行进
stop(t)
%% 获取所有物体
list = getSpawnedModels(gazebo);
%% 移除两堵墙
removeModel(gazebo,'grey_wall');
removeModel(gazebo,'grey_wall_0');
%% 清空变量
clear
%% 关闭连接
rosshutdown
关于gazebo中怎么实现避障行进就分享到这里了，希望以上内容可以对大家有一定的帮助，可以学到更多知识。如果觉得文章不错，可以把它分享出去让更多的人看到。
