clear?
clc
Xo=[0?0];%起點(diǎn)位置
k=15;%計(jì)算引力需要的增益系數(shù)
m=10;%計(jì)算斥力系數(shù)
Po=2.5;%障礙影響距離
Pstop=0.1;
n=7;
l=0.2;
J=600;
Xsum=[10?10;4.5?5;5?4.5;5.5?4;4?5.5;5?3;3?5;10.2?10.2];
Xj=Xo;
ex=0;
madx=1;
mad（madx1）=Xsum（11）;%將目標(biāo)點(diǎn)存入
mad（madx2）=Xsum（12）;


for?j=1:J
????Goal（j1）=Xj（1）;
????Goal（j2）=Xj（2）;
????Theta=compute_angle（XjXsumn）;
????Angle=Theta（1）;
????angle_at=Theta（1）;
????%調(diào)用引力模塊
????[FatxFaty]=compute_Attract（XjXsumkAnglemnPo）;
????for?i=1:n
????????angle_re（i）=Theta（i+1）;
????end
????%調(diào)用斥力模塊
????[YrerxxYreryy]=compute_repulsion（XjXsummangle_renPo）;
????
????%判斷是否在局部極小值點(diǎn)
????angleatt（j）=Angle;
????Fatt=sqrt（Fatx^2+Faty^2）;
????Frep=sqrt（Yrerxx^2+Yreryy^2）;
????if?Yrerxx>=0
????????anglerep（j）=atan（Yreryy/Yrerxx）;
????else
????????anglerep（j）=p

?屬性????????????大小?????日期????時(shí)間???名稱
-----------?---------??----------?-----??----

?????文件???????3849??2018-05-23?20:20??main.m

-----------?---------??----------?-----??----

?????????????????3849????????????????????1