gmapping算法的MATLAB实现
来源:互联网 发布:纵向数据分析方法 编辑:程序博客网 时间:2024/06/14 17:07
首先给出在matalab中实现地图的创建与轨迹的给定:
从上面可以看出黑线画的是地图,红线画的是要跟踪的轨迹代码如下:
% %Wall Exterior
map(:,1) = [80; 20; 210; 20];
map(:,2) = [210; 20; 210; 230];
map(:,3) = [210; 230; 80; 230];
map(:,4) = [80; 230; 80; 170];
map(:,5) = [80; 170; 20; 170];
map(:,6) = [20; 170; 20; 80];
map(:,7) = [20; 80; 80; 80];
map(:,8) = [80; 80; 80; 20];
%Wall Interior
map(:,9) = [110; 50; 180; 50];
map(:,10) = [180; 50; 180; 200];
map(:,11) = [180; 200; 110; 200];
map(:,12) = [110; 200; 110; 170];
map(:,13) = [110; 170; 170; 170];
map(:,14) = [170; 170; 170; 80];
map(:,15) = [170; 80; 110; 80];
map(:,16) = [110; 80; 110; 50];
%Wall Interior
map(:,17) = [50; 110; 140; 110];
map(:,18) = [140; 110; 140; 140];
map(:,19) = [140; 140; 50; 140];
map(:,20) = [50; 140; 50; 110];
%plot map
figure(1)
clf
hold on
for d = 1:size(map,2)
plot([map(1,d) map(3,d)],[map(2,d) map(4,d)],'k')
end
via = [100,35; 185,35; 185,40; 190,45; 195,50; 195,200; 190,205; 185,210; 180,215; 110,215; 105,195; 100,190; 95,185; ...
95,170; 90,165; 85,160; 80, 155; 50,155; 45, 150; 40,145; 35,140; 35,110; 40,105; 45, 100; 50,95; 140,95; 145,100; ...
150,105; 155,110; 155,140; 150,145; 145,150; 140,155; 50,155; 45, 150; 30,145; 35,140; 35,110; 40,105; ...
45,100; 50,95; 80,95; 85,90; 90,85; 95,80; 95,35];
hold on
plot(via(:,1),via(:,2),'-r')
欢迎大家一起来讨论地图构建算法研究
- gmapping算法的MATLAB实现
- gmapping 算法解析
- 基于粒子滤波的SLAM(GMapping)算法分析
- Gmapping hector cartogarpher 三种激光雷达算法的比对
- ROS下用gmapping 构建实验室地图的实现
- rviz实现gmapping的具体方法,利用官方包
- 匈牙利算法的MatLab实现
- 蒙特卡罗算法的matlab实现
- KNN的matlab实现算法
- SIFT算法的MATLAB实现
- 遗传算法的matlab实现
- 遗传算法的matlab实现
- DES算法的matlab实现
- SIFT算法的Matlab实现
- KNN算法的matlab实现
- OMP算法的matlab实现
- 遗传算法的matlab实现
- 遗传算法的matlab实现
- mysql集群的优缺点
- yii2 下使用memcached(非memcache)
- 文件流的压缩和解压
- 网络判断打开WiFi
- springMVC form表单提交---包含时间类型的数据
- gmapping算法的MATLAB实现
- css笔记
- Will restarting multipath affect production?
- SAP空格无法带出历史记录的解决办法
- 打造自己的JavaScript武器库
- K-最近邻法(KNN) C++实现
- HTTP & HTTPS网络协议重点总结(基于SSL/TLS的握手、TCP/IP协议基础、加密学)
- 个人C++错误汇总
- delphi pos 多个中文字符