CN113686299B - 一种海上动态目标定位与移速预测方法 - Google Patents
一种海上动态目标定位与移速预测方法 Download PDFInfo
- Publication number
- CN113686299B CN113686299B CN202110956041.8A CN202110956041A CN113686299B CN 113686299 B CN113686299 B CN 113686299B CN 202110956041 A CN202110956041 A CN 202110956041A CN 113686299 B CN113686299 B CN 113686299B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- target
- carrier
- axis
- earth
- 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
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000006243 chemical reaction Methods 0.000 claims description 32
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000009466 transformation Effects 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 5
- 230000033001 locomotion Effects 0.000 claims description 4
- 230000010354 integration Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 238000001514 detection method Methods 0.000 abstract description 6
- 238000001914 filtration Methods 0.000 abstract description 5
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 230000007547 defect Effects 0.000 abstract description 3
- 230000004927 fusion Effects 0.000 abstract description 3
- 238000000691 measurement method Methods 0.000 abstract description 2
- 230000000052 comparative effect Effects 0.000 description 5
- 230000004069 differentiation Effects 0.000 description 4
- 230000004807 localization Effects 0.000 description 2
- 238000006424 Flood reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000005693 optoelectronics Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
- G01C1/02—Theodolites
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/13—Differential equations
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/10—Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Remote Sensing (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Radar, Positioning & Navigation (AREA)
- Pure & Applied Mathematics (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Operations Research (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种光电测量方法,具体涉及一种海上动态目标定位与移速预测方法,用于解决对于海上动态目标,传统目标定位方法不仅不能精准定位,并且无法获取动态目标的移动速度信息,不利于预测动态目标移动轨迹预测的不足之处。该海上动态目标定位与移速预测方法在不具备激光测距仪直接获取载机与目标之间距离的条件下,利用海平面的平稳特性,提出一种无源定位方法,实现对目标的准确定位;然后采用非线性跟踪微分器,实现对目标移动速度的滤波与估计,获取目标的精确移动速度信息;最终实现目标定位与移动速度预测。本发明可为多源融合探测、目标跟踪、轨迹预判等提供关键参考数据。
Description
技术领域
本发明涉及一种光电测量方法,具体涉及一种海上动态目标定位与移速预测方法。
背景技术
机载光电平台的主要功能是搭载红外、可见光、激光测距等光学探测载荷,实现对远距离目标的搜索、探测、识别、跟踪、定位等功能。目标定位是利用载体和光电平台的测量信息,实现对目标地理位置(包括目标的经度、纬度、高程)的解算,是光电平台的重要功能之一。目标定位可获取目标的地理位置信息,为多源融合探测、目标跟踪、轨迹预判等提供关键参考数据,是航空探测中的关键技术之一。
传统的目标定位方法大多是针对静态的目标,利用激光测距仪获取载体与目标之间的距离,结合载体位置、载体姿态、光电平台框架角等信息,利用几何坐标转换,解算出目标位置。另外,传统的目标定位方法主要关注对目标的经度、纬度、高程数据的解算,缺少对目标在东北天坐标系下移动速度的预测方法,无法获取目标的移动速度信息,不利于对动态目标的移动轨迹预测。
针对海上的船只、快艇等动态目标的搜索探测是机载光电平台的重要应用方向之一。大多情况下,载体与动态目标之间的距离在数十公里以上,且动态目标处于快速机动状态,但动态目标相对于陆地、海面的海拔高度无大幅度的起落,相对比较平稳,即动态目标具有“远、快、稳”的特性。传统目标定位方法需要利用激光测距仪获取载体与动态目标之间的距离,激光测距仪很难实现如此远距离的准确测距,且动态目标处于移动状态,激光测距仪的精度和稳定性很难满足,同时传统方法无法解算出动态目标的移动速度,不利于对目标轨迹的预测。
发明内容
本发明的目的是解决对于海上动态目标,传统目标定位方法不仅不能精准定位,并且无法获取动态目标的移动速度信息,不利于预测动态目标移动轨迹预测的不足之处,而提供一种海上动态目标定位与移速预测方法。
为了解决上述现有技术所存在的不足之处,本发明提供了如下技术解决方案:
一种海上动态目标定位与移速预测方法,其特殊之处在于,包括如下步骤:
步骤(1)、建立基础坐标系集及转换关系:
所述基础坐标系集包括大地坐标系c、地球直角坐标系e、导航坐标系n、载机坐标系b、瞄准线坐标系s;
所述大地坐标系c采用国际地球参考系统WGS-84系统,地球上的点在大地坐标系c中表示为经度λ、纬度L、高度H;
所述地球直角坐标系e采用根据地球的参考椭球面建立的笛卡尔直角坐标系,其原点为参考椭球面的中心点位置,X轴由原点指向本初子午圈与赤道圈在椭球面上的交点,Z轴由原点指向地球北极,X轴、Y轴、Z轴服从右手坐标系法则,在地球直角坐标系e中,任意一点的坐标可表示为[xe,ye,ze];
所述大地坐标系c与地球直角坐标系e的坐标转换关系为:
其中,Re为复数的实部,e为自然常数;
所述导航坐标系n采用东北天地理坐标系,原点为载机位置,X轴指向正东方向,Y轴指向正北方向,X轴、Y轴和Z轴服从右手坐标系法,则任意一点的坐标在导航坐标系n中可表示为[xn,yn,zn];
所述地球直角坐标系e到导航坐标系n的坐标转换关系为:
所述载机坐标系b定义Y轴为机头方向,Z轴为机身正上方向,X轴、Y轴和Z轴服从右手坐标系法则,则任意一点的坐标在载机坐标系b中可表示为[xb,yb,zb];
所述导航坐标系n到载机坐标系b的坐标转换关系为:
所述瞄准线坐标系s定义X轴为光电平台的方位框架角,Y轴为光电平台的俯仰框架角,Z轴为光电平台的横滚框架角,则任意一点的坐标在瞄准线坐标系s中可表示为[xs,ys,zs];
所述载机坐标系b到瞄准线坐标系s的坐标转换关系为:
步骤(2)、获取载机的POS信息、光电平台的框架角:
根据载机的POS机,获取载机的POS信息,其包括经度、维度、高程、北向速度、东向速度、天向速度、偏航角、俯仰角、横滚角;根据光电平台上的测角传感器,获取光电平台的框架角,其包括方位框架角和俯仰框架角;
步骤(3)、根据海平面的海拔高度稳定特性,建立载机与目标之间的距离估计模型,确定无源目标定位方法,完成对目标在大地坐标系c下的经度、纬度和高度的估计,实现目标定位功能:
(3.1)定义探测海域的平均海拔高度为H1,载机的海拔高度为H2,则目标在导航坐标系n下的坐标为[xn,yn,H1-H2],目标在瞄准线坐标系s下的坐标为[0,0,rs],其中rs表示目标与载机之间的距离值;
根据步骤(1)的坐标系转换关系,则
利用上式可以解算出载机与目标之间的距离rs;
(3.2)根据步骤(1)的坐标系转换关系,利用载机与目标之间的距离值rs,目标在地球直角坐标系e下的坐标值为:
(3.3)对目标在地球直角坐标系e下的坐标值[xe,ye,ze],采用迭代法与经度转换公式进行坐标转换,获得目标在大地坐标系c中的坐标,实现目标定位;
步骤(4)、建立非线性跟踪微分器,对其离散状态方程中的跟踪函数进行优化,建立最速离散跟踪微分器;
步骤(5)、将目标的位置数据信号输入至最速离散跟踪微分器,建立移动速度估计模型,实现对目标移速的估计:
(5.1)利用步骤(3.1)中目标在瞄准线坐标系s下的坐标[0,0,rs],以及载机与目标之间的距离rs,获得目标在导航坐标系n中的坐标为:
(5.2)将在导航坐标系n下目标的东向位置xn和北向位置yn作为输入信号,分别输入两个与步骤(4)中结构相同的最速离散跟踪微分器,两个最速离散跟踪微分器分别实现对东向移动速度和北向移动速度的实时估计。
进一步地,步骤(1)中,
其中,ψ表示载机的偏航角;θ表示载机的俯仰角;γ表示载机的横滚角;
进一步地,步骤(3.3)中,所述对目标在地球直角坐标系e下的坐标值[xe,ye,ze],采用迭代法与经度转换公式进行坐标转换,获得目标在大地坐标系c中的坐标的具体步骤为:
(3.3.1)设定北半球纬度为正,南半球纬度为负;东经为正,西经为负,则迭代公式的初值公式为:
迭代公式为:
其中,a表示地球长半轴的长度,b表示地球短半轴的长度,e表示地球偏心率;N0表示目标位置对应的曲率半径初值,Ni表示第i次迭代目标位置对应的曲率半径;H0表示目标位置对应的高度初值,Hi表示第i次迭代目标位置对应的高度;L0表示目标位置对应的纬度初值,Li表示第i次迭代目标位置对应的纬度;
重复迭代4~5次,完成对目标在大地坐标系c下的纬度L、高度H的估计;
(3.3.2)由经度转换公式直接完成对目标在大地坐标系c下经度λ的估计,经度转换公式为:
进一步地,步骤(4)中,所述建立非线性跟踪微分器,对其离散状态方程中的跟踪函数进行优化,建立最速离散跟踪微分器的具体步骤如下:
(4.1)建立非线性跟踪微分器的状态方程:
其中,r为调节跟踪速度的参数;v0表示输入信号,即目标位置数据;sign为函数符号;表示x1对时间的导数,表示x2对时间的导数;即对非线性跟踪微分器输入信号v0,将输出两个状态值x1和x2,其中状态x1可快速跟踪输入信号v0,状态x2为v0的近似微分;
(4.2)将步骤(4.1)中的状态方程离散化为:
其中,h表示采样步长,v(k)表示第k次采样的输入数据,x1(k)、x2(k)分别表示第k次采样的状态值,x1(k+1)、x2(k+1)分别表示第k+1次采样的状态值;
(4.3)为了解决高频颤振问题,对步骤(4.2)得到的离散状态方程中的跟踪函数进行改进,建立最速离散跟踪微分器为:
其中,函数fhan(x1,x2,r,h)表示最速控制综合函数,fhan[x1(k)-v(k),x2(k),r,h]表示函数fhan(x1,x2,r,h)中x1=x1(k)-v(k),x2=x2(k);
函数fhan(x1,x2,r,h)具体定义如下:
进一步地,步骤(5.2)中,所述两个最速离散跟踪微分器分别实现对东向移动速度和北向移动速度的实时估计的具体步骤为:将步骤(5.1)中在导航坐标系n下目标的东向位置xn和北向位置yn作为输入信号,分别输入两个与步骤(4.3)中结构相同的最速离散跟踪微分器;
与现有技术相比,本发明的有益效果是:
(1)本发明利用海平面的平稳特性,提出一种无源定位方法,实现对海上动态目标的准确定位;然后采用非线性跟踪微分器,实现对目标移动速度的滤波与估计,获取目标的精确移动速度信息;最终实现目标定位与移动速度预测;本发明可为多源融合探测、目标跟踪、轨迹预判等提供关键参考数据。
(2)相较于利用地球椭球几何关系联立方程求解的典型无源目标定位方法,本发明提出的无源目标定位方法仅需要通过单个等式方程即可直接获得载机和目标之间的距离,从而解算出目标位置,本发明方法结构更简单,计算量更小,定位精度更高。
附图说明
图1为本发明一种海上动态目标定位与移速预测方法的流程示意图。
具体实施方式
下面结合附图和示例性实施例对本发明作进一步地说明。
参照图1,本发明旨在针对海上动态目标的运动特性,提出一种海上动态目标定位与移速预测方法,首先在不具备激光测距仪直接获取载机与目标之间距离的条件下,利用海平面的平稳特性,提出一种无源定位方法,实现对目标的准确定位;然后采用非线性跟踪微分器,实现对目标移动速度的滤波与估计,获取目标的精确移动速度信息;最终实现目标定位与移动速度预测。
一种海上动态目标定位与移速预测方法,包括如下步骤:
步骤(1)、建立基础坐标系集及转换关系:
在本发明实施例中,基础坐标系集包括大地坐标系c、地球直角坐标系e、导航坐标系n、载机坐标系b、瞄准线坐标系s,本发明可根据具体应用场景添加或删减坐标系,不限于上述五个坐标系范围;
其中,定义大地坐标系c:采用国际地球参考系统WGS-84系统,地球上的点在大地坐标系c中表示为经度λ、纬度L、高度H;定义地球直角坐标系e:根据地球的参考椭球面,建立笛卡尔直角坐标系,其原点为参考椭球面的中心点位置,X轴由原点指向本初子午圈与赤道圈在椭球面上的交点,Z轴由原点指向地球北极,X轴、Y轴、Z轴服从右手坐标系法则,在地球直角坐标系e中,任意一点的坐标可表示为[xe,ye,ze];大地坐标系c与地球直角坐标系e的坐标转换关系为:
其中,Re为复数的实部,e为自然常数;
定义导航坐标系n:采用东北天地理坐标系,原点为载机位置,X轴指向正东方向,Y轴指向正北方向,X轴、Y轴、Z轴服从右手坐标系法则,导航坐标系n绕地球缓慢旋转,则任意一点的坐标在导航坐标系n中可表示为[xn,yn,zn];地球直角坐标系e到导航坐标系n的坐标转换关系为:
定义载机坐标系b:Y轴为机头方向,Z轴为机身正上方向,X轴、Y轴和Z轴服从右手坐标系法则,则任意一点的坐标在载机坐标系b中可表示为[xb,yb,zb];导航坐标系n到载机坐标系b的坐标转换关系为:
其中,ψ表示载机的偏航角;θ表示载机的俯仰角;γ表示载机的横滚角;
定义瞄准线坐标系s:X轴为光电平台的方位框架角,Y轴为光电平台的俯仰框架角,Z轴为光电平台的横滚框架角,则任意一点的坐标在瞄准线坐标系s中可表示为[xs,ys,zs];载机坐标系b到瞄准线坐标系s的坐标转换关系为:
本实施例中采用两轴两框架的光电平台,其X轴、Y轴、Z轴方向的安装角误差设定为零,即初始时光电平台的瞄准线坐标系s与载机坐标系b重合;由载机坐标系b先沿瞄准线坐标系s的X轴转动角度,再沿瞄准线坐标系s的Y轴转动β0角度,所述的表达式如下:
步骤(2)、获取载机的POS信息、光电平台的框架角:
其中,载机的POS信息主要包括载机的经度、维度、高程、北向速度、东向速度、天向速度、偏航角、俯仰角、横滚角,可从载机的POS机读取;光电平台的框架角主要包括方位框架角和俯仰框架角,可通过光电平台框架上安装的旋转变压器或光电编码器等测角传感器获取;
步骤(3)、根据海平面的海拔高度稳定特性,建立载机与目标之间的距离估计模型,确定无源目标定位方法,完成对目标在大地坐标系c下的经度、纬度和高度的估计,实现目标定位功能:
(3.1)据调查,我国领海的巨浪高度平均在6m以下,相比于载机与目标的距离值,可忽略海浪的小幅度波动,认为海面为一个平面,且海域的平均海拔高度比较稳定,载机所探测海域的平均海拔高度可从国家测绘部门获取;探测海域的平均海拔高度表示为H1,载机的海拔高度为H2,则目标在导航坐标系n下的坐标为[xn,yn,H1-H2],目标在瞄准线坐标系s下的坐标为[0,0,rs],其中rs表示目标与载机之间的距离值;
根据步骤(1)的坐标系转换关系,则
上式中的第三行等式方程仅含有一个未知量rs,利用第三行等式方程即可解算出载机与目标之间的距离值rs;
(3.2)根据步骤(1)的坐标系转换关系,利用载机与目标之间的距离值rs,目标在地球直角坐标系e下的坐标值为:
(3.3)目标在大地坐标系c中的坐标(即经度λ、纬度L、高度H)可根据其在地球直角坐标系e下的坐标值[xe,ye,ze],采用迭代法与经度转换公式进行坐标转换:
(3.3.1)设定北半球纬度为正,南半球纬度为负;东经为正,西经为负,则迭代公式的初值公式为:
迭代公式为:
其中,a表示地球长半轴的长度,b表示地球短半轴的长度,e表示地球偏心率;N0表示目标位置对应的曲率半径初值,Ni表示第i次迭代目标位置对应的曲率半径;H0表示目标位置对应的高度初值,Hi表示第i次迭代目标位置对应的高度;L0表示目标位置对应的纬度初值,Li表示第i次迭代目标位置对应的纬度;
通过4次的迭代,完成对目标在大地坐标系c下的纬度L、高度H的估计;
(3.3.2)由经度转换公式直接完成对目标在大地坐标系c下经度λ的估计,经度转换公式为:
步骤(4)、建立非线性跟踪微分器,对其离散状态方程中的跟踪函数进行优化,建立最速离散跟踪微分器:
经典微分器是利用信号前后采样的差值与采样周期的比值近似信号的微分,对于噪声较小的信号能够实现其微分的较好估计,而实际信号通常被随机噪声污染,例如目标随海浪随机波动,载机POS信息包含有随机噪声,经典微分器会将噪声放大,将真实微分信息淹没,无法实现对目标移动速度的稳定估计;非线性跟踪微分器具有快速跟踪能力和良好的滤波特性,能够很好的适应于具有噪声干扰的海上动态目标位置信号的跟踪和微分提取;
(4.1)建立非线性跟踪微分器的状态方程:
其中,r为调节跟踪速度的参数;v0表示输入信号,即目标位置数据;sign为函数符号;表示x1对时间的导数,表示x2对时间的导数;即对非线性跟踪微分器输入信号v0,将输出两个状态值x1和x2,其中状态x1可快速跟踪输入信号v0,状态x2为v0的近似微分;
非线性跟踪微分器的作用是快速跟踪输入信号,同时给出输入信号的微分,具备良好的噪声抑制和滤除效果;
(4.2)为了在数字计算机上实现非线性跟踪微分器的运算,将步骤(4.1)中的状态方程离散化为:
其中,h表示采样步长,v(k)表示第k次采样的输入数据,x1(k)、x2(k)分别表示第k次采样的状态值,x1(k+1)、x2(k+1)分别表示第k+1次采样的状态值;
(4.3)研究表明,直接离散化后的非线性跟踪微分器在跟踪输入信号的过程中,易发生高频颤振现象;为了解决高频颤振问题,保证跟踪微分器能够给出品质较好的微分信号,对步骤(4.2)得到的离散状态方程中的跟踪函数进行改进,建立最速离散跟踪微分器为:
其中,函数fhan(x1,x2,r,h)表示最速控制综合函数,fhan[x1(k)-v(k),x2(k),r,h]表示函数fhan(x1,x2,r,h)中x1=x1(k)-v(k),x2=x2(k);
函数fhan(x1,x2,r,h)具体定义如下:
步骤(5)、将目标的位置数据信号输入至最速离散跟踪微分器,建立移动速度估计模型,实现对目标移速的估计:
由于目标在天向速度(即目标随海浪上下浮动的速度)值很小,可对其忽略,本步骤重点实现对目标在导航坐标系n下的北向速度和东向速度的估计;
(5.1)利用步骤(3.1)中目标在瞄准线坐标系s下的坐标[0,0,rs],以及载机与目标之间的距离rs,获得目标在导航坐标系n中的坐标为:
(5.2)将在导航坐标系n下目标的东向位置xn和北向位置yn作为输入信号,分别输入两个与步骤(4.3)中结构相同的最速离散跟踪微分器;
利用本发明提出的一种海上动态目标定位与移速预测方法,在无法直接测量载机与目标距离的条件下,可获得动态目标在大地坐标系c下的经度λ、纬度L、高度H,以及在导航坐标系n下的东向移动速度和北向移动速度,实现动态目标定位和移速预测功能。
对比例:
为了突出本发明中的无源目标定位方法的特点,这里给出一种典型的无源目标定位方法作为对比例。对比例中,载机在地球直角坐标系e中的坐标可用向量表示,目标在地球直角坐标系e中的坐标可用向量表示,且满足地球椭球几何关系:
其中,a表示地球长半轴的长度,b表示地球短半轴的长度;
联立公式(1)和公式(2),需要联立四个齐次方程进行求解,获得两个目标坐标的解,需要配合目标实际所在区域,在两个解中判断出目标的实际坐标解。由于地球不是一个理想的椭球体,按照该对比例,解算出的目标坐标的精度偏低。与该对比例相比,本发明提出的无源目标定位方法仅需要通过单个等式方程即可直接获得载机和目标之间的距离,从而解算出目标位置,本发明方法结构更简单,计算量更小,定位精度更高。
以上实施例仅用以说明本发明的技术方案,而非对其限制,对于本领域的普通专业技术人员来说,可以对前述各实施例所记载的具体技术方案进行修改,或者对其中部分技术特征进行等同替换,而这些修改或者替换,并不使相应技术方案的本质脱离本发明所保护技术方案的范围。
Claims (1)
1.一种海上动态目标定位与移速预测方法,其特征在于,包括如下步骤:
步骤(1)、建立基础坐标系集及转换关系:
所述基础坐标系集包括大地坐标系c、地球直角坐标系e、导航坐标系n、载机坐标系b、瞄准线坐标系s;
所述大地坐标系c采用国际地球参考系统WGS-84系统,地球上的点在大地坐标系c中表示为经度λ、纬度L、高度H;
所述地球直角坐标系e采用根据地球的参考椭球面建立的笛卡尔直角坐标系,其原点为参考椭球面的中心点位置,X轴由原点指向本初子午圈与赤道圈在椭球面上的交点,Z轴由原点指向地球北极,X轴、Y轴、Z轴服从右手坐标系法则,在地球直角坐标系e中,任意一点的坐标可表示为[xe,ye,ze];
所述大地坐标系c与地球直角坐标系e的坐标转换关系为:
其中,Re为复数的实部,e为自然常数;
所述导航坐标系n采用东北天地理坐标系,原点为载机位置,X轴指向正东方向,Y轴指向正北方向,X轴、Y轴和Z轴服从右手坐标系法,则任意一点的坐标在导航坐标系n中可表示为[xn,yn,zn];
所述地球直角坐标系e到导航坐标系n的坐标转换关系为:
所述载机坐标系b定义Y轴为机头方向,Z轴为机身正上方向,X轴、Y轴和Z轴服从右手坐标系法则,则任意一点的坐标在载机坐标系b中可表示为[xb,yb,zb];
所述导航坐标系n到载机坐标系b的坐标转换关系为:
其中,ψ表示载机的偏航角;θ表示载机的俯仰角;γ表示载机的横滚角;
所述瞄准线坐标系s定义X轴为光电平台的方位框架角,Y轴为光电平台的俯仰框架角,Z轴为光电平台的横滚框架角,则任意一点的坐标在瞄准线坐标系s中可表示为[xs,ys,zs];
所述载机坐标系b到瞄准线坐标系s的坐标转换关系为:
步骤(2)、获取载机的POS信息、光电平台的框架角:
根据载机的POS机,获取载机的POS信息,其包括经度、维度、高程、北向速度、东向速度、天向速度、偏航角、俯仰角、横滚角;根据光电平台上的测角传感器,获取光电平台的框架角,其包括方位框架角和俯仰框架角;
步骤(3)、根据海平面的海拔高度稳定特性,建立载机与目标之间的距离估计模型,确定无源目标定位方法,完成对目标在大地坐标系c下的经度、纬度和高度的估计,实现目标定位功能:
(3.1)定义探测海域的平均海拔高度为H1,载机的海拔高度为H2,则目标在导航坐标系n下的坐标为[xn,yn,H1-H2],目标在瞄准线坐标系s下的坐标为[0,0,rs],其中rs表示目标与载机之间的距离值;
根据步骤(1)的坐标系转换关系,则
利用上式可以解算出载机与目标之间的距离rs;
(3.2)根据步骤(1)的坐标系转换关系,利用载机与目标之间的距离值rs,目标在地球直角坐标系e下的坐标值为:
(3.3)对目标在地球直角坐标系e下的坐标值[xe,ye,ze],采用迭代法与经度转换公式进行坐标转换,获得目标在大地坐标系c中的坐标,实现目标定位;
(3.3.1)设定北半球纬度为正,南半球纬度为负;东经为正,西经为负,则迭代公式的初值公式为:
迭代公式为:
其中,a表示地球长半轴的长度,b表示地球短半轴的长度,e表示地球偏心率;N0表示目标位置对应的曲率半径初值,Ni表示第i次迭代目标位置对应的曲率半径;H0表示目标位置对应的高度初值,Hi表示第i次迭代目标位置对应的高度;L0表示目标位置对应的纬度初值,Li表示第i次迭代目标位置对应的纬度;
重复迭代4~5次,完成对目标在大地坐标系c下的纬度L、高度H的估计;
(3.3.2)由经度转换公式直接完成对目标在大地坐标系c下经度λ的估计,经度转换公式为:
步骤(4)、建立非线性跟踪微分器,对其离散状态方程中的跟踪函数进行优化,建立最速离散跟踪微分器;
(4.1)建立非线性跟踪微分器的状态方程:
其中,r为调节跟踪速度的参数;v0表示输入信号,即目标位置数据;sign为函数符号;表示x1对时间的导数,表示x2对时间的导数;即对非线性跟踪微分器输入信号v0,将输出两个状态值x1和x2,其中状态x1可快速跟踪输入信号v0,状态x2为v0的近似微分;
(4.2)将步骤(4.1)中的状态方程离散化为:
其中,h表示采样步长,v(k)表示第k次采样的输入数据,x1(k)、x2(k)分别表示第k次采样的状态值,x1(k+1)、x2(k+1)分别表示第k+1次采样的状态值;
(4.3)为了解决高频颤振问题,对步骤(4.2)得到的离散状态方程中的跟踪函数进行改进,建立最速离散跟踪微分器为:
其中,函数fhan(x1,x2,r,h)表示最速控制综合函数,fhan[x1(k)-v(k),x2(k),r,h]表示函数fhah(x1,x2,r,h)中x1=x1(k)-v(k),x2=x2(k);
函数fhan(x1,x2,r,h)具体定义如下:
步骤(5)、将目标的位置数据信号输入至最速离散跟踪微分器,建立移动速度估计模型,实现对目标移速的估计:
(5.1)利用步骤(3.1)中目标在瞄准线坐标系s下的坐标[0,0,rs],以及载机与目标之间的距离rs,获得目标在导航坐标系n中的坐标为:
(5.2)将在导航坐标系n下目标的东向位置xn和北向位置yn作为输入信号,分别输入两个与步骤(4)中结构相同的最速离散跟踪微分器,两个最速离散跟踪微分器分别实现对东向移动速度和北向移动速度的实时估计,具体步骤为:将步骤(5.1)中在导航坐标系n下目标的东向位置xn和北向位置yn作为输入信号,分别输入两个与步骤(4.3)中结构相同的最速离散跟踪微分器;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110956041.8A CN113686299B (zh) | 2021-08-19 | 2021-08-19 | 一种海上动态目标定位与移速预测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110956041.8A CN113686299B (zh) | 2021-08-19 | 2021-08-19 | 一种海上动态目标定位与移速预测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113686299A CN113686299A (zh) | 2021-11-23 |
CN113686299B true CN113686299B (zh) | 2023-05-02 |
Family
ID=78580720
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110956041.8A Active CN113686299B (zh) | 2021-08-19 | 2021-08-19 | 一种海上动态目标定位与移速预测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113686299B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114066988B (zh) * | 2022-01-18 | 2022-04-08 | 中国人民解放军63921部队 | 一种光电测控设备的自动标定方法和光电测控设备 |
CN115540876B (zh) * | 2022-11-28 | 2023-04-07 | 济南和普威视光电技术有限公司 | 一种结合离线dem和光电视频数据的目标定位方法 |
CN117420571B (zh) * | 2023-12-19 | 2024-03-19 | 武汉大学 | 基于浮动平台的远海岸静动态基准站联网定位方法及系统 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110487266B (zh) * | 2019-08-24 | 2023-04-18 | 西安应用光学研究所 | 一种适用于海面目标的机载光电高精度无源定位方法 |
CN111366148B (zh) * | 2020-03-27 | 2022-11-22 | 西安应用光学研究所 | 适用于机载光电观瞄系统多次观察的目标定位方法 |
CN111798491B (zh) * | 2020-07-13 | 2022-09-06 | 哈尔滨工业大学 | 一种基于Elman神经网络的机动目标跟踪方法 |
CN112486176B (zh) * | 2020-12-02 | 2021-09-21 | 吉林大学 | 一种考虑扰动的无人驾驶框架车轨迹跟踪控制方法 |
-
2021
- 2021-08-19 CN CN202110956041.8A patent/CN113686299B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113686299A (zh) | 2021-11-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113686299B (zh) | 一种海上动态目标定位与移速预测方法 | |
CN109556632B (zh) | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 | |
CN107314768B (zh) | 水下地形匹配辅助惯性导航定位方法及其定位系统 | |
CN108362281B (zh) | 一种长基线水下潜艇匹配导航方法及系统 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
CN109556631B (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 | |
CN109239709B (zh) | 一种无人船的局部环境地图自主构建方法 | |
CN103196445B (zh) | 基于匹配技术的地磁辅助惯性的载体姿态测量方法 | |
CN106093892A (zh) | 基于标校卫星同时开展雷达rcs标定与外测标定系统 | |
CN107132542B (zh) | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 | |
CN107449444A (zh) | 一种多星图姿态关联的星敏感器内参数标定方法及其装置 | |
CN101344391A (zh) | 基于全功能太阳罗盘的月球车位姿自主确定方法 | |
CN113739795B (zh) | 一种基于偏振光/惯性/视觉组合导航的水下同步定位与建图方法 | |
CN112378399B (zh) | 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法 | |
CN109738902B (zh) | 一种基于同步信标模式的水下高速目标高精度自主声学导航方法 | |
CN111025366B (zh) | 基于ins及gnss的网格slam的导航系统及方法 | |
CN113551668B (zh) | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 | |
CN114019552A (zh) | 一种基于贝叶斯多传感器误差约束的定位置信度优化方法 | |
CN110132281A (zh) | 一种基于询问应答模式的水下高速目标高精度自主声学导航方法 | |
CN106153037A (zh) | 一种机器人的室内定位方法、装置及系统 | |
CN111207773B (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
CN113819904B (zh) | 一种基于天顶点矢量的偏振/vio三维姿态确定方法 | |
CN104501809A (zh) | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 | |
CN112098926B (zh) | 一种利用无人机平台的智能测角训练样本生成方法 | |
CN110927765B (zh) | 激光雷达与卫星导航融合的目标在线定位方法 |
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 |