法律状态公告日
法律状态信息
法律状态
2023-03-03
未缴年费专利权终止 IPC(主分类):B64G 1/28 专利号:ZL2015101249961 申请日:20150319 授权公告日:20170308
专利权的终止
2017-03-08
授权
授权
2015-07-22
实质审查的生效 IPC(主分类):B64G1/28 申请日:20150319
实质审查的生效
2015-06-24
公开
公开
技术领域
本发明属于卫星姿态控制领域,涉及一种卫星姿态控制方法。
背景技术
卫星姿态控制对于星载仪器能否对目标进行精准定向或跟踪,进而完成特定任务(如侦查、通信、中 继等)起着关键作用。传统的卫星姿态控制主要依靠喷气反作用系统与惯性执行机构,前者不仅消耗燃料, 且会对星载敏感仪器造成污染;惯性执行机构主要有飞轮(RW)与控制力矩陀螺(CMG)两类,其优点是仅需 太阳能供电,寿命长,精度高,污染小等。
相比于RW,CMG具有转矩放大效应,但为了实现与卫星平台的三自由度动量交换,系统结构较为复杂, 需要将转子安装于可转动的外框架上。目前常用的CMG系统方案一般采用单框架(VSCMG)或双框架(DGCMG) 结构,前者转子转速可调,而后者转子转速恒定。配置另外的外框架或使转子转速可调实质上都为系统提 供了一个自由度,因此这两种方案都只具备两自由度,无法依靠单独一台VSCMG或DGCMG完成与卫星平台 的三维动量交换。另外,外框架的限制也增加了系统的奇异风险。目前解决方案一般要将若干CMG单元相 配合构成CMG陀螺群(Cluster),例如金字塔构型,并且需要制定针对奇异点问题的操纵率,庞大的伺服 系统大大增加了姿态控制系统的重量、体积、成本以及能源消耗,目前的应用多见于大型空间站。最近有 学者提出了一种将上述二者相结合的双框架变速力矩控制陀螺(DG-VSCMG),这种方案虽然理论上具有三 自由度,但由于双框架的限制使得其转矩放大作用不理想,且机械结构和控制策略极为复杂,目前相关研 究较少。而为防止可能发生的欠驱动情况,惯性执行机构还必须备有冗余单元,目前许多在轨空间站都采 用在三正交飞轮基础上增加第四个飞轮与三正交飞轮斜交,这进一步增加了系统结构和控制的复杂度。
发明内容
本发明的目的是克服现有技术的上述问题,提供一种结构和控制测量简单,可以减轻飞行器重量,节 约星载空间并易于操纵的卫星姿态控制方法。本发明采用球形电机作为动量交换装置,并基于简单的增量 控制策略即实现转子角动量大小与方向的同时控制,能够完成与卫星平台的三自由度动量交换。本发明的 技术解决方案如下:
一种基于球形电机三自由度动量交换的卫星姿态控制方法,此方法的球形动量交换装置为球形电机, 通过定子壳与卫星平台连接,包括下列步骤:
(1)确定控制欧拉轴转角
取姿态控制指令q4作为输入量,以控制欧拉轴转角ψref作为输出量,确定控制欧拉轴转角: ψref=2arccos(q4)
其中,q4为姿态控制指令,是姿态四元数的标量分量,ψref是卫星控制欧拉轴转角;
(2)确定分级控制欧拉轴转角
以(1)中的控制欧拉轴转角ψref为输入量,各级控制欧拉轴转角ψk为输出量,确定分级数n和各级 控制欧拉轴转角:
其中,ψk是第k次增量机动的控制欧拉轴转角,k是增量机动的次序,取值为{1,2,…,n},n是设定 的总的增量机动级数,tk表示第k次机动期望完成时刻,t0=0;
(3)确定各级增量控制力矩
以各级控制欧拉轴转角ψk和期望完成时刻tk为输入量,各级增量控制力矩Tk为输出量,确定各级增 量控制力矩:
Tk=4Jψk/(tk-tk-1)2*[q1 q2 q3]T
其中,Tk为参考坐标系N下第k级增量机动的控制力矩矢量,J表示卫星绕欧拉轴的转动惯量, [q1 q2 q3]T是姿态四元数的向量分量,也即欧拉轴;
然后将控制力矩Tk从参考坐标系N变换到球形转子虚框架坐标系V以便于求取轨迹控制指令:
τk=[τt τg τh]T=Cvn*Tk,
其中,τk是虚框架坐标系V下的控制力矩分量列阵,τh是类飞轮变速转矩分量,τt是由卫星转动产 生的陀螺进动力矩分量,τg是转子倾斜加速转矩分量,Cvn为参考坐标系N到虚框架坐标系V的变换矩阵, N坐标系为卫星姿态参考坐标系,虚框架坐标系V由虚拟单框架确定,在任意时刻球形转子都存在一个虚 拟单框架,其框架转动惯量为零,将转子自转角动量方向定义为轴,轴与转子瞬时倾斜角动量方向也 即虚拟框架转轴重合,轴由右手定则确定;
(4)确定球形转子轨迹控制指令
由力矩控制指令求得球形转子的控制轨迹的计算公式为:
其中,Ω分别是转子角速度在虚框架坐标轴g、t上的投影分量,表示球形转子本体倾斜角速率、 自转角速率;分别是转子角加速度在虚框架坐标轴g、t上的投影分量,表示倾斜角加速度,自转 角加速度;Ig,It,Ih分别是球形转子关于虚拟坐标轴t、g、h的转动惯量分量;ωBg,ωBt分别是卫星 平台角速度ωB在虚拟坐标系轴g、t上的投影分量;
(5)对球形转子进行轨迹跟踪控制
将(4)中球形转子虚框架坐标系V下的控制轨迹指令变换到欧拉轴坐标系下进行轨迹跟踪控制;
(6)调整增量分级n
球形动量交换装置跟踪轨迹控制指令,输出力矩作用于卫星平台,完成三自由度角动量交换,机动过 程中若超过转子最大倾角,则增大增量分级n,返回步骤(2)重新进行卫星姿态调整。
本发明与现有技术相比的优点在于:以球形电机作为新型无框架动量交换装置,该装置仅需一个运动 部件,且基于简单的控制策略即能够实现转子角动量大小与方向的同时控制,从而完成与卫星平台的动量 交换,避免了VS-DGCMG复杂的机械结构,能够有效减少飞行器重量,节约星载空间。
附图说明
图1本发明的球形动量交换装置与卫星平台关系示意图
图2本发明的流程图
图3(a)球形动量交换装置俯视图和侧视图
图3(b)定子线圈编号平铺图
图4本发明的球形动量交换装置剖面几何示意图
图5本发明的瞬时虚拟框架与转子角速度合成示意图
图6本发明的NBR坐标示意图
图7本发明的球形动量交换装置控制系统框图
图8(a)倾斜指令力矩与动量交换装置实际输出力矩
图8(b)自转加速度指令力矩与装置实际输出力矩
图8(c)转子倾角响应曲线
图8(d)转子倾角速率响应曲线
图9(a)卫星实际角速度响应曲线
图9(b)卫星姿态四元数响应曲线
图9(c)卫星欧拉角机动响应曲线
图10不同n下的转子倾角响应曲线
图中,图中,1定子壳体2永磁转子3定子线圈4万向轴承
具体实施方式
本发明的三自由度动量交换姿态控制方法是在新型永磁球形电机动量交换装置中实现的。该新型球形 电机动量交换装置的角动量载体为球形转子,依靠电磁场直接驱动,在定子电流激励磁场作用下,能够实 现角动量大小与方向的同时独立控制,进而完成与卫星平台的三维动量交换。该装置与卫星的平台关系如 图1所示,立方体表示卫星平台,球体为球形动量交换装置,通过定子壳与卫星平台连接。坐标系O-xyz 为本体坐标系。卫星姿态控制流程如图2所示。
该装置基本结构如图3所示,主要由定转子两大部分组成。定子线圈为无铁心柱形结构,由铜漆包 线绕制,均匀紧密缠在绝缘硬塑材质的定子轴上。定子绕组共有24个,分为三层成放射状固定在由不导 磁材料构成的定子球壁上,每层8个,分别位于定子球壳的赤道、北纬30°、南纬30°位置。转子采 用表面粘贴式稀土钕铁硼永磁体励磁,这是由于采用二面角形以获得更均匀的磁场分布,永磁体共12块, 在转子上均匀分布;在转子赤道线的两侧,每层6个永磁体呈S、N极交替分布,与转子球体紧密贴合; 永磁体的充磁方式为平行充磁,方向是沿永磁体几何中心的法线方向,底部采用万向轮轴承将转子与定子 基座相连接。球形动量交换装置的几何剖面图如图4所示,几何参数及数值见表1。
表1球形动量交换装置几何参数及数值表
本发明的原理:球形电机作为一中结构简单、能量密度大的多自由度电机,球形转子可以作为角动量 的载体,通过电磁作用可以实现与卫星平台三自由度的动量交换;由于发明所提出球形动量交换装置定子 绕组空间排列的特殊性,使得其转子存在最大倾角限制,因此传统的反馈控制不适用于该新型动量交换装 置,需要采用一种在小角度范围内操作的控制策略。设动量交换装置转子存在一个最大倾斜角度δmax,本 装置设计的δmax=15°,为解决框架角受限的问题,采用了具有n级切换的增量式机动控制,是把姿态大角 度控制目标分为n级小角度逐步控制以减少对球形转子的倾角要求。首先由姿态控制指令q4求得控制旋转 欧拉角ψref,然后将控制旋转欧拉角分为n级小的旋转欧拉角ψk以逐步机动控制;对于每一级ψk确定其参 考坐标系系N下控制力矩Tk,并将其变换到虚框架坐标系V下以便于求出控制轨迹指令然后将控制轨迹变换到转子坐标系R下进行轨迹跟踪控制,装置输出力矩作用于卫星平台,完 成三自由动量交换。根据机动过程中转子倾角是否超出最大倾角限制,调整增量分级n。
为了使本技术领域的人员更好地理解本申请方案,下面将结合附图对本申请的具体实现方式进行描述。 (1)确定控制欧拉轴转角
取姿态控制指令q4作为输入量,以控制欧拉轴转角ψref作为输出量,确定控制欧拉轴转角: ψref=2arccos(q4)
其中,q4为姿态控制指令,是姿态四元数的标量分量,ψref是卫星控制欧拉轴转角;
(2)确定分级控制欧拉轴转角
以(1)中的控制欧拉轴转角ψref为输入量,各级控制欧拉轴转角ψk为输出量,确定分级数n和各级 控制欧拉轴转角:
其中,ψk是第k次增量机动的控制欧拉轴转角,k是增量机动的次序,取值为{1,2,…,n},n是设定 的总的增量机动级数,tk表示第k次机动期望完成时刻,t0=0;
(3)确定各级增量控制力矩
以各级控制欧拉轴转角ψk和期望完成时刻tk为输入量,各级增量控制力矩Tk为输出量,确定各级增 量控制力矩:
Tk=4Jψk/(tk-tk-1)2*[q1 q2 q3]T
其中,Tk为参考坐标系N下第k级增量机动的控制力矩矢量,J表示卫星绕欧拉轴的转动惯量, [q1 q2 q3]T是姿态四元数的向量分量,也即欧拉轴;
然后将控制力矩Tk从参考坐标系N变换到球形转子虚框架坐标系V以便于求取轨迹控制指令:
τk=[τt τg τh]T=Cvn*Tk,
其中,τk是虚框架坐标系V下的控制力矩分量列阵,τh是类飞轮变速转矩分量,τt是由卫星转动产 生的陀螺进动力矩分量,τg是转子倾斜加速转矩分量,Cvn为参考坐标系N到虚框架坐标系V的变换矩阵。
图5为本发明的瞬时虚拟框架与转子角速度合成示意图,如图5(a)所示,在任意时刻球形转子都存在 一个虚拟单框架,其框架转动惯量为零,由该虚拟框架可以确定一套新的坐标系V,将转子自转角动量方 向定义为轴,轴与转子瞬时倾斜角动量方向也即虚拟框架转轴重合,轴可由右手定则确定。图5(b) 中,ωrotor表示球形转子的角速度向量,Ω分别是转子角速度在虚框架坐标轴g、t上的投影分量,表 示球形转子本体倾斜角速率、自转角速率。
图6为本发明的NBR NBR坐标系示意图,N坐标系为参考坐标系,B坐标系为卫星本体坐标系,R坐标 系为球形转子坐标系。
(4)确定球形转子轨迹控制指令
利用动量矩定理,建立球形动量交换装置的动力学模型:
由力矩控制指令求得球形转子的控制轨迹的计算公式为:
其中,Ω分别是转子角速度在虚框架坐标轴g、t上的投影分量,表示球形转子本体倾斜角速率、 自转角速率;分别是转子角加速度在虚框架坐标轴g、t上的投影分量,表示倾斜角加速度,自转 角加速度;Ig,It,Ih分别是球形转子关于虚拟坐标轴t、g、h的转动惯量分量;ωBg,ωBt分别是卫星 平台角速度ωB在虚拟坐标系轴g、t上的投影分量;
(5)对球形转子进行轨迹跟踪控制
将(4)中球形转子虚框架坐标系V下的控制轨迹指令变换到转子坐标系R下以进行轨迹跟踪控制:
其中,B为从V坐标系到转子坐标系R的变换矩阵;转子坐标系R是附着于球形转子上的dqp坐标系; 为欧拉角速度,为欧拉角加速度;
(6)调整增量分级n
球形动量装置跟踪轨迹控制指令,输出力矩作用于卫星平台,完成三自由度角动量交换。机动过程中 若超过转子最大倾角,则应适当增大(2)中的增量分级n。
如图7所示,轨迹跟踪控制主要由电气回环和动力学回环。电气部分由定子电流环提供期望开关信号, 动力部分为位置回环。球形动量装置采用转矩分配的轨迹跟踪控制,转子轨迹跟踪指令位置θd和指令位置 微分
(7)仿真分析:
为验证本发明所提出的控制策略的有效性,利用Matlab/Simulink仿真平台对该新型动量交换装置与 卫星平台进行了联合建模与仿真,结果与理论期望一致,验证了方案的合理性。仿真参数见表2:
表2仿真参数及数值
仿真结果分析:
图8(a)为倾斜指令力矩与动量交换装置实际输出力矩;图8(b)为自转加速度指令力矩与装置实 际输出力矩;图8(c)为转子倾角响应曲线;图8(d)为转子倾角速率响应曲线;图9(a)卫星实际角 速度响应曲线;图9(b)为卫星姿态四元数响应曲线;图9(c)为卫星欧拉角机动响应曲线;图10为不 同n下的转子倾角响应曲线。从图8(a)、(b)可以看出,球形动量交换装置可以很好的跟踪期望力矩; 图8(c)、(d)表明在n=4时,卫星机动过程中,转子最大倾角为0.262,约等于|±15°|;图9可见卫星 平台在24秒机动时间内按照期望要求完成了4次增量式机动,运动效果由四元数法和欧拉角两种表示; 图10显示了不同n下的转子倾角响应曲线,满足物理限制。仿真验证了本文提出的基于新型球形动量交 换装置及欧拉轴n级增量控制策略的有效性。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
机译: 一种基于单动力的抓取机构的控制方法,因为基于单动力的抓取机构包括驱动辊,驱动电机,从动辊和带,其中,该方法包括:1)检测罗迪惯性矩I1 Llo驱动器,驱动辊的半径R。从动辊的R和惯性矩(2,2)控制驱动电机的制动转矩M1;系统。
机译: 一种基于并行数据传输的ISDN交换机融合数据存储装置及其控制方法
机译: 一种基于数字程序的由机电机构“全有或全无”操作并使用机器运行速度变量的控制方法。实施该方法的设备以及该方法在针织机控制中的应用