资源简介
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
相关资源
- 马尔可夫链状态空间的分解实验报告
- 计算方法A上机作业
- 相位屏仿真方法.rar
- 基于高斯混合模型的背景减除
- 基于co-training的手写数字识别Multiple
- 多普勒脉冲雷达回波仿真
- kpca lda mds降维 人脸数据
- 光伏在MPPT下的boost电路
- 随机梯度下降算法
- 基础差分进化算法Rastrigin测试
- ABC带约束优化算法
- 连接二值图像中断开的点
- 车牌倾斜校正
- 卷积编解码,实现了2/33/4删余卷积
- 有源电力滤波器APF
- RBF神经网络预测
- 基于模糊控制和PID结合的倒立摆仿真
- 基本风+阵风+噪声风+渐变风联合仿真
- 瑞利信道下的分集合并技术仿真
- advisor复合电源二次开发过程
- 旅行商问题中国34省会的
- 计量经济学软件eviews6.0建模方法与操
- 机场延误 遗传算法
- MSSIM 图像相似度的计算
- 微电网虚拟同步发电寄控制模型
- flocking concrol.zip
- 蚁狮算法寻优
- 二次曲面拟合实现高程模型建立
- 角点检测Corners代码
- 基于梯度法的模型参考自适应程序
评论
共有 条评论