-
大小: 2KB文件類(lèi)型: .m金幣: 1下載: 0 次發(fā)布日期: 2021-05-08
- 語(yǔ)言: Matlab
- 標(biāo)簽: MATLAB??勢(shì)場(chǎng)柵格??
資源簡(jiǎn)介
基于柵格地圖的模型,勢(shì)場(chǎng)法的原理,設(shè)置初始點(diǎn)與目標(biāo)點(diǎn)的路徑規(guī)劃圖
個(gè)人心血
代碼片段和文件信息
clear
map=ones(1010)%創(chuàng)建地圖
%[xy]=find(map)
obst=[1522233233353845475355586374758084858990]%錄入障礙物地圖
%map(15)=map(22)=
%map(23)=map(32)=map(33)=map(35)=map(38)=map(45)=map(47)=map(53)=map(55)=map(55)=map(58)=map(63)=map(74)=map(75)=map(80)=map(84)=map(85)=map(89)=map(90)=0
t=length(obst)
for?i=1:t
????map(obst(i))=0
end%將障礙物柵格值設(shè)為零
%for?i=1:t
%?????long(i)=fix(k(i)/10)
%?????width(i)=fix(k(i)/10)
%?????m=(long(i)-8)^2+(width(i)-8)^2
next_orientation=[-9111109-1-11-10];%周?chē)?個(gè)柵格的序號(hào)差?
step=[]%路徑數(shù)組
%w=[361063212]
%a=[21212121]
%v=a.^(1/2)
j=12;
while?j~=88
????
????next_value=next_orientation+j;
????b=(next_value==88)
????if?max(b)==0
for?i=1:8
????
????high(i)=fix(next_value(i)/10)
????width(i)=mod(next_value(i)10)
????distance(i)=(high(i)-8)^2+(width(i)-8)^2
%next_value=next_orientation+j;
grav(i)=distan
評(píng)論
共有 條評(píng)論