一种两轴四框架光电吊舱的伺服控制方法及系统的制作方法

文档序号:8318566阅读:1115来源:国知局
一种两轴四框架光电吊舱的伺服控制方法及系统的制作方法
【技术领域】
[0001] 本发明属于机载光电吊舱的伺服控制技术,具体涉及一种两轴四框架光电吊舱的 平台稳定技术以及高精度光电跟踪控制技术。
【背景技术】
[0002] 高精度机载光电吊舱具有隔离载体运动、承载光电载荷的功能,其主要作用是,在 载机机身振动以及外部风力干扰等状况下实现高精度高稳定光电跟踪控制。随着目标机动 性能的增强与用户的功能要求的增加,机载光电吊舱需要具有更高的跟踪能力、更好的平 台稳定能力以及更大的运动范围。
[0003] 两轴四框架光电吊舱作为吊舱的一种结构形式可以使光电吊舱具有更大的跟踪 范围,更好的平台稳定性能与跟踪精度。两轴四框架光电吊舱结构形式如图1,其由方位 轴与俯仰轴两个轴系组成,方位轴包括内方位框架与外方位框架,俯仰轴包括内俯仰框架 与外俯仰框架。与两轴两框架光电吊舱相比,两轴四框架吊舱的外框架可部分隔离外部风 力干扰的影响,且通过设计合适的两轴四框架光电吊舱伺服控制技术使内方位框架与内俯 仰框架始终互相垂直,从而对干扰运动起到更佳的隔离作用,可减小吊舱框架的几何约束 耦合,使内框架处于更良好的稳定环境,易于提高系统的平台稳定精度,保证视轴的空间稳 定。
[0004] 为了实现两轴四框架光电吊舱的高精度稳定跟踪控制必须保证两轴四框架吊舱 的内方位框架与内俯仰框架始终互相垂直,两轴四框架光电吊舱的伺服控制技术需要解决 吊舱内外框架联动的问题,因而其控制技术远较两轴两框架光电吊舱复杂。因此,亟需针对 两轴四框架光电吊舱设计一套内外框联动平台稳定控制技术,在此基础上进一步设计一种 内外框联动高精度高稳定度的光电跟踪控制技术,以满足两轴四框架光电吊舱的平台稳定 控制与高精度光电跟踪控制等性能方面的要求。

【发明内容】

[0005] 本发明要解决的技术问题是提供一种满足两轴四框架光电吊舱控制需要的先进 伺服控制技术,使光电吊舱在载机机身振动以及外部风力干扰等状况下实现高精度高稳定 光电跟踪控制。
[0006] 本发明首先设计了一种内外框架联动平台稳定控制技术使该吊舱具有很好的平 台稳定性能,该平台稳定控制技术可保证内方位框架与内俯仰框架始终互相垂直,减小了 吊舱框架的几何约束耦合,使光电吊舱在过顶时也具有很好的平台稳定性能;在此基础上, 本发明又设计了一种内外框联动光电跟踪控制技术以提高光电跟踪精度,最终使该光电吊 舱实现该吊舱的高精度与高稳定度的光电跟踪控制。
[0007] 为了实现这一目的,本发明采取的技术方案是:
[0008] -种两轴四框架机载光电吊舱的伺服控制方法,光电吊舱由方位轴与俯仰轴两个 轴系组成,方位轴包括内方位框架与外方位框架,俯仰轴包括内俯仰框架与外俯仰框架;该 光电吊舱在载机机身振动以及外部风力干扰状况下通过下述方法实现高精度高稳定光电 跟踪控制:
[0009] (1)内框架执行所设计的内框架位置环跟踪控制算法获得内框架速度环控制量, 将速度环控制量代入陀螺速度环稳定回路获得相应的DA 口电压控制量,通过驱动器将DA 口电压控制量功率放大后驱动内框架电机带动内框架作出跟踪控制运动;具体包括以下步 骤:
[0010] (I. 1)获取脱靶量数据,进行脱靶量数据处理,并计算分段PID控制量;
[0011] (1. 1. 1)获取脱靶量数据,进行脱靶量数据处理;
[0012] 通过DSP处理器的通讯接口单元每20ms读取一次内方位的脱革巴数据Δ Θ _nfw,当 前Ims内方位目标给定位置Posr_nfw如下式所示:Posr_nfw = Pos_nfw+A Θ _nfw/20 ;其 中,Posr_nfw为每Ims当前内方位目标给定位置,Pos_nfw为当前Ims内方位码盘当前测量 的值;
[0013] 通过DSP处理器的通讯接口单元每20ms读取一次内俯仰的脱革巴数据Δ Θ _nfy,当 前Ims内俯仰目标给定位置Posr_nfy如下式所示:
[0014] Posr_nfy=Pos_nfy+ Λ Θ _nfy/20 ;其中,Posr_nfy 为每 Ims 当前内俯仰目标给定 位置,Pos_nfy为当前俯仰码盘当前测量的值;
[0015] (I. 1. 2)将经过上一步骤处理后的脱靶量代入到分段PID控制计算得到分段PID 控制量;
[0016] 根据上一步骤中获得的当前Ims方位目标位置值Posr_nfw与当前Ims内方位码 盘当前测量的值P〇s_ni,计算当前Ims的内方位等效目标偏差值Err_nfw=Posr_nfw-Pos_ nfw,内方位误差的积分ErrI_nfw=2Err_nfw,内方位误差的微分ErrD_nfw=(当前Ims的 Err_nfw-上Ims的Err_nfw)X1000,将上述参数代入分段PID控制中获得内方位分段变参 数PID控制量PIDspeedOut_nfw ;内方位分段变参数PID控制量PIDspeedOut_nfw的公式 如下式所示:
[0017] PIDspeedOut_nfw=nfwKpXEr;r_nfV+nfVKi XErrI_nfV+nfVKdXE;rrD_nfV,其中: nfwKp为内方位比例系数,nfwKi为内方位积分系数,nfwKd为内方位微分系数;
[0018] 根据上一步骤中获得的当前Ims俯仰目标位置值Posr_nfy与当前Ims内俯仰码 盘当前测量的值P〇s_n,计算当前Ims的内俯仰等效目标偏差值Err_nfy=Posr_nfy-Pos_ nfy,内俯仰误差的积分ErrI_nfy=2Err_nfy,内俯仰误差的微分ErrD_nfy=(当前Ims的 Err_nfy-上Ims的Err_nfy) X 1000,将上述参数代入分段PID控制中获得内俯仰分段变参 数PID控制量PIDspeedOut_nfy ;内俯仰分段变参数PID控制量PIDspeedOut_nfy的公式 如下式所示:
[0019] PIDspeedOut_nfw=nfyKpXEr;r_nfy+nfyKi XErrI_nfy+nfyKdXE;rrD_nfy,其中: nfyKp为内俯仰比例系数,nfyKi为内俯仰积分系数,nfyKd为内俯仰微分系数;
[0020] (1. 2)获得加速度滞后补偿控制量,并与上述步骤(I. 1)中分段PID控制量控制量 相加获得位置环总控制量;
[0021] (1. 2. 1)获取陀螺速度滞后补偿控制量
[0022] 通过DSP伺服控制器的陀螺读数单元获得经过滤波处理过的光电载荷相对内方 位轴的惯性空间速度gyrospeed_nfw,与内方位滞后补偿系数nfwKi相乘得内方位跟踪速 度滞后补偿控制量 gyrospeedOut_nfw=gyrospeed_nfwXnfwKl ;
[0023] 通过DSP伺服控制器的陀螺读数单元获得经过滤波处理过的光电载荷相对内俯 仰轴的惯性空间速度gyrospeed_nfy,与内俯仰滞后补偿系数nfyKl相乘得内俯仰跟踪速 度滞后补偿控制量 gyrospeedOut_nfy=gyrospeed_nfy XnfyKl ;
[0024] ( L 2. 2)获取陀螺加速度滞后补偿控制量
[0025] 将步骤(1. 2. 1)中测量的内方位惯性空间速度值gyrospeed_nfw微分后获得内方 位惯性空间加速度值gyroAccspeed_nfw,与内方位滞后补偿系数nfwK2相乘得内方位速度 滞后补偿控制量 gyroAccSpeed0ut_nfw=gyroAccSpeed_nfwXnfwK2 ;
[0026] 将步骤(L 2. 1)中测量的内俯仰惯性空间速度值gyrospeecLnfy微分后获得内俯 仰惯性空间加速度值gyroAccspeed_nfy,与内俯仰滞后补偿系数nfyK2相乘得内俯仰速度 滞后补偿控制量 gyroAccSpeed0ut_nfy=gyroAccSpeed_nfyXnfyK2 ;
[0027] ( L 2. 3)获取总的速度给定控制量;
[0028] 将步骤(1. 1.2)中内方位分段PID控制量PIDspeedOut_nfw、步骤(1·2· 1)中 内方位陀螺速度滞后补偿控制量gyrospeedOut_nfw、步骤(1. 2. 2)中内方位陀螺加速 度滞后补偿控制量gyroAccSpeedOut_nfw相加作为内方位速度给定控制量SpeedOut_ nfw=PIDspeedOut_nfw+gyrospeedOut_nfw+gyroAccSpeedOut_nfw ;
[0029] 将步骤(I. 1.2)中内俯仰分段PID控制量PIDspeedOut_nfy、步骤(1·2· 1)中 内俯仰陀螺速度滞后补偿控制量gyrospeedOut_nfy、步骤(1. 2. 2)中内俯仰陀螺加速 度滞后补偿控制量gyroAccSpeedOut_nfy相加作为内俯仰速度给定控制量Speed0ut_ nfy=PIDspeedOut_nfy+gyrospeedOut_nfy+gyroAccSpeedOut_nfy ;
[0030] (I. 3)将步骤(I. 2)中位置环总控制量代入陀螺速度环稳定回路获得相应的DA 口 电压控制量;
[0031] (I. 3. 1)获取陀螺速度偏差值
[0032] DSP控制器每Ims将读取的内方位速度给定控制量speedOut_nfw,减去光电载 荷相对内方位轴的惯性空间速度gyrospeed_nfw,获得内方位陀螺速度偏差值SpeedErr_ nfw=SpeedOut_nfw-gyrospeed_nfw ;
[0033] DSP控制器每Ims将读取的内俯仰速度给定控制量speedOut_nfy,减去光电载 荷相对内俯仰轴的惯性空间速度gyrospeecLnfy获得内俯仰陀螺速度偏差值SpeedErr_ nfy=SpeedOut_nfy-gyrospeed_nfy ;
[0034] (I. 3. 2)获取控制电机运动所需要的DA 口电压控制量;
[0035] 根据步骤(I. 3. 1)中得到的内方位陀螺速度偏差值SpeedErr_nfw计算DA 口内 方位电压控制量 Ut_nfw=SpeedErr_nfw X nfwspeedKp+speedErrI_nfw X nfwspeedKi,其中: 内方位陀螺速度偏差值的积分speedErrI_nfw=SspeedErr_nfw,nfwspeedKi为内
当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1