CN105786024B - 一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 - Google Patents
一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 Download PDFInfo
- Publication number
- CN105786024B CN105786024B CN201610117951.6A CN201610117951A CN105786024B CN 105786024 B CN105786024 B CN 105786024B CN 201610117951 A CN201610117951 A CN 201610117951A CN 105786024 B CN105786024 B CN 105786024B
- Authority
- CN
- China
- Prior art keywords
- pitching
- orientation
- photoelectric platform
- model
- controller
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法,属于跟踪控制技术领域。所述控制方法包括建立机载光电平台模型并对其进行简化,设计方位向和俯仰向线性自抗扰控制器,调试得到线性自抗扰控制器的参数并进行参数调整,建立模型误差补偿模块对控制量进行修正,实现对地面机动目标运动跟踪。本发明在考虑外部多源扰动以及无人机跟踪地面机动目标的过程中,为了解决传统方法不能高精度稳定控制机载光电平台跟踪地面机动目标或者控制方法过于复杂不利于工程实现的问题。
Description
技术领域
本发明属于跟踪控制技术领域,涉及诸如机载光电平台系统之类的侦察、监视、观测、跟踪、成像系统,具体地说,是指一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法。
背景技术
光电平台是近十年来发展极为迅速的一种新型图像侦察设备。光电平台是利用光电探测器件作为敏感元件,利用机电控制保持探测器视线稳定,从而实现对目标的捕获、跟踪、瞄准和稳定功能的系统。随着新型光学和结构材料等相关技术的发展,研究人员成功实现了缩小光学系统和结构框架的体积,减轻光电平台总体重量的目标。因此,光电平台使用在飞机或空间飞行器上,具有多探测器并用、全数字化方式工作等特点,能够实现全天时、全天候工作;在对目标外形和轮廓的侦察和跟踪的同时,也可获取多种目标信息,并可进行测量、定位和识别等功能。
目前,无人机作为完成侦察和监视任务的重要载体,它由于机上无人,因此可以在不适合有人驾驶飞机的环境中使用,如“危险”、“肮脏”、“枯燥”等特殊环境。当利用无人机进行大范围的搜索侦察,或者逼近甚至飞临侦察目标上空进行盘旋式的连续跟踪侦察时,一般需要在无人机上装载如机载光电平台等机载设备,从而获取有针对性的、详细的、不间断的信号情报。作为无人机侦察、监视、目标捕获及识别、目标测距的重要手段,机载光电侦察平台日益受到重视。其上装载的电视和红外侦察设备获取的图像信息,直观、生动、形象逼真,而且白天、夜间均可工作,具有很强的互补性,同时也可通过无线电链路传输系统实时地送往后方地面站,便于地面人员做出迅速而果断的决策,从而实现对地面机动目标的高精度跟踪。
由于无人机跟踪地面机动目标的过程中,光电平台系统装载在飞机上,载机的姿态变化、振动和飞行中的风阻力矩会造成视轴指向改变,从而对光电平台中观测设备产生显著影响,甚至丢失跟踪目标。为了克服这些影响,必须建立光电平台跟踪控制系统,将系统中光学传感器的视轴与载机的运动、振动,以及外界环境的扰动等相隔离,使视轴能够克服外界扰动,并按照给定指令按一定规律运动,进而实现对机动目标的跟踪监测。
因此,要在无人机跟踪地面机动目标的过程中实现机载光电平台的跟踪控制,首先要求跟踪控制系统能够不受载机姿态变化和外界风等因素的扰动,始终控制光电平台的视轴指向目标;然后在视轴指向目标的基础之上,当所跟踪的目标进行机动运动时,跟踪控制系统能够控制机载光电平台偏转,使得机动目标始终处于机载光电平台成像的中心位置。
机载光电平台跟踪控制系统是一个多输入、多输出、存在一定耦合和非线性摩擦干扰的复杂系统。摩擦是一种复杂的、非线性的、具有不确定性的自然现象,对于机械伺服系统而言,摩擦环节使系统响应出现爬行、振荡或稳态误差,成为提高系统性能的障碍。从控制角度来讲,为了减轻机械伺服系统中摩擦环节引起的不良影响,应采用适当的控制补偿方法,对摩擦环节进行补偿。
另外,机载光电平台跟踪控制系统在跟踪地面机动目标的过程中,始终受到载机飞行带来的扰动影响。无人机在方位、俯仰和滚转方向上的角运动或振动通过轴承摩擦耦合到光电跟踪平台上造成平台的振动,从而使光电成像传感器视轴指向发生变化。无人机在侦察、监视、跟踪地面目标的不同阶段,往往需要不同飞行控制律的切换,并且存在较大的机动,这些特点使得其对光电平台的扰动影响更加严重。
同时,光电成像跟踪器延迟所造成的系统相位滞后限制了系统位置带宽的提高,影响控制系统的跟踪精度,使系统动态响应变差,甚至丢失目标。
无人机在跟踪地面机动目标的过程中,机载光电平台跟踪控制系统存在的上述特点使得其很难获得满意的跟踪精度。
传统的方法一般是基于简化的机载光电平台系统数学模型设计控制器,当考虑多源外部扰动因素时,其控制精度较低,无法满足高精度跟踪控制的需求。同时,直接根据精确的机载光电平台系统数学模型设计控制器,现有的方法往往造成控制器阶数较高或结构复杂,导致工程上无法应用或计算量较大对机载计算机的要求较高,不利于工程实现。
发明内容
本发明在考虑外部多源扰动(如紊流、常值风、突风,飞机角运动扰动等)以及无人机跟踪地面机动目标的过程中,为了解决传统方法不能高精度稳定控制机载光电平台跟踪地面机动目标或者控制方法过于复杂不利于工程实现的问题,提出了一种基于模型误差补偿的机载光电平台高精度跟踪控制设计方法。
本发明提供的跟踪控制设计方法,可以根据载机角运动、外界风扰动以及地面机动目标的运动情况,调整光电平台方位向和俯仰向的偏转角度,在无人机利用机载光电平台跟踪和监视地面机动目标的过程中,使得机载光电平台的视轴始终高精度稳定地指向所需跟踪的地面机动目标,即机动目标始终处于光电平台成像的中心位置,从而改善跟踪地面机动目标的精确性、稳定性和持续性。
本发明提供的一种基于模型误差补偿的机载光电平台高精度跟踪控制设计方法,包括以下几个步骤:
步骤一:建立机载光电平台对象模型,包括机载光电平台对象在方位向和俯仰向模型,具体是:
方位向电机及负载的开环传递函数Goa(s)为:
其中,Tam,Tae,Kao分别代表方位环的机电时间常数、电磁时间常数以及开环增益,s为利用拉普拉斯变换求解传递函数的复变量。
俯仰向电机及负载的开环传递函数Gof(s)为:
其中,Tfm,Tfe,Kfo分别代表俯仰环的机电时间常数、电磁时间常数以及开环增益。
步骤二:将步骤一所建立的机载光电平台方位向和俯仰向模型分别简化,得到简化机载光电平台模型为:
步骤三:设计方位向和俯仰向线性自抗扰控制器,调试得到线性自抗扰控制器的参数。
步骤四:建立模型误差补偿模块。
所述的模型误差补偿模块为:
步骤五:对无人机角运动对机载光电平台的扰动进行建模。
两轴光电平台方位向和俯仰向的扰动量分别为:
其中,ωx,ωy,ωz为在机体坐标系中无人机绕机体轴的旋转角速度,θa,θf为在框架坐标系中光电平台视轴在方位向和俯仰向上的偏转角度。
步骤六:建立地面机动目标运动的数学模型,具体为:
地面机动目标运动的数学模型为:
其中XT,YT分别为地面机动目标在地面坐标系X轴和Y轴方向的坐标值,q为地面机动目标速度方向,为速度方向的变化率,nT为地面机动目标的过载值,t为时间变量,VT0为地面机动目标的速度初始值,XT0,YT0为地面机动目标在地面坐标系X轴和Y轴方向的初始位置坐标值。
步骤七:线性自抗扰控制器参数调整。
利用未简化机载光电平台模型对模型误差补偿模块进行仿真验证,并根据给定精度要求对方位向或俯仰向线性自抗扰控制器的参数ωc,ωo进行调整。具体为:
设方位向和俯仰向的给定仿真精度要求分别为ess_a和ess_f,调整的控制器参数为ωc,ωo;设ωac_tuning,ωao_tuning,ωfc_tuning,ωfo_tuning分别为方位向和俯仰向的带宽调整阈值,在步骤三调试得到的控制器参数基础上每次将控制器带宽增加一个带宽调整阈值,然后计算控制器的稳态精度是否小于等于仿真精度的要求ess_a和ess_f,若小于等于则停止调整带宽,当前控制器即满足设计要求,否则继续将控制器带宽增加一个带宽微调阈值,直到当前控制器的稳态精度达到仿真精度要求。
本发明的基于模型误差补偿的机载光电平台高精度跟踪控制设计方法的优点和有益效果在于:
(1)本方法适用于无人机在考虑紊流、常值风、突风、机体振动等多源外部扰动的情况下,利用机载光电平台高精度跟踪地面机动目标的情况。本方法设计的跟踪控制器,能够在复杂情形下保证机载光电平台的视轴始终指向地面机动目标。
(2)考虑到机载光电平台方位向和俯仰向综合模型的特点,以及现有传统方法往往简单地省略小系数分母项从而导致控制精度降低的问题,本方法设计了模型误差补偿模块,在不增加计算量的情况下,提高了系统的控制精度,不仅更好的满足了机载光电平台的高精度控制需求,而且具有较好的鲁棒性,也有利于工程实现。
(3)考虑到在多源内部和外部扰动的基础上,调整控制器的参数使得所建立的控制器达到仿真精度要求并不容易,因此本方法提出在简化模型情况下所设计的控制器参数的基础上,通过设置方位向和俯仰向的带宽微调阈值来对控制器的参数进行往复微调,最终使得控制器精度达到给定精度要求。该调参方法逐步进行,为设计人员提供了参数调整的方向。
附图说明
图1是基于模型误差补偿的机载光电平台高精度跟踪控制器结构示意图。
图2是基于模型误差补偿的机载光电平台高精度跟踪控制方法示意图。
图3是实施例中给出的无人机跟踪地面机动目标的轨迹曲线。
图4是实施例中给定的无人机角运动对两轴光电平台方位向和俯仰向的扰动量曲线。
图5是实施例中得到的机载光电平台的跟踪误差曲线。
图6是图5中机载光电平台跟踪误差曲线局部放大后的曲线。
具体实施方式
下面结合实施例和附图对本发明作进一步详细说明。
本发明中涉及到的坐标系的定义为:
(1)地面坐标系OgXgYgZg:
在地面上选一点Og,使Xg轴在水平面内指向某一方向,Zg轴垂直于地面并指向地心,Yg轴也在水平面内并垂直于Xg,其指向按照右手定则确定。
(2)机体坐标系ObXbYbZb:
原点Ob选在飞机质心处,机体坐标系与飞机固连,Xb轴在飞机对称平面内并平行于飞机的设计轴线指向机头,Yb轴垂直于飞机对称平面指向机身右侧,ObZb在飞机对称平面内,与ObXbYbZb坐标系构成右手直角坐标系。
(3)框架坐标系OrXrYrZr:
框架坐标系的原点规定为平台框架支承中心Or,光电传感器的视轴方向为OrXr轴正方向,YrOrZr平面与OrXr垂直。框架坐标系相对于机体坐标系的旋转角度变换关系用欧拉角θa,θf表示,两个欧拉角是载体坐标系进行两次旋转变换的。旋转变换的次序依次为:
本发明首先提供一种基于模型误差补偿的机载光电平台高精度跟踪控制器,如图1所示,所述的跟踪控制器包括方位向或俯仰向线性自抗扰控制器、模型误差补偿模块和机载光电平台模型建立模块。根据给定的光电平台方位向或俯仰向控制指令,方位向或俯仰向线性自抗扰控制器输出控制量到模型误差补偿模块;所述的模型误差补偿模块对所述的控制量进行误差补偿后,输出修正后的控制量给机载光电平台模型建立模块,在所述的机载光电平台模型建立模块,结合多源外部扰动,输出光电平台视轴在方位向或俯仰向上的偏转角和偏转角速度。所述的控制指令是指光电平台视轴在方位向的偏转角度θa或俯仰向的偏转角度θf。
所述的方位向或俯仰向线性自抗扰控制器包括线性配置函数模块和三阶扩张状态观测器,具体处理过程为:首先接收到光电平台方位向或俯仰向控制指令,然后对方位向或俯仰向偏转角度进行微分计算,求出偏转角速度;并计算出偏转角误差和偏转角速度误差;接着,利用线性配置函数,根据偏转角误差、偏转角速度误差和系统扰动估计值,得到方位向或俯仰向线性自抗扰控制器的控制量。所述的多源外部扰动包括摩擦扰动、外部风扰动和载机姿态变化扰动等。所述的偏转角误差是控制指令给定的方位向或俯仰向偏转角减去机载光电平台方位向或俯仰向模型输出的偏转角,所述的偏转角速度误差是利用控制指令给定的方位向或俯仰向偏转角求出的偏转角速度减去机载光电平台方位向或俯仰向模型输出的偏转角速度。
基于所述的跟踪控制器,本发明提供一种基于模型误差补偿的机载光电平台高精度跟踪控制方法,如图2所示,包括以下几个步骤:
步骤一:建立机载光电平台模型。所述的机载光电平台模型包括方位向模型和俯仰向模型。
具体为:根据机载光电平台系统中电机及负载、摩擦干扰力矩、PWM功率放大电路、速率陀螺、电视跟踪器等模块的数学模型,以及各模块之间的关系,分别建立机载光电平台方位向模型和俯仰向模型,所述的机载光电平台方位向模型考虑到了载体姿态变化方位向扰动摩擦干扰力矩和光电平台视轴在方位向上的偏转角度,所述的机载光电平台俯仰向模型考虑到了载体姿态变化俯仰向扰动摩擦干扰力矩和光电平台视轴在俯仰向上的偏转角度,具体是:
某型无人机上采用的光电平台方位向电机及负载的开环传递函数为:
俯仰向电机及负载的开环传递函数为:
其中,s为利用拉普拉斯变换求解传递函数的复变量。
步骤二:考虑到步骤一所建立的方位向和俯仰向的光电平台模型中,其电磁时间常数远远小于机电时间常数,即0.00337<<3.4,0.00725<<0.57,因此可以忽略电磁时间常数的影响,将步骤一所建的光电平台模型分别简化为:
步骤三:针对步骤二中所述的简化光电平台模型,利用线性自抗扰控制方法,分别设计方位向和俯仰向线性自抗扰控制器,如图2所示,具体包括:利用三阶扩张状态观测器计算总扰动的估计值;利用线性配置函数以及总扰动的估计值计算线性自抗扰控制器的控制量大小;
所述的线性配置函数为:
所述的三阶扩张状态观测器为:
其中,u1(t),u2(t),u3(t)分别为所述跟踪控制器的三个控制量;e1(t)为方位向或俯仰向的偏转角度信号与估计值之间的误差值;为偏转角度信号估计值的导数值;为角速度信号估计值的导数值;为机载光电平台总扰动估计值的导数值;x1(t)为方位向或俯仰向的偏转角度信号;为偏转角度信号x1(t)的估计值;x2(t)为方位向或俯仰向的角速度信号;为角速度信号x2(t)的估计值;为机载光电平台总扰动的估计值。a1,ωc,b,ωo均为方位向和俯仰向线性自抗扰控制器的设计参数。其中a1,b根据所述的简化的机载光电平台模型取值:方位环:a1=Tam,俯仰环:a1=Tfm,ωc,ωo通过调试得到。
根据步骤二中所述的简化的光电平台模型,通过调试得到线性自抗扰控制器的参数为:
方位环:a1=3.4,ωc=40,ωo=80;
俯仰环:a1=0.57,ωc=40,ωo=90。
步骤四:由于步骤三设计的方位向或俯仰向线性自抗扰控制器是基于步骤二所建立的简化的光电平台模型,因此当步骤三所述控制器实际应用时,由于模型误差导致其控制精度不高。为进一步提高跟踪控制精度,在步骤三设计的控制器中,增加模型误差补偿策略,以减少建模误差对控制精度的影响。具体为:在控制量输入机载光电平台方位向或俯仰向数学模型之前,增加模型误差补偿模块,对步骤三所述控制器输出的控制量进行修正计算,得到修正后的控制量,所述的模型误差补偿模块为:
步骤五:由于无人机角速率的变化对光电平台产生扰动影响,因此,对无人机角运动对机载光电平台的扰动进行建模,得到扰动量。
根据无人机跟踪地面机动目标纵向和横侧向控制律,结合空气中的常值风扰动、突发风扰动、紊流等气流扰动,以及地面机动目标的运动,建立无人机六自由度非线性模型,输出机体坐标系中无人机绕机体轴的旋转角速度,得到无人机对光电平台的扰动关系,同时输出方位向或俯仰向控制指令给方位向或俯仰向线性自抗扰控制器。
所述的两轴光电平台方位向和俯仰向的扰动量分别为:
其中,ωx,ωy,ωz为在机体坐标系中无人机绕机体轴的旋转角速度,θa,θf为在框架坐标系中光电平台视轴在方位向和俯仰向上的偏转角度。
如图4所示为无人机角运动两轴光电平台方位向和俯仰向的扰动量曲线。
步骤六:建立地面机动目标的数学模型,具体为:
地面机动目标运动的数学模型为:
其中q为地面机动目标速度方向值,取值为-45°,nT为0,为地面机动目标速度方向的变化率,取值为0。如图3给出无人机跟踪地面机动目标的轨迹曲线。
步骤七:线性自抗扰控制器参数调整。
利用步骤一所述的未简化机载光电平台模型和模型误差补偿模块,给定控制量精度要求,对方位向或俯仰向线性自抗扰控制器的参数ωc,ωo进行调整。具体为:
设方位向和俯仰向的给定精度要求分别为ess_a=1*10-6rad和ess_f=1*10-6rad,根据步骤三所述的各线性自抗扰控制器参数的意义可知,需要调整的控制器参数为ωc,ωo;设ωac_tuning=5,ωao_tuning=5,ωfc_tuning=5,ωfo_tuning=5分别为方位向和俯仰向的带宽调整阈值,在步骤三的调试得到的控制器参数基础上每次将控制器带宽增加一个带宽调整阈值,然后计算控制器的稳态精度是否小于等于仿真精度的要求ess_a和ess_f,若小于等于则停止调整带宽,当前控制器即满足设计要求,否则继续将控制器带宽增加一个带宽调整阈值,直到当前控制器的稳态精度达到仿真精度要求。在上述的机载光电平台模型和控制器参数下,经过两次控制器带宽的调整,方位向和俯仰向线性自抗扰控制器带宽参数最终调整为:
方位环:ωc=50,ωo=90;
俯仰环:ωc=50,ωo=100。
利用本发明提供的控制器带宽参数的最终调整结果如图5所示,并根据本发明提供的跟踪控制方法进行仿真所获得的机载光电平台跟踪误差曲线,方位向和俯仰向的误差大小均在0附近;为进一步清晰的观察机载光电平台跟踪误差曲线,将图5放大后,得到图6为机载光电平台跟踪误差局部放大后的曲线,由图6可知,稳定后的方位向和俯仰向的跟踪误差均在±1*10-6rad之内,即实施例的仿真结果满足方位向和俯仰向的给定精度要求,实现了高精度的跟踪控制。
Claims (6)
1.一种基于模型误差补偿的机载光电平台高精度跟踪控制器,其特征在于:所述的跟踪控制器包括方位向或俯仰向线性自抗扰控制器、模型误差补偿模块和机载光电平台模型建立模块;根据给定的光电平台方位向或俯仰向控制指令,方位向或俯仰向线性自抗扰控制器输出控制量到模型误差补偿模块;所述的模型误差补偿模块对所述的控制量进行误差补偿后,输出修正后的控制量给机载光电平台模型建立模块,在所述的机载光电平台模型建立模块,结合多源外部扰动,输出光电平台视轴在方位向或俯仰向上的偏转角和偏转角速度;所述的控制器的控制方法包括如下步骤:
步骤一:建立机载光电平台对象模型,包括机载光电平台对象在方位向和俯仰向模型,具体是:
方位向电机及负载的开环传递函数Goa(s)为:
其中,Tam,Tae,Kao分别代表方位环的机电时间常数、电磁时间常数以及开环增益,s为利用拉普拉斯变换求解传递函数的复变量;
俯仰向电机及负载的开环传递函数Gof(s)为:
其中,Tfm,Tfe,Kfo分别代表俯仰环的机电时间常数、电磁时间常数以及开环增益;
步骤二:将步骤一所建立的机载光电平台方位向和俯仰向模型分别简化,得到简化机载光电平台模型为:
步骤三:设计方位向和俯仰向线性自抗扰控制器,调试得到线性自抗扰控制器的参数;
步骤四:建立模型误差补偿模块;
所述的模型误差补偿模块为:
方位向:
俯仰向:
步骤五:对无人机角运动对机载光电平台的扰动进行建模;
两轴光电平台方位向和俯仰向的扰动量分别为:
其中,ωx,ωy,ωz为在机体坐标系中无人机绕机体轴的旋转角速度,θa,θf为在框架坐标系中光电平台视轴在方位向和俯仰向上的偏转角度;
步骤六:建立地面机动目标运动的数学模型,具体为:
其中XT,YT分别为地面机动目标在地面坐标系X轴和Y轴方向的坐标值,q为地面机动目标速度方向,为速度方向的变化率,nT为地面机动目标的过载值,t为时间变量,VT0为地面机动目标的速度初始值,XT0,YT0为地面机动目标在地面坐标系X轴和Y轴方向的初始位置坐标值;
步骤七:线性自抗扰控制器参数调整。
2.根据权利要求1所述的一种基于模型误差补偿的机载光电平台高精度跟踪控制器,其特征在于:所述的控制指令是指光电平台视轴在方位向的偏转角度或俯仰向的偏转角度。
3.根据权利要求1所述的一种基于模型误差补偿的机载光电平台高精度跟踪控制器,其特征在于:所述的方位向或俯仰向线性自抗扰控制器包括线性配置函数模块和三阶扩张状态观测器,具体处理过程为:首先接收到光电平台方位向或俯仰向控制指令,然后对方位向或俯仰向偏转角度进行微分计算,求出偏转角速度;并计算出偏转角误差和偏转角速度误差;接着,利用线性配置函数,根据偏转角误差、偏转角速度误差和系统扰动估计值,得到方位向或俯仰向线性自抗扰控制器的控制量。
4.一种基于模型误差补偿的机载光电平台高精度跟踪控制方法,其特征在于:包括以下几个步骤,
步骤一:建立机载光电平台对象模型,包括机载光电平台对象在方位向和俯仰向模型,具体是:
方位向电机及负载的开环传递函数Goa(s)为:
其中,Tam,Tae,Kao分别代表方位环的机电时间常数、电磁时间常数以及开环增益,s为利用拉普拉斯变换求解传递函数的复变量;
俯仰向电机及负载的开环传递函数Gof(s)为:
其中,Tfm,Tfe,Kfo分别代表俯仰环的机电时间常数、电磁时间常数以及开环增益;
步骤二:将步骤一所建立的机载光电平台方位向和俯仰向模型分别简化,得到简化机载光电平台模型为:
步骤三:设计方位向和俯仰向线性自抗扰控制器,调试得到线性自抗扰控制器的参数;
步骤四:建立模型误差补偿模块;
所述的模型误差补偿模块为:
方位向:
俯仰向:
步骤五:对无人机角运动对机载光电平台的扰动进行建模;
两轴光电平台方位向和俯仰向的扰动量分别为:
其中,ωx,ωy,ωz为在机体坐标系中无人机绕机体轴的旋转角速度,θa,θf为在框架坐标系中光电平台视轴在方位向和俯仰向上的偏转角度;
步骤六:建立地面机动目标运动的数学模型,具体为:
其中XT,YT分别为地面机动目标在地面坐标系X轴和Y轴方向的坐标值,q为地面机动目标速度方向,为速度方向的变化率,nT为地面机动目标的过载值,t为时间变量,VT0为地面机动目标的速度初始值,XT0,YT0为地面机动目标在地面坐标系X轴和Y轴方向的初始位置坐标值;
步骤七:线性自抗扰控制器参数调整。
5.根据权利要求4所述的一种基于模型误差补偿的机载光电平台高精度跟踪控制方法,其特征在于:所述的方位向或俯仰向线性自抗扰控制器包括线性配置函数和三阶扩张状态观测器,利用三阶扩张状态观测器计算总扰动的估计值;利用线性配置函数以及总扰动的估计值计算线性自抗扰控制器的控制量大小;
所述的线性配置函数为:
所述的三阶扩张状态观测器为:
其中,u1(t),u2(t),u3(t)分别为所述跟踪控制器的三个控制量;e1(t)为方位向或俯仰向的偏转角度信号与估计值之间的误差值;为偏转角度信号估计值的导数值;为角速度信号估计值的导数值;为机载光电平台总扰动估计值的导数值;x1(t)为方位向或俯仰向的偏转角度信号;为偏转角度信号x1(t)的估计值;x2(t)为方位向或俯仰向的角速度信号;为角速度信号x2(t)的估计值;为机载光电平台总扰动的估计值;a1,ωc,b,ωo均为方位向和俯仰向线性自抗扰控制器的设计参数;其中a1、b根据所述的简化的机载光电平台模型取值:方位环:a1=Tam,俯仰环:a1=Tfm,ωc,ωo通过调试得到。
6.根据权利要求4所述的一种基于模型误差补偿的机载光电平台高精度跟踪控制方法,其特征在于:步骤七中所述的参数调整是指根据给定精度要求对控制器参数ωc,ωo进行调整,具体为:
设方位向和俯仰向的给定仿真精度要求分别为ess_a和ess_f,调整的控制器参数为ωc,ωo;设ωac_tuning,ωao_tuning,ωfc_tuning,ωfo_tuning分别为方位向和俯仰向的带宽调整阈值,每次将控制器带宽增加一个带宽调整阈值,然后计算控制器的稳态精度是否小于等于仿真精度的要求ess_a和ess_f,若小于等于则停止调整带宽,当前控制器即满足设计要求,否则继续将控制器带宽增加一个带宽微调阈值,直到当前控制器的稳态精度达到仿真精度要求。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610117951.6A CN105786024B (zh) | 2016-03-02 | 2016-03-02 | 一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610117951.6A CN105786024B (zh) | 2016-03-02 | 2016-03-02 | 一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105786024A CN105786024A (zh) | 2016-07-20 |
CN105786024B true CN105786024B (zh) | 2018-08-24 |
Family
ID=56387180
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610117951.6A Active CN105786024B (zh) | 2016-03-02 | 2016-03-02 | 一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105786024B (zh) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106249762B (zh) * | 2016-08-30 | 2019-03-22 | 凯迈(洛阳)测控有限公司 | 一种机载光电侦察设备平稳锁定控制方法 |
CN108279576B (zh) * | 2017-12-26 | 2021-09-28 | 湖北航天技术研究院总体设计所 | 一种复合轴目标跟踪仿真测试系统 |
CN108303877B (zh) * | 2018-01-10 | 2020-05-05 | 浙江工业大学 | 一种基于eso的网络化运动控制系统迭代学习高精度轮廓跟踪控制方法 |
CN109129479B (zh) * | 2018-08-23 | 2021-03-09 | 广东工业大学 | 一种基于扰动力补偿的刚柔耦合运动平台控制方法 |
CN110109343B (zh) | 2019-04-30 | 2021-09-10 | 东南大学 | 一种光电跟踪系统视觉测量时滞补偿方法 |
CN111324152B (zh) * | 2019-12-05 | 2023-08-15 | 广东工业大学 | 一种刚柔耦合高精度旋转平台及其控制方法 |
CN112087063B (zh) * | 2020-03-25 | 2022-04-08 | 中国矿业大学 | 一种无线电能传输系统的改进型自抗扰控制方法及系统 |
CN111665873B (zh) * | 2020-05-29 | 2022-09-06 | 西安应用光学研究所 | 基于参考光的瞄准线高精度稳定方法 |
CN112033233B (zh) * | 2020-07-27 | 2022-07-26 | 河北汉光重工有限责任公司 | 一种非线性干扰下的间接驱动高精度伺服实现方法 |
CN111896935B (zh) * | 2020-08-05 | 2024-03-15 | 西安应用光学研究所 | 采用凝视型探测器光电搜索系统的反扫稳定补偿方法 |
CN112286042A (zh) * | 2020-09-14 | 2021-01-29 | 西安工业大学 | 基于扩张状态观测器的光电稳瞄平台三步线性控制方法 |
CN112197803B (zh) * | 2020-09-29 | 2022-04-15 | 北京环境特性研究所 | 船载光电传感器控制方法和装置 |
CN112672281B (zh) * | 2020-12-24 | 2022-11-01 | 中航贵州飞机有限责任公司 | 一种利用无线电链路装订光电侦察设备安装误差的方法 |
CN115442820A (zh) * | 2021-06-03 | 2022-12-06 | 中国移动通信集团四川有限公司 | 一种小区服务优化方法、装置及电子设备 |
CN113515147B (zh) * | 2021-07-29 | 2023-11-07 | 安徽大学 | 一种双轴跟踪转台伺服系统改进自抗扰控制器及方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4488249A (en) * | 1982-02-04 | 1984-12-11 | Martin Marietta Corporation | Alignment error calibrator and compensator |
JPH08236678A (ja) * | 1995-02-27 | 1996-09-13 | Hitachi Constr Mach Co Ltd | ダムバー加工方法及びダムバー加工装置 |
CN101793523A (zh) * | 2010-03-10 | 2010-08-04 | 北京航空航天大学 | 一种组合导航和光电探测一体化系统 |
CN102722179A (zh) * | 2012-06-11 | 2012-10-10 | 湖南正奇信息科技有限公司 | 基于三维悬浮技术的目标跟踪平台稳定控制系统 |
CN102882447A (zh) * | 2012-09-10 | 2013-01-16 | 中国科学院光电技术研究所 | 一种光电跟踪系统水平轴双电机装置及同步驱动跟踪控制方法 |
CN103149939A (zh) * | 2013-02-26 | 2013-06-12 | 北京航空航天大学 | 一种基于视觉的无人机动态目标跟踪与定位方法 |
CN103693205A (zh) * | 2013-12-30 | 2014-04-02 | 广东电网公司电力科学研究院 | 基于齿隙估计与补偿的吊舱稳定平台控制方法 |
CN104266663A (zh) * | 2014-09-28 | 2015-01-07 | 中国科学院光电技术研究所 | 一种运动平台光电跟踪系统二级稳定扰动解耦方法 |
CN104281159A (zh) * | 2014-09-10 | 2015-01-14 | 天津航天中为数据系统科技有限公司 | 稳定平台的动态位置环控制方法及系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4639166B2 (ja) * | 2006-05-18 | 2011-02-23 | 本田技研工業株式会社 | 制御装置 |
-
2016
- 2016-03-02 CN CN201610117951.6A patent/CN105786024B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4488249A (en) * | 1982-02-04 | 1984-12-11 | Martin Marietta Corporation | Alignment error calibrator and compensator |
JPH08236678A (ja) * | 1995-02-27 | 1996-09-13 | Hitachi Constr Mach Co Ltd | ダムバー加工方法及びダムバー加工装置 |
CN101793523A (zh) * | 2010-03-10 | 2010-08-04 | 北京航空航天大学 | 一种组合导航和光电探测一体化系统 |
CN102722179A (zh) * | 2012-06-11 | 2012-10-10 | 湖南正奇信息科技有限公司 | 基于三维悬浮技术的目标跟踪平台稳定控制系统 |
CN102882447A (zh) * | 2012-09-10 | 2013-01-16 | 中国科学院光电技术研究所 | 一种光电跟踪系统水平轴双电机装置及同步驱动跟踪控制方法 |
CN103149939A (zh) * | 2013-02-26 | 2013-06-12 | 北京航空航天大学 | 一种基于视觉的无人机动态目标跟踪与定位方法 |
CN103693205A (zh) * | 2013-12-30 | 2014-04-02 | 广东电网公司电力科学研究院 | 基于齿隙估计与补偿的吊舱稳定平台控制方法 |
CN104281159A (zh) * | 2014-09-10 | 2015-01-14 | 天津航天中为数据系统科技有限公司 | 稳定平台的动态位置环控制方法及系统 |
CN104266663A (zh) * | 2014-09-28 | 2015-01-07 | 中国科学院光电技术研究所 | 一种运动平台光电跟踪系统二级稳定扰动解耦方法 |
Non-Patent Citations (2)
Title |
---|
机载光电平台的复合补偿控制方法;扈宏杰 等;《光学精密工程》;20120630;第20卷(第6期);第1272-1280页 * |
航空光电稳定平台的自抗扰控制系统;魏伟 等;《光学精密工程》;20150831;第23卷(第8期);第2296-2304页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105786024A (zh) | 2016-07-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105786024B (zh) | 一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 | |
Jia et al. | Integral backstepping sliding mode control for quadrotor helicopter under external uncertain disturbances | |
Wang et al. | Robust H∞ attitude tracking control of a quadrotor UAV on SO (3) via variation-based linearization and interval matrix approach | |
Wu et al. | Modeling and sliding mode-based attitude tracking control of a quadrotor UAV with time-varying mass | |
CN105911866B (zh) | 四旋翼无人飞行器的有限时间全阶滑模控制方法 | |
CN106774400B (zh) | 一种基于逆动力学的无人机三维轨迹制导方法 | |
CN105607473B (zh) | 小型无人直升机的姿态误差快速收敛自适应控制方法 | |
CN108594837A (zh) | 基于pd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 | |
CN111338368B (zh) | 一种航天器快速机动姿态跟踪自适应鲁棒控制方法 | |
Liu et al. | Robust attitude control for quadrotors with input time delays | |
CN110488875A (zh) | 基于动态逆的无人机跟踪目标初始段航向误差修正方法 | |
Jia et al. | Accurate high-maneuvering trajectory tracking for quadrotors: A drag utilization method | |
Ahmadinejad et al. | Autonomous Flight of Quadcopters in the Presence of Ground Effect | |
CN108427429B (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
CN106292297B (zh) | 基于pid控制器和l1自适应控制器的姿态控制方法 | |
Liang et al. | Active disturbance rejection attitude control for a bird-like flapping wing micro air vehicle during automatic landing | |
Yang et al. | Sampled-data robust visual servoing control for moving target tracking of an inertially stabilized platform with a measurement delay | |
Hua et al. | A time-optimal trajectory planning strategy for an aircraft with a suspended payload via optimization and learning approaches | |
Kim et al. | Design and verification of controllers for airships | |
CN114815888B (zh) | 一种仿射形式的制导控制一体化控制方法 | |
CN108227723A (zh) | 一种水下机器人及其稳定性分析及结构优化的应用方法 | |
CN110209179A (zh) | 一种高超声速飞行器的快速高度跟踪算法 | |
Oliveira et al. | Ground target tracking for unmanned aerial vehicles | |
Gao et al. | Adaptive Tracking and Perching for Quadrotor in Dynamic Scenarios | |
Bouzid et al. | Boosted flight controller for quadrotor navigation under disturbances |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |