资源简介
D* Lite路径规划算法,可以在源代码中修改地图大小、起始点、目标点、四向或八向搜寻,算法随机生成原始地图和实际地图,路径规划过程中根据实际障碍物情况改变生成路径。

代码片段和文件信息
function [key1key2]=CalculateKey(s)%计算节点key值参数(当前节点)返回该节点key值
global km;
global g;
global rhs;
global key;
global s_start;
global neighbour;
if(size(neighbour1)==4)%四向时两点间代价为横做坐标差值相加
h=abs(s_start(1)-s(1))+abs(s_start(2)-s(2));
else%八向时两点间代价为横做坐标差值最大的数
% h=max(abs(s_start(1)-s(1))abs(s_start(2)-s(2)));%h是可以改进的点
h=min(abs(s_start(1)-s(1))abs(s_start(2)-s(2)))*1.4+abs(abs(s_start(1)-s(1))-abs(s_start(2)-s(2)));
% h=0;
end
key2=min(g(s(1)s(2))rhs(s(1)s(2)));
key1=key2+km+h;
key(s(1)s(2)).key1=key1;
key(s(1)s(2)).key2=key2;
end
属性 大小 日期 时间 名称
----------- --------- ---------- ----- ----
目录 0 2019-05-27 17:35 D_star Lite_veryok\
文件 789 2019-05-27 14:47 D_star Lite_veryok\rhs_cal.m
文件 7213 2019-05-27 17:20 D_star Lite_veryok\main.m~
文件 391 2019-05-23 17:10 D_star Lite_veryok\UTopKey.m
文件 7259 2019-05-27 17:33 D_star Lite_veryok\main.m
文件 1905 2019-05-27 14:49 D_star Lite_veryok\ComputeShortestPath.m
文件 420 2019-05-27 09:12 D_star Lite_veryok\UpdateVertex.m
文件 234 2019-05-23 16:35 D_star Lite_veryok\CompareKey.m
文件 203 2019-05-23 19:39 D_star Lite_veryok\over_border.m
文件 690 2019-05-27 09:04 D_star Lite_veryok\CalculateKey.m
- 上一篇:httpd基于端口的域名解析
- 下一篇:新版txt坐标生成与检查软件2000.zip
相关资源
- 编程实现二维DCT变换
- 图像二值化
- 用FFT对信号进行频谱分析
- Tone-Reservation
- QGA 量子遗传算法
- 差分形式的阻滞增长模型
- 遗传算法的M文件
- 简单二阶互联系统的非线性动力学分
- 基于改进势场栅格法的移动机器人路
- 基于改进人工势场的矿井导航装置路
- 利用改进人工势场法的智能车避障路
- 基于改进人工势场法的救灾机器人路
- 手写数字识别-模板匹配法
- Stock_Watson_动态因子分析模型
- 果蝇优化算法优化支持向量回归程序
- 自己做的一个简单GUI扑克纸牌识别-
- multi output SVR
- AR过程的线性建模过程与各种功率谱估
- PCNN TOOLBOX
- 基于A_算法的空间机械臂避障路径规划
- plstoolbox.zip
- 中国国家基础地理信息系统GIS数据
- 粒子群微电网优化调度
- 矩阵分析-经典教材-中文版-Roger.A.Ho
- 压缩感知TwIST
- 基于最小错误率的贝叶斯手写数字分
- 最全系统辨识源代码,包括多种最小
- 导弹制导实验
- 画跟踪精确度图的程序.zip
- 重力场大地水准面及重力异常阶次误
评论
共有 条评论