gazebo中怎么实现避障行进

发布时间：2021-06-21 18:29:34 阅读：355 作者：Leah 栏目：大数据

这篇文章将为大家详细讲解有关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中怎么实现避障行进就分享到这里了，希望以上内容可以对大家有一定的帮助，可以学到更多知识。如果觉得文章不错，可以把它分享出去让更多的人看到。

猜你喜欢