一种滚摆伺服机构惯性空间扫描轨迹混合控制方法及系统与流程
本发明属于光电精密跟踪,尤其涉及一种滚摆伺服机构惯性空间扫描轨迹混合控制方法及系统。
背景技术:
1、在机载光电跟瞄伺服控制系统中,滚摆伺服机构基于位置闭环的惯性空间扫描路径规划轨迹方案已经得到广泛应用。目前常用的伺服轨迹控制技术方案如下:
2、1、在惯性空间进行总体扫描路径规划,判断扫描起始位置,扫描方位边界,扫描俯仰行数。
3、2、根据当前载体两轴角度,和安装在载体基座上的捷联惯导方位、俯仰、横滚姿态,反向解算出惯性空间方位俯仰角度。
4、3、判断下一步的惯性空间扫描目标角度,将该惯性空间目标角度,结合惯导三轴姿态,解算出设备系两轴角度。
5、4、在载体坐标系下对滚动轴和摆动轴各自进行位置闭环控制。
6、现有技术存在以下主要问题:
7、(1)扫描过程中在起始和结束段以及方位阶跃换行过程中,由于存在由静止到运动的时域突变,相当于频域上具有高频成分,因此会激发位置闭环上的幅频响应大于1的部分,具体表现为阶跃开始或到达停止点时会超调然后再逐渐趋于稳定。
8、(2)对于滚摆机构来说在扫描惯性空间轨迹接近于载体滚动轴直径时,由于存在过天顶角区域,滚动轴和摆动轴速度差异巨大,且滚动轴实际控制时必然会有可执行的极限速度,因此扫描过程的逐点闭环过程会引发强烈的非线性耦合情况,具体表现为扫描空间轨迹越靠近天顶角死区时误差越大,只有在路径的起始和结束两个端点阶段,才能走出符合规划要求的惯性空间轨迹。
9、(3)扫描过程中只是使用了惯导姿态角度,并未结合三轴陀螺实时速度,因此当设备载体存在较大的姿态变化时,未利用高带宽的速度环进行扰动补偿,导致扫描路径不够精准。
10、上述问题导致了滚摆机构惯性空间扫描轨迹执行的精确性降低,限制了其在机动情况下快速稳定捕获惯性空间可疑目标的能力。
技术实现思路
1、有鉴于此,本发明创造旨在提供一种滚摆伺服机构惯性空间扫描轨迹混合控制方法及系统,解决现有滚摆伺服机构惯性空间扫描过程中因位置闭环控制导致的边界超调、天顶角区域非线性耦合以及机动条件下扰动补偿不足等问题。
2、为达到上述目的,本发明创造的技术方案是这样实现的:
3、本发明创造一方面提供一种滚摆伺服机构惯性空间扫描轨迹混合控制方法,包括:
4、s1:获取载体坐标系下转台的滚动轴实际角度和摆动轴实际角度;
5、s2:依据载体三轴姿态值,将转台的滚动轴实际角度和摆动轴实际角度转换至惯性空间,得到惯性空间实际角度;
6、s3:当前扫描阶段为非匀速段时,执行:
7、利用平滑处理器处理扫描路径规划的惯性空间目标角度与惯性空间实际角度,获得空间预期角度;
8、基于空间预期角度与载体三轴姿态值计算获得载体坐标系下的滚动轴预期角度和摆动轴预期角度;
9、将滚动轴预期角度和摆动轴预期角度作为位置闭环参考值,滚动轴实际角度和摆动轴实际角度作为位置闭环反馈,进行位置闭环校正,进而获得速度闭环控制量;
10、当前扫描阶段为匀速段时,执行:
11、根据惯性空间实际角度和扫描路径规划的扫描速度,将惯性空间球坐标系下的扫描速度投影到惯性空间直角坐标系,获得惯性空间三轴速度;
12、根据惯性空间三轴速度和载体三轴姿态值,将惯性空间三轴速度投影到载体坐标系,获得载体坐标系三轴速度;
13、将载体坐标系三轴速度依次投影到转台的两级运动坐标系,并补偿三轴陀螺速度,获得用于驱动载体的三轴驱动速度;
14、基于三轴驱动速度与滚动轴、摆动轴之间的运动学映射关系,进行逆运动学求解,得到滚动轴待执行速度和摆动轴待执行速度,并作为速度闭环控制量。
15、优选的,转台包括滚动电机和摆动电机,以及滚动绝对编码器和摆动绝对编码器。
16、优选的,s1中,通过滚动绝对编码器和摆动绝对编码器分别获得滚动轴角度读数和摆动轴角度读数,减去各自零点获得滚动轴实际角度和摆动轴实际角度。
17、优选的,平滑处理器为非线性跟踪微分器。
18、优选的,s2中,通过捷联惯导获取载体三轴姿态值。
19、优选的,s2中,根据载体三轴姿态值分别建立三个欧拉角的旋转矩阵,将载体坐标系下转台的滚动轴实际角度和摆动轴实际角度在三个旋转矩阵下依次投影,得到惯性空间实际角度。
20、优选的,非匀速段包括扫描起始加速段、扫描结束减速段以及俯仰方向换行阶跃段中的至少一种。
21、优选的,转台中的滚动电机用于驱动滚动外框架,摆动电机用于驱动摆动内框架,载体坐标系三轴速度逐级投影到转台滚动外框架坐标系、摆动内框架坐标系,摆动内框架坐标系下的三轴速度即为用于驱动载荷的三轴驱动速度。
22、优选的,当前扫描阶段为匀速段时,获得速度闭环控制量后,判断滚动轴待执行速度是否大于预设的滚动轴极限速度:
23、若滚动轴待执行速度大于滚动轴极限速度,则以预设的滚动轴极限速度作为滚动轴待执行速度,反向推算更新惯性空间球坐标系下的扫描速度,基于更新后的扫描速度重新计算滚动轴待执行速度和摆动轴待执行速度。
24、本发明创造另一方面提供一种滚摆伺服机构惯性空间扫描轨迹混合控制系统,包括:
25、转台,其用于驱动载荷;
26、捷联惯导,用于获取载体三轴姿态值;
27、三轴陀螺,用于获取载体惯性空间中的速度扰动;
28、以及,伺服主控处理器,其被配置为执行滚摆伺服机构惯性空间扫描轨迹混合控制方法。
29、与现有技术相比,本发明创造能够取得如下有益效果:
30、本发明依据跟瞄特性采用分段混合控制策略,在加速段、减速段及俯仰阶跃段等非匀速段的惯性空间角度规划中引入非线性跟踪微分器,对惯性空间扫描轨迹进行平滑过渡处理,避免了加减速段和俯仰阶跃段因位置突变引入的高频干扰,从而有效解决了扫描边界处超调的问题。并在匀速段采用惯性空间速度直接投影控制方式,减少了位置闭环带宽有限产生的不确定性波动,此外构建了从速度闭环到惯性空间速度的反向限速机制,即当滚动轴待执行速度大于滚动轴极限速度时,以滚动轴极限速度作为滚动轴待执行速度,反向推算更新惯性空间球坐标系下的扫描速度,再重新计算双轴速度,使得扫描路径即使接近滚动直径(天顶角死区)时,双轴合成轨迹精度也不会受到影响。
31、本发明在匀速扫描段的外框架和内框架速度投影过程中,引入了三轴陀螺进行实时速度补偿,将陀螺实时速度与投影后的载体坐标系速度进行矢量叠加,使得转台载荷即使受到载体机动带来的扰动,也仍能实现平稳扫描,显著提高了系统的抗扰能力和扫描精度。
1.一种滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,包括:
2.根据权利要求1所述的滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,所述转台包括滚动电机和摆动电机,以及滚动绝对编码器和摆动绝对编码器。
3.根据权利要求2所述的滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,所述s1中,通过滚动绝对编码器和摆动绝对编码器分别获得滚动轴角度读数和摆动轴角度读数,减去各自零点获得滚动轴实际角度和摆动轴实际角度。
4.根据权利要求1所述的滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,所述平滑处理器为非线性跟踪微分器。
5.根据权利要求1所述的滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,所述s2中,通过捷联惯导获取所述载体三轴姿态值。
6.根据权利要求1或5所述的滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,所述s2中,根据所述载体三轴姿态值分别建立三个欧拉角的旋转矩阵,将载体坐标系下转台的滚动轴实际角度和摆动轴实际角度在所述三个旋转矩阵下依次投影,得到惯性空间实际角度。
7.根据权利要求1所述的滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,所述非匀速段包括扫描起始加速段、扫描结束减速段以及俯仰方向换行阶跃段中的至少一种。
8.根据权利要求2所述的滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,所述转台中的滚动电机用于驱动滚动外框架,摆动电机用于驱动摆动内框架,载体坐标系三轴速度逐级投影到转台滚动外框架坐标系、摆动内框架坐标系,摆动内框架坐标系下的三轴速度即为用于驱动载荷的三轴驱动速度。
9.根据权利要求2所述的滚摆伺服机构惯性空间扫描轨迹混合控制方法,其特征在于,当前扫描阶段为匀速段时,获得速度闭环控制量后,判断滚动轴待执行速度是否大于预设的滚动轴极限速度:
10.一种滚摆伺服机构惯性空间扫描轨迹混合控制系统,其特征在于,包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com