CN106529105A - 无人机载光电稳定转台惯性态建模仿真方法 - Google Patents
无人机载光电稳定转台惯性态建模仿真方法 Download PDFInfo
- Publication number
- CN106529105A CN106529105A CN201710007195.6A CN201710007195A CN106529105A CN 106529105 A CN106529105 A CN 106529105A CN 201710007195 A CN201710007195 A CN 201710007195A CN 106529105 A CN106529105 A CN 106529105A
- Authority
- CN
- China
- Prior art keywords
- systems
- axle
- unmanned plane
- angle
- model
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 43
- 230000006641 stabilisation Effects 0.000 title claims abstract description 18
- 238000011105 stabilization Methods 0.000 title claims abstract description 18
- 238000004088 simulation Methods 0.000 title abstract description 15
- 230000000007 visual effect Effects 0.000 claims abstract description 72
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 31
- 230000008569 process Effects 0.000 claims description 20
- 230000003287 optical effect Effects 0.000 claims description 15
- 230000000712 assembly Effects 0.000 claims description 11
- 238000000429 assembly Methods 0.000 claims description 11
- 230000033001 locomotion Effects 0.000 claims description 11
- 230000009466 transformation Effects 0.000 claims description 10
- 230000005484 gravity Effects 0.000 claims description 9
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 5
- 238000005096 rolling process Methods 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000008859 change Effects 0.000 description 6
- 230000003044 adaptive effect Effects 0.000 description 4
- 238000009434 installation Methods 0.000 description 2
- 238000002955 isolation Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000005622 photoelectricity Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/30—Circuit design
- G06F30/36—Circuit design at the analogue level
- G06F30/367—Design verification, e.g. using simulation, simulation program with integrated circuit emphasis [SPICE], direct methods or relaxation methods
Landscapes
- Engineering & Computer Science (AREA)
- Computer Hardware Design (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Microelectronics & Electronic Packaging (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种无人机载光电稳定转台惯性态建模仿真方法,首先将光电转台抽象化功能模型,然后利用视轴线惯性稳定递推迭代算法解算的模型方位角和模型高低角。本发明构造了光电转台二自由度功能模型,设计实现了视轴线惯性稳定递推迭代算法,很好地解决了三维视景仿真光电转台的功能建模和惯性态算法建模难题,具有很好的工程可用性。
Description
技术领域
本发明涉及建模仿真方法领域,具体是一种无人机载光电稳定转台惯性态建模仿真方法。
背景技术
无人机载光电稳定转台(简称光电转台)为可见光摄像机、前视红外仪、激光测距仪、激光指示器、光学稳定瞄准装备的承载机构,具有隔离无人机角运动对承载设备影响、实现姿态自适应控制功能的高技术精密装备。无人机部队官兵在装备飞行训练过程中发现,光电转台执行侦察任务过程中,由于天气能见度、无人机较高航高等因素的影响,操作过程非常复杂,操作手的技术熟练度要求高,对实装飞行过程的依赖度较高。无人机飞行空域较宽,空域协调较为复杂,无人机部队开展实装飞行的条件受到诸多因素的限制。无人机装备的使用寿命有限,不允许频繁地开展实装飞行训练。因此,迫切需要基于三维视景仿真技术的替代训练设备,来解决无人机部队视频侦察的替代训练难题。光电转台工作模式有多种,而惯性态为其它重要工作模式的前提和基础,光电转台不执行惯性态,就不能执行其它几种与执行任务相关的重要工作模式。国内外没有针对无人机载光电转台硬件设备三维视景仿真应用的全数字仿真建模相关研究。
发明内容
本发明的目的是提供一种无人机载光电稳定转台惯性态建模仿真方法,以解决现有技术没有无人机载光电转台仿真建模方法的问题。
为了达到上述目的,本发明所采用的技术方案为:
无人机载光电稳定转台惯性态建模仿真方法,其特征在于:包括以下步骤:
(1)、光电转台抽象化功能构模:
从功能上将光电稳定转台简化为二轴二框架结构,该二轴二框架结构由内环组件、外环组件和支座组成,内环组件安装视点,视点的虚拟光轴线记为模型视轴线,内环组件旋转轴安装在外环组件上,可随外环组件一起运动,内环组件绕旋转轴相对外环组件转动,其转动角为高低角,记为模型高低角,外环组件的旋转轴固定在支座上,可绕外环轴相对于支座做方位旋转,其转动角为方位角,记为模型方位角,支座为安装固定装置,可固定于无人机等运动或静止平台上;
(2)、视轴线惯性稳定递推迭代算法设计:
(2.1)、确定无人机N系坐标系,其坐标原点设定在无人机的质心上,Xn轴指向地理北,Zn轴为重力方向,Yn轴为向东;
确定航迹坐S系坐标系,航迹坐S系坐标原点在无人机质心处,Xs轴与无人机规划航向同向,Zs轴为重力方向,Ys轴与Xs轴和Zs轴为右手定则关系;
确定无人机U系坐标系,无人机U系与无人机机体固联,其坐标原点Ou为无人机的质心,Xu轴为无人机的机头方向,Zu轴垂直于机身平面并指向下方,Yu轴与Xu轴和Zu轴构成右手定则关系,无人机偏航角为无人机U系Xu轴投影在无人机N系XnOnYn平面上的方位角;无人机俯仰角为无人机U系的XuOuYu平面与无人机N系的XnOnYn平面的夹角,向上为正;无人机滚转角为无人机U系的XuOuZu平面与无人机N系的XnOnZn平面的夹角,右转为正;
确定光电转台坐标系,光电转台坐标系包括基座B系、方位环A系、高低环F系和横滚环R系;其中基座B系的坐标原点Ob为转轴中心,Zb轴由镜头指向目标,Xb轴、Yb轴分别平行于无人机U系的Xu轴、Yu轴;方位环A系与光电转台的方位环固联,相对基座B系,只能绕Zb轴旋转,产生光电转台方位角θa;高低环F系与高低环固联,Yf轴沿高低环轴与方位环A系Ya轴同向,高低环F系,为方位环A系绕Ya轴旋转高低角θf而得到;横滚环R系与横滚环固联,Xr轴沿横滚环轴并与高低环Xf轴同向,横滚环R系,为高低F系,绕Xf轴旋转横滚角θr得到;
确定像平面M系坐标系,像平面M系坐标原点Om为像主点,Zm轴与光轴平行且指向目标,当光电转台三个姿态角均为零时,像平面M系Ym轴垂直飞行方向向右,Xm轴垂直于Ym轴向上,像平面M系的Z坐标为焦距f;
确定摄像机C系坐标轴,摄像机C系坐标原点Oc位于摄像机光心即像主点处,Xc轴平行于像平面M系的Xm轴,Yc轴平行于像平面M系的Ym轴,Zc轴平行于像平面M系的Xm轴;
地面站K系、无人机K系,坐标原点为分别为地面站和无人机质心,Xk轴向东,Yk轴向北,Zk轴与重力反向,Xk轴、Yk轴和Zk轴为右手定则关系;
令地面目标点在地面站K系坐标为T:[xt yt zt]T,无人机瞬时位置在地面站K系坐标为U:[xu yu zu]T,功能模型对目标跟踪的实时姿态角(a,β),a,β分别为模型方位角和模型高低角,模型视轴线与地面的交点即地主点O的摄像机C系坐标Oc:[0 0 L]T,其中L为视轴线斜距;
(2.2)、解算模型视轴线的无人机N系方向余弦:
基于坐标变换原理,地主点O由摄像机C系至无人机N系的坐标变换过程如式(5):
其中,和分别为无人机N系至航迹S系、航迹S系至无人机U系、基座B系至方位环A系、方位环A系至高低环F系的旋转变换矩阵,分别对应于无人机的航向角φhx、包括偏航角俯仰角和滚转角的无人机姿态角、包括模型方位角模型高低角的模型姿态角的输入角参量,其表达式如式(5.1)~(5.4)所示:
其中,Mx、My、Mz分别绕X轴、Y轴和Z轴的基本旋转矩阵,
则模型视轴线的无人机N系的方位余弦表达式如式(6):
其中,上式中的xn、yn和zn表达式如下:
则即为当前时刻k的模型视轴线的无人机N系方向余弦;(2.3)、DFP解算模型姿态角:
DFP解算模型姿态角可使得模型视轴线在采样各时刻保持方向不变,具体来说,确保当前模型视轴线方向余弦与前一时刻的视轴线方向余弦相等,当前时刻根据来反向解算模型方位角和模型高低角;
根据视轴线方向余弦的解算过程可知,解算模型方位角和模型高低角为模型视轴线解算逆向过程,为典型的非线性过程,很难直接用解析表达式计算,需要使用数值迭代法求解,其代价函数J(·)如式(7):
使用DFP拟牛顿数值迭代算法来解算式(7)中的模型姿态角,为了达到快速收敛提高算法的效率目的,将前一时刻的模型视轴线方向余弦赋予当前模型视轴线方向余弦,并把前一时刻解算的模型姿态角作为DFP解算的迭代输入,基于当前无人机姿态角、无人机航向角为已知参量,使用DFP拟牛顿法迭代解算当前时刻的包括模型方位角和模型高低角的模型姿态角。
本发明工作原理:将实装光电转台复杂的机械伺服结构、陀螺仪稳定回路和图像控制仪自适应控制回路,简化为由视点、内环组件、外环组件、支座组成的二自由度功能模型,基于模型视轴线惯性空间保持不变原理,利用前一采样时刻解算的模型视轴线方向余弦和模型姿态角传递为当前时间的迭代解算初值,使用DFP拟牛顿数据值迭代算法来实时解算功能模型的方位角和高低角,实现惯性态仿真算法的设计,解决了在三维视景仿真模拟训练中的光电转台惯性态的数字建模仿真关键技术问题。
本发明构造了光电转台二自由度功能模型,设计实现了视轴线惯性稳定递推迭代算法,很好地解决了三维视景仿真光电转台的功能建模和惯性态算法建模难题,具有很好的工程可用性。
本发明很好了解决三维仿真环下对光电转台惯性态的数字建模仿真问题。软件仿真测试表明,收敛速度快、计算精度高。将模型和算法加载到三维视景仿真场景中测试后,能够很好地实现了对场景视点的控制,与实装光电转台的逼真度高,无论无人机何种运动方式,或者运动到何地,模型视轴线保持惯性空间相对稳定,仿真视场画面保持稳定不晃动,计算机***资源实时占用率不高,三维画面流畅稳定。
附图说明
图1为抽象化功能模型示意图。
图2为无人机N系图。
图3为航迹S系图。
图4为无人机U系图。
图5为光电转台坐标系图。
图6为像平面M系与摄像机C系图。
图7为视轴线惯性稳定递推迭代算法流程图。
图8为摄像机C系至无人机N系坐标变换过程图。
图9为DFP解算模型姿态角流程图。
图10为功能模型惯性态仿真方位角变化曲线图。
图11为功能模型惯性态仿真高低角变化曲线图。
图12为惯性态截图1。
图13为惯性态截图2。
图14为惯性态截图3。
图15为惯性态截图4。
具体实施方式
光电转台惯性态是无人机执行作战任务时的重要工作模式,主要用于完成隔离无人机角运动对承载的摄像机/红外仪/激光测距仪/激光指示器/光学瞄准器设备的影响,保持视场在惯性空间相对稳定,有利于无人机光电侦察/目标跟踪/武器瞄准等作战使用。本发明着重解决光电转台惯性工作态的数字功能建模问题,不采购光电转台的实物装备,仅使用计算机软件仿真实现光电转台的硬件隔离角运动、惯性空间稳定功能。发明拟要解决的技术问题包括实装光电转台操作层面功能抽象化建模和惯性态仿真算法设计,完成对光电转台惯性态功能的高逼真度仿真实现。光电转台操作层面功能抽象化建模,着重从光电转台任务执行功能层面进行抽象化构模,设计实现同实装完全一致的操作自由度、承载设备安装位置(摄像机/前视红外仪/激光测距仪/激光指示器/光学瞄准装置的视角位置)、设备响应参数、设备安装位置等等。光电转台惯性态软件仿真算法建模,是本发明的核心内容,拟使用智能计算方法和坐标变换算法,解决对光电转台硬件惯性态的功能仿真,在三维仿真软硬件环境下,用以替代光电转台硬件对承载设备的角运动隔离和保持惯性空间稳定的有效仿真难题,解决部队无人机装备的高逼真度替代训练问题。
本发明的技术方案:
本发明主要包括两部分内容,其一是光电转台抽象化功能构模,其二是光电转台惯性态仿真算法实现。
1、光电转台抽象化功能构模:
实装光电转台为两轴四框架结构,由机械伺服机构、陀螺仪稳定机构和图像控制仪自适应控制机构组成,本发明从功能上将其简化为二轴二框架结构(简记为功能模型)。如图1所示,由内环组件、外环组件和支座组成。内环组件安装视点(包括摄像机/前视红外仪/激光测距仪/激光指示器/光学瞄准装置仿真视点,视点的虚拟光轴线简记为模型视轴线),内环组件旋转轴安装在外环组件上,可随外环组件一起运动。内环组件绕旋转轴相对外环组件转动,其转动角为高低角(简记为模型高低角)。外环组件旋转轴固定在支座上,可绕外环轴相对于支座做方位旋转,其转动角为方位角(简记为模型方位角)。支座为安装固定装置,可固定于无人机等运动或静止平台上。
2、视轴线惯性稳定递推迭代算法设计
视轴线惯性稳定递推迭代算法为本发明的核心内容,主要使用智能计算方法和坐标变换算法来仿真光电转台硬件工作时对其承载设备的视轴线在光电转台惯性空间内保持稳定过程,即保持光电转台搭载的摄像机/前视红外仪/激光指示器/激光测距仪/光学瞄准装置的视轴线在惯性空间内持续不变,构建实装光电转台在惯性态时其陀螺仪稳定机构、机械伺服机构和图像控制仪的自适应控制过程的功能仿真算法,称之为视轴线惯性稳定递推迭代算法。
具体来说,利用视轴线惯性稳定递推迭代算法解算的模型方位角和模型高低角,控制本发明提出的功能模型,以实现对模型视轴线的实时控制,使其在惯性空间保持稳定,隔离无人机平台角运用的影响。视轴线惯性稳定递推迭代算法基本原理:从惯性态起始时刻开始,将前一时刻模型视轴线的方向余弦和模型姿态角作为当前时刻方向余弦和模型姿态角解算初值,使用非线性数值迭代算法解算当前时刻的模型姿态角,实现对功能模型视轴线的自适应控制,以此类推,实现各采样时刻对模型视轴线的精确控制。
本发明视轴线惯性稳定递推迭代算法设计流程如下:
(2.1)、如图2所示,无人机N系,其坐标原点设定在无人机的质心上,Xn轴指向地理北,Zn轴为重力方向,Yn轴为向东。
如图3所示,航迹坐S系坐标原点在无人机质心处,Xs轴与无人机规划航向同向,Zs轴为重力方向,Ys轴与Xs轴和Zs轴为右手定则关系。
如图4所示,无人机U系与无人机机体固联,其坐标原点Ou为无人机的质心,Xu轴为无人机的机头方向,Zu轴垂直于机身平面并指向下方,Yu轴与Xu轴和Zu轴构成右手定则关系,无人机偏航角为无人机U系Xu轴投影在无人机N系XnOnYn平面上的方位角;无人机俯仰角为无人机U系的XuOuYu平面与无人机N系的XnOnYn平面的夹角,向上为正;无人机滚转角为无人机U系的XuOuZu平面与无人机N系的XnOnZn平面的夹角,右转为正。
如图5所示,光电转台坐标系包括基座B系、方位环A系、高低环F系和横滚环R系;其中基座B系的坐标原点Ob为转轴中心,Zb轴由镜头指向目标,Xb轴、Yb轴分别平行于无人机U系的Xu轴、Yu轴;方位环A系与光电转台的方位环固联,相对基座B系,只能绕Zb轴旋转,产生光电转台方位角θa;高低环F系与高低环固联,Yf轴沿高低环轴与方位环A系Ya轴同向,高低环F系,为方位环A系绕Ya轴旋转高低角θf而得到;横滚环R系与横滚环固联,Xr轴沿横滚环轴并与高低环Xf轴同向,横滚环R系,为高低F系,绕Xf轴旋转横滚角θr得到。
如图6所示,像平面M系,坐标原点Om为像主点,Zm轴与光轴平行且指向目标,当光电转台三个姿态角均为零时,像平面M系Ym轴垂直飞行方向向右,Xm轴垂直于Ym轴向上,像平面M系的Z坐标为焦距f。
如图6所示,摄像机C系坐标原点Oc位于摄像机光心即像主点处,Xc轴平行于像平面M系的Xm轴,Yc轴平行于像平面M系的Ym轴,Zc轴平行于像平面M系的Xm轴。
地面站K系、无人机K系,坐标原点为分别为地面站和无人机质心,Xk轴向东,Yk轴向北,Zk轴与重力反向,Xk轴、Yk轴和Zk轴为右手定则关系。
令地面目标点坐标为T:[xt yt zt]T(地面站K系),无人机瞬时位置为U:[xu yu zu]T(地面站K系),功能模型对目标跟踪的实时姿态角(α,β)(α,β分别为模型方位角和模型高低角),模型视轴线与地面的交点(地主点O)的摄像机C系坐标Oc:[0 0 L]T(L为视轴线斜距)。
(2.2)、本发明提出的视轴线惯性稳定递推迭代算法,计算流程如图7所示,主要包括解算模型视轴线的无人机N系方向余弦和DFP解算模型姿态角二个关键步骤:
(2.2.1)解算模型视轴线的无人机N系方向余弦:
如图8所示,基于坐标变换原理,地主点O由摄像机C系至无人机N系的坐标变换过程如下:
其中,和分别为无人机N系至航迹S系、航迹S系至无人机U系、基座B系至方位环A系、方位环A系至高低环F系的旋转变换矩阵,分别对应于无人机的航向角φhx、包括偏航角俯仰角和滚转角的无人机姿态角、包括模型方位角模型高低角的模型姿态角的输入角参量,其表达式如式(5.1)~(5.4)所示:
其中,Mx、My、Mz分别绕X轴、Y轴和Z轴的基本旋转矩阵。
则模型视轴线的无人机N系的方位余弦表达式如下:
其中,上式中的xn、yn和zn表达式如下:
则即为当前时刻k的模型视轴线的无人机N系方向余弦。
(2.2.2)、DFP解算模型姿态角:
DFP解算模型姿态角流程如图9所示,使得模型视轴线在采样各时刻保持方向不变,具体来说,确保当前模型视轴线方向余弦与前一时刻的视轴线方向余弦相等,当前时刻根据来反向解算模型方位角和模型高低角。
根据视轴线方向余弦的解算过程可知,解算模型方位角和模型高低角为模型视轴线解算逆向过程,为典型的非线性过程,很难直接用解析表达式计算,需要使用数值迭代法求解,其代价函数J(·)表达式如下:
本发明使用DFP拟牛顿数值迭代算法来解算式(7)中的模型姿态角。为了达到快速收敛提高算法的效率目的,本发明将前一时刻的模型视轴线方向余弦赋予当前模型视轴线方向余弦,并把前一时刻解算的模型姿态角作为DFP解算的迭代输入,基于当前无人机姿态角、无人机航向角为已知参量,使用DFP拟牛顿法迭代解算当前时刻的模型姿态角(模型方位角和模型高低角)。
为了验证本发明提出的光电转台惯性态仿真建模技术的正确性,给定了功能模型的初始姿态,即模型视轴线的指向,模拟无人机绕地面某点做大圆圈飞行(航向角做大幅度变化),通过给出的视轴线惯性稳定递推迭代算法,来实时解算功能模型的姿态变化,即模型方位角和模型高低角调整变化,使得视轴线始终保持在初始给定的惯性空间方向,实现功能模型隔离无人机角运动功能,并保持惯性空间稳定。
测试具体参数如下:功能模型始姿态角度[40°,10°],无人机初始姿态角[10°,10°,10°],无人机初始航向为正北,其它参数不变。模型方位角和模型高低角变化曲线如图10和图11所示。
由图10和图11可知,随着无人机航向角的快速变化(做大圆周运动),为使得视轴线保持在初始的惯性方向,视轴线惯性稳定递推迭代算法重新解算了模型方向角和模型高低角,可以看出,模型方位角变化较大,呈360度周期性变化,模型高低角在0度和359度间呈非线性变化。结果表明,本发明提出的无人机载光电稳定转台惯性态建模仿真技术理论正确。
将功能模型加载到三维仿真场景,并把视轴线惯性稳定递推迭代算法软件工程化后用于控制该三维场景视角,惯性态测试截图如图12~图15所示,无论无人机做何种运动方式,也无论运动到任何地点,视场视轴线保持相对稳定,画面不抖动不旋转,计算机资源占用率不高,三维画面流畅稳定,不仅说明无人机载光电稳定转台惯性态建模仿真技术理论正确,而且还证明了该技术具有较好的工程可用性。
Claims (1)
1.无人机载光电稳定转台惯性态建模仿真方法,其特征在于:包括以下步骤:
(1)、光电转台抽象化功能构模:
从功能上将光电稳定转台简化为二轴二框架结构,该二轴二框架结构由内环组件、外环组件和支座组成,内环组件安装视点,视点的虚拟光轴线记为模型视轴线,内环组件旋转轴安装在外环组件上,可随外环组件一起运动,内环组件绕旋转轴相对外环组件转动,其转动角为高低角,记为模型高低角,外环组件的旋转轴固定在支座上,可绕外环轴相对于支座做方位旋转,其转动角为方位角,记为模型方位角,支座为安装固定装置,可固定于无人机等运动或静止平台上;
(2)、视轴线惯性稳定递推迭代算法设计:
(2.1)、确定无人机N系坐标系,其坐标原点设定在无人机的质心上,Xn轴指向地理北,Zn轴为重力方向,Yn轴为向东;
确定航迹坐S系坐标系,航迹坐S系坐标原点在无人机质心处,Xs轴与无人机规划航向同向,Zs轴为重力方向,Ys轴与Xs轴和Zs轴为右手定则关系;
确定无人机U系坐标系,无人机U系与无人机机体固联,其坐标原点Ou为无人机质心,Xu轴为无人机的机头方向,Zu轴垂直于机身平面并指向下方,Yu轴与Xu轴和Zu轴构成右手定则关系,无人机偏航角为无人机U系Xu轴投影在无人机N系XnOnYn平面上的方位角;无人机俯仰角为无人机U系的XuOuYu平面与无人机N系的XnOnYn平面的夹角,向上为正;无人机滚转角为无人机U系的XuOuZu平面与无人机N系的XnOnZn平面的夹角,右转为正;
确定光电转台坐标系,光电转台坐标系包括基座B系、方位环A系、高低环F系和横滚环R系;其中基座B系的坐标原点Ob为转轴中心,Zb轴由镜头指向目标,Xb轴、Yb轴分别平行于无人机U系的Xu轴、Yu轴;方位环A系与光电转台的方位环固联,相对基座B系,只能绕Zb轴旋转,产生光电转台方位角θa;高低环F系与高低环固联,Yf轴沿高低环轴与方位环A系Ya轴同向,高低环F系,为方位环A系绕Ya轴旋转高低角θf而得到;横滚环R系与横滚环固联,Xr轴沿横滚环轴并与高低环Xf轴同向,横滚环R系,为高低F系,绕Xf轴旋转横滚角θr得到;
确定像平面M系坐标系,像平面M系坐标原点Om为像主点,Zm轴与光轴平行且指向目标,当光电转台三个姿态角均为零时,像平面M系Ym轴垂直飞行方向向右,Xm轴垂直于Ym轴向前,像平面M系的Z坐标为焦距f;
确定摄像机C系坐标系,摄像机C系坐标原点Oc位于摄像机光心即像主点处,Xc轴平行于像平面M系的Xm轴,Yc轴平行于像平面M系的Ym轴,Zc轴平行于像平面M系的Xm轴;
地面站K系、无人机K系,坐标原点为分别为地面站和无人机质心,Xk轴向东,Yk轴向北,Zk轴与重力反向,Xk轴、Yk轴和Zk轴为右手定则关系;
令地面目标点在地面站K系坐标为T:[xt yt zt]T,无人机瞬时位置在地面站K系坐标为U:[xu yu zu]T,功能模型对的实时姿态角(a,β),a,β分别为模型方位角和模型高低角,模型视轴线与地面的交点即地主点O的摄像机C系坐标Oc:[0 0 L]T,其中L为视轴线斜距;
(2.2)、解算模型视轴线的无人机N系方向余弦:
基于坐标变换原理,地主点O由摄像机C系至无人机N系的坐标变换过程如式(5):
其中,和分别为无人机N系至航迹S系、航迹S系至无人机U系、基座B系至方位环A系、方位环A系至高低环F系的旋转变换矩阵,分别对应于无人机的航向角φhx、包括偏航角俯仰角和滚转角的无人机姿态角、包括模型方位角模型高低角的模型姿态角的输入角参量,其表达式如式(5.1)~(5.4)所示:
其中,Mx、My、Mz分别绕X轴、Y轴和Z轴的基本旋转矩阵,
则模型视轴线的无人机N系的方位余弦表达式如式(6):
其中,上式中的xn、yn和zn表达式如下:
则即为当前时刻k的模型视轴线的无人机N系方向余弦;
(2.3)、DFP解算模型姿态角:
DFP解算模型姿态角可使得模型视轴线在采样各时刻保持方向不变,具体来说,确保当前模型视轴线方向余弦与前一时刻的视轴线方向余弦相等,根据当前时刻来反向解算模型方位角和模型高低角;
根据视轴线方向余弦的解算过程可知,解算模型方位角和模型高低角为模型视轴线解算逆向过程,为典型的非线性过程,很难直接用解析表达式计算,需要使用数值迭代法求解,其代价函数J(·)如式(7):
使用DFP拟牛顿数值迭代算法来解算式(7)中的模型姿态角,为了达到快速收敛提高算法的效率目的,将前一时刻的模型视轴线方向余弦赋予当前模型视轴线方向余弦,并把前一时刻解算的模型姿态角作为DFP解算的迭代输入,基于当前无人机姿态角、无人机航向角为已知参量,使用DFP拟牛顿法迭代解算当前时刻的包括模型方位角和模型高低角的模型姿态角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710007195.6A CN106529105B (zh) | 2017-01-05 | 2017-01-05 | 无人机载光电稳定转台惯性态建模仿真方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710007195.6A CN106529105B (zh) | 2017-01-05 | 2017-01-05 | 无人机载光电稳定转台惯性态建模仿真方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106529105A true CN106529105A (zh) | 2017-03-22 |
CN106529105B CN106529105B (zh) | 2019-07-12 |
Family
ID=58335255
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710007195.6A Expired - Fee Related CN106529105B (zh) | 2017-01-05 | 2017-01-05 | 无人机载光电稳定转台惯性态建模仿真方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106529105B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107798947A (zh) * | 2017-11-07 | 2018-03-13 | 中国航天空气动力技术研究院 | 一种作战型无人机模拟训练***及操作方法 |
CN108622437A (zh) * | 2018-04-23 | 2018-10-09 | 大连理工大学 | 一种多机型无人机调试平台和调试方法 |
CN110645954A (zh) * | 2019-09-29 | 2020-01-03 | 凯迈(洛阳)测控有限公司 | 一种四框架两轴稳定平台视轴角度计算方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104535079A (zh) * | 2014-11-25 | 2015-04-22 | 中国科学院长春光学精密机械与物理研究所 | 机载光电惯性稳定平台隔离度测试***及方法 |
US20160041300A1 (en) * | 2014-08-07 | 2016-02-11 | Lockheed Martin Corporation | System and method for gravimetry without use of an inertial reference |
CN105547295A (zh) * | 2016-01-25 | 2016-05-04 | 西安应用光学研究所 | 基于陀螺测速的机载光电观瞄***用地面目标无源测速方法 |
CN105607639A (zh) * | 2015-12-21 | 2016-05-25 | 河北汉光重工有限责任公司 | 一种三轴稳定伺服平台的姿态解算及补偿方法 |
CN105607658A (zh) * | 2016-03-31 | 2016-05-25 | 西北工业大学 | 一种机载光电平台稳定指向控制方法 |
CN105606125A (zh) * | 2015-12-21 | 2016-05-25 | 河北汉光重工有限责任公司 | 一种惯性稳定设备的测试装置及方法 |
-
2017
- 2017-01-05 CN CN201710007195.6A patent/CN106529105B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160041300A1 (en) * | 2014-08-07 | 2016-02-11 | Lockheed Martin Corporation | System and method for gravimetry without use of an inertial reference |
CN104535079A (zh) * | 2014-11-25 | 2015-04-22 | 中国科学院长春光学精密机械与物理研究所 | 机载光电惯性稳定平台隔离度测试***及方法 |
CN105607639A (zh) * | 2015-12-21 | 2016-05-25 | 河北汉光重工有限责任公司 | 一种三轴稳定伺服平台的姿态解算及补偿方法 |
CN105606125A (zh) * | 2015-12-21 | 2016-05-25 | 河北汉光重工有限责任公司 | 一种惯性稳定设备的测试装置及方法 |
CN105547295A (zh) * | 2016-01-25 | 2016-05-04 | 西安应用光学研究所 | 基于陀螺测速的机载光电观瞄***用地面目标无源测速方法 |
CN105607658A (zh) * | 2016-03-31 | 2016-05-25 | 西北工业大学 | 一种机载光电平台稳定指向控制方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107798947A (zh) * | 2017-11-07 | 2018-03-13 | 中国航天空气动力技术研究院 | 一种作战型无人机模拟训练***及操作方法 |
CN108622437A (zh) * | 2018-04-23 | 2018-10-09 | 大连理工大学 | 一种多机型无人机调试平台和调试方法 |
CN110645954A (zh) * | 2019-09-29 | 2020-01-03 | 凯迈(洛阳)测控有限公司 | 一种四框架两轴稳定平台视轴角度计算方法 |
CN110645954B (zh) * | 2019-09-29 | 2021-09-14 | 凯迈(洛阳)测控有限公司 | 一种四框架两轴稳定平台视轴角度计算方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106529105B (zh) | 2019-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106777489B (zh) | 无人机载光电稳定转台跟踪态建模仿真方法 | |
CN104898642B (zh) | 一种用于航天器姿态控制算法的集成测试仿真*** | |
CN107924638B (zh) | 用于云台模拟的***和方法 | |
CN104527994B (zh) | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 | |
CN107390545A (zh) | 一种无人机及其载荷的仿真训练*** | |
CN105929836B (zh) | 用于四旋翼飞行器的控制方法 | |
CN109164822B (zh) | 一种基于具有混合执行机构的航天器姿态控制方法 | |
CN106529105A (zh) | 无人机载光电稳定转台惯性态建模仿真方法 | |
CN109823572B (zh) | 敏捷卫星姿态往复快速摆动的执行机构配置及控制方法 | |
CN103991559A (zh) | 一种洛伦兹航天器悬停控制方法 | |
CN106227066A (zh) | 航天器空间操控可配置视景显示方法 | |
Zappulla et al. | Floating spacecraft simulator test bed for the experimental testing of autonomous guidance, navigation, & control of spacecraft proximity maneuvers and operations | |
CN113867143A (zh) | 地外天体安全软着陆解析避障制导方法 | |
CN106200383B (zh) | 一种基于模型参考自适应神经网络的三轴惯性稳定平台控制方法 | |
CN105511500A (zh) | 一种空间目标动态光学特性地面模拟中目标和光源控制模拟***及方法 | |
CN110162069A (zh) | 一种近地轨道航天器阳光反射凝视期望姿态解析求解方法 | |
Lugo-Cárdenas et al. | The MAV3DSim: A simulation platform for research, education and validation of UAV controllers | |
CN110466803B (zh) | 基于等倾角姿态控制的自旋稳定卫星姿态预测方法 | |
Song et al. | A target tracking realization method of UAV simulation training system | |
Xu et al. | Simulation Modeling for Inertial Work-pattern of UAV Optoelectronic Gimbals | |
Mutlu | Platform motion disturbances decoupling by means of inertial sensors for a motion stabilized gimbal | |
Li et al. | Cooperative control method of multiple spacecraft formation based on graphtheory | |
McCamish | Distributed autonomous control of multiple spacecraft during close proximity operations | |
Zhang et al. | Space target surveillance based on non-linear model predictive control | |
Zhai et al. | Design of software-defined-satellite-based PID attitude control application in python |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190712 |