91av视频/亚洲h视频/操亚洲美女/外国一级黄色毛片 - 国产三级三级三级三级

  • 大小: 3.98KB
    文件類型: .zip
    金幣: 1
    下載: 0 次
    發布日期: 2021-03-28
  • 語言: Matlab
  • 標簽: matlab??

資源簡介


在論壇上搜了一些matlab人工勢場法程序,但很多都有一些問題,比如目標不可達,角度計算錯誤等等。在這些的基礎上,我進行了改進,使得能夠更好地到達目標點,減少了震蕩,但是依舊會出現幾次震蕩,愿高手繼續完善。程序可以用C寫出來,做機器人路徑規劃或者避障的同學,該文檔有很高的參考性。

資源截圖

代碼片段和文件信息

function?[angle_atangle_rep]=?compute_angle(XX_targetX_obsn)%[angle_atangle_rep]是向量返回值X是機器人坐標,X_target目標點的坐標,X_robot是障礙的坐標向量是n*2矩陣
????for?i=1:n%n個障礙物
?????????del_Xi=X_obs(i1)-X(1);%Xsum(i1)取第i行第1列,X(1)指X向量的第1個值
?????????del_Yi=X_obs(i2)-X(2);
?????????ri=sqrt(del_Xi^2+del_Yi^2);%ri為兩點距離
?????????if?del_Xi>0
?????????????angle=asin(del_Xi/ri);
?????????else
?????????????angle=pi+asin(del_Xi/ri);
?????????end
?????????????angle_rep(i)=pi+angle;%保存每個障礙物角度在angle_rep向量里面??????
????end
????%與目標點的夾角
?????????del_Xi=X_target(1)-X(1);
?????????del_Yi=X_target(2)-X(2);
?????????ri=sqrt(del_Xi^2+del_Yi^2);%ri為兩點距離
?????????if?del_Xi>0
?????????????angle_at=asin(del_Xi/ri);
?????????else
?????????????angle_at=pi+asin(del_Xi/ri);
?????????end
end


?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件?????????859??2015-04-12?17:38??人工勢場?-?模糊處理\compute_angle.m
?????文件?????????262??2015-04-12?16:59??人工勢場?-?模糊處理\compute_attraction.m
?????文件?????????785??2015-04-12?18:12??人工勢場?-?模糊處理\compute_repultion.m
?????文件????????1181??2015-04-13?10:32??人工勢場?-?模糊處理\distance_fuzzyControl.m
?????文件????????2602??2015-04-13?10:43??人工勢場?-?模糊處理\main.m
?????目錄???????????0??2015-04-13?10:43??人工勢場?-?模糊處理\

評論

共有 條評論