資源簡(jiǎn)介
通過(guò)人工勢(shì)場(chǎng)法進(jìn)行避障處理,可以避免局部最小值問(wèn)題

代碼片段和文件信息
function?Y=compute_angle(XXsumn)%Y是引力,斥力與x軸的角度向量X是起點(diǎn)坐標(biāo),Xsum是目標(biāo)和障礙的坐標(biāo)向量是(n+1)*2矩陣
??for?i=1:n+1%n是障礙數(shù)目
??????deltaXi=Xsum(i1)-X(1)
??????deltaYi=Xsum(i2)-X(2)
??????ri=sqrt(deltaXi^2+deltaYi^2)
??????if?deltaXi>0
??????????theta=asin(deltaXi/ri)
??????else
??????????theta=pi-asin(deltaXi/ri)
??????end
??????if?i==1%表示是目標(biāo)
??????????angle=theta
??????else
??????????angle=pi+theta
??????end?????
??????Y(i)=angle%保存每個(gè)角度在Y向量里面,第一個(gè)元素是與目標(biāo)的角度,后面都是與障礙的角度
??end
??????
?屬性????????????大小?????日期????時(shí)間???名稱
-----------?---------??----------?-----??----
?????文件?????843536??2006-09-13?14:20??single_robot_artificial_field\1.bmp
?????文件?????836184??2006-09-13?14:20??single_robot_artificial_field\2.bmp
?????文件????????562??2009-03-24?14:58??single_robot_artificial_field\compute_angle.asv
?????文件????????562??2009-03-24?15:04??single_robot_artificial_field\compute_angle.m
?????文件????????463??2009-03-24?17:03??single_robot_artificial_field\compute_Attract.asv
?????文件????????463??2009-03-24?17:08??single_robot_artificial_field\compute_Attract.m
?????文件???????1065??2006-09-13?14:20??single_robot_artificial_field\compute_repulsion.m
?????文件???????2959??2009-03-25?15:57??single_robot_artificial_field\main.m
?????文件???????7134??2009-03-25?15:59??single_robot_artificial_field\no3.fig
????..A.SH.??????5632??2009-04-06?20:53??single_robot_artificial_field\Thumbs.db
?????目錄??????????0??2018-04-03?19:54??single_robot_artificial_field
-----------?---------??----------?-----??----
??????????????1698560????????????????????11
- 上一篇:單步六層電梯
- 下一篇:ne5532的lib文件和olb文件
評(píng)論
共有 條評(píng)論