一种任意时间到达的固定翼无人机制导方法

文档序号:31606773发布日期:2022-09-21 10:58阅读:来源:国知局

技术特征:
1.一种任意时间到达的固定翼无人机制导方法,其特征在于,所述方法包括以下步骤:步骤s100:建立无人机与目标点的二维碰撞模型,所述二维碰撞模型中包括无人机的位置、目标点的位置、无人机的速度v、经过无人机的水平基准线ref,从无人机到目标点的视线los,从水平基准线ref到速度v的夹角θ,逆时针方向为正;步骤s200:根据所述无人机的位置和所述目标点的位置得到所述无人机和所述目标点的相对距离r以及水平基准线ref到视线los的夹角q;步骤s300:根据所述水平基准线到视线的夹角q以及所述水平基准线ref到速度v的夹角θ得到从速度v到视线los的夹角η;步骤s400:根据所述无人机和所述目标点的相对距离r、所述速度v到视线los的夹角η和所述无人机的速度v设计无人机的盘旋制导律;步骤s500:获取期望无人机的到达时间为t
d
,无人机的已飞时间为t,根据预设的导航系数、所述无人机的速度v、所述无人机和所述目标点的相对距离r、所述水平基准线ref到视线los的夹角q、所述水平基准线到速度的夹角θ计算当前时刻无人机达到目标点所用时间t
go
;步骤s600:根据所述期望无人机的到达时间t
d
、所述无人机的已飞时间t、所述当前时刻无人机达到目标点所用时间t
go
以及预设阈值确定选择所述无人机的盘旋制导律或预设的时间控制制导律进行制导,得到无人机的过载指令,以控制无人机飞行。2.根据权利要求1所述的方法,其特征在于,步骤s200中根据所述无人机的位置和所述目标点的位置得到所述无人机和所述目标点的相对距离r,具体为:具体地,(x,y)为无人机的位置,(x
t
,y
t
)为目标点的位置。3.根据权利要求2所述的方法,其特征在于,步骤s200中根据所述无人机的位置和所述目标点的位置得到水平基准线ref到视线los的夹角q,具体为:若x
t
≥x,则若x
t
<x,y
t
≥y,则若x
t
<x,y
t
<y,则其中,q为水平基准线ref到视线los的夹角。4.根据权利要求3所述的方法,其特征在于,步骤s300具体为:η=q-θ其中,θ为水平基准线ref到速度v的夹角,η为速度v到视线los的夹角。5.根据权利要求4所述的方法,其特征在于,步骤s400包括:步骤s410:根据所述无人机和所述目标点的相对距离r、所述速度v到视线los的夹角η和所述无人机的速度v得到水平基准线ref到视线los的角速率步骤s420:根据所述无人机的速度v、所述速度v到视线los的夹角η以及所述水平基准线ref到视线los的角速率设计无人机的盘旋制导律。6.根据权利要求5所述的方法,其特征在于,步骤s410具体为:
其中,为水平基准线ref到视线los的角速率;步骤s420具体为:其中,a为无人机的过载指令。7.根据权利要求6所述的方法,其特征在于,步骤s500中根据预设的导航系数、所述无人机的速度v、所述无人机和所述目标点的相对距离r、所述水平基准线ref到视线los的夹角q、所述水平基准线到速度的夹角θ计算当前时刻无人机达到目标点所用时间t
go
,具体为:其中,t
go
为当前时刻无人机达到目标点所用时间,n为预设的导航系数。8.根据权利要求7所述的方法,其特征在于,步骤s600中预设的时间控制制导律,具体为:其中,t
d
为期望无人机的到达时间、t为所述无人机的已飞时间、t
go
为当前时刻无人机达到目标点所用时间。9.根据权利要求8所述的方法,其特征在于,步骤s600具体为:若则使用所述盘旋制导律进行制导;若则使用预设的时间控制制导律进行制导。10.根据权利要求9所述的方法,其特征在于,步骤s600之后还包括:步骤s700:当所述无人机和所述目标点的相对距离r小于预设距离阈值时,制导停止。

技术总结
本发明公开了一种任意时间到达的固定翼无人机制导方法,包括建立无人机与目标点的二维碰撞模型;根据无人机和目标点的位置得到无人机和目标点的相对距离r以及水平基准线到视线的夹角q;结合水平基准线到速度的夹角θ得到从速度到视线的夹角η;根据相对距离r、夹角η和无人机的速度v设计无人机的盘旋制导律;根据预设的导航系数、无人机的速度v、相对距离r、夹角q、夹角θ计算当前时刻无人机达到目标点所用时间t


技术研发人员:郭鸿武 岳生民 陆子豪
受保护的技术使用者:中国人民解放军国防科技大学
技术研发日:2022.07.20
技术公布日:2022/9/20
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1