一种基于主动指向超静平台的多级协同控制方法技术

一种基于主动指向超静平台的多级协同控制方法，适用于天文观测、高分辨率对地观测等具有载荷超高精度确定需求的领域。在星体姿控系统+快反镜的两级控制系统的基础上，在航天器星体与载荷之间安装具有指向功能的超静平台，组成由一级星体姿控、二级载荷姿控和三级快摆镜组成的三级控制系统。实现对期望姿态的高精度控制。本发明专利技术针对新型航天器平台三级复合系统，提出了基于主动指向超静平台的多级协同控制方法，设计星体一级、载荷二级和快反镜三级系统控制律；在满足系统响应需求的前提下，实现多级多带宽复合控制，解决了星体‑载荷‑快速反射镜三者之间的协同控制问题。

【技术实现步骤摘要】
一种基于主动指向超静平台的多级协同控制方法
本专利技术属于航天器姿态控制领域，涉及一种基于主动指向超静平台的多级协同控制方法。
技术介绍
姿态跟踪控制问题是航天器控制领域中的一类重要问题，工程实际中高精度高稳定度的姿态跟踪控制需求日益迫切。已有高精度姿态跟踪系统通常采用粗跟踪+精跟踪的复合控制策略。通过用广角测量敏感器搜索目标并粗跟踪期望姿态，以窄视场成像闭环锁定目标，以高带宽快摆镜实现闭环调节。复合控制需要两级或以上的控制系统串联实现。詹姆斯韦伯望远镜进行天文观测时的粗跟踪主要靠星体姿态控制。精跟踪是通过快反镜对光路直接进行调节，具有响应速度快、跟踪精度高等优点。目前的星体姿控系统+快反镜的两级控制面临以下问题。一方面，受力矩输出和整星大惯量的约束，星体姿态控制带宽较低，跟瞄误差较大且在机动末端会有较长的稳定时间，对快摆镜行程和控制带宽提出了很高要求，导致了视场大小与测量精度之间的矛盾。另一方面，星上多源振动导致载荷机动跟瞄过程中平稳性不高，亟需在星体与载荷之间安装隔振抑振平台。
技术实现思路
本专利技术解决的技术问题是：克服现有技术的不足，提出了一种基于主动指向超静平台的多级协同控制方法，解决了星体-载荷-快速反射镜三者之间的协同控制问题。本专利技术采用的技术解决方案是：一种基于主动指向超静平台的多级协同控制方法，包括如下步骤：(1)建立多级复合控制姿态跟踪模型：在一级星体姿控、二级载荷姿控的基础上，引入快摆镜作为三级。快摆镜可以直接改变视轴指向。三级控制系统将视场中目标偏离光轴的角度作为反馈量输出到快摆镜，使目标被锁定在视场的中央。多级复合控制的目标即保证视轴指向期望姿态。(2)基于相对测量的多级复合控制器设计：将多输入多输出系统简化为单输入单输出系统，分别设计星体、载荷和快反镜单通道控制器，以简化控制器设计。(3)基于相对测量的多级复合控制框架设计：一级控制目标实现主动指向平台的卸载，保证二级工作空间；二级控制目标实现快摆镜转角的卸载，保证三级工作空间；三级控制目标实现视轴与目标轴的重合，实现精确指向。(4)多级复合控制带宽设计：在满足系统响应需求的前提下，从一级到三级，控制对象质量惯量由大到小，带宽设计由低带宽到高带宽，实现多级多带宽复合控制。进一步的，目标轴定义为视轴原点与目标连线的矢量方向，视轴为成像面的法向量；星体与载荷主轴为机械主轴；θTF为视轴与目标方向的夹角，由空间目标测量相机直接测量，即快摆静指向控制量；θTP为载荷主轴与目标方向的夹角，即载荷指向控制量；θFP为视轴与载荷主轴的夹角，即快摆镜的偏转角；θTP为星体主轴与目标方向的夹角，即星体指向控制量；θPB为载荷与星体夹角，由主动指向平台直接测量。进一步的，星体单通道控制器：根据带宽要求设计PID控制参数，同时通过前馈控制补偿主动指向超静平台在载荷指向调节中对卫星平台的反作用力矩，控制律如下：式中，Is为整星惯量，能够保证星体执行机构提供整星姿态控制需要的力矩；ksp、ksi、ksd为控制器参数；θTB是通过相对测量计算间接得到的星体姿态相对于目标的量，Tb为星体控制力矩；ωbr为星体角速度；r×为矢量r的反对称矩阵，其中r可为任意矢量；为矢量r的导数，其中r可为任意矢量。进一步的，载荷单通道控制器：根据带宽要求设计PID控制参数，同时通过载荷的参考轨迹设计载荷的平动前馈补偿，避免主动指向超静平台支杆行程饱和；载荷单通道控制器为：式中，Ipc为载荷相对于整星质心os的惯量在整星质心坐标系fs表达；载荷控制器中采用Ipc能够实现载荷质心op绕整星质心os转动，实现载荷和星体平台姿态保持一致；kpp、kpi、kpd为载荷控制器参数；θTP是载荷主轴与目标方向的夹角，通过相对测量计算间接得到；Tp、ωpr分别为为载荷控制力矩和载荷角速度。进一步的，载荷平动前馈补偿为：式中，cps为载荷质心op相对于整星质心os的一阶惯性张量在整星质心坐标系fs表达，具体计算为其中，mp为载荷的质量；rps为载荷质心到整星质心的相对位置矢量；rp为载荷任意一点到载荷质心的位置矢量。进一步的，载荷的控制力/力矩需要向主动指向超静平台作动器控制力转换，计算主动指向超静平台各个作动器所需控制力，作动器分配律如下：其中，Jp为主动指向超静平台位置和姿态变化转换到各个作动器伸缩量的雅克比变换矩阵，且ei为第i个作动器与星体安装面交点到有效载荷安装面交点单位向量，且其中，bi为从星体安装面中心指向作动杆与星体安装面交点的位置向量，pi为从有效载荷质心指向作动杆与有效载荷安装面交点的位置向量；x0＝[00Ho+HP]T为星体安装面中心到有效载荷质心的位置向量；i＝1,2,…,N；N为作动器个数，×为向量叉乘符号。进一步的，快摆镜积分单通道控制器设计：快摆镜驱动电压到摆镜转角等效为一阶惯性环节，即其中，TFSM为控制周期，GFSM(s)为快摆镜动力学的传递函数；快摆镜控制采用双积分控制器，即其中，Ki_FSM、Kj_FSM为积分常数，CFSM(s)为快摆镜控制器的传递函数。进一步的，设计基于相对测量的多级复合控制框架，具体为：三级快摆镜的控制目标是使视轴与目标方向的夹角θTF趋近于零，实现视轴与目标轴的重合，此过程中，载荷主轴与目标轴的夹角θTP作为扰动量存在，导致快摆镜存在转角行程积累即θFP≠0；二级主动指向平台的控制目标是使θTP趋近于零，实现快摆镜转角的卸载即θFP→0，保证快摆镜的工作行程；一级指向控制目标是使θTB趋近于零，实现主动指向平台的卸载即θPB→0，保证主动指向平台的工作行程。进一步的，多级复合控制带宽，具体为：一级星体姿控系统采用低带宽<二级载荷姿控系统采用中带宽<三级快摆镜控制系统采用高带宽。本专利技术与现有技术相比的优点在于：目前的航天器姿态控制系统只有星体一级姿态控制，受限于敏感器测量带宽、执行机构响应带宽等因素无法进一步提高载荷的指向精度与稳定度。本专利技术设计的基于主动指向超静平台的多级协同控制方法，采用三级协同姿态跟踪控制架构，降低了对相机高采样率、快摆镜高带宽的要求，避免了高带宽对测量噪声的放大；有效减少快摆镜的工作行程，降低了相机视场，有助于进一步提高精级精度。本专利技术直接服务于采用多级协同控制的姿态跟踪控制方案设计及仿真。附图说明图1为多级协同控制姿态跟踪控制示意图；图2为基于相对测量的多级协同控制框架；图3为多级协同控制带宽设计；图4为多级协同控制一二级指向误差；图5为两级控制与多级协同控制光轴指向误差对比。具体实施方式基于多级复合控制的卫星控制系统由一级星体姿控、二级载荷姿控和三级快摆镜控制组成。星体与载荷之间为并联驱动六自由度的超静平台(主动指向超静平台)。此多级平台控制系统的控制周期本文档来自技高网...

【技术保护点】
1.一种基于主动指向超静平台的多级协同控制方法，其特征在于包括如下步骤：/n(1)建立多级复合控制姿态跟踪指向模型；/n(2)设计基于相对测量的多级复合控制器：将多输入多输出系统简化为单输入单输出系统，分别设计星体单通道控制器、载荷单通道控制器和快摆镜积分单通道控制器；/n(3)设计基于相对测量的多级复合控制框架：一级控制目标实现主动指向平台的卸载，保证二级工作空间；二级控制目标实现快摆镜转角的卸载，保证三级工作空间；三级控制目标实现视轴与目标轴的重合，实现对期望姿态的精确指向；/n(4)设计多级复合控制带宽：在满足系统响应需求的前提下，从一级到三级，控制对象质量惯量由大到小，带宽设计由低带宽到高带宽，实现多级多带宽复合控制。/n

【技术特征摘要】
1.一种基于主动指向超静平台的多级协同控制方法，其特征在于包括如下步骤：
(1)建立多级复合控制姿态跟踪指向模型；
(2)设计基于相对测量的多级复合控制器：将多输入多输出系统简化为单输入单输出系统，分别设计星体单通道控制器、载荷单通道控制器和快摆镜积分单通道控制器；
(3)设计基于相对测量的多级复合控制框架：一级控制目标实现主动指向平台的卸载，保证二级工作空间；二级控制目标实现快摆镜转角的卸载，保证三级工作空间；三级控制目标实现视轴与目标轴的重合，实现对期望姿态的精确指向；
(4)设计多级复合控制带宽：在满足系统响应需求的前提下，从一级到三级，控制对象质量惯量由大到小，带宽设计由低带宽到高带宽，实现多级多带宽复合控制。


2.根据权利要求1所述的一种基于主动指向超静平台的多级协同控制方法，其特征在于：步骤(1)所述建立多级复合控制姿态跟踪指向模型，具体为：在一级星体姿控、二级载荷姿控的基础上，引入快摆镜作为三级；快摆镜可以直接改变视轴指向；三级控制系统将视场中目标偏离光轴的角度作为反馈量输出到快摆镜，使目标被锁定在视场的中央；多级复合控制的目标即保证视轴指向期望姿态。


3.根据权利要求2所述的一种基于主动指向超静平台的多级协同控制方法，其特征在于：目标轴定义为视轴原点与目标连线的矢量方向，视轴为成像面的法向量；星体与载荷主轴为机械主轴；θTF为视轴与目标方向的夹角，由空间目标测量相机直接测量，即快摆静指向控制量；θTP为载荷主轴与目标方向的夹角，即载荷指向控制量；θFP为视轴与载荷主轴的夹角，即快摆镜的偏转角；θTP为星体主轴与目标方向的夹角，即星体指向控制量；θPB为载荷与星体夹角，由主动指向平台直接测量。


4.根据权利要求1所述的一种基于主动指向超静平台的多级协同控制方法，其特征在于：星体单通道控制器：根据带宽要求设计PID控制参数，同时通过前馈控制补偿主动指向超静平台在载荷指向调节中对卫星平台的反作用力矩，控制律如下：



式中，Is为整星惯量，能够保证星体执行机构提供整星姿态控制需要的力矩；ksp、ksi、ksd为控制器参数；θTB是通过相对测量计算间接得到的星体姿态相对于期望姿态的量，Tb为星体控制力矩；ωbr为星体角速度；r×为矢量r的反对称矩阵，其中r可为任意矢量；为矢量r的导数，其中r可为任意矢量。


5.根据权利要求4所述的一种基于主动指向超静平台的多级协同控制方法，其特征在于：载荷单通道控制器：根据带宽要求设计PID控制参数，同时通过载荷的参考轨迹设计载荷的平动前馈补偿，避免主动指向超静平台支杆行程饱和；
载荷单通道控制器为：



式中，Ipc为载荷相对于整星质心os的惯量在整星质心坐标系fs表达；载荷控制器中采用Ipc能够实现载荷质心op...

【专利技术属性】
技术研发人员：汤亮，袁利，关新，王有懿，姚宁，宗红，郝仁剑，郭子熙，冯骁，张科备，刘昊，龚立纲，
申请(专利权)人：北京控制工程研究所，
类型：发明
国别省市：北京;11