CN111624873A - 一种三轴惯性稳定平台***伺服回路变增益控制方法 - Google Patents
一种三轴惯性稳定平台***伺服回路变增益控制方法 Download PDFInfo
- Publication number
- CN111624873A CN111624873A CN202010409047.9A CN202010409047A CN111624873A CN 111624873 A CN111624873 A CN 111624873A CN 202010409047 A CN202010409047 A CN 202010409047A CN 111624873 A CN111624873 A CN 111624873A
- Authority
- CN
- China
- Prior art keywords
- shaft
- axis
- coordinate system
- table body
- inertia
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 239000011159 matrix material Substances 0.000 claims abstract description 8
- 230000003068 static effect Effects 0.000 claims abstract description 7
- 238000004364 calculation method Methods 0.000 claims description 16
- 238000004804 winding Methods 0.000 claims description 11
- 238000005259 measurement Methods 0.000 claims description 8
- 238000012546 transfer Methods 0.000 claims description 7
- 238000013461 design Methods 0.000 claims description 4
- 238000004458 analytical method Methods 0.000 claims description 3
- 230000006641 stabilisation Effects 0.000 claims description 2
- 238000011105 stabilization Methods 0.000 claims description 2
- 230000002194 synthesizing effect Effects 0.000 claims description 2
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims 1
- 230000008859 change Effects 0.000 abstract description 6
- 230000008878 coupling Effects 0.000 description 4
- 238000010168 coupling process Methods 0.000 description 4
- 238000005859 coupling reaction Methods 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0205—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
- G05B13/024—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明提供了一种三轴惯性稳定平台***伺服回路变增益控制方法,通过实时测量框架角度的值来计算转动惯量矩阵范数,以正实时修正伺服回路控制器的增益,消除转动惯量的变化对伺服回路的静态精度和动态精度影响。本发明首次给出了在载体相对平台台体任意姿态时的伺服回路单输入单输出控制方法,确保台体始终保持惯性空间稳定,实现了载体采用三轴稳定平台***后的无约束轨迹运动。
Description
技术领域
本发明涉及一种三轴稳定平台***伺服回路变增益控制方法,尤其涉及三轴平台***的伺服回路控制方法,主要用于实现全姿态高精度导航的航空、航天领域。
背景技术
三轴惯性稳定平台***能有效隔离运动载体的角运动扰动,使得惯性测量单元相对于惯性空间保持稳定,其包括台体、内框架、外框架和基座,其中,惯性测量单元安装在台体内,基座固连在运动载体上。其中,内框架和外框架组成的框架***,用于为台体提供相对基座的旋转自由度,但由于框架***和台体间存在着相对运动约束,所以框架***的运动会对台体带来影响。这些影响包含基座与台体间的坐标变换、力矩变换,以及框架***惯性干扰力矩对台体的作用等。
在惯性稳定平台伺服***工作时,框架***的转动惯量最终通过惯性干扰力矩对台体的作用体现出来,包括转动惯量间的耦合、惯量积的耦合等,但最关键的是框架转动惯量在台体上的耦合。另外,为使台体相对惯性空间稳定,在台体上安装了三个陀螺仪作为伺服回路的敏感元件,但由于作为伺服回路执行机构的三个力矩电机分别装在台体轴、内框架轴和外框架轴上,在不同框架角时伺服回路存在着耦合。βyk为外框架绕内框架坐标系Yp1轴转动的角度;βzk为内框架绕台体坐标系Zp轴转动的角度。
现有技术中都是取βyk、βzk为零时计算的转动惯量常值作为设计输入,这会带来以下两个问题:1.βyk、βzk为非零时的转动惯量的变化会导致***的带宽变化,从而引起幅值裕度和相位裕度变化,影响伺服回路的稳定性;2.βyk、βzk为非零时的转动惯量的变化会引起伺服回路的静态精度和动态精度,因此,急需开展三轴惯性稳定平台***伺服回路控制方法研究。
发明内容
本发明的目的在于克服现有技术的不足,提供一种三轴惯性稳定平台***伺服回路变增益控制方法,该方法可实现框架角变化时伺服回路性能保持不变,可以有效提高台体相对惯性空间的稳定精度和能力。
本发明的上述目的通过以下技术方案实现:一种三轴惯性稳定平台***伺服回路变增益控制方法,其特征在于:基于三轴惯性稳定平台***实现,所述稳定平台***包括基座、外框架、内框架和台体,其中,外框架通过外框架轴与基座连接,内框架通过内框架轴与外框架连接,台体通过台体轴与内框架连接,对应的本体坐标系分别为基座本体坐标系X1Y1Z1、外框架本体坐标系Xp2Yp2Zp2、内框架本体坐标系Xp1Yp1Zp1和台体本体坐标系XpYpZp;所述四个坐标系的原点重合,并且:台体本体坐标系的Zp轴与内框架本体坐标系的Zp1轴重合,外框架的本体坐标系的Yp2轴与内框架本体坐标系的Yp1轴重合,基座本体坐标系的X1轴与外框架本体坐标系的Xp2轴重合;其中,基座与载体固定连接,在所述稳定平台***在载体带动下发生内部相对转动时,基座绕外框架坐标系的Xp2轴转动,外框架绕内框架坐标系的Yp1轴转动,内框架绕台体坐标系的Zp轴转动;
所述三轴惯性稳定平台***伺服回路变增益控制方法包括如下步骤:
(2)将台体在Zp轴上的角速度分量经过解耦后得到台体Zp轴的合成转动角速度ωz;将台体在Yp轴上的角速度分量经过解耦后得到内框架Yp1轴的合成转动角速度ωy;将台体在Xp轴上的角速度分量经过解耦后得到外框架Xp2轴的合成转动角速度ωx;
(3)得到外框架绕内框架本体坐标系的Yp1轴转动的角度βyk=0并且内框架绕台体本体坐标系的Zp轴转动的角度βzk=0时的转动惯量:
其中,分别为台体相对于Xp轴、Yp轴、Zp轴的转动惯量;分别为内框架相对于Xp1轴、Yp1轴轴的转动惯量;分别为外框架相对于Xp2轴、Yp2轴的转动惯量,为βyk=0、并且βzk=0时的台体本体坐标系的Xp轴合成转动惯量,为βyk=0并且、βzk=0时的台体本体坐标系的Yp轴合成转动惯量,为βyk=0并且、βzk=0时的台体本体坐标系的Zp轴合成转动惯量;
(4)分别把作为Xp轴、Yp轴和Zp轴伺服回路的被控对象,根据性能指标要求设计控制器,得到台体本体坐标系的Xp轴控制器为Cx,0(s)、台体本体坐标系的Yp轴控制器为Cy,0(s)、台体本体坐标系的Zp轴控制器为的控制器分别为Cx,0(s)、Cy,0(s)、Cz,0(s);其中,为力矩电机的传递函数,T为电机的时间常数,K0为电机的输出比例系数;ux、uy、uz分别为Xp轴、Yp轴和Zp轴伺服回路力矩电机的输入量;s为复变角频率,ωx(s)为Xp轴角速度ωx(t)的拉氏变换,ux(s)为Xp轴控制器输出量ux(t)的拉氏变换,ωy(s)为Yp轴角速度ωy(t)的拉氏变换,uy(s)为Yp轴控制器输出量uy(t)的拉氏变换,ωz(s)为Zp轴角速度ωz(t)的拉氏变换,uz(s)为Zp轴控制器输出量uz(t)的拉氏变换;t为时间变量;
(5)当基座相对于台体处于任意姿态时,实时测量出βyk和βzk的值,计算出||Jp||的值;结合步骤(4)的台体本体坐标系的Xp轴控制器为Cx,0(s)、台体本体坐标系的Yp轴控制器为Cy,0(s)、台体本体坐标系的Zp轴控制器为Cz,0(s),得到一组新的三轴平台伺服回路变增益控制器:
其中,Cx(s)为根据测量角度βyk、和βzk计算的Xp轴控制器,Cy(s)为根据测量角度βyk、和βzk计算的Yp轴控制器,Cz(s)为根据测量角度βyk、和βzk计算的Zp轴控制器,Jp为三轴惯性稳定平台***的台体合成转动惯量矩阵。
上述三轴惯性稳定平台***伺服回路变增益控制方法中,在步骤(2)中,解耦的步骤为:
(21)得到三轴惯性稳定平台***内部相对转动的角度,包括:外框架绕内框架坐标系Yp1轴转动的角度βyk;内框架绕台体坐标系Zp轴转动的角度βzk;
(22)得到三轴惯性稳定平台***的转动惯量,包括:台体相对于Xp轴、Yp轴、Zp轴的转动惯量的内框架相对于Xp1轴、Yp1轴、Zp1轴的转动惯量的外框架相对于Xp2轴、Yp2轴、Zp2轴的转动惯量的
(23)得到三轴惯性稳定平台***的台体合成转动惯量矩阵Jp,包括:合成到台体Xp轴上的主转动惯量合成到台体Yp轴上的主转动惯量对Xp轴和YP轴的合成转动惯量积Jxy、对Xp轴和ZP轴的合成转动惯量积Jxz、对Yp轴和ZP轴的合成转动惯量积Jyz;具体计算公式如下:
式中,
(24)计算台体、内框架和外框架的合成转动角速度,具体计算公式如下:
写为分量表达式,为
其中,ωz为台体Zp轴的合成转动角速度;ωy为内框架Yp1轴的合成转动角速度;ωx为外框架Xp2轴的合成转动角速度。
上述三轴惯性稳定平台***伺服回路变增益控制方法中,在步骤(4)中,性能指标要求包括静态精度指标、动态精度指标和对象不确定性指标;其中,
动态精度指标为:
对象不确定性指标为:
上述三轴惯性稳定平台***伺服回路变增益控制方法中,在步骤(4)中,Cx,0(s)、Cy,0(s)、Cz,0(s)的典型值为:
上述三轴惯性稳定平台***伺服回路变增益控制方法中,在步骤(5)中,三轴惯性稳定平台***内部相对转动角度通过如下方法得到:
在内框架的Yp1轴上安装角度传感器,测量得到外框架绕内框架本体坐标系的Yp1轴转动的角度βyk;在台体Zp轴上安装角度传感器,测量得到内框架绕台体本体坐标系的Zp轴转动的角度βzk。
上述三轴惯性稳定平台***伺服回路变增益控制方法中,在步骤(3)中,当三轴惯性稳定平台***的结构确定后,通过有限元分析方法计算得到所述平台的转动惯量,或对所述三轴惯性稳定平台***进行测量得到转动惯量。
上述三轴惯性稳定平台***伺服回路变增益控制方法中,在步骤(5)中,||Jp||取1-范数、2-范数或∞-范数,具体计算公式为:
上述三轴惯性稳定平台***伺服回路变增益控制方法中,在步骤(5)中,外框架绕内框架本体坐标系的Yp1轴转动的角度βyk的取值范围为0~360°;内框架绕台体本体坐标系的Zp轴转动的角度βzk的取值范围为0~360°。
本发明与现有技术相比具有以下优点:
(1)、本发明克服了在全姿态条件下βyk、βzk为非零时转动惯量的变化引起***带宽变化而引起幅值裕度和相位裕度变化造成伺服回路稳定性下降的问题,实现了全姿态条件下的鲁棒稳定性;
(2)、本发明克服了在全姿态条件下βyk、βzk为非零时转动惯量的变化引起伺服回路的静态精度和动态精度下降的问题,实现了全姿态条件下的精度保持能力;
(3)、本发明在计算过程不存在无解区域,可以覆盖任意姿态角的情况,相比现有的计算方法更准确、适用性更广。
附图说明
图1为三轴惯性稳定平台***中三个本体坐标系之间的关系示意图;
图2为本发明的三轴惯性稳定平台***的伺服回路解耦方法流程图;
图3为采用本发明的平台***伺服回路流程图;
图4为解耦后的平台***伺服回路流程图;
图5为本发明示例中三轴平台的转动惯量矩阵范数||Jp||2在βyk、βzk为±180°的范围内的值;
图6为本发明示例中伺服回路开环伯德图;
图7为本发明示例中伺服回路开环传递函数变化时的伯德图;
图8为本发明示例中伺服回路单位阶跃响应曲线。
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细的描述:
一种三轴惯性稳定平台***的伺服回路解耦方法,基于三轴惯性稳定平台***实现,所述稳定平台***包括基座、外框架、内框架和台体,对应的本体坐标系分别为基座本体坐标系X1Y1Z1、外框架本体坐标系Xp2Yp2Zp2、内框架本体坐标系Xp1Yp1Zp1和台体本体坐标系XpYpZp;所述四个坐标系的原点重合,并且:台体本体坐标系的Zp轴与内框架本体坐标系的Zp1轴重合,外框架的本体坐标系的Yp2轴与内框架本体坐标系的Yp1轴重合,基座本体坐标系的X1轴与外框架本体坐标系的Xp2轴重合;其中,基座与载体固连,在所述稳定平台***在载体带动下发生内部相对转动时,基座绕外框架坐标系的Xp2轴转动,外框架绕内框架坐标系的Yp1轴转动,内框架绕台体坐标系的Zp轴转动;
如图1所示的四个坐标系的关系示意图,这四个本体坐标系的原点重合,并且存在如下相对约束关系:台体本体坐标系的Zp轴与内框架本体坐标系的Zp1轴重合,外框架的本体坐标系的Yp2轴与内框架本体坐标系的Yp1轴重合,基座本体坐标系的X1轴与外框架本体坐标系的Xp2轴重合;其中,基座与载体固连,在所述稳定平台***在载体带动下发生内部相对转动时,基座绕外框架坐标系的Xp2轴转动且转动角度为βxk,外框架绕内框架坐标系的Yp1轴转动且转动角度为βyk,内框架绕台体坐标系的Zp轴转动且转动角度为βzk。
如图2所示,该三轴惯性稳定平台***伺服回路变增益控制方法的步骤如下:
(2)、经过解耦后,得到台体Zp轴的合成转动角速度ωz、内框架Yp1轴的合成转动角速度ωy;外框架Xp2轴的合成转动角速度ωx;
(3)、计算或测量出框架归零(βyk=0、βzk=0)时的转动惯量:
(4)、分别把作为Xp轴、Yp轴和Zp轴伺服回路的被控对象,根据性能指标要求进行控制器的设计,求得的控制器分别为Cx,0(s)、Cy,0(s)、Cz,0(s);式中,为力矩电机的传递函数,T为电机的时间常数,K0为电机的输出比例系数;ux、uy、uz为Xp轴、Yp轴和Zp轴伺服回路力矩电机的输入量;
(5)、当基座相对于平台台体处于任意姿态时,实时测量出βyk、βzk的值,计算出||Jp||的值;结合步骤(4)的控制器Cx,0(s)、Cy,0(s)、Cz,0(s),可得到一组新的三轴平台伺服回路变增益控制器
在设计三轴惯性稳定平台***的伺服回路控制器时,需要进行解耦,如图3所示。在图中,第一个解耦器TJ实现转动惯量的解耦,第二个解耦器TM实现力矩的解耦
式中,
为台体相对于Xp轴、Yp轴、Zp轴的转动惯量; 为内框架相对于Xp1轴、Yp1轴、Zp1轴的转动惯量;为外框架相对于Xp2轴、Yp2轴、Zp2轴的转动惯量;βyk为外框架绕内框架坐标系Yp1轴转动的角度;βzk为内框架绕台体坐标系Zp轴转动的角度。
||Jp||的计算方法可取1-范数、2-范数或∞-范数,具体计算公式为
在经过转动惯量解耦、力矩解耦后,可把平台***伺服回路简化为三个相对独立的单输入单输出回路,如图4所示。但由于在全姿态条件下,||Jp||的值并不是常值,而是一个随着框架角变化的量,如图5所示。
在步骤(2)中的解耦步骤为:
(21)、测量得到所述稳定平台***内部相对转动的角度,包括:外框架绕内框架坐标系Yp1轴转动的角度βyk;内框架绕台体坐标系Zp轴转动的角度βzk;
(22)、测量或计算得到三轴惯性稳定平台***的转动惯量,包括:台体相对于Xp轴、Yp轴、Zp轴的转动惯量的内框架相对于Xp1轴、Yp1轴、Zp1轴的转动惯量的外框架相对于Xp2轴、Yp2轴、Zp2轴的转动惯量的
(23)、计算所述稳定平台***的台体合成转动惯量矩阵Jp,包括:合成到台体Xp轴上的主转动惯量合成到台体Yp轴上的主转动惯量对轴Xp和YP的合成转动惯量积Jxy、对轴Xp和ZP的合成转动惯量积Jxz、对轴Yp和ZP的合成转动惯量积Jyz;具体计算公式如下:
式中,
(24)、计算台体、内框架和外框架的合成转动角速度,具体计算公式如下:
写为分量表达式,为
其中,ωz为台体Zp轴的合成转动角速度;ωy为内框架Yp1轴的合成转动角速度;ωx为外框架Xp2轴的合成转动角速度。
在步骤(4)中,性能指标要求包括静态精度指标、动态精度指标和对象不确定性指标:
(1)静态精度指标为伺服回路为一个II型***,因此,需增加一个积分环节;
(2)动态精度主要考虑在低频段尽量增加伺服回路的力矩刚度,性能界函数为
式中,M为干扰力矩,φmax为台体相对惯性空间的最大转角误差,J为对应轴的转动惯量;
精度指标为
(3)对象不确定性主要考虑高频未建模特性,权函数为
对象不确定性指标为
由于精度指标和对象不确定性指标是一对矛盾量,因此,在设计控制器时需要在上述两个指标之间取折中。
在步骤(4)中,控制器Cx,0(s)、Cy,0(s)、Cz,0(s)的典型值为:
在步骤(5)中,通过如下方法测量得到三轴惯性稳定平台***内部相对转动角度:在内框架的Yp1轴上安装角度传感器,测量得到外框架绕内框架本体坐标系的Yp1轴转动的角度βyk;在台体Zp轴上安装传感器测量内框架绕台体本体坐标系的Zp轴转动的角度βzk。
在步骤(3)中,当三轴惯性稳定平台***的结构确定后,通过有限元分析方法计算得到所述平台的转动惯量,或对所述三轴惯性稳定平台***进行测量得到转动惯量。
在步骤(5)中,||Jp||的可取1-范数、2-范数或∞-范数,具体计算公式为
在步骤(5)中,转动角度βyk、βzk的取值范围为0~360°。
为形象说明本发明提供的基于克雷洛夫角奇异条件下的姿态角解算方法,优选的实施例为:
例1:设三轴平台的转动惯量矩阵范数||Jp||2在βyk、βzk为±180°的范围内的值如图5所示,其中,当βyk、βzk为0°时的 从图中可以看出,随着βyk从0°至90°变化时,||Jp||2会逐渐变大,当βyk=90°、βzk=0°时,
由于||Jp||2为一个与框架角相关的变量,为此,在设计控制器时,先取βyk、βzk为0°时的转动惯量作为常值,以Xp伺服回路为例,设计的控制器为
伺服回路开环传递函数如图6所示,可以看出,在带宽范围内的低频段,开环传递函数幅值大于性能界函数的值,而在带宽范围外的高频段,开环传递函数幅值小于对象不确定性的值;伺服回路的带宽为163.2rad/s,相位裕度为53.9°,满足设计要求。
当βyk=90°、βzk=0°时,伺服回路带宽减小为157.3rad/s,相位裕度为51.8°,如图7中虚线所示。从图中可以看出,伺服回路仍然稳定,但由于增益下降会引起精度下降、快速响应能力变弱。如图8所示,图中虚线为βyk=90°、βzk=0°时无增益补偿时的伺服回路单位阶跃响应,实现为本发明变增益控制的伺服回路单位阶跃响应,可以看出,本发明变增益控制具有响应时间快、超调量小、精度高的优点。
以上所述,仅为本发明一个具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (8)
1.一种三轴惯性稳定平台***伺服回路变增益控制方法,其特征在于:基于三轴惯性稳定平台***实现,所述稳定平台***包括基座、外框架、内框架和台体,其中,外框架通过外框架轴与基座连接,内框架通过内框架轴与外框架连接,台体通过台体轴与内框架连接,对应的本体坐标系分别为基座本体坐标系X1Y1Z1、外框架本体坐标系Xp2Yp2Zp2、内框架本体坐标系Xp1Yp1Zp1和台体本体坐标系XpYpZp;所述四个坐标系的原点重合,并且:台体本体坐标系的Zp轴与内框架本体坐标系的Zp1轴重合,外框架的本体坐标系的Yp2轴与内框架本体坐标系的Yp1轴重合,基座本体坐标系的X1轴与外框架本体坐标系的Xp2轴重合;其中,基座与载体固定连接,在所述稳定平台***在载体带动下发生内部相对转动时,基座绕外框架坐标系的Xp2轴转动,外框架绕内框架坐标系的Yp1轴转动,内框架绕台体坐标系的Zp轴转动;
所述三轴惯性稳定平台***伺服回路变增益控制方法包括如下步骤:
(2)将台体在Zp轴上的角速度分量经过解耦后得到台体Zp轴的合成转动角速度ωz;将台体在Yp轴上的角速度分量经过解耦后得到内框架Yp1轴的合成转动角速度ωy;将台体在Xp轴上的角速度分量经过解耦后得到外框架Xp2轴的合成转动角速度ωx;
(3)得到外框架绕内框架本体坐标系的Yp1轴转动的角度βyk=0并且内框架绕台体本体坐标系的Zp轴转动的角度βzk=0时的转动惯量:
其中,分别为台体相对于Xp轴、Yp轴、Zp轴的转动惯量;分别为内框架相对于Xp1轴、Yp1轴轴的转动惯量;分别为外框架相对于Xp2轴、Yp2轴的转动惯量,为βyk=0、并且βzk=0时的台体本体坐标系的Xp轴合成转动惯量,为βyk=0并且、βzk=0时的台体本体坐标系的Yp轴合成转动惯量,为βyk=0并且、βzk=0时的台体本体坐标系的Zp轴合成转动惯量;
(4)分别把作为Xp轴、Yp轴和Zp轴伺服回路的被控对象,根据性能指标要求设计控制器,得到台体本体坐标系的Xp轴控制器为Cx,0(s)、台体本体坐标系的Yp轴控制器为Cy,0(s)、台体本体坐标系的Zp轴控制器为的控制器分别为Cx,0(s)、Cy,0(s)、Cz,0(s);其中,为力矩电机的传递函数,T为电机的时间常数,K0为电机的输出比例系数;ux、uy、uz分别为Xp轴、Yp轴和Zp轴伺服回路力矩电机的输入量;s为复变角频率,ωx(s)为Xp轴角速度ωx(t)的拉氏变换,ux(s)为Xp轴控制器输出量ux(t)的拉氏变换,ωy(s)为Yp轴角速度ωy(t)的拉氏变换,uy(s)为Yp轴控制器输出量uy(t)的拉氏变换,ωz(s)为Zp轴角速度ωz(t)的拉氏变换,uz(s)为Zp轴控制器输出量uz(t)的拉氏变换;t为时间变量;
(5)当基座相对于台体处于任意姿态时,实时测量出βyk和βzk的值,计算出||Jp||的值;结合步骤(4)的台体本体坐标系的Xp轴控制器为Cx,0(s)、台体本体坐标系的Yp轴控制器为Cy,0(s)、台体本体坐标系的Zp轴控制器为Cz,0(s),得到一组新的三轴平台伺服回路变增益控制器:
其中,Cx(s)为根据测量角度βyk、和βzk计算的Xp轴控制器,Cy(s)为根据测量角度βyk、和βzk计算的Yp轴控制器,Cz(s)为根据测量角度βyk、和βzk计算的Zp轴控制器,Jp为三轴惯性稳定平台***的台体合成转动惯量矩阵。
2.根据权利要求1所述的三轴惯性稳定平台***伺服回路变增益控制方法,其特征在于:在步骤(2)中,解耦的步骤为:
(21)得到三轴惯性稳定平台***内部相对转动的角度,包括:外框架绕内框架坐标系Yp1轴转动的角度βyk;内框架绕台体坐标系Zp轴转动的角度βzk;
(22)得到三轴惯性稳定平台***的转动惯量,包括:台体相对于Xp轴、Yp轴、Zp轴的转动惯量的内框架相对于Xp1轴、Yp1轴、Zp1轴的转动惯量的外框架相对于Xp2轴、Yp2轴、Zp2轴的转动惯量的
(23)得到三轴惯性稳定平台***的台体合成转动惯量矩阵Jp,包括:合成到台体Xp轴上的主转动惯量合成到台体Yp轴上的主转动惯量对Xp轴和YP轴的合成转动惯量积Jxy、对Xp轴和ZP轴的合成转动惯量积Jxz、对Yp轴和ZP轴的合成转动惯量积Jyz;具体计算公式如下:
式中,
(24)计算台体、内框架和外框架的合成转动角速度,具体计算公式如下:
写为分量表达式,为
其中,ωz为台体Zp轴的合成转动角速度;ωy为内框架Yp1轴的合成转动角速度;ωx为外框架Xp2轴的合成转动角速度。
5.根据权利要求1所述的三轴惯性稳定平台***伺服回路变增益控制方法,其特征在于:在步骤(5)中,三轴惯性稳定平台***内部相对转动角度通过如下方法得到:
在内框架的Yp1轴上安装角度传感器,测量得到外框架绕内框架本体坐标系的Yp1轴转动的角度βyk;在台体Zp轴上安装角度传感器,测量得到内框架绕台体本体坐标系的Zp轴转动的角度βzk。
6.根据权利要求1所述的三轴惯性稳定平台***伺服回路变增益控制方法,其特征在于:在步骤(3)中,通过有限元分析方法计算得到所述平台的转动惯量,或对所述三轴惯性稳定平台***进行测量得到转动惯量。
8.根据权利要求1所述的轴惯性稳定平台***伺服回路变增益控制方法,其特征在于:在步骤(5)中,外框架绕内框架本体坐标系的Yp1轴转动的角度βyk的取值范围为0~360°;内框架绕台体本体坐标系的Zp轴转动的角度βzk的取值范围为0~360°。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010409047.9A CN111624873B (zh) | 2020-05-14 | 2020-05-14 | 一种三轴惯性稳定平台***伺服回路变增益控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010409047.9A CN111624873B (zh) | 2020-05-14 | 2020-05-14 | 一种三轴惯性稳定平台***伺服回路变增益控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111624873A true CN111624873A (zh) | 2020-09-04 |
CN111624873B CN111624873B (zh) | 2022-08-12 |
Family
ID=72258117
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010409047.9A Active CN111624873B (zh) | 2020-05-14 | 2020-05-14 | 一种三轴惯性稳定平台***伺服回路变增益控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111624873B (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6566775B1 (en) * | 2000-01-10 | 2003-05-20 | Richard Benito Fradella | Minimal-loss flywheel battery and related elements |
CN109270946A (zh) * | 2018-11-13 | 2019-01-25 | 北京航空航天大学 | 挠性航天器的姿态控制方法 |
CN110941285A (zh) * | 2019-11-29 | 2020-03-31 | 云南大学 | 一种基于双ip核的无人机飞行控制*** |
-
2020
- 2020-05-14 CN CN202010409047.9A patent/CN111624873B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6566775B1 (en) * | 2000-01-10 | 2003-05-20 | Richard Benito Fradella | Minimal-loss flywheel battery and related elements |
CN109270946A (zh) * | 2018-11-13 | 2019-01-25 | 北京航空航天大学 | 挠性航天器的姿态控制方法 |
CN110941285A (zh) * | 2019-11-29 | 2020-03-31 | 云南大学 | 一种基于双ip核的无人机飞行控制*** |
Non-Patent Citations (1)
Title |
---|
殷春武 等: ""无角速度测量的姿态跟踪动态PD控制"", 《电机与控制学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN111624873B (zh) | 2022-08-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108759845B (zh) | 一种基于低成本多传感器组合导航的优化方法 | |
CN106052682B (zh) | 一种混合式惯性导航***及导航方法 | |
KR20160101182A (ko) | 플랫폼 안정화 시스템 | |
CN109000612A (zh) | 设备的角度估算方法、装置、摄像组件及飞行器 | |
CN108681239B (zh) | 一种两轴一体陀螺加速度计解耦伺服控制回路***及方法 | |
CN105043414B (zh) | 一种三轴惯性稳定平台***的台体控制参数计算方法 | |
CN105021195A (zh) | 一种四轴惯性稳定平台***的伺服回路解耦方法 | |
CN104697521B (zh) | 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法 | |
CN111121824B (zh) | 一种mems传感器的标定方法 | |
CN111221347B (zh) | 垂直起降固定翼无人机姿态估计中加速度补偿方法及*** | |
JPH10318778A (ja) | 衛星の位置を機内で自主的に求める方法と装置 | |
CN107247459A (zh) | 抗干扰飞行控制方法及装置 | |
CN105115505A (zh) | 一种四轴惯性稳定平台***的二阶动态干扰力矩补偿方法 | |
CN110733672A (zh) | 一种控制力矩陀螺动态响应时延特性闭环补偿方法 | |
CN111006663B (zh) | 一种基于serf陀螺仪和速率陀螺仪的三轴惯性平台*** | |
CN107102546B (zh) | 一种惯性平台混合式伺服控制回路 | |
CN105115503B (zh) | 一种三轴稳定平台***的伺服回路解耦方法 | |
CN109649691A (zh) | 一种偏置动量卫星单飞轮与磁联合控制方法和*** | |
CN109443352B (zh) | 一种四轴惯性稳定平台***的伺服回路解耦方法 | |
CN112577514A (zh) | 一种mems惯性器件的标定方法 | |
CN111665872B (zh) | 基于等效变换的两轴两框架稳定控制方法 | |
CN111624873B (zh) | 一种三轴惯性稳定平台***伺服回路变增益控制方法 | |
CN105277212B (zh) | 一种三轴惯性稳定平台***的二阶动态干扰力矩补偿方法 | |
CN112198797A (zh) | 一种无人机高度多级控制***及方法 | |
CN104034347B (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 |