CN109828269B - 一种基于位置环滤波的速度环角跟踪的方法 - Google Patents
一种基于位置环滤波的速度环角跟踪的方法 Download PDFInfo
- Publication number
- CN109828269B CN109828269B CN201910207421.4A CN201910207421A CN109828269B CN 109828269 B CN109828269 B CN 109828269B CN 201910207421 A CN201910207421 A CN 201910207421A CN 109828269 B CN109828269 B CN 109828269B
- Authority
- CN
- China
- Prior art keywords
- value
- angle
- signal processor
- target
- antenna
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种基于位置环滤波的速度环角跟踪的方法,解决在运动载体平台上雷达角跟踪精度易受信噪比影响,或被干扰诱偏的问题。该方法首先通过天线接收目标回波并得到角误差信息,姿态测量设备和位置测量设备获取实时状态信息;然后由信号处理器对获取的回波、角误差信息及实时状态信息进行处理,得到雷达测量值在目标坐标系中的坐标;随后由信号处理器进行三维滤波,得到坐标的滤波值,并将该滤波值转换为伺服的角速度值;最后,信号处理器将角速度值发送至伺服,完成角度闭环控制。本方法解决了在运动载体平台上雷达角跟踪精度易受信噪比影响,或被干扰诱偏的问题,具有较强的抗干扰能力,计算量小,适合工程应用。
Description
技术领域
本发明涉及一种速度环角跟踪的方法,特别是一种基于位置环滤波的速度环角跟踪的方法。
背景技术
对于跟踪雷达来说,不仅在探测区域能发现目标,还能确定目标的距离和二维角坐标位置,并在连续观测目标一段时间后,就能提供该目标的轨道或航迹,是其具备的主要功能。常用的跟踪雷达的天线波束通过获取角误差信号和使用一套闭环伺服系统,使得角误差信号最小来保持对目标的跟踪。
但在实际工作中,由于目标信噪比低,角误差信号受噪声影响严重,容易造成角度跟踪不稳定;另外,探测区域中杂波或干扰信号的存在,也可能造成角误差信号错误,造成角度跟踪偏离目标。因此,研究如何处理角误差信号来保持对目标的稳定角度跟踪,在该体制雷达的应用中具有重要意义。
传统的角度跟踪方法主要分为两种:
第一种是伺服工作在速度环路,根据获得的角误差信号,乘上比例系数,作为角速度值控制伺服转动,完成角度跟踪。该方法可对运动的载体平台进行解耦,可实现动平台条件下的雷达角度跟踪。
但该方法在实现中无法使用角度维滤波,跟踪精度受瞬时角误差信号影响大,因此容易受到噪声或干扰影响。
第二种是伺服工作在位置环路,根据获得的角误差信号,乘上比例系统,得到目标相对于雷达的偏角控制伺服,完成角度跟踪。
该方法面临的主要问题是:由于伺服工作在位置环路,无法利用陀螺对载体平台敏感出的角度信息进行解耦,这样在雷达位置环路跟踪过程中载体平台的姿态变化将直接叠加至雷达的测角结果中,即雷达测角为θ1,闭环过程中,载体平台变化,实际目标角度变为θ2,导致雷达无法跟踪上目标。
发明内容
本发明目的在于提供一种基于位置环滤波的速度环角跟踪的方法,解决以往方法在实现中无法使用角度维滤波,跟踪精度受瞬时角误差信号影响大,因此容易受到噪声或干扰影响,由于伺服工作在位置环路,无法利用陀螺对载体平台敏感出的角度信息进行解耦,导致雷达无法跟踪上目标的问题。
一种基于位置环滤波的速度环角跟踪的方法的具体步骤为:
第一步搭建角跟踪系统
角跟踪系统,包括:目标模拟设备、天线、伺服、姿态测量设备、位置测量设备和信号处理器。
目标模拟设备输出端与天线输入端导线连接;天线输出端与信号处理器输入端1导线连接;姿态测量设备输出端与信号处理器输入端2导线连接;位置测量设备输出端与信号处理器输入端3连接;信号处理器输出端与伺服输入端导线连接。
第二步天线接收目标回波并得到角误差信息
目标模拟设备在预定角度下释放目标回波,天线对和通道、方位通道和俯仰通道接收到的回波信号进行处理,得到方位角误差信息AZerr、俯仰角误差信息ELerr,并上报给信号处理器。
第三步姿态测量设备和位置测量设备获取实时状态信息
第四步信号处理器对获取的回波、角误差信息及实时状态信息进行处理
信号处理器对回波数据进行目标检测,得到目标距离R,并将角误差信息转化为目标偏离天线的实际角度:方位角AZ=AZerr·kAZ,俯仰角EL=ELerr·kEL,并将上述测量值转换到天线坐标系下的坐标kAZ为方位角误差比例系数,kEL为俯仰角误差比例系数。
通过由天线系转换到载体平台系的旋转矩阵,根据姿态测量信息求出雷达测量值在载体平台系中的坐标。
根据载体平台的位置信息,得到雷达测量值在目标坐标系中的坐标。
第五步信号处理器进行三维滤波,得到坐标的滤波值
信号处理器对雷达测量值的坐标进行α-β滤波,滤波到此结束。
第六步信号处理器根据滤波值,转换为伺服的角速度值
将角度值除以kAZ为方位角误差比例系数,kEL为俯仰角误差比例系数,得到伺服的方位角速度值ωAZ,俯仰角速度值ωEL:ωAZ=AZf/kAZ,ωEL=ELf/kEL。
第七步将角速度值发送至伺服完成闭环跟踪
信号处理器在接收下一帧回波矩阵前,将得到的角速度值发送至伺服,进行角度闭环跟踪。
角度闭环跟踪过程结束,天线稳定跟踪目标。
优选地,天线坐标系下的坐标为:
x=R·sin(-AZ) (1)
y=R·cos(AZ)·cos(EL) (2)
z=R·cos(AZ)·sin(EL) (3)
优选地,由天线系转换到载体平台系的旋转矩阵为:
优选地,雷达测量值在载体平台系中的坐标:
优选地,雷达测量值在目标坐标系中的坐标:
优选地,信号处理器对雷达测量值的坐标进行α-β滤波,坐标x为:
其中T为两次测量值获取的时间间隔。
根据预测值与测量值得到第k+1次的新息x(k+1)。其中,第k+1次的x坐标的雷达测量值为xm(k+1)。
其中α为距离滤波参数,β为速度滤波参数,滤波到此结束。
优选地,α为0.01,
优选地,β为0.001。
优选地,天线坐标系下的目标距离滤波值Rf为:
优选地,方位角滤波值AZf和俯仰角滤波值ELf为:
本发明主要应用于跟踪雷达系统,能解决在运动载体平台上雷达角跟踪精度易受信噪比影响,或被干扰诱偏的问题,具有较强的抗干扰能力,计算量小,适合工程应用。
具体实施方式
一种基于位置环滤波的速度环角跟踪的方法的具体步骤为:
第一步搭建角跟踪系统
角跟踪系统,包括:目标模拟设备、天线、伺服、姿态测量设备、位置测量设备和信号处理器。
目标模拟设备输出端与天线输入端导线连接;天线输出端与信号处理器输入端1导线连接;姿态测量设备输出端与信号处理器输入端2导线连接;位置测量设备输出端与信号处理器输入端3连接;信号处理器输出端与伺服输入端导线连接。
第二步天线接收目标回波并得到角误差信息
目标模拟设备在预定角度下释放目标回波,天线对和通道、方位通道和俯仰通道接收到的回波信号进行处理,得到方位角误差信息AZerr、俯仰角误差信息ELerr,并上报给信号处理器。
第三步姿态测量设备和位置测量设备获取实时状态信息
第四步信号处理器对获取的回波、角误差信息及实时状态信息进行处理
信号处理器对回波数据进行目标检测,得到目标距离R,并将角误差信息转化为目标偏离天线的实际角度:方位角AZ=AZerr·kAZ,俯仰角EL=ELerr·kEL,并将上述测量值转换到天线坐标系下的坐标kAZ为方位角误差比例系数,kEL为俯仰角误差比例系数。
x=R·sin(-AZ) (1)
y=R·cos(AZ)·cos(EL) (2)
z=R·cos(AZ)·sin(EL) (3)
根据姿态测量信息求出雷达测量值在载体平台系中的坐标,其中由天线系转换到载体平台系的旋转矩阵为:
得到雷达测量值在载体平台系中的坐标:
根据载体平台的位置信息,得到雷达测量值在目标坐标系中的坐标:
第五步信号处理器进行三维滤波,得到坐标的滤波值
其中T为两次测量值获取的时间间隔。
根据预测值与测量值得到第k+1次的新息x(k+1)。其中,第k+1次的x坐标的雷达测量值为xm(k+1)。
其中α为距离滤波参数,取经验值0.01,β为速度滤波参数,取经验值0.001。滤波到此结束,坐标y和坐标z的滤波过程与上述一致。
第六步信号处理器根据滤波值,转换为伺服的角速度值
将角度值除以kAZ为方位角误差比例系数,kEL为俯仰角误差比例系数,得到伺服的方位角速度值ωAZ,俯仰角速度值ωEL:ωAZ=AZf/kAZ,ωEL=ELf/kEL。
第七步将角速度值发送至伺服完成闭环跟踪
信号处理器在接收下一帧回波矩阵前,将得到的角速度值发送至伺服,进行角度闭环跟踪。
角度闭环跟踪过程结束,天线稳定跟踪目标。
本发明主要应用于跟踪雷达系统,能解决在运动载体平台上雷达角跟踪精度易受信噪比影响,或被干扰诱偏的问题,具有较强的抗干扰能力,计算量小,适合工程应用。
Claims (10)
1.一种基于位置环滤波的速度环角跟踪的方法,其特征在于该方法的具体步骤为:
第一步 搭建角跟踪系统
角跟踪系统,包括:目标模拟设备、天线、伺服、姿态测量设备、位置测量设备和信号处理器;
目标模拟设备输出端与天线输入端导线连接;天线输出端与信号处理器输入端1导线连接;姿态测量设备输出端与信号处理器输入端2导线连接;位置测量设备输出端与信号处理器输入端3连接;信号处理器输出端与伺服输入端导线连接;
第二步 天线接收目标回波并得到角误差信息
目标模拟设备在预定角度下释放目标回波,天线对和通道、方位通道和俯仰通道接收到的回波信号进行处理,得到方位角误差信息AZerr、俯仰角误差信息ELerr,并上报给信号处理器;
第三步 姿态测量设备和位置测量设备获取实时状态信息
第四步 信号处理器对获取的回波、角误差信息及实时状态信息进行处理
信号处理器对回波数据进行目标检测,得到目标距离R,并将角误差信息转化为目标偏离天线的实际角度:方位角AZ=AZerrgkAZ,俯仰角EL=ELerrgkEL,并将上述测量值转换到天线坐标系下的坐标kAZ为方位角误差比例系数,kEL为俯仰角误差比例系数;
通过由天线系转换到载体平台系的旋转矩阵,根据姿态测量信息求出雷达测量值在载体平台系中的坐标;
根据载体平台的位置信息,得到雷达测量值在目标坐标系中的坐标;
第五步 信号处理器进行三维滤波,得到坐标的滤波值
信号处理器对雷达测量值的坐标进行α-β滤波,滤波到此结束;
第六步信号处理器根据滤波值,转换为伺服的角速度值
将角度值除以kAZ,kEL,得到伺服的方位角速度值ωAZ,俯仰角速度值ωEL:ωAZ=AZf/kAZ,ωEL=ELf/kEL;
第七步 将角速度值发送至伺服完成闭环跟踪
信号处理器在接收下一帧回波矩阵前,将得到的角速度值发送至伺服,进行角度闭环跟踪;
角度闭环跟踪过程结束,天线稳定跟踪目标。
2.根据权利要求1所述的一种基于位置环滤波的速度环角跟踪的方法,其特征在于,
天线坐标系下的坐标为:
x=R·sin(-AZ) (1)
y=R·cos(AZ)·cos(EL) (2)
z=R·cos(AZ)·sin(EL) (3)。
7.根据权利要求6所述的一种基于位置环滤波的速度环角跟踪的方法,其特征在于,α为0.01。
8.根据权利要求6所述的一种基于位置环滤波的速度环角跟踪的方法,其特征在于,β为0.001。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910207421.4A CN109828269B (zh) | 2019-03-19 | 2019-03-19 | 一种基于位置环滤波的速度环角跟踪的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910207421.4A CN109828269B (zh) | 2019-03-19 | 2019-03-19 | 一种基于位置环滤波的速度环角跟踪的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109828269A CN109828269A (zh) | 2019-05-31 |
CN109828269B true CN109828269B (zh) | 2020-10-16 |
Family
ID=66870380
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910207421.4A Active CN109828269B (zh) | 2019-03-19 | 2019-03-19 | 一种基于位置环滤波的速度环角跟踪的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109828269B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110244274A (zh) * | 2019-07-03 | 2019-09-17 | 北京遥感设备研究所 | 一种基于全向搜索的位置滤波方法 |
CN111190348B (zh) * | 2019-11-25 | 2022-03-15 | 西安电子工程研究所 | 一种雷达导引头角速度优化方法 |
CN111736146B (zh) * | 2020-07-03 | 2022-06-21 | 哈尔滨工业大学 | 一种基于速度滤波的双基地检测前跟踪方法及装置 |
CN113608432B (zh) * | 2021-08-06 | 2023-11-10 | 中国人民解放军63691部队 | 船载二自由度伺服系统高动态环路参数调节方法及系统 |
CN113960620B (zh) * | 2021-09-30 | 2023-08-18 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 高精度波束跟踪系统 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2273863C1 (ru) * | 2004-10-20 | 2006-04-10 | Открытое акционерное общество "Корпорация "Фазотрон - научно-исследовательский институт радиостроения" | Моноимпульсное радиолокационное устройство сопровождения по направлению |
CN101697466A (zh) * | 2009-10-28 | 2010-04-21 | 上海电机学院 | 直线电机伺服系统 |
US8681041B2 (en) * | 2011-03-22 | 2014-03-25 | Raytheon Company | System, method, and filter for target tracking in cartesian space |
CN102339071B (zh) * | 2011-08-31 | 2013-03-06 | 桂林电子科技大学 | 动中通单脉冲角度跟踪系统和跟踪方法 |
CN102509887B (zh) * | 2011-10-27 | 2014-03-26 | 零八一电子集团有限公司 | 线性变系数伺服驱动雷达天线跟踪运动目标的伺服系统 |
CN102722184B (zh) * | 2012-06-18 | 2014-09-17 | 中国电子科技集团公司第十研究所 | 单脉冲天线角度模拟跟踪方法 |
CN104142693A (zh) * | 2014-08-07 | 2014-11-12 | 中国电子科技集团公司第五十四研究所 | 一种基于卡尔曼滤波的窄波束角跟踪方法 |
CN106229680B (zh) * | 2016-08-31 | 2023-05-12 | 四川灵通电讯有限公司 | 对运动中的卫星天线进行实时对星的装置的应用方法 |
CN107785663B (zh) * | 2017-10-10 | 2018-10-12 | 深圳市华讯方舟空间信息产业科技有限公司 | 天线波束姿态控制方法和系统 |
-
2019
- 2019-03-19 CN CN201910207421.4A patent/CN109828269B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109828269A (zh) | 2019-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109828269B (zh) | 一种基于位置环滤波的速度环角跟踪的方法 | |
CN107560613B (zh) | 基于九轴惯性传感器的机器人室内轨迹跟踪系统及方法 | |
CN105021192B (zh) | 一种基于零速校正的组合导航系统的实现方法 | |
CN107315345B (zh) | 基于双天线gnss和预瞄追踪模型的农机自动导航控制方法 | |
CN100516775C (zh) | 一种捷联惯性导航系统初始姿态确定方法 | |
CN103940425B (zh) | 一种磁‑惯性组合捷联测量方法 | |
CN106500721B (zh) | 一种水下机器人双冗余姿态检测系统 | |
CN110763188A (zh) | 一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法 | |
CN108536163B (zh) | 一种单面结构环境下的动力学模型/激光雷达组合导航方法 | |
CN113155129B (zh) | 一种基于扩展卡尔曼滤波的云台姿态估计方法 | |
CN108897341A (zh) | 一种运动载体光电跟踪系统快速目标跟踪控制方法 | |
CN106842080B (zh) | 一种磁场测量装置姿态摆动干扰去除方法 | |
CN103175528A (zh) | 基于捷联惯导系统的捷联罗经姿态测量方法 | |
CN110703205B (zh) | 基于自适应无迹卡尔曼滤波的超短基线定位方法 | |
Zhang et al. | A dynamic window-based UWB-odometer fusion approach for indoor positioning | |
CN108871379B (zh) | 一种dvl测速误差在线标定方法 | |
CN116026322B (zh) | 一种盾构掘进姿态测量方法及系统 | |
CN111521996A (zh) | 一种激光雷达的安装标定方法 | |
CN106646507B (zh) | 基于惯性引导的激光跟踪测量设备多目标测量方法与装置 | |
CN106595669A (zh) | 一种旋转体姿态解算方法 | |
CN109765569B (zh) | 一种基于激光雷达实现虚拟航迹推算传感器的方法 | |
CN112130134B (zh) | 一种基于时间补偿的实时基线修正方法 | |
JP4647475B2 (ja) | 移動体位置等推定検出方法、装置及び移動体位置等推定検出方法のプログラム | |
CN108562269A (zh) | 一种相对高度测量方法及装置 | |
Cao et al. | Algorithm and verification for estimating tractor driving wheel slip rate |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |