CN106842911A - 一种二维指向镜成像跟踪的图像伺服控制方法 - Google Patents

一种二维指向镜成像跟踪的图像伺服控制方法 Download PDF

Info

Publication number
CN106842911A
CN106842911A CN201611050472.3A CN201611050472A CN106842911A CN 106842911 A CN106842911 A CN 106842911A CN 201611050472 A CN201611050472 A CN 201611050472A CN 106842911 A CN106842911 A CN 106842911A
Authority
CN
China
Prior art keywords
prime
servo control
scan mirror
omega
overbar
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
Application number
CN201611050472.3A
Other languages
English (en)
Other versions
CN106842911B (zh
Inventor
陈子印
于飞
张凤
黄刚
王淳
李婧
康建兵
刘雪峰
张超
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Space Research Mechanical and Electricity
Original Assignee
Beijing Institute of Space Research Mechanical and Electricity
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Space Research Mechanical and Electricity filed Critical Beijing Institute of Space Research Mechanical and Electricity
Priority to CN201611050472.3A priority Critical patent/CN106842911B/zh
Publication of CN106842911A publication Critical patent/CN106842911A/zh
Application granted granted Critical
Publication of CN106842911B publication Critical patent/CN106842911B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Abstract

一种二维指向镜成像跟踪的图像伺服控制方法,首先采集二维指向镜的方位轴角度值、俯仰轴角度值作为角位置测量反馈信号,采集CCD相机焦面目标的偏移量作为图像信息反馈,然后计算二维指向镜的轴跟踪目标所需的增量,并建立跟踪微分器,将音圈电机定子线圈模型简化为RL网络,定义二维指向镜轴参数估计偏差,最后计算得到速度等价控制量、角速度跟踪误差、轴电流等价控制量,进而得到二维指向镜的轴电压控制量,生成驱动信号并完成伺服控制。本发明方法通过采用基于图像反馈信息的跟踪控制方法,相比单纯的二维指向镜角位置伺服控制,增加了图像反馈信息,提高了测量精度,具有更高控制精度的优点。

Description

一种二维指向镜成像跟踪的图像伺服控制方法
技术领域
本发明涉及伺服控制技术领域,特别是一种二维指向镜成像跟踪的图像伺服控制方法。
背景技术
近年来国内外发射的许多光学遥感仪器上都采用了指向或扫描装置用以增加视场和减少重返时间,且在轨运行状态良好。美国GOES(地球同步环境卫星)系列是地球同步静止轨道的气象卫星、美国Landsat(陆地卫星)系列是太阳同步轨道资源卫星,Landsat-4、5上的TM(主体测绘仪)、法国SPOT-5太阳同步轨道地球资源遥感卫星搭载的两台相同的HRG(高分辨率几何)相机、国际合作项目地球观测系统(EOS)携带的先进空间热发射和反射辐射仪(ASTER)均搭载了扫描机构通过摆扫或推扫的方式进行成像。国内第一代极轨气象卫星FY-1(风云一号)携带的扫描辐射计采用了45°旋转反射机构扫描方式、中巴地球资源卫星(CBERS)携带的红外多光谱扫描仪(IRMSS)采用了摆动扫描机构扫描方式。
随着遥感应用技术的发展,光学系统中的扫描机构不再局限于单自由度的摆扫或推扫运动,通过采用具有两轴正交的二维指向机构可以实现对空间一定范围内的指向控制和目标跟踪,结合面阵CCD成像元件能够实现对地观测的凝视成像和目标跟踪。
二维指向镜的成像跟踪控制和指向控制是互为相反的两个过程,指向控制的驱动信号是给定的两轴电机转角,而成像跟踪控制的驱动信号是由地物在CCD相机焦面上像在成像坐标系下的偏移量提供的,成像跟踪控制将指向控制作为内环,外环增加了图像伺服闭环,而二维指向镜成像的非线性特性增加了控制的难度。目前,国内外论文中的对二维指向镜的成像特性分析大多基于45°镜假设,能够获得视轴转角与电机转角的直接解析关系,而一旦非45°镜成像就无法获得成像模型的解析形式,而工程上由于光学系统的复杂和多反射结构无法保证45°位置关系,因此此时的成像跟踪控制将变得困难。目前,国内外对二维指向镜均实现了基于角位置反馈信息的位置伺服控制,通过采集测角传感器输出的角位置信息作为反馈量与当前的指令角度信号作比较,将偏差信号送入角位置控制器,再由控制器计算输出控制电压信号,通过驱动电路输出相应的驱动信号驱动执行机构实现角位置指向控制。但采用图像反馈信息进行跟踪控制的文献和应用很少,而基于二维指向镜的图像跟踪控制是在角位置闭环控制的基础上增加了图像信息反馈,而图像位置信息的测量精度高于一般测角器件的精度,目前基于角位置测量信息的指向控制精度大约为1mrad,而基于图像信息反馈的跟踪控制精度能达到0.1mrad,具有明显的精度优势。所以采用图像位置闭环控制能够增加系统的跟踪精度。专利《基于二维转镜的星载目标跟踪系统及方法》(CN200910226500.6)、《用于航空航天成像领域的快速反射镜扫描跟踪系统及方法》(CN201410020863.5)均采用与本专利相似的执行机构,但本专利采用基于图像反馈信息的导引律和参数自适应反步法控制器实现图像跟踪控制,与上述专利采用的控制方法不同。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供了一种二维指向镜成像跟踪的图像伺服控制方法,解决了现有的基于角位置测量信息的控制技术精度不高的问题,具有较好的使用价值。
本发明的技术解决方案是:一种二维指向镜成像跟踪的图像伺服控制方法,包括如下步骤:
(1)采集二维指向镜的方位轴角度值α、俯仰轴角度值β,并作为角位置测量反馈信号,采集CCD相机焦面目标的偏移量u、v,并作为图像信息反馈;所述的二维指向镜分别与音圈电机的两个输出轴相连,音圈电机控制二维指向镜中的方位轴、俯仰轴角度,二维指向镜改变射入CCD相机焦面的光线,CCD相机根据射入光线对目标成像;
(2)利用步骤(1)采集得到的CCD相机焦面目标的偏移量u、v分别计算二维指向镜的方位轴跟踪目标所需的增量Δα为
二维指向镜的俯仰轴跟踪目标所需的增量Δβ为
其中,δα、δβ的取值范围为(0,360]°,kα、kβ取值为正数,uΔα≤0,vΔβ≤0;
(3)建立跟踪微分器为
其中,x0为跟踪微分器输入,x1、x2为跟踪微分器输出,为x2的二阶导数,为x1的一阶导数,r>0,对应的函数定义为
(4)将二维指向镜方位轴或者俯仰轴对应的音圈电机定子线圈模型简化为RL网络,根据力矩平衡原理得到二维指向镜单自由度数学模型为
其中,θ为音圈电机输出轴的转角,ω为音圈电机输出轴的角速度, J为音圈电机转动惯量,Kn为音圈电机挠性枢轴扭转刚度,Km为音圈电机电流力矩系数,i为音圈电机电枢绕组电流,L为音圈电机电枢的电感,R为音圈电机电枢的电阻,Kb为音圈电机反电动势系数,E为输入电压;
定义二维指向镜方位轴参数估计偏差为
其中,j为伺服控制周期数目,j的初始值为1, 分别表示估计值的变化率,为第j个控制周期参数估计值,初值分别为真实值Kb、L、R的0.8倍;
定义二维指向镜俯仰轴参数估计偏差为
其中,j为伺服控制周期数目,j的初始值为1, 分别表示参数估计值的变化率, 为参数估计值,初值分别为 Kb'、L'、R'的0.8倍;
(5)令θ为第j个伺服控制周期的二维指向镜的方位轴角度α,定义第j个伺服控制周期二维指向镜的方位轴角度的跟踪误差
其中,θco=Δθ+θ,Δθ为Δα;
得到速度等价控制量ωco
其中,kθ>0,为通过将θco作为步骤(3)中微分跟踪器的x0计算得到的x2
令θ'为第j个伺服控制周期的二维指向镜的俯仰轴角度β,定义第j个伺服控制周期二维指向镜的俯仰轴的角度跟踪误差
其中,θco'=Δθ'+θ',Δθ'为Δβ;
得到速度等价控制量ωco'为
其中,kθ'>0,为通过将θco'作为步骤(3)中微分跟踪器的x0计算得到的x2
(6)定义第j个伺服控制周期二维指向镜的方位轴角速度跟踪误差为
其中,ωco为步骤(5)计算得到的第j个伺服控制周期的速度等价控制量,ω为将第j个伺服控制周期的方位轴角度α作为步骤(3)中微分跟踪器的x0而得到的x2
得到第j个伺服控制周期方位轴电流等价控制量ico
其中,kω>0,为将步骤(5)计算得到的第j个伺服控制周期的ωco作为步骤(3)中微分跟踪器的x0而得到的x2
定义第j个伺服控制周期二维指向镜的俯仰轴角速度跟踪误差为
其中,ωco'为步骤(5)计算得到的第j个伺服控制周期的速度等价控制量,ω'为将第j个伺服控制周期的β作为步骤(3)中微分跟踪器x0计算得到的x2
得到第j个伺服控制周期俯仰轴电流等价控制量ico'为
其中,kω'>0,为将步骤(5)计算得到的第j个伺服控制周期的ωco'作为步骤(3)中微分跟踪器的x0而得到的x2
(7)定义第j个伺服控制周期二维指向镜的方位轴电流跟踪误差为
进而得到第j个伺服控制周期二维指向镜的方位轴电压控制量为
其中,ki>0,为将第j个伺服控制周期的计算得到的ico作为步骤(3)中微分跟踪器的x0得到的x2
γ4、γ5、γ2、γ3、γ1均为正数;
定义第j个伺服控制周期二维指向镜的俯仰轴电流跟踪误差为
进而得到第j个伺服控制周期二维指向镜的俯仰轴电压控制量为
其中,ki'>0,为将第j个伺服控制周期的计算得到的ico'作为步骤(3)中微分跟踪器的x0得到的x2
γ4'、γ5'、γ2'、γ3'、γ1'均为正数;
(8)将步骤(7)得到的E、E'转换为驱动信号,并分别驱动二维指向镜的方位轴音圈电机和俯仰轴音圈电机转动,完成第j个伺服控制周期伺服控制。
所述的采集二维指向镜的方位轴角度值α、俯仰轴角度值β为通过两轴测角器件完成。
本发明与现有技术相比的优点在于:
(1)本发明方法通过采用基于图像反馈信息的跟踪控制方法,相比单纯的二维指向镜角位置伺服控制,增加了图像反馈信息,提高了测量精度,具有更高的控制精度的优点;
(2)本发明方法通过采用导引律函数设计,将成像坐标系下像的偏移量转换为对应两轴转角的增量,针对二维指向镜的非线性成像特性,解决了无法直接获得焦面图像偏移量到两轴电机绝对角度的解析形式的问题;
(3)本发明方法采用参数自适应反步法设计位置闭环,解决了被控对象模型参数不确定下的控制问题,并采用非线性跟踪微分器获得中间控制量的导数值,避免了因常规反步法中直接求导而增加计算量的不足。
附图说明
图1为二维指向镜结构示意图;
图2为二维指向镜成像示意图;
图3为二维指向镜图像伺服控制结构示意图;
图4为成像跟踪焦面偏移量轨迹;
图5为成像跟踪焦面X向偏移量随时间变化曲线;
图6为成像跟踪焦面Y向偏移量随时间变化曲线;
图7为二维指向镜两轴电机转角变化曲线。
具体实施方式
本发明针对现有技术的不足,提出一种二维指向镜成像跟踪的图像伺服控制方法,解决了现有的基于角位置测量信息的控制技术精度不高的问题,具有较好的使用价值,下面结合附图对本发明方法进行详细说明。
本发明方法中二维指向镜如图1所示,包括二维指向机构、俯仰轴和方位轴电机、俯仰轴和方位轴测角传感器,俯仰轴和方位轴正交安装,均采用枢轴支撑结构,二维指向镜与CCD相机以一定相对位置安装,满足二维指向镜方位轴和俯仰轴处于零位时,反射光线投影在CCD相机焦面的成像坐标系XOY中心,二维指向镜反射入射光线到CCD相机进行成像,如图2所示为二维指向镜成像示意图,CCD相机输出像在成像坐标系下的偏移量。本发明方法中成像跟踪伺服控制算法包括外环图像闭环和内环位置闭环,图像闭环根据像在成像坐标系下XY方向的偏移量利用导引函数分别计算出二维指向镜俯仰轴和方位轴转动角度增量,然后将得到的角度增量分别与方位轴和俯仰轴的测角传感器测量的角度值相加作为指令角度输出给位置闭环。位置闭环根据指令角度,通过控制算法分别输出驱动信号实现俯仰轴和方位轴电机的转动,保证在入射光线角度变化时,经过二维指向镜的反射光线仍然处于CCD相机焦面的成像坐标系XOY中心,进而实现成像跟踪伺服控制。图像闭环直接采用导引函数计算转角增量,避免了直接由图像偏移量到两轴电机绝对角度关系的解析计算;位置闭环控制采用参数自适应反步法设计,能够保证算法在模型参数不确定下的控制性能,并且在反步法设计中引入跟踪微分器计算中间控制量的导数,避免了常规反步法中需对中间控制量进行解析求导而导致计算量膨胀的不足,增加了系统的鲁棒性。
综上所述,本发明方法包括如下步骤:
(1)采集二维指向镜的方位轴和俯仰轴测角传感器输出经过模数转换后得到方位轴角度值α、俯仰轴角度值β,并作为角位置测量反馈信号;采集CCD相机焦面目标的偏移量u、v,并作为图像信息反馈。
(2)利用导引函数分别计算图像信息反馈中偏移量u、v所对应二维指向镜的方位轴、俯仰轴的角度增量。
基于步骤(1)中采集的CCD相机焦面目标的偏移量u、v,利用如下导引函数计算二维指向镜的方位轴、俯仰轴的角度增量为
其中,δα,δβ分别为导引律增益系数,取值范围为(0,360]°,kα,kβ为导引律收敛速度调节系数,取值为正数,导引律中的正负号与二维指向镜两轴转动的正方向和焦面坐标系正方向定义相关,保证uΔα≤0,vΔβ≤0。
(3)利用跟踪微分器基于二维指向镜的方位轴、俯仰轴的角度信息(α、β)计算角速度信号。
本发明方法采用如下微分跟踪器,将x0作为微分跟踪器的输入信号,x1、x2为微分跟踪器的输出信号
其中,为x1的一阶导数,为x2的一阶导数,r>0为微分跟踪器加速度约束,为符号函数定义为
根据以上算法,当分别输入两轴电机转角x0=α或x0=β,将得到两轴电机转动角速度信息为
(4)基于二维指向镜单自由度运动模型,利用参数自适应反步法设计角位置跟踪控制器和参数自适应律。
由于二维指向镜如图1所示正交安装的两轴能够单独控制,所以方位轴的电机控制为例,基于参数自适应反步法设计控制器和自适应律,得到的控制器形式同样适用于另一个轴。
将方位轴音圈电机定子线圈模型简化为一个RL网络,根据动力学的力矩平衡原理可得二维指向镜方位轴数学模型为
其中,θ为音圈电机输出轴的转角,单位rad,ω为音圈电机输出轴的角速度,单位rad/s;J为音圈电机转动惯量,单位为Kg·m2;Kn为音圈电机挠性枢轴扭转刚度,单位N·m·A-1;Km为音圈电机电流力矩系数,单位N·m·A-1;i为音圈电机电枢绕组电流,单位A;L为音圈电机电枢的电感,单位H;R为音圈电机电枢的电阻,单位Ω;Kb为音圈电机反电动势系数,单位V·s·rad-1;E为输入电压,单位为V。
对于数学模型参数存在缓变的不确定性,定义参数的估计偏差为
其中,分别为式(5)中参数的估计值。
(5)对于步骤2中计算出的方位轴角度增量Δθ=Δα和步骤1中测量的当前电机轴转角θ=a相加作为位置伺服闭环的输入角度信息,用θco=θ+Δθ表示。
1)角位置环设计
定义角位置跟踪误差
其中,θ为当前电机转角测量值由步骤1获得,θco为位置伺服闭环的输入角度值,对(7)求导,移项整理得
其中,其中是将指令角度信号θco作为微分跟踪器式(3)的输入x0=θco,而得到的ωco为角速度等价控制量,定义角速度跟踪误差
其中,ω是将当前角位置测量信号θ作为微分跟踪器式(3)的输入x0=θ,计算得到实现了无速度传感器时的角速度信号的获取。
设计角速度等价控制量ωco
其中,控制参数kθ>0,前馈信号作为指令速度信号进行补偿,将式(10)代入式(8)得到
2)角速度环设计
对速度跟踪误差求导,由式(5)和(10)整理得
其中,是将式(10)中角速度等价控制信号ωco作为微分跟踪器式(3)的输入x0=ωco,而得到的对上式进一步整理得
定义电流环跟踪误差
其中,ico为电流等价控制量,i为测量电流信号,设计电流等价控制量ico为如下形式
其中,控制参数kω>0,由式(10)可知,对于传统反步法设计过程的计算涉及到θco的二阶导数和状态变量的偏导数,需要进行解析求导,此处采用微分跟踪器获得的数值解,优化了设计过程,则将式(15)代入式(13)得到
3)电流环设计
对电流环误差求导,将式(15)代入得
其中,是将式(10)中角速度等价控制信号ico作为微分跟踪器式(3)的输入x0=ico,而得到的对于传统反步法设计过程的计算涉及到ωco的二阶导数和其它状态变量的偏导数,需要进行解析求导,此处采用微分跟踪器获得的数值解,优化了设计过程。
设计电压控制控量为如下形式
其中,控制增益ki>0。
将式(18)代入式(17)整理得
4)参数自适应律设计
构造李雅普诺夫能量函数为
对上式求导,将式(19)、(16)和(11)代入得
进一步整理得
设计参数自适应律为
将式(23)~(27)代入式(22)进一步整理得
当且仅当时,由LaSalle不变原理得控制输入能够保证闭环系统渐近稳定,证明控制算法设计过程是有效的,图像跟踪闭环控制系统结构框图如图3所示,下面结合仿真实验实施例对本发明方法进行详细说明。
本发明方法仿真实施例中方位轴音圈电机参数包括电感L=8.4×10-3H、R=6.3Ω、电流力矩系数Km=0.43Nm/A、反电动势系数Kb=0.43V/(rad·s)、转动惯量J=1.45×10-2Kg·m2、枢轴扭转刚度Kn=3.006Nm/rad,将参数估计值初始化为俯仰轴音圈电机参数包括电感L'=4.6×10-3H、R'=5.9Ω、电流力矩系数Km'=0.09Nm/A、反电动势系数Kb'=0.09V/(rad·s)、转动惯量J'=7.2×10-4Kg·m2、枢轴扭转刚度Kn'=0.622Nm/rad,参数估计值初始化为 方位轴控制器参数包括kθ=2、kω=15、ki=50,参数自适应增益系数包括γ1=100、γ2=100、γ3=5、γ4=10、γ5=10,俯仰轴控制器参数包括kθ'=1.5、kω'=10、ki'=30,参数自适应增益系数包括γ1'=50、γ2'=50、γ3'=2、γ4'=5、γ5'=5,根据本发明方法中上述步骤进行仿真,得到仿真实施例结果。
仿真结果如图4、图5、图6、图7所示,其中,仿真实验初始条件是当二维指向镜处于零位状态时,经过反射的光线在焦面上的像位于成像坐标系XOY的中心(0,0),此时分别靠外力转动指向镜的方位轴和俯仰轴直至偏转到某一角度,释放外力时二维指向镜的两轴在控制器的作用下转动能够保证焦面上像回到成像坐标系XOY的中心,如图4所示为焦面像的轨迹,如图5所示为成像跟踪焦面X向偏移量随时间变化曲线,如图6所示为成像跟踪焦面Y向偏移量随时间变化曲线,如图7所示为二维指向镜两轴电机转角变化曲线。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

Claims (2)

1.一种二维指向镜成像跟踪的图像伺服控制方法,其特征在于包括如下步骤:
(1)采集二维指向镜的方位轴角度值α、俯仰轴角度值β,并作为角位置测量反馈信号,采集CCD相机焦面目标的偏移量u、v,并作为图像信息反馈;所述的二维指向镜分别与音圈电机的两个输出轴相连,音圈电机控制二维指向镜中的方位轴、俯仰轴角度,二维指向镜改变射入CCD相机焦面的光线,CCD相机根据射入光线对目标成像;
(2)利用步骤(1)采集得到的CCD相机焦面目标的偏移量u、v分别计算二维指向镜的方位轴跟踪目标所需的增量Δα为
Δ α = δ α e 2 k α u - 1 e 2 k α u - 1
二维指向镜的俯仰轴跟踪目标所需的增量Δβ为
Δ β = - δ β e 2 k β v - 1 e 2 k β v - 1
其中,δα、δβ的取值范围为(0,360]°,kα、kβ取值为正数,uΔα≤0,vΔβ≤0;
(3)建立跟踪微分器为
x · 1 = x 2 x · 2 = - r s i g n ( x 1 - x 0 + x 2 | x 2 | 2 r )
其中,x0为跟踪微分器输入,x1、x2为跟踪微分器输出,为x2的二阶导数,为x1的一阶导数,r>0,对应的函数定义为
s i g n ( x ) = 1 , i f ( x > 0 ) - 1 , i f ( x < 0 ) ;
(4)将二维指向镜方位轴或者俯仰轴对应的音圈电机定子线圈模型简化为RL网络,根据力矩平衡原理得到二维指向镜单自由度数学模型为
&theta; &CenterDot; = &omega; &omega; &CenterDot; = K &OverBar; m i - K &OverBar; n &theta; i &CenterDot; = E L - R L i - K b L &omega;
其中,θ为音圈电机输出轴的转角,ω为音圈电机输出轴的角速度, J为音圈电机转动惯量,Kn为音圈电机挠性枢轴扭转刚度,Km为音圈电机电流力矩系数,i为音圈电机电枢绕组电流,L为音圈电机电枢的电感,R为音圈电机电枢的电阻,Kb为音圈电机反电动势系数,E为输入电压;
定义二维指向镜方位轴参数估计偏差为
K &OverBar; ~ m ( j ) = K &OverBar; ^ m ( j ) - K &OverBar; m K &OverBar; ~ n ( j ) = K &OverBar; ^ n ( j ) - K &OverBar; n K ~ b ( j ) = K ^ b ( j ) - K b L ~ ( j ) = L ^ ( j ) - L R ~ ( j ) = R ^ ( j ) - R
其中,j为伺服控制周期数目,j的初始值为1, 分别表示估计值的变化率,为第j个控制周期参数估计值,初值分别为真实值Kb、L、R的0.8倍;
定义二维指向镜俯仰轴参数估计偏差为
K &OverBar; ~ m &prime; ( j ) = K &OverBar; ^ m &prime; ( j ) - K &OverBar; m &prime; ( j ) K &OverBar; ~ n &prime; ( j ) = K &OverBar; ^ n &prime; ( j ) - K &OverBar; n &prime; ( j ) K ~ b &prime; ( j ) = K ^ b &prime; ( j ) - K b &prime; ( j ) L ~ &prime; ( j ) = L ^ &prime; ( j ) - L &prime; ( j ) R ~ &prime; ( j ) = R ^ &prime; ( j ) - R &prime; ( j )
其中,j为伺服控制周期数目,j的初始值为1, 分别表示参数估计值的变化率, 为参数估计值,初值分别为 Kb'、L'、R'的0.8倍;
(5)令θ为第j个伺服控制周期的二维指向镜的方位轴角度α,定义第j个伺服控制周期二维指向镜的方位轴角度的跟踪误差
&theta; ~ = &theta; - &theta; c o
其中,θco=Δθ+θ,Δθ为Δα;
得到速度等价控制量ωco
&omega; c o = - k &theta; &theta; ~ + &theta; &CenterDot; c o
其中,kθ>0,为通过将θco作为步骤(3)中微分跟踪器的x0计算得到的x2
令θ'为第j个伺服控制周期的二维指向镜的俯仰轴角度β,定义第j个伺服控制周期二维指向镜的俯仰轴的角度跟踪误差
&theta; ~ &prime; = &theta; &prime; - &theta; c o &prime;
其中,θco'=Δθ'+θ',Δθ'为Δβ;
得到速度等价控制量ωco'为
&omega; c o &prime; = - k &theta; &prime; &theta; ~ &prime; + &theta; &CenterDot; c o &prime;
其中,kθ'>0,为通过将θco'作为步骤(3)中微分跟踪器的x0计算得到的x2
(6)定义第j个伺服控制周期二维指向镜的方位轴角速度跟踪误差为
&omega; ~ = &omega; - &omega; c o
其中,ωco为步骤(5)计算得到的第j个伺服控制周期的速度等价控制量,ω为将第j个伺服控制周期的方位轴角度α作为步骤(3)中微分跟踪器的x0而得到的x2
得到第j个伺服控制周期方位轴电流等价控制量ico
i c o = 1 K &OverBar; ^ m ( K &OverBar; ^ n &theta; - k &omega; &omega; ~ - &theta; ~ + &omega; &CenterDot; c o )
其中,kω>0,为将步骤(5)计算得到的第j个伺服控制周期的ωco作为步骤(3)中微分跟踪器的x0而得到的x2
定义第j个伺服控制周期二维指向镜的俯仰轴角速度跟踪误差为
&omega; ~ &prime; = &omega; &prime; - &omega; c o &prime;
其中,ωco'为步骤(5)计算得到的第j个伺服控制周期的速度等价控制量,ω'为将第j个伺服控制周期的β作为步骤(3)中微分跟踪器x0计算得到的x2
得到第j个伺服控制周期俯仰轴电流等价控制量ico'为
i c o &prime; = 1 K &OverBar; ^ m &prime; ( K &OverBar; ^ n &prime; &theta; &prime; - k &omega; &prime; &omega; ~ &prime; - &theta; ~ &prime; + &omega; &CenterDot; c o &prime; )
其中,kω'>0,为将步骤(5)计算得到的第j个伺服控制周期的ωco'作为步骤(3)中微分跟踪器的x0而得到的x2
(7)定义第j个伺服控制周期二维指向镜的方位轴电流跟踪误差为
i ~ = i - i c o
进而得到第j个伺服控制周期二维指向镜的方位轴电压控制量为
E = R ^ i + K ^ b &omega; + L ^ i &CenterDot; c o - k i L ^ i ~ - L ^ K ^ m &omega; ~
其中,ki>0,为将第j个伺服控制周期的计算得到的ico作为步骤(3)中微分跟踪器的x0得到的x2
γ4、γ5、γ2、γ3、γ1均为正数;
定义第j个伺服控制周期二维指向镜的俯仰轴电流跟踪误差为
i ~ &prime; = i &prime; - i c o &prime;
进而得到第j个伺服控制周期二维指向镜的俯仰轴电压控制量为
E &prime; = R ^ &prime; i &prime; + K ^ b &prime; &omega; &prime; + L ^ &prime; i &CenterDot; c o &prime; - k i &prime; L ^ &prime; i ~ &prime; - L ^ &prime; K ^ m &prime; &omega; ~ &prime;
其中,ki'>0,为将第j个伺服控制周期的计算得到的ico'作为步骤(3)中微分跟踪器的x0得到的x2
γ4'、γ5'、γ2'、γ3'、γ1'均为正数;
(8)将步骤(7)得到的E、E'转换为驱动信号,并分别驱动二维指向镜的方位轴音圈电机和俯仰轴音圈电机转动,完成第j个伺服控制周期伺服控制。
2.根据权利要求1所述的一种二维指向镜成像跟踪的图像伺服控制方法,其特征在于:所述的采集二维指向镜的方位轴角度值α、俯仰轴角度值β为通过两轴测角器件完成。
CN201611050472.3A 2016-11-23 2016-11-23 一种二维指向镜成像跟踪的图像伺服控制方法 Active CN106842911B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611050472.3A CN106842911B (zh) 2016-11-23 2016-11-23 一种二维指向镜成像跟踪的图像伺服控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611050472.3A CN106842911B (zh) 2016-11-23 2016-11-23 一种二维指向镜成像跟踪的图像伺服控制方法

Publications (2)

Publication Number Publication Date
CN106842911A true CN106842911A (zh) 2017-06-13
CN106842911B CN106842911B (zh) 2019-07-12

Family

ID=59146079

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611050472.3A Active CN106842911B (zh) 2016-11-23 2016-11-23 一种二维指向镜成像跟踪的图像伺服控制方法

Country Status (1)

Country Link
CN (1) CN106842911B (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107664510A (zh) * 2017-08-30 2018-02-06 中国科学院上海技术物理研究所 一种星载二维指向机构测角精度检测装置及实现方法
CN108919646A (zh) * 2018-07-18 2018-11-30 中国航空工业集团公司洛阳电光设备研究所 一种基于支持向量机的快速偏转镜视轴抖振抑制方法
CN113237439A (zh) * 2021-04-30 2021-08-10 长春理工大学 一种潜望式激光通信终端的解耦跟踪方法
CN115514896A (zh) * 2022-11-01 2022-12-23 季华实验室 面阵相机像移补偿方法、装置、系统与可读存储介质
CN115795283A (zh) * 2023-02-07 2023-03-14 华南理工大学 一种基于迭代学习跟踪微分器的微分信号提取方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060028374A1 (en) * 2004-08-06 2006-02-09 Time Domain Corporation System and method for ultra wideband subarray beam steering
CN102721962A (zh) * 2012-06-08 2012-10-10 北京航空航天大学 多通道时延多普勒二维分割映射多星多时图像增强的成像装置
CN103759922A (zh) * 2014-01-22 2014-04-30 北京空间机电研究所 一种航天遥感器二维指向镜指向精度测量方法
CN104034510A (zh) * 2014-06-12 2014-09-10 中国科学院上海技术物理研究所 一种可便携的光电跟踪性能检测装置
CN203908500U (zh) * 2014-05-26 2014-10-29 唐山学院 一种激光跟踪测量装置
CN104820440A (zh) * 2015-04-21 2015-08-05 北京空间机电研究所 一种星上点目标轨迹跟踪系统
CN104932251A (zh) * 2015-05-28 2015-09-23 北京空间机电研究所 一种用于空间光学遥感器随动系统的同步控制方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060028374A1 (en) * 2004-08-06 2006-02-09 Time Domain Corporation System and method for ultra wideband subarray beam steering
CN102721962A (zh) * 2012-06-08 2012-10-10 北京航空航天大学 多通道时延多普勒二维分割映射多星多时图像增强的成像装置
CN103759922A (zh) * 2014-01-22 2014-04-30 北京空间机电研究所 一种航天遥感器二维指向镜指向精度测量方法
CN203908500U (zh) * 2014-05-26 2014-10-29 唐山学院 一种激光跟踪测量装置
CN104034510A (zh) * 2014-06-12 2014-09-10 中国科学院上海技术物理研究所 一种可便携的光电跟踪性能检测装置
CN104820440A (zh) * 2015-04-21 2015-08-05 北京空间机电研究所 一种星上点目标轨迹跟踪系统
CN104932251A (zh) * 2015-05-28 2015-09-23 北京空间机电研究所 一种用于空间光学遥感器随动系统的同步控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
胡丹: "基于快速反射镜的精跟踪控制系统的设计", 《科技创新与应用》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107664510A (zh) * 2017-08-30 2018-02-06 中国科学院上海技术物理研究所 一种星载二维指向机构测角精度检测装置及实现方法
CN107664510B (zh) * 2017-08-30 2023-05-05 中国科学院上海技术物理研究所 一种星载二维指向机构测角精度检测装置及实现方法
CN108919646A (zh) * 2018-07-18 2018-11-30 中国航空工业集团公司洛阳电光设备研究所 一种基于支持向量机的快速偏转镜视轴抖振抑制方法
CN108919646B (zh) * 2018-07-18 2021-02-26 中国航空工业集团公司洛阳电光设备研究所 一种基于支持向量机的快速偏转镜视轴抖振抑制方法
CN113237439A (zh) * 2021-04-30 2021-08-10 长春理工大学 一种潜望式激光通信终端的解耦跟踪方法
CN113237439B (zh) * 2021-04-30 2022-07-15 长春理工大学 一种潜望式激光通信终端的解耦跟踪方法
CN115514896A (zh) * 2022-11-01 2022-12-23 季华实验室 面阵相机像移补偿方法、装置、系统与可读存储介质
CN115795283A (zh) * 2023-02-07 2023-03-14 华南理工大学 一种基于迭代学习跟踪微分器的微分信号提取方法
CN115795283B (zh) * 2023-02-07 2023-06-16 华南理工大学 一种基于迭代学习跟踪微分器的微分信号提取方法

Also Published As

Publication number Publication date
CN106842911B (zh) 2019-07-12

Similar Documents

Publication Publication Date Title
CN106842911B (zh) 一种二维指向镜成像跟踪的图像伺服控制方法
CN110174899A (zh) 一种基于敏捷卫星的高精度成像姿态指向控制方法
CN103983254B (zh) 一种新型敏捷卫星机动中成像方法
CN106125745B (zh) 一种对空间合作目标跟踪成像的卫星姿态控制方法
CN106526832B (zh) 一种二维指向机构伺服控制方法及系统
CN106791417B (zh) 一种风力发电机机舱双路摄像头防抖系统
CN105446346B (zh) 遥感卫星对月相对定标姿态调整方法
CN110488606A (zh) 一种多四旋翼主从式保性能神经自适应协同编队控制方法
CN105160125B (zh) 一种星敏感器四元数的仿真分析方法
CN105043417B (zh) 多目标连续成像偏流角补偿方法
CN107600464A (zh) 利用星敏感器信息的飞轮控制捕获太阳及对日定向方法
CN111897357A (zh) 一种卫星对地扫描的姿态跟踪控制方法
CN106909161B (zh) 一种敏捷卫星零偏流角成像的最优姿态机动规划方法
CN107132542A (zh) 一种基于光学和多普勒雷达的小天体软着陆自主导航方法
CN109018441A (zh) 一种卫星任意姿态机动过程偏流角跟踪控制方法
CN102360231B (zh) 一种基于速率陀螺的挠性天线伺服控制系统
CN107618678A (zh) 卫星姿态角度偏差下的姿控信息联合估计方法
CN105739513A (zh) 一种四旋翼飞行机器人非线性轨迹跟踪控制器及其跟踪控制方法
CN102607531B (zh) 空间低速高精度二维像移补偿指向控制系统
CN103955223A (zh) 一种深空探测软着陆过程的姿轨耦合控制方法
CN108508918A (zh) 一种静轨遥感卫星数传天线高精度实时对地指向控制方法
CN108413987A (zh) 一种定日镜的校准方法、装置及系统
CN103631276A (zh) 一种基于旋转双棱镜的跟踪装置及其控制方法
CN105891839A (zh) 一种具有彩色点云获取能力的全向激光雷达装置
CN107664096B (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