-
大小: 651B文件類型: .py金幣: 1下載: 0 次發(fā)布日期: 2021-05-15
- 語言: Python
- 標(biāo)簽: L1制導(dǎo)??實(shí)現(xiàn)代碼??python??算法??
資源簡介
根據(jù)之前發(fā)布放入L1制導(dǎo)算法文檔寫出的python程序,涉及了點(diǎn)到直線垂向量求解、L1制導(dǎo)算法應(yīng)用和普通點(diǎn)制導(dǎo)揉和,對理解和應(yīng)用L1制導(dǎo)有著啟發(fā)作用。
代碼片段和文件信息
#(ptarget_x??ptarget_y)??(target_x??target_y)構(gòu)成目標(biāo)直線
A?=?target_y?-?ptarget_y
B?=?ptarget_x?-?target_x
C?=?target_x?*?ptarget_y?-?ptarget_x?*?target_y
k?=?-(A?*?UAVPosition_x.value?+?B?*?UAVPosition_y.value?+?C)?/?(A?*?A?+?B?*?B)
[dx??dy]?=?[k?*A??k?*?B]
v?=?math.hypot(V_x.value??V_y.value)
L1?
評(píng)論
共有 條評(píng)論