CN112433532A - 考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法 - Google Patents
考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法 Download PDFInfo
- Publication number
- CN112433532A CN112433532A CN201910792494.4A CN201910792494A CN112433532A CN 112433532 A CN112433532 A CN 112433532A CN 201910792494 A CN201910792494 A CN 201910792494A CN 112433532 A CN112433532 A CN 112433532A
- Authority
- CN
- China
- Prior art keywords
- steering engine
- decoupling
- aircraft
- rudder
- real time
- 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 28
- 230000001133 acceleration Effects 0.000 claims description 17
- 238000005259 measurement Methods 0.000 claims description 15
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000008878 coupling Effects 0.000 description 10
- 238000010168 coupling process Methods 0.000 description 10
- 238000005859 coupling reaction Methods 0.000 description 10
- 230000004044 response Effects 0.000 description 9
- 230000008569 process Effects 0.000 description 6
- 238000004088 simulation Methods 0.000 description 6
- 230000008901 benefit Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 5
- 238000013461 design Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 238000005096 rolling process Methods 0.000 description 3
- 230000010354 integration Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000002411 adverse Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000001808 coupling effect Effects 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 238000009987 spinning Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种考虑二阶舵机动力学的解耦自驾仪及控制方法,该***包括用以接收制导***实时传递出的需用过载信息的需用过载接收模块,用于实时获得飞行器的飞行参数的飞行器参数测量模块,和获得完全解耦且考虑二阶舵机动力学滞后的舵指令的考虑二阶舵机动力学的解耦控制模块,其中,根据需用过载信息和飞行器的飞行参数获得控制解耦的舵指令,再结合飞行器的飞行参数获得考虑舵机动力学滞后且控制解耦的舵指令,再结合飞行器的飞行参数获得完全解耦且考虑二阶舵机动力学滞后的舵指令,据此控制舵机打舵工作。
Description
技术领域
本发明涉及一种旋转飞行器的控制***及方法,具体涉及一种考虑二阶舵机动力学的解耦自驾仪及控制方法。
背景技术
旋转飞行器通过采用自旋的方式可以带来诸多益处,如有效降低飞行器结构设计偏差对飞行器弹道的影响、简化控制***设计、省略滚转控制机构等等。但该类飞行器在带来诸多益处的同时也存在一些弊端。由于飞行器自旋后会产生较大的滚转角速度,这使得飞行器产生了气动耦合、惯性耦合以及控制耦合等特性,使得俯仰通道和偏航通道间相互耦合交联,不利于对飞行器俯仰、偏航两通道进行精确控制。除此之外,舵机的滞后特性对旋转飞行器的控制有着较大的影响,因此在设计自驾仪的时候有必要考虑舵机环节对飞行器控制***的影响,而传统的设计方法往往默认舵机为一阶惯性环节,这种方法忽略了旋转飞行器的控制耦合特性,且舵机模型建立不够精确,这增加了所设计自驾仪的风险性,而如果将舵机认定为二阶惯性环节,旋转飞行器动力学模型为八阶***,模型较为复杂,且在解算过程中会涉及到求逆运算,八阶***求逆过于困难,飞行器的处理设备难以及时解算完成;这些问题为旋转飞行器控制***的精确稳定控制带来了较为严峻的挑战;
现有技术中,在实际控制旋转飞行器的过程中,都是忽略了上述耦合的影响和二阶惯性环节,所以飞行器的实际控制过程中存在一定的偏差,不过最终的制导控制效果还有待提高。
为了解决上述问题,有必要设计一种考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法,从而保证对飞行器的精确控制。
发明内容
为了克服上述问题,本发明人进行了锐意研究,设计出一种考虑二阶舵机动力学的解耦自驾仪及控制方法,该***包括用以接收制导***实时传递出的需用过载信息的需用过载接收模块,用于实时获得飞行器的飞行参数的飞行器参数测量模块,和获得完全解耦且考虑二阶舵机动力学滞后的舵指令的考虑二阶舵机动力学的解耦控制模块,其中,根据需用过载信息和飞行器的飞行参数获得控制解耦的舵指令,再结合飞行器的飞行参数获得考虑舵机动力学滞后且控制解耦的舵指令,再结合飞行器的飞行参数获得完全解耦且考虑二阶舵机动力学滞后的舵指令,据此控制舵机打舵工作,从而完成本发明。
具体来说,本发明的目的在于提供一种考虑二阶舵机动力学的解耦自驾仪,该***安装在旋转飞行器上,该***包括
需用过载接收模块1,其与旋转飞行器上的制导***相连,用以接收制导***实时传递出的需用过载信息,
飞行器参数测量模块2,其用于实时获得飞行器的飞行参数,和
考虑二阶舵机动力学的解耦控制模块3,其用于实时根据需用过载信息和飞行器的飞行参数获得完全解耦且考虑二阶舵机动力学滞后的舵指令。
其中,所述飞行器参数测量模块2包括舵机姿态传感器21、舵机角速率传感器22、加速度计23、惯性陀螺24和估测器25;
其中,所述舵机姿态传感器21用于实时测量得到飞行器的俯仰舵偏角信息和偏航舵偏角信息,
所述舵机角速率传感器22用于实时测量得到飞行器的俯仰舵机角速率信息和偏航舵机角速率信息,
所述加速度计23用于实时测量得到飞行器的加速度信息,
所述惯性陀螺24用于实时测量得到飞行器的偏航角速率信息和俯仰角速率信息,
所述估测器25用于根据所述加速度信息实时估算得到飞行器的攻角信息和侧滑角信息。
其中,考虑二阶舵机动力学的解耦控制模块3包括控制解耦的舵指令解算子模块31、考虑舵机动力学滞后且控制解耦的舵指令解算子模块32和完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块33;
其中,所述控制解耦的舵指令解算子模块31用于实时根据需用过载信息和飞行器的飞行参数获得控制解耦的舵指令;
所述考虑舵机动力学滞后且控制解耦的舵指令解算子模块32用于实时根据飞行器的飞行参数和控制解耦的舵指令获得考虑舵机动力学滞后且控制解耦的舵指令;
所述完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块33用于实时根据飞行器的飞行参数和考虑舵机动力学滞后且控制解耦的舵指令获得完全解耦且考虑二阶舵机动力学滞后的舵指令。
其中,所述控制解耦的舵指令解算子模块31通过下式(一)实时获得控制解耦的舵指令,
u2=-K2x2+L2v2 (一)
其中,u2表示控制解耦的舵指令,K2表示状态反馈矩阵,L2表示前馈补偿矩阵,x2表示舵机状态空间表达式的状态变量,v2表示需用过载。
其中,所述考虑舵机动力学滞后且控制解耦的舵指令解算子模块32通过下式(二)实时获得考虑舵机动力学滞后且控制解耦的舵指令,
y2=C2∫(A2x2+B2u2)dt (二)
其中,y2表示考虑舵机动力学滞后且控制解耦的舵指令,
A2、B2、C2都表示舵机***参数。
其中,所述完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块33通过下式(三)实时获得完全解耦且考虑二阶舵机动力学滞后的舵指令,
u1=-K1x1+L1v1 (三)
其中,u1表示完全解耦且考虑二阶舵机动力学滞后的舵指令,K1表示状态反馈矩阵,L1表示前馈补偿矩阵,x1表示飞行器状态空间表达式的状态变量,v1表示考虑舵机动力学滞后且控制解耦的舵指令。
其中,所述考虑二阶舵机动力学的解耦控制模块3与飞行器的舵机4相连,所述舵机4根据完全解耦且考虑二阶舵机动力学滞后的舵指令打舵工作。
本发明还提供一种考虑二阶舵机动力学的解耦自驾仪的解耦控制方法,该方法包括如下步骤,
步骤1,通过过载接收模块1接收制导***传递出的需用过载信息;
步骤2,通过飞行器参数测量模块2获得飞行器的飞行参数;
步骤3,通过考虑二阶舵机动力学的解耦控制模块3根据需用过载信息和飞行器的飞行参数获得完全解耦且考虑二阶舵机动力学滞后的舵指令;
步骤4,实时重复步骤1-3,从而实时得到完全解耦且考虑二阶舵机动力学滞后的舵指令。
其中,所述步骤2包括如下子步骤,
子步骤2-1,通过舵机姿态传感器21实时测量得到飞行器的俯仰舵偏角信息和偏航舵偏角信息,
子步骤2-2,通过舵机角速率传感器22实时测量得到飞行器的俯仰舵机角速率信息和偏航舵机角速率信息,
子步骤2-3,通过加速度计23实时测量得到飞行器的加速度信息,通过惯性陀螺24实时测量得到飞行器的偏航角速率信息和俯仰角速率信息,
子步骤2-4,通过估测器25根据所述三轴加速度信息实时估算得到飞行器的攻角和侧滑角。
其中,所述步骤3包括如下子步骤,
子步骤3-1,通过控制解耦的舵指令解算子模块31实时根据需用过载信息和飞行器的飞行参数获得控制解耦的舵指令;
子步骤3-2,通过考虑舵机动力学滞后且控制解耦的舵指令解算子模块32实时根据飞行器的飞行参数和控制解耦的舵指令获得考虑舵机动力学滞后且控制解耦的舵指令;
子步骤3-3,通过完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块33实时根据飞行器的飞行参数和考虑舵机动力学滞后且控制解耦的舵指令获得完全解耦且考虑二阶舵机动力学滞后的舵指令。
本发明所具有的有益效果包括:
(1)考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法能够在接收到的需用过载基础上,结合旋转飞行器当前的飞行状况,考虑二阶舵机动力学及耦合情况,为舵机提供更为合理的舵机控制指令,从而加强旋转飞行器的控制效果,提高旋转飞行器的控制精度;
(2)考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法中考虑二阶舵机动力,并且简化了计算过程,用模型变换的方式将八阶***变换为两个四阶***进行解算控制,节约计算时间,使其能够满足飞行器实时获得信息的要求。
附图说明
图1示出根据本发明一种优选实施方式的考虑二阶舵机动力学的解耦自驾仪整体逻辑图;
图2示出仿真实验中俯仰方向需用过载及响应曲线;
图3示出仿真实验中偏航方向需用过载及响应曲线。
附图标号说明:
1-需用过载接收模块
2-飞行器参数测量模块
3-考虑二阶舵机动力学的解耦控制模块
21-舵机姿态传感器
22-舵机角速率传感器
23-加速度计
24-惯性陀螺
25-估测器
31-控制解耦的舵指令解算子模块
32-考虑舵机动力学滞后且控制解耦的舵指令解算子模块
33-完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块
4-舵机
具体实施方式
下面通过附图和实施例对本发明进一步详细说明。通过这些说明,本发明的特点和优点将变得更为清楚明确。
在这里专用的词“示例性”意为“用作例子、实施例或说明性”。这里作为“示例性”所说明的任何实施例不必解释为优于或好于其它实施例。尽管在附图中示出了实施例的各种方面,但是除非特别指出,不必按比例绘制附图。
根据本发明提供的一种考虑二阶舵机动力学的解耦自驾仪,如图1中所示,该***安装在旋转飞行器上,所述旋转飞行器优选为高动态的旋转飞行器,即转速在10r/s以上的旋转飞行器;本申请中所述的耦合是指在对飞行器的俯仰方向和偏航方向分别控制时,其中一个方向的控制指令会对另外一个方向造成影响和干扰,尤其是在对飞行器的俯仰方向进行控制时,由于旋转的原因,其舵机打舵产生的作用力很有可能会在水平方向上有一定的分力,该分力就会导致飞行器在偏航方向上发生偏转。
该***包括需用过载接收模块1,飞行器参数测量模块2和考虑二阶舵机动力学的解耦控制模块3;
其中,所述用过载接收模块1与旋转飞行器上的制导***相连,用以接收制导***实时传递出的需用过载信息,
所述制导***也安装在飞行器上,其能够根据飞行器上传感器件获得的飞行器自身信息及目标信息实时给出需用过载,一般情况下再根据该需用过载控制舵机打舵工作,但本申请提供的方案中,该需用过载不会直接传递给舵机,而是传递给所述需用过载接收模块1,经过处理后在将处理得到的完全解耦且考虑二阶舵机动力学滞后的舵指令传递给舵机。从而使得舵机的打舵工作更有针对性,对于滚转飞行器的控制效果更好。
其中,所述制导***为本领域中已有的制导***,其中可以采用比例导引制导律、重力补偿制导律等等已有的制导律。
所述飞行器参数测量模块2用于实时获得飞行器的飞行参数,所述飞行参数包括俯仰舵偏角、偏航舵偏角、俯仰舵机角速率、偏航舵机角速率、加速度、速度、偏航角速率、俯仰角速率、攻角和侧滑角;所述飞行器参数测量模块2能够从其自身携带的存储芯片中实时调取与飞行参数有关的动力系数。
所述考虑二阶舵机动力学的解耦控制模块3用于实时根据需用过载信息和飞行器的飞行参数获得完全解耦且考虑二阶舵机动力学滞后的舵指令,并将该舵指令传递给舵机,由舵机按照该舵指令打舵工作。
在一个优选的实施方式中,所述需用过载信息包括期望俯仰过载和期望偏航过载;所述期望俯仰过载即为制导***解算出的,在俯仰方向需要提供的过载;所述期望偏航过载即为制导***解算出的,在偏航方向需要提供的过载。
所述控制解耦的舵指令、考虑舵机动力学滞后且控制解耦的舵指令和完全解耦且考虑二阶舵机动力学滞后的舵指令都是舵指令,区别主要在于精度、准确性不同,所述舵指令都包括俯仰方向舵指令和偏航方向舵指令;所述俯仰方向舵指令表示最终要传递给舵机的,由舵机在俯仰方向执行的指令;所述偏航方向舵指令表示最终要传递给舵机的,由舵机在偏航方向执行的指令。
在飞行器的制导***获得需用过载时,如果该需用过载直接传递给舵机,舵机必然根据其中的期望俯仰过载解算对应的俯仰方向舵指令,根据其中的期望偏航过载解算对应的偏航方向舵指令,在舵机执行过程中,舵机的滞后特性对旋转飞行器的控制有着较大的影响,而且传统的设计方法往往默认舵机为一阶惯性环节,这种方法忽略了旋转飞行器的控制耦合特性,从而导致最终打舵结果与期望值之间的偏差过大;需用过载在经过考虑二阶舵机动力学的解耦控制模块解算以后,提前考虑计算了舵机滞后、耦合等干扰因素带来的影响,从而根据最终得到的完全解耦且考虑二阶舵机动力学滞后的舵指令进行打舵工作,能够使得打舵结果与期望值更为接近,控制效果更好。
在一个优选的实施方式中,所述飞行器参数测量模块2包括舵机姿态传感器21、舵机角速率传感器22、加速度计23、惯性陀螺24和估测器25;
其中,其中,所述舵机姿态传感器21用于实时测量得到飞行器的俯仰舵偏角信息和偏航舵偏角信息;
所述舵机角速率传感器22用于实时测量得到飞行器的俯仰舵机角速率信息和偏航舵机角速率信息;
所述加速度计23用于实时测量得到飞行器的加速度信息,
所述惯性陀螺24用于实时测量得到飞行器的偏航角速率信息和俯仰角速率信息,
所述估测器25用于根据所述三轴加速度信息实时估算得到飞行器的攻角和侧滑角。
其中,所述加速度计23设置有多个,优选地,至少设置有3个,其中至少一个加速度计位于飞行器的质心上,其安装朝向为沿着飞行器轴线朝向飞行器行进方向,用以测量飞行器沿着轴线方向的加速度,即飞行器自身的加速度,该加速度经过积分后可以得到飞行器的速度信息;
另外还有两个加速度计都安装在飞行器的轴线上,并且与质心之间偏离一定距离,并且这两个加速度计的安装方向彼此垂直,这两个加速度计都与所述估测器25相连,加速度计能够实时测量其自身所在位置处的加速度值,经过积分后即可得到该点的速度,再乘以该点与质心之间的距离即可得到该点角速度,再积分即可得到角度;优选地,该估测器还与飞行器上的地磁传感器相连,所述地磁传感器能够实时获知飞行器的滚转角,从而通过这两个加速度计和滚转角信息能够分别得到飞行器的侧滑角和攻角。在所述估测器中存储有加速度计与质心之间的距离,在所述估测器中还能够进行积分计算,从而该估测器能够实时给出飞行器的侧滑角信息和攻角信息。
在一个优选的实施方式中,考虑二阶舵机动力学的解耦控制模块3包括控制解耦的舵指令解算子模块31、考虑舵机动力学滞后且控制解耦的舵指令解算子模块32和完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块33;
其中,所述控制解耦的舵指令解算子模块31用于实时根据需用过载信息和飞行器的飞行参数获得控制解耦的舵指令;
所述考虑舵机动力学滞后且控制解耦的舵指令解算子模块32用于实时根据飞行器的飞行参数和控制解耦的舵指令获得考虑舵机动力学滞后且控制解耦的舵指令;
所述完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块33用于实时根据需飞行器的飞行参数和考虑舵机动力学滞后且控制解耦的舵指令获得完全解耦且考虑二阶舵机动力学滞后的舵指令。
优选地,所述控制解耦的舵指令解算子模块31通过下式(一)实时获得控制解耦的舵指令,
u2=-K2x2+L2v2 (一)
其中,u2表示控制解耦的舵指令,K2表示状态反馈矩阵,L2表示前馈补偿矩阵,x2表示舵机状态空间表达式的状态变量,v2表示需用过载;
优选地,
v2=[vy vz]T
优选地,所述考虑舵机动力学滞后且控制解耦的舵指令解算子模块32通过下式(二)实时获得考虑舵机动力学滞后且控制解耦的舵指令,
y2=C2∫(A2x2+B2u2)dt (二)
其中,y2表示考虑舵机动力学滞后且控制解耦的舵指令,
A2、B2、C2都表示舵机***参数,
d3、d11、d12、d21、d22都表示舵机模型的动力系数;能够根据其自身的已知参数和飞行器自身转速能够实时获知上述舵机模型的动力系数。
优选地,所述完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块33通过下式(三)实时获得完全解耦且考虑二阶舵机动力学滞后的舵指令,
u1=-K1x1+L1v1 (三)
其中,u1表示完全解耦且考虑二阶舵机动力学滞后的舵指令,K1表示状态反馈矩阵,L1表示前馈补偿矩阵,x1表示飞行器状态空间表达式的状态变量,v1与y2一样,都表示考虑舵机动力学滞后且控制解耦的舵指令;
在一个优选的实施方式中,所述舵机模型的动力系数通过下式获得:
在一个优选的实施方式中,所述考虑二阶舵机动力学的解耦控制模块3与飞行器的舵机4相连,所述舵机4根据完全解耦且考虑二阶舵机动力学滞后的舵指令打舵工作;
所述舵机4根据完全解耦且考虑二阶舵机动力学滞后的舵指令打舵工作得到的实际过载可通过下式(四)获知:
y1=C1∫(A1x1+B1u1)dt (四)
其中,y1=[ay az]T,表示实际响应过载,ay表示俯仰方向响应过载,az表示偏航方向响应过载,A1、B1、C1都表示飞行器***参数,
a25、a24、a27、a22、a28和a34都表示旋转飞行器的动力系数,所述旋转飞行器的动力系数是预装在飞行器中的已知数据,一般在飞行器出厂前通过风洞实验等方式计算获得的,在飞行器飞行过程中可以随时调取该数据。
本发明还提供一种考虑二阶舵机动力学的解耦自驾仪的解耦控制方法,该方法是通过上文所述考虑二阶舵机动力学的解耦自驾仪实现的,
该方法包括如下步骤,
步骤1,通过过载接收模块1接收制导***传递出的需用过载信息;
步骤2,通过飞行器参数测量模块2获得飞行器的飞行参数;
步骤3,通过考虑二阶舵机动力学的解耦控制模块3根据需用过载信息和飞行器的飞行参数获得完全解耦且考虑二阶舵机动力学滞后的舵指令;
步骤4,实时重复步骤1-3,从而实时得到完全解耦且考虑二阶舵机动力学滞后的舵指令。
优选地,所述步骤2包括如下子步骤,
子步骤2-1,通过舵机姿态传感器21实时测量得到飞行器的俯仰舵偏角信息和偏航舵偏角信息,
子步骤2-2,通过舵机角速率传感器22实时测量得到飞行器的俯仰舵机角速率信息和偏航舵机角速率信息,
子步骤2-3,通过加速度计23实时测量得到飞行器的加速度信息,通过惯性陀螺24实时测量得到飞行器的偏航角速率信息和俯仰角速率信息,
子步骤2-4,通过估测器25根据所述三轴加速度信息实时估算得到飞行器的攻角和侧滑角。
优选地,所述步骤3包括如下子步骤,
子步骤3-1,通过控制解耦的舵指令解算子模块31实时根据需用过载信息和飞行器的飞行参数获得攻角收敛误差和侧滑角收敛误差;
子步骤3-2,通过
控制解耦的舵指令解算子模块31实时根据需用过载信息和飞行器的飞行参数获得控制解耦的舵指令;
子步骤3-2,通过考虑舵机动力学滞后且控制解耦的舵指令解算子模块32实时根据飞行器的飞行参数和控制解耦的舵指令获得考虑舵机动力学滞后且控制解耦的舵指令;
子步骤3-3,通过完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块33实时根据飞行器的飞行参数和考虑舵机动力学滞后且控制解耦的舵指令获得完全解耦且考虑二阶舵机动力学滞后的舵指令。
仿真实验:
通过计算机进行旋转飞行器的模拟仿真实验,旋转飞行器的模拟条件:旋转飞行器的飞行速度为580m/s,转速为11.6r/s;
通过计算机能够直接模拟该旋转飞行器的制导***和舵机***,所述制导***能够实时给出制导指令,也就是需用过载,具体包括期望俯仰过载和期望偏航过载,该需用过载随时间变化的轨迹如图2、图3中的实线所示;舵机***能够根据制导指令或者需用过载控制舵机打舵工作,并且直接给出根据该需用过载控制舵机工作后实际能够为旋转飞行器提供的过载情况;
在实验例中,截取计算机中制导***给出的需用过载,并不直接将该需用过载传递给舵机***,将该需用过载传递给本申请提供的考虑二阶舵机动力学的解耦自驾仪中,通过本申请提供的考虑二阶舵机动力学的解耦自驾仪的解耦控制方法得到完全解耦且考虑二阶舵机动力学滞后的舵指令,再将该完全解耦且考虑二阶舵机动力学滞后的舵指令传递给舵机***,据此控制舵机工作,得到舵机工作后实际能够为旋转飞行器提供的过载情况;
其中,通过需用过载接收模块接收需用过载信息,即期望俯仰过载ayc=10*square(t),期望偏航过载azc=0;
通过计算机实时给出模拟的飞行器的飞行参数,包括俯仰舵偏角、偏航舵偏角、俯仰舵机角速率、偏航舵机角速率攻角、侧滑角、速度、俯仰角和偏航角;并且给出旋转飞行器的动力系数如下:
舵机参数表如下:
通过下式(一)、(二)、(三)解算得到俯仰方向舵机响应指令和偏航方向舵机响应指令;
u2=-K2x2+L2v2 (一)
y2=C2∫(A2x2+B2u2)dt (二)
u1=-K1x1+L1v1 (三)
v2=[vy vz]T,vy表示期望俯仰过载,vz表示期望偏航过载,
α表示攻角,β表示侧滑角,表示俯仰角速率,表示偏航角速率,δy表示俯仰舵偏角,δz表示偏航舵偏角,表示俯仰舵机角速率,表示偏航舵机角速率;u1表示完全解耦且考虑二阶舵机动力学滞后的舵指令,包括俯仰方向舵机响应指令和偏航方向舵机响应指令;
在将舵机响应指令传递会计算机中舵机***后,仿真得到舵机工作后实际能够为旋转飞行器提供的过载情况如图2和图3中的虚线“解耦自驾仪”所示。
在对比例中,截取计算机中制导***给出的需用过载,并不直接将该需用过载传递给舵机***,将该需用过载传递给现有技术中已有的用在旋转飞行器中的传统三回路自驾仪中,该传统三回路自驾仪对该需用过载做出响应,得到舵机控制指令,并据此控制舵机,最终得到舵机提供的过载情况,如图2和图3中的点划线“传统三回路自驾仪”所示。
从图2和图3中可以看出,传统三回路自驾仪存在耦合的影响,在调整俯仰方向期望过载时,偏航方向过载的波动较大,而且其偏航方向过载的收敛速度较慢,必然会对飞行器的姿态及命中精度带来不良影响;而本申请提供的考虑二阶舵机动力学的解耦自驾仪不仅消除了俯仰控制时对偏航控制的耦合影响,而且收敛速度快,优势明显。
以上结合了优选的实施方式对本发明进行了说明,不过这些实施方式仅是范例性的,仅起到说明性的作用。在此基础上,可以对本发明进行多种替换和改进,这些均落入本发明的保护范围内。
Claims (10)
1.一种考虑二阶舵机动力学的解耦自驾仪,其特征在于,该***安装在旋转飞行器上,该***包括
需用过载接收模块(1),其与旋转飞行器上的制导***相连,用以接收制导***实时传递出的需用过载信息,
飞行器参数测量模块(2),其用于实时获得飞行器的飞行参数,和
考虑二阶舵机动力学的解耦控制模块(3),其用于实时根据需用过载信息和飞行器的飞行参数获得完全解耦且考虑二阶舵机动力学滞后的舵指令。
2.根据权利要求1所述的考虑二阶舵机动力学的解耦自驾仪,其特征在于,
所述飞行器参数测量模块(2)包括舵机姿态传感器(21)、舵机角速率传感器(22)、加速度计(23)、惯性陀螺(24)和估测器(25);
其中,所述舵机姿态传感器(21)用于实时测量得到飞行器的俯仰舵偏角信息和偏航舵偏角信息,
所述舵机角速率传感器(22)用于实时测量得到飞行器的俯仰舵机角速率信息和偏航舵机角速率信息,
所述加速度计(23)用于实时测量得到飞行器的加速度信息,
所述惯性陀螺(24)用于实时测量得到飞行器的偏航角速率信息和俯仰角速率信息,
所述估测器(25)用于根据所述加速度信息实时估算得到飞行器的攻角信息和侧滑角信息。
3.根据权利要求1所述的考虑二阶舵机动力学的解耦自驾仪,其特征在于,
考虑二阶舵机动力学的解耦控制模块(3)包括控制解耦的舵指令解算子模块(31)、考虑舵机动力学滞后且控制解耦的舵指令解算子模块(32)和完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块(33);
其中,所述控制解耦的舵指令解算子模块(31)用于实时根据需用过载信息和飞行器的飞行参数获得控制解耦的舵指令;
所述考虑舵机动力学滞后且控制解耦的舵指令解算子模块(32)用于实时根据飞行器的飞行参数和控制解耦的舵指令获得考虑舵机动力学滞后且控制解耦的舵指令;
所述完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块(33)用于实时根据飞行器的飞行参数和考虑舵机动力学滞后且控制解耦的舵指令获得完全解耦且考虑二阶舵机动力学滞后的舵指令。
4.根据权利要求3所述的考虑二阶舵机动力学的解耦自驾仪,其特征在于,
所述控制解耦的舵指令解算子模块(31)通过下式(一)实时获得控制解耦的舵指令,
u2=-K2x2+L2v2 (一)
其中,u2表示控制解耦的舵指令,K2表示状态反馈矩阵,L2表示前馈补偿矩阵,x2表示舵机状态空间表达式的状态变量,v2表示需用过载。
5.根据权利要求3所述的考虑二阶舵机动力学的解耦自驾仪,其特征在于,
所述考虑舵机动力学滞后且控制解耦的舵指令解算子模块(32)通过下式(二)实时获得考虑舵机动力学滞后且控制解耦的舵指令,
y2=C2∫(A2x2+B2u2)dt (二)
其中,y2表示考虑舵机动力学滞后且控制解耦的舵指令,A2、B2、C2都表示舵机***参数。
6.根据权利要求3所述的考虑二阶舵机动力学的解耦自驾仪,其特征在于,
所述完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块(33)通过下式(三)实时获得完全解耦且考虑二阶舵机动力学滞后的舵指令,
u1=-K1x1+L1v1 (三)
其中,优选地,u1表示完全解耦且考虑二阶舵机动力学滞后的舵指令,K1表示状态反馈矩阵,L1表示前馈补偿矩阵,x1表示飞行器状态空间表达式的状态变量,v1表示考虑舵机动力学滞后且控制解耦的舵指令。
7.根据权利要求1所述的考虑二阶舵机动力学的解耦自驾仪,其特征在于,
所述考虑二阶舵机动力学的解耦控制模块(3)与飞行器的舵机(4)相连,所述舵机(4)根据完全解耦且考虑二阶舵机动力学滞后的舵指令打舵工作。
8.一种考虑二阶舵机动力学的解耦自驾仪的解耦控制方法,其特征在于,
该方法包括如下步骤,
步骤1,通过过载接收模块(1)接收制导***传递出的需用过载信息;
步骤2,通过飞行器参数测量模块(2)获得飞行器的飞行参数;
步骤3,通过考虑二阶舵机动力学的解耦控制模块(3)根据需用过载信息和飞行器的飞行参数获得完全解耦且考虑二阶舵机动力学滞后的舵指令;
步骤4,实时重复步骤1-3,从而实时得到完全解耦且考虑二阶舵机动力学滞后的舵指令。
9.根据权利要求8所述的考虑二阶舵机动力学的解耦自驾仪的解耦控制方法,其特征在于,
所述步骤2包括如下子步骤,
子步骤2-1,通过舵机姿态传感器(21)实时测量得到飞行器的俯仰舵偏角信息和偏航舵偏角信息,
子步骤2-2,通过舵机角速率传感器(22)实时测量得到飞行器的俯仰舵机角速率信息和偏航舵机角速率信息,
子步骤2-3,通过加速度计(23)实时测量得到飞行器的加速度信息,通过惯性陀螺(24)实时测量得到飞行器的偏航角速率信息和俯仰角速率信息,
子步骤2-4,通过估测器(25)根据所述三轴加速度信息实时估算得到飞行器的攻角和侧滑角。
10.根据权利要求8所述的考虑二阶舵机动力学的解耦自驾仪的解耦控制方法,其特征在于,
所述步骤3包括如下子步骤,
子步骤3-1,通过控制解耦的舵指令解算子模块(31)实时根据需用过载信息和飞行器的飞行参数获得控制解耦的舵指令;
子步骤3-2,通过考虑舵机动力学滞后且控制解耦的舵指令解算子模块(32)实时根据飞行器的飞行参数和控制解耦的舵指令获得考虑舵机动力学滞后且控制解耦的舵指令;
子步骤3-3,通过完全解耦且考虑二阶舵机动力学滞后的舵指令解算子模块(33)实时根据飞行器的飞行参数和考虑舵机动力学滞后且控制解耦的舵指令获得完全解耦且考虑二阶舵机动力学滞后的舵指令。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910792494.4A CN112433532B (zh) | 2019-08-26 | 2019-08-26 | 考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910792494.4A CN112433532B (zh) | 2019-08-26 | 2019-08-26 | 考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112433532A true CN112433532A (zh) | 2021-03-02 |
CN112433532B CN112433532B (zh) | 2022-06-21 |
Family
ID=74690462
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910792494.4A Active CN112433532B (zh) | 2019-08-26 | 2019-08-26 | 考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112433532B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113296400A (zh) * | 2021-05-14 | 2021-08-24 | 湖北三江航天红峰控制有限公司 | 一种两回路过载自动驾驶仪的参数整定方法及*** |
CN114942649A (zh) * | 2022-06-06 | 2022-08-26 | 北京石油化工学院 | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 |
Citations (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101342937A (zh) * | 2008-03-14 | 2009-01-14 | 上海海事大学 | 一种船舶推进***以及航行控制方法 |
JP2010015540A (ja) * | 2008-06-06 | 2010-01-21 | Omron Corp | 制御装置、温度調節器および目標値加工装置 |
CN101833338A (zh) * | 2010-05-17 | 2010-09-15 | 哈尔滨工程大学 | 无人潜航器垂直面欠驱动运动控制方法 |
DE202011005186U1 (de) * | 2011-04-12 | 2011-11-30 | Abelardo Schott Garcia, gesetzlich vertreten durch Karl-Helmut Schott | Kraftfahrzeug mit mindestens zwei durch Kupplung verbundene Verbrennungsmotoren |
CN102929151A (zh) * | 2012-11-14 | 2013-02-13 | 北京理工大学 | 一种基于指数时变二阶滑模的再入飞行姿态控制方法 |
US20130255625A1 (en) * | 2012-03-27 | 2013-10-03 | GM Global Technology Operations LLC | System and method for controlling engine speed |
CN106507759B (zh) * | 2009-04-03 | 2013-12-25 | 中国航天空气动力技术研究院 | 飞行器流动与跨学科***的耦合求解方法 |
CN103926837A (zh) * | 2014-04-22 | 2014-07-16 | 西北工业大学 | 多种耦合作用下飞行器综合解耦方法 |
CN104265708A (zh) * | 2014-09-04 | 2015-01-07 | 北京航空航天大学 | 一种基于运动状态同步的自适应解耦控制方法 |
CN104813059A (zh) * | 2012-09-17 | 2015-07-29 | 克诺尔商用车制动***有限公司 | 盘式制动器的调整装置、相应的盘式制动器和用于运行盘式制动器的磨损调整设备的方法 |
CN104850056A (zh) * | 2014-10-30 | 2015-08-19 | 中国运载火箭技术研究院 | 一种适用于多通道耦合飞行器的伺服弹性试验及分析方法 |
US20150286221A1 (en) * | 2010-03-22 | 2015-10-08 | John R. Goulding | Controlling roll and pitch of a single-track legged vehicle |
CN105151280A (zh) * | 2015-09-28 | 2015-12-16 | 哈尔滨工业大学深圳研究生院 | 一种飞行器用俯仰和偏航完全解耦的尾翼调节机构 |
CN105339262A (zh) * | 2013-03-14 | 2016-02-17 | 宾夕法尼亚大学理事会 | 用于微型飞行器的被动旋翼控制机构 |
US20170136842A1 (en) * | 2015-06-03 | 2017-05-18 | Levant Power Corporation | Methods and systems for controlling vehicle body motion and occupant experience |
CN107345535A (zh) * | 2017-07-04 | 2017-11-14 | 太原理工大学 | 一种流量压力分腔协调控制负载模拟方法 |
CN108008745A (zh) * | 2017-10-19 | 2018-05-08 | 南京航空航天大学 | 基于相位滞后补偿的磁悬浮飞轮同频振动力抑制方法及控制*** |
US20180164835A1 (en) * | 2016-09-27 | 2018-06-14 | Arizona Board Of Regents On Behalf Of Arizona State University | Systems and methods for dynamics, modeling, simulation and control of mid-flight coupling of quadrotors |
CN108845583A (zh) * | 2018-06-15 | 2018-11-20 | 上海航天控制技术研究所 | 提高btt控制飞行器侧滑角抑制能力的偏航通道控制方法 |
CN109000522A (zh) * | 2018-08-16 | 2018-12-14 | 上海航天控制技术研究所 | 差动式双余度舵机的安全优化控制方法 |
-
2019
- 2019-08-26 CN CN201910792494.4A patent/CN112433532B/zh active Active
Patent Citations (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101342937A (zh) * | 2008-03-14 | 2009-01-14 | 上海海事大学 | 一种船舶推进***以及航行控制方法 |
JP2010015540A (ja) * | 2008-06-06 | 2010-01-21 | Omron Corp | 制御装置、温度調節器および目標値加工装置 |
CN106507759B (zh) * | 2009-04-03 | 2013-12-25 | 中国航天空气动力技术研究院 | 飞行器流动与跨学科***的耦合求解方法 |
US20150286221A1 (en) * | 2010-03-22 | 2015-10-08 | John R. Goulding | Controlling roll and pitch of a single-track legged vehicle |
CN101833338A (zh) * | 2010-05-17 | 2010-09-15 | 哈尔滨工程大学 | 无人潜航器垂直面欠驱动运动控制方法 |
DE202011005186U1 (de) * | 2011-04-12 | 2011-11-30 | Abelardo Schott Garcia, gesetzlich vertreten durch Karl-Helmut Schott | Kraftfahrzeug mit mindestens zwei durch Kupplung verbundene Verbrennungsmotoren |
US20130255625A1 (en) * | 2012-03-27 | 2013-10-03 | GM Global Technology Operations LLC | System and method for controlling engine speed |
CN104813059A (zh) * | 2012-09-17 | 2015-07-29 | 克诺尔商用车制动***有限公司 | 盘式制动器的调整装置、相应的盘式制动器和用于运行盘式制动器的磨损调整设备的方法 |
CN102929151A (zh) * | 2012-11-14 | 2013-02-13 | 北京理工大学 | 一种基于指数时变二阶滑模的再入飞行姿态控制方法 |
CN105339262A (zh) * | 2013-03-14 | 2016-02-17 | 宾夕法尼亚大学理事会 | 用于微型飞行器的被动旋翼控制机构 |
CN103926837A (zh) * | 2014-04-22 | 2014-07-16 | 西北工业大学 | 多种耦合作用下飞行器综合解耦方法 |
CN104265708A (zh) * | 2014-09-04 | 2015-01-07 | 北京航空航天大学 | 一种基于运动状态同步的自适应解耦控制方法 |
CN104850056A (zh) * | 2014-10-30 | 2015-08-19 | 中国运载火箭技术研究院 | 一种适用于多通道耦合飞行器的伺服弹性试验及分析方法 |
US20170136842A1 (en) * | 2015-06-03 | 2017-05-18 | Levant Power Corporation | Methods and systems for controlling vehicle body motion and occupant experience |
CN105151280A (zh) * | 2015-09-28 | 2015-12-16 | 哈尔滨工业大学深圳研究生院 | 一种飞行器用俯仰和偏航完全解耦的尾翼调节机构 |
US20180164835A1 (en) * | 2016-09-27 | 2018-06-14 | Arizona Board Of Regents On Behalf Of Arizona State University | Systems and methods for dynamics, modeling, simulation and control of mid-flight coupling of quadrotors |
CN107345535A (zh) * | 2017-07-04 | 2017-11-14 | 太原理工大学 | 一种流量压力分腔协调控制负载模拟方法 |
CN108008745A (zh) * | 2017-10-19 | 2018-05-08 | 南京航空航天大学 | 基于相位滞后补偿的磁悬浮飞轮同频振动力抑制方法及控制*** |
CN108845583A (zh) * | 2018-06-15 | 2018-11-20 | 上海航天控制技术研究所 | 提高btt控制飞行器侧滑角抑制能力的偏航通道控制方法 |
CN109000522A (zh) * | 2018-08-16 | 2018-12-14 | 上海航天控制技术研究所 | 差动式双余度舵机的安全优化控制方法 |
Non-Patent Citations (7)
Title |
---|
BAOXU LIU等: "LQR lateral-directional control law design for distributed propulsion layout flying wing", 《2017 IEEE INTERNATIONAL CONFERENCE ON CYBERNETICS AND INTELLIGENT SYSTEMS AND IEEE CONFERENCE ON ROBOTICS, AUTOMATION AND MECHATRONICS》 * |
XINGWEI SHI等: "Velocity-Free Guidance Scheme for Close-Range Rendezvous", 《2018 IEEE CSAA GUIDANCE, NAVIGATION AND CONTROL CONFERENCE》 * |
ZHENG, ZP等: "Control Strategy Research of High-frequency Position Response Servo System for Electromechanical Actuator", 《PROCEEDINGS OF THE 4TH INTERNATIONAL CONFERENCE ON MECHATRONICS, MATERIALS, CHEMISTRY AND COMPUTER ENGINEERING》 * |
彭博等: "滚转导弹解耦过载驾驶仪及其 BP 自适应调度法", 《固体火箭技术》 * |
朱大林: "双旋弹飞行特性与制导控制方法研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
武庆雅: "旋转弹药的惯性导航与解耦控制方法研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
范世鹏: "滚转导弹控制耦合特性分析与解耦方法", 《***工程与电子技术》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113296400A (zh) * | 2021-05-14 | 2021-08-24 | 湖北三江航天红峰控制有限公司 | 一种两回路过载自动驾驶仪的参数整定方法及*** |
CN114942649A (zh) * | 2022-06-06 | 2022-08-26 | 北京石油化工学院 | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 |
CN114942649B (zh) * | 2022-06-06 | 2022-12-06 | 北京石油化工学院 | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112433532B (zh) | 2022-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112286217A (zh) | 基于径向基神经网络的自动驾驶仪及其解耦控制方法 | |
US20180290719A1 (en) | Motion control device and motion control method for ship | |
CN108873929B (zh) | 一种固定翼飞机自主着舰方法及*** | |
CN112433532B (zh) | 考虑二阶舵机动力学的解耦自驾仪及其解耦控制方法 | |
CN113568419B (zh) | 一种变载四旋翼无人机容错控制方法 | |
US5259569A (en) | Roll damper for thrust vector controlled missile | |
CN106802570B (zh) | 一种无人直升机位置跟踪的方法与装置 | |
CN110895418A (zh) | 补偿舵机动力学滞后的低速旋转飞行器控制方法及*** | |
CN106248082B (zh) | 一种飞行器自主导航***及导航方法 | |
CN115016268A (zh) | 一种基于滑模理论的可倾转四旋翼无人机容错控制方法 | |
CN113419431B (zh) | 一种基于事件触发的平流层飞艇轨迹跟踪控制方法及*** | |
CN112433473B (zh) | 考虑旋转飞行器耦合问题的鲁棒解耦控制***及控制方法 | |
JP2022520118A (ja) | 無人航空機の高度から風向および風速度の測定値を決定するためのシステムおよび方法 | |
CN114964226A (zh) | 噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法 | |
CN112486023B (zh) | 一种巡飞弹航迹飞行控制***仿真设计方法及该控制*** | |
EP1196831B1 (en) | Enhanced stall and recovery control system | |
US6886774B2 (en) | Method for piloting a spinning projectile | |
CN111538350B (zh) | 一种采用三段柔化切换实现无人机的高度全自动飞行的方法 | |
CN115993769A (zh) | 一种用于高动态飞行器的一体化制导控制方法 | |
CN112445235A (zh) | 一种应用于高动态飞行器的滚转稳定控制方法及*** | |
US3540678A (en) | Method of and apparatus for controlling the transverse acceleration and roll damping of steerable aerodynamic bodies | |
CN108107726A (zh) | 一种基于对称时变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
JP2001325245A (ja) | ハイブリッドフィルタ | |
CN114779826B (zh) | 一种适用于非零滚转角的轴对称飞行器侧向控制方法 | |
CN116700306B (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 |