一种基于两轴机载雷达伺服平台的兴趣点跟踪控制方法与流程

文档序号:13673669阅读:来源:国知局
技术特征:
1.一种基于两轴机载雷达伺服平台的兴趣点跟踪控制方法,其步骤如下:(1)对飞机平飞时,即飞机速度为水平方向,飞机惯导输出的惯导数据中的飞机速度数据、飞机姿态数据进行滤波,滤波中心频率根据需求进行设定,飞机惯导输出的机载惯导数据,包括飞机位置数据、飞机速度数据、飞机姿态数据;(2)根据步骤(1)的飞机位置数据及需要观测的兴趣点位置数据,对飞机及兴趣点所处地球位置进行识别,计算飞机到兴趣点连线在地面投影的长度;(3)根据步骤(1)的飞机位置数据及需要观测的兴趣点位置数据,获取飞机到兴趣点连线在地面投影与正北方向的夹角设定正北为0°,北偏东为正,夹角的范围为[0,360];(4)根据步骤(1)滤波后的飞机速度数据,求取飞机水平方向的合成速度的方向与正北方向的夹角θv,设定正北为0°,北偏东为正,夹角θv的范围为[0,360];(5)根据飞机位置数据中的海拔高度、及需要观测的兴趣点位置数据中的兴趣点的海拔高度,确定飞机与兴趣点相对高度h,设定速度坐标系O-XVYVZV,以雷达天线中心为O点,速度坐标系的YV轴指向飞机的速度正方向,速度坐标系的ZV轴垂直于YV轴指向天空,即垂直于水平面,速度坐标系的XV轴垂直于OYVZV平面,三轴关系满足笛卡尔直角坐标系关系,根据飞机位置与兴趣点位置和相对高度h,计算速度坐标系下雷达天线指向兴趣点的前视角和下视角;(6)根据飞机和兴趣点的相对位置,计算步骤(5)设定的速度坐标系下飞机的雷达指向兴趣点的波束的单位方向向量;(7)设定飞机机体坐标系O-XRYRZR,机体坐标系的YR轴正方向为机头方向,机体坐标系的XR轴正方向与YR轴垂直指向飞机右侧,且在飞机机体水平平面上,ZR轴垂直于OXRYR平面,三轴关系满足笛卡尔直角坐标系关系;根据步骤(1)滤波后的飞机姿态数据,使用坐标转换方法,将步骤(6)得到的波束的单位方向向量从步骤(5)设定的速度坐标系下转换到飞机机体坐标系下,得到飞机机体坐标系下波束的单位方向向量;(8)根据步骤(7)设定的飞机机体坐标系下的波束的单位方向向量,计算两轴雷达伺服平台的雷达天线的方位角和俯仰角两轴雷达伺服平台的雷达天线的方位角和俯仰角分别为雷达天线方位轴指令角和俯仰轴指令角,即需要方位轴和俯仰轴转到的角度;(9)通过传感器得到雷达天线实时的方位角ηa和俯仰角ηp,并根据步骤(8)得到的两轴雷达伺服平台的方位轴指令角和俯仰轴指令角控制雷达天线从实时的方位角ηa转到方位轴指令角控制雷达天线从实时的俯仰角ηp转到俯仰轴指令角实现了雷达天线波束指向兴趣点的跟踪控制。2.根据权利要求1所述的一种基于两轴机载雷达伺服平台的兴趣点跟踪控制方法,其特征在于:所述步骤(2)中对飞机及兴趣点所处地球位置进行识别中的兴趣点为全球范围内的兴趣点。3.根据权利要求1所述的一种基于两轴机载雷达伺服平台的兴趣点跟踪控制方法,其特征在于:所述步骤(2)中对飞机及兴趣点所处地球位置进行识别,计算飞机和兴趣点在地面投影的距离,步骤如下:将地球视为标准球体,半径为6371.004m,设飞机惯导输出的飞机的经纬度分别为Rlo,Rla,需要观测的兴趣点经纬度分别为Tlo,Tla,设置位置经纬度取值标准为以子午线为0°经度线,东经取经度的正值,西经取经度的负值,以赤道为0°纬度线,北纬取90°减纬度值,南纬取90°加纬度值,根据步骤(1)的飞机惯导位置数据及需要观测的兴趣点位置数据,确定以上标准下飞机位置经度NRlo及纬度NRla、兴趣点位置经度NTlo及纬度NTla,进而计算新的飞机雷达位置和兴趣点位置在地面投影的距离D。4.根据权利要求1所述的一种基于两轴机载雷达伺服平台的兴趣点跟踪控制方法,其特征在于:所述步骤(7)中使用坐标转换方法,将步骤(6)得到的波束的单位方向向量从步骤(5)设定的速度坐标系下转换到步骤(7)设定的飞机机体坐标系下,得到飞机机体坐标系下波束的单位方向向量,公式如下:Vaxi[3]=TRTPTAOv[3]Vaxi[3]为步骤(7)设定的飞机机体坐标系下波束的单位方向向量,Ov[3]为步骤(5)设定的速度坐标系下的波束的单位方向向量,TA为波束从速度坐标系下转换到机体标系下的绕ZV轴旋转的转换矩阵,TP为波束从速度坐标系下转换到机体标系下的绕旋转后的XV轴旋转的转换矩阵,TR为波束从速度坐标系下转换到机体标系下的绕旋转后的YV轴旋转的转换矩阵。5.根据权利要求1所述的一种基于两轴机载雷达伺服平台的兴趣点跟踪控制方法,其特征在于:所述步骤(9)控制雷达天线从实时的方位角ηa转到方位轴指令角控制雷达天线实时的俯仰角ηp转到俯仰轴指令角步骤如下:当雷达天线实时方位角度ηa与方位角指令的角度差大于ηa与旋转180°后位置的角度差时,采用防过顶处理算法获得最终雷达天线方位轴指令角和俯仰轴指令角当雷达天线实时方位角度ηa与方位角指令的角度差小于等于ηa与旋转180°后位置的角度差时,直接将雷达天线方位轴指令角和轴指令角分别作为最终雷达天线方位轴指令角和俯仰轴指令角然后,控制雷达天线从实时的方位角ηa转到方位轴指令角控制雷达天线实时的俯仰角ηp转到俯仰轴指令角防过顶处理算法公式如下:
当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1