資源簡介
根據之前發布放入L1制導算法文檔寫出的python程序,涉及了點到直線垂向量求解、L1制導算法應用和普通點制導揉和,對理解和應用L1制導有著啟發作用。
代碼片段和文件信息
#(ptarget_x??ptarget_y)??(target_x??target_y)構成目標直線
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?
評論
共有 條評論