资源简介

根据之前发布放入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 

评论

共有 条评论