这篇文章将为大家详细讲解有关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中怎么实现避障行进就分享到这里了,希望以上内容可以对大家有一定的帮助,可以学到更多知识。如果觉得文章不错,可以把它分享出去让更多的人看到。
免责声明:本站发布的内容(图片、视频和文字)以原创、转载和分享为主,文章观点不代表本网站立场,如果涉及侵权请联系站长邮箱:is@yisu.com进行举报,并提供相关证据,一经查实,将立刻删除涉嫌侵权内容。