function?Theta?=?compute_angle（XXgrrepn）
%X????????????當(dāng)前位姿
%Xgr??????????目標(biāo)點(diǎn)、障礙點(diǎn)位姿
%repn?????????障礙數(shù)目
%ret??????????目標(biāo)點(diǎn)、障礙點(diǎn)與X軸夾角
for?i?=?1?:?repn+1
??????deltax?=?Xgr（i1）-X（1）;
??????deltay?=?Xgr（i2）-X（2）;
????r?=?sqrt（deltax^2?+?deltay^2）;?
????
????if?deltax?>=?0?&?deltay?>=?0
????Theta（i）?=?asin（deltay/r）;
????elseif?deltax??0
????Theta（i）?=?pi-asin（deltay/r）;
????elseif?deltax?<=0?&?deltay?<=0
????Theta（i）?=?pi?-?asin（deltay/r）;
????elseif?deltax>0?&deltay<0
????Theta（i）?=?2*pi?+?asin（deltay/r）;
????
?????
?????
????end
end

?屬性????????????大小?????日期????時(shí)間???名稱(chēng)
-----------?---------??----------?-----??----
?????文件?????????602??2020-11-27?06:07??rengong2\compute_angle.m
?????文件?????????851??2020-11-27?06:07??rengong2\compute_attract.m
?????文件????????2485??2020-11-27?06:07??rengong2\compute_repulsion.m
?????文件????????2085??2020-11-27?06:07??rengong2\main.m