CN111412083B - 一种确定伺服作动器长度变化的方法 - Google Patents
一种确定伺服作动器长度变化的方法 Download PDFInfo
- Publication number
- CN111412083B CN111412083B CN202010260800.2A CN202010260800A CN111412083B CN 111412083 B CN111412083 B CN 111412083B CN 202010260800 A CN202010260800 A CN 202010260800A CN 111412083 B CN111412083 B CN 111412083B
- Authority
- CN
- China
- Prior art keywords
- vector
- fulcrum
- swing
- coordinate system
- determining
- 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.)
- Active
Links
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F02—COMBUSTION ENGINES; HOT-GAS OR COMBUSTION-PRODUCT ENGINE PLANTS
- F02K—JET-PROPULSION PLANTS
- F02K1/00—Plants characterised by the form or arrangement of the jet pipe or nozzle; Jet pipes or nozzles peculiar thereto
- F02K1/002—Plants characterised by the form or arrangement of the jet pipe or nozzle; Jet pipes or nozzles peculiar thereto with means to modify the direction of thrust vector
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F02—COMBUSTION ENGINES; HOT-GAS OR COMBUSTION-PRODUCT ENGINE PLANTS
- F02K—JET-PROPULSION PLANTS
- F02K9/00—Rocket-engine plants, i.e. plants carrying both fuel and oxidant therefor; Control thereof
- F02K9/80—Rocket-engine plants, i.e. plants carrying both fuel and oxidant therefor; Control thereof characterised by thrust or thrust vector control
- F02K9/805—Rocket-engine plants, i.e. plants carrying both fuel and oxidant therefor; Control thereof characterised by thrust or thrust vector control servo-mechanisms or control devices therefor
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Mechanical Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Application Of Or Painting With Fluid Materials (AREA)
- Supercharger (AREA)
Abstract
本申请公开了一种确定伺服作动器长度变化的方法,具体包括以下步骤:在摆动中心处建立与箭体结构坐标系平行的坐标系;在坐标系中确定摆动中心与伺服作动器之间的各支点矢量;确定各支点矢量在坐标系中的坐标向量;根据各支点矢量的坐标向量确定两伺服作动器的长度变化。本申请能够根据推力矢量实时需求的两通道偏转角度指令,以及预设的悬挂几何尺寸常量,给出所需两伺服作动器的精确长度变化。
Description
技术领域
本申请涉及火箭领域,具体地,涉及一种确定伺服作动器长度变化的方法。
背景技术
推力矢量控制是一种常用的执行机构操纵方法,能够通过伺服作动器直接改变反作用推力装置(如火箭发动机、喷气式航空发动机等)工质的喷射方向,产生垂直于载具(如运载火箭、导弹及喷气式飞机等)运动方向的控制力,具有控制能力强,响应快,效率高的优点。
以典型的火箭发动机摆动喷管推力矢量控制方式为例,如图1,两个通道直线伺服作动器的长度方向轴线正交,每个通道直线伺服作动器的两端通过铰链分别连接于箭体及喷管上,喷管通过万向节或具有较大扭转刚度的柔性接头或球窝铰链与发动机连接,连接点形成摆动中心。若采用柔性接头,由于发动机工作时内部压强增大,可造成喷管摆动中心的下沉运动。通过伺服控制器控制两个伺服作动器的长度变化,进而操纵喷管出口的三维指向,使喷管相对于载具呈现理想的出口方向,实现推力矢量的控制。
传统的推力矢量控制方式往往采用通道间独立的线性控制,不适用于通道间牵连耦合运动较为明显的悬挂几何形式;而现有技术中的通道间牵连耦合运动较为明显的悬挂几何形式,给出的逆运动学求解方法为联立约束方程组的隐式迭代方法,存在收敛稳定性及计算量大等问题,仅在地面测试系统中应用,不适用于对计算可靠性及时间要求严苛的在线伺服控制。
因此,如何能够针对推力矢量控制的逆运动学问题,确定伺服作动器长度变化是本领域人员目前急需解决的问题。
发明内容
本申请的目的在于提供一种确定伺服作动器长度变化的方法,能够针对推力矢量控制的逆运动学问题,确定伺服作动器长度变化。
为达到上述目的,本申请提供了一种确定伺服作动器长度变化的方法,具体包括以下步骤:在摆动中心处建立与箭体结构坐标系平行的坐标系;
在坐标系中确定摆动中心与伺服作动器之间的各支点矢量;确定各支点矢量在坐标系中的坐标向量;根据各支点矢量的坐标向量确定两伺服作动器的长度变化。
如上的,其中,坐标系中的任意矢量的坐标向量记为r,r=[rx ry rz]T,其中rx表示在坐标系的X轴中的坐标,ry表示在坐标系的Y轴上的坐标,rz表示在坐标系的Z轴上的坐标,T表示矩阵的转置。
如上的,其中伺服作动器包括俯仰伺服作动器和偏航伺服作动器。
如上的,其中俯仰伺服作动器与箭体结构铰接的上支点定义为A1,与喷管铰接的下支点定义为B1;偏航伺服作动器与箭体结构铰接的上支点定义为A2,与喷管铰接的下支点定义为B2;各支点矢量包括:摆动中心到上支点A1、A2的上支点矢量、摆动中心到下支点B1、B2的下支点矢量;其中上支点矢量rE1、上支点矢量rE2、下支点矢量rR1以及下支点矢量rR2在坐标系中的坐标向量具体表示为:
其中,xp为发动机工作时摆动中心的下沉量,可以表示为工作压强P的函数,其中xp=f(P);H为xp=0时摆动中心到上支点A1或上支点A2的正X轴方向距离;E为摆动中心到上支点A1的的负Y轴方向距离,或摆动中心O到上支点A2的负Z轴方向距离;R为摆动中心O到下支点B1的负Y轴距离,或摆动中心O到下支点B2的负Z轴距离;L为摆动中心O到下支点B1或下支点B2的正X轴方向距离,均为与喷管悬挂几何相关的常数。
如上的,其中根据各支点矢量的坐标向量确定两伺服作动器长度变化具体包括以下子步骤:确定合成摆角;根据合成摆角确定喷管中心轴的单位矢量在坐标系中的坐标向量;根据喷管中心轴的单位矢量在坐标系中的坐标向量,确定沿合成转轴方向的单位矢量值;根据合成转轴上的单位矢量值确定两伺服作动器长度指令长度变化。
如上的,其中,喷管中心轴的单位矢量包括喷管中心轴摆动前和摆动后的单位矢量,摆动前位于零位处、摆动后喷管中心轴的单位矢量u和u′在坐标系中的坐标向量具体分别表示为:
如上的,其中在确定两伺服作动器长度变化之前,还包括,计算摆角δ1,δ2为某一值时,摆动中心O到下支点B1、B2的下支点矢量的具体值;其中摆动中心O到下支点B1、B2的下支点矢量的具体值表示为:其中rR1为摆角δ1,δ2均为零时的摆动中心O到下支点B1的下支点矢量,rR2为摆角δ1,δ2均为零时的摆动中心O到下支点B2的下支点矢量,为沿合成转轴方向的单位矢量值,Φ为合成摆角。
如上的,其中两伺服作动器长度变化xr1、xr2具体表示为:其中,r′R1、r′R2分别为摆角δ1,δ2为某一值时,摆动中心O到下支点B1、B2的下支点矢量的具体值。rE1为摆动中心O到上支点A1的上支点矢量的坐标向量,rE2为摆动中心O到上支点A2的上支点矢量的坐标向量。
本申请的有益效果是:本申请能够根据推力矢量实时需求的两通道偏转角度指令,以及预设的悬挂几何尺寸常量(并可以考虑预测推力装置增压后的下沉量),完全通过有限步骤的正向计算给出所需两伺服作动器的精确长度变化。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请中记载的一些实施例,对于本领域普通技术人员来讲,还可以根据这些附图获得其他的附图。
图1是现有技术中摆动喷管的示意图;
图2A是根据本申请实施例提供的俯仰通道作动器的平面结构约束关系示意图;
图2B是根据本申请实施例提供的偏航通道作动器的平面结构约束关系示意图;
图3是根据本申请实施例提供的两通道作动器同时驱动摆动喷管示意图(仅示出俯仰通道作动器);
图4是根据本申请实施例提供的确定伺服作动器长度变化的方法流程图。
具体实施方式
下面结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
本申请涉及一种确定伺服作动器长度变化的方法。根据本申请,能够根据推力矢量实时需求的两通道摆角指令,以及预设的悬挂几何尺寸常量,完全正向计算给出所需两伺服作动器的精确长度变化。
其中由图1可知,俯仰通道作动器和偏航通道作动器的一端均与喷管连接且在零位时处在两个相互垂直的平面内。请参见图2,其中图2A为俯仰通道作动器的平面结构约束关系示意图,图2B是根据本申请实施例提供的偏航通道作动器的平面结构约束关系示意图。
请继续参见图2,其中图2A和图2B中的喷管与发动机连接,连接点形成摆动中心O。在图2A中,俯仰通道作动器的两端分别与箭体和喷管铰接,其中与箭体的铰接点为上支点A1,与喷管的铰接点为下支点B1。在图2B中,偏航通道作动器与箭体结构的铰接点为上支点A2,与喷管的铰接点为下支点B2。
飞行控制器控制偏航通道作动器或俯仰通道作动器伸长或缩短的过程中带动喷管发生角度偏转,喷管出口的三维指向发生变化,从而实现推力矢量的变化。其中偏航通道作动器或俯仰通道作动器均对应一个通道,分别为偏航通道和俯仰通道,其中飞行器发出的控制指令,即为摆角指令,指示两通道改变摆角,从而使喷管出口的三维指向发生变化。本实施例中飞行控制器每次发出的摆角指令为根据飞行状态周期性更新的值,目的是让喷管根据该指令进行摆角的偏转,而若想实现喷管的摆角偏转,就需要求得伺服作动器的长度变化。
本申请提供了确定伺服作动器长度变化的方法,如图4所示,具体包括如下步骤:
步骤S410:在摆动中心处建立与箭体结构坐标系平行的坐标系。
以摆动中心O为坐标系中心建立与箭体结构坐标系平行的坐标系O-XYZ,其中,俯仰通道作动器位于XOY平面内,如图2A和3所示。偏航通道作动器位于XOZ平面内,如图2B所示。其中坐标系O-XYZ中的任意矢量坐标向量记为r,r=[rx ry rz]T,其中rx表示在坐标系O-XYZ的X轴中的坐标,ry表示在坐标系O-XYZ的Y轴上的坐标,rz表示在坐标系O-XYZ的Z轴上的坐标,T表示矩阵的转置。
步骤S420:在坐标系中确定摆动中心与伺服作动器之间的各支点矢量。
具体地,其中摆动中心O与伺服作动器之间的支点矢量具体为摆动中心O到上支点A1、A2以及摆动中心O到下支点B1、B2的矢量。
具体地,摆动中心O到上支点A1的上支点矢量记为上支点矢量rE1,如图3所示。摆角δ1,δ2均为零时(即喷管位于图3中左边示出的位置,喷管中心轴摆动前位于零位处),喷管中心轴的单位矢量记为u,摆动中心O到下支点B1的矢量记为下支点矢量rR1。两通道摆角δ1,δ2为某一值时(即喷管进行了旋转摆动,偏转到了图3中右边示出的位置),喷管中心轴的单位矢量记为u′,摆动中心O到下支点B1的矢量记为下支点矢量r′R1。
进一步地,摆动中心O到上支点A2的矢量记为上支点矢量rE2。伺服作动器两通道的摆角δ1,δ2均为零时,摆动中心O到下支点B2的矢量记为下支点矢量rR2;两通道摆角δ1,δ2为某一值时,摆动中心O到下支点B2的矢量记为下支点矢量r′R2。
步骤S430:确定各支点矢量在坐标系中的坐标向量。
具体地,支点矢量rE1、rE2、rR1、rR2在坐标系O-XYZ的坐标向量具体表示为:
其中,xp为发动机工作时摆动中心O的下沉量,可以表示为工作压强P(可从传感器测量得到)的函数,其中xp=f(P)。由图2A和图2B可知,其中H为冷态(xp=0)时摆动中心O到上支点A1或上支点A2的正X轴方向距离,E为摆动中心O到上支点A1的负Y轴方向距离,或摆动中心O到上支点A2的负Z轴方向距离,R为摆动中心O到下支点B1的负Y轴距离,或摆动中心O到下支点B2的负Z轴距离,L为摆动中心O到下支点B1或下支点B2的正X轴方向距离,均为与喷管悬挂几何相关的常数。
步骤S440:根据各支点矢量的坐标向量确定两伺服作动器长度变化。
具体地,其中根据各支点矢量的坐标向量、摆角指令与喷管中心轴的单位矢量进行伺服作动器长度变化的确定。具体包括以下子步骤:
步骤D1:确定合成摆角。
进一步地,将两伺服作动器的摆角合成,定义为合成摆角,其中合成摆角Φ具体表示为:
其中δ1,δ2为伺服作动器两通道的摆角。
步骤D2:根据合成摆角确定喷管中心轴的单位矢量在坐标系中的坐标向量。
具体地,摆动前位于零位处、摆动后喷管中心轴的单位矢量u和u′在坐标系中的坐标向量具体分别表示为:
其中,Φ为合成摆角,δ1,δ2为两通道的摆角。
步骤D3:根据喷管中心轴的单位矢量在坐标系中的坐标向量,确定沿合成转轴方向的单位矢量值。
其中,u和u′为摆动前位于零位处、摆动后喷管中心轴的单位矢量。
步骤D4:根据合成转轴上的单位矢量值确定两伺服作动器长度变化。
其中在确定两伺服作动器长度变化之前,还包括,计算摆角δ1,δ2为某一值时,摆动中心O到下支点B1、B2的下支点矢量的具体值。
具体地,摆动中心O到下支点B1、B2的下支点矢量的具体值表示为:
进一步地,根据摆动中心O到下支点B2的下支点矢量值确定两伺服作动器长度变化,其中两伺服作动器长度变化xr1、xr2具体表示为:
xr1=|r′R1-rE1|
xr2=|r′R2-rE2|
其中,r′R1、r′R2分别为摆角δ1,δ2为某一值时,摆动中心O到下支点B1、B2的下支点矢量的具体值。rE1为摆动中心O到上支点A1的上支点矢量的坐标向量,rE2为摆动中心O到上支点A2的上支点矢量的坐标向量。
本申请的有益效果是:本申请能够根据推力矢量实时需求的两通道偏转角度指令,以及预设的悬挂几何尺寸常量(并可以考虑预测推力装置增压后的下沉量),完全通过有限步骤的正向计算给出所需两伺服作动器的精确长度变化。
虽然当前申请参考的示例被描述,其只是为了解释的目的而不是对本申请的限制,对实施方式的改变,增加和/或删除可以被做出,但不脱离本申请的范围。
以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以所述权利要求的保护范围为准。
Claims (3)
1.一种确定伺服作动器长度变化的方法,其特征在于,具体包括以下步骤:
在摆动中心处建立与箭体结构坐标系平行的坐标系;
在坐标系中确定摆动中心与伺服作动器之间的各支点矢量;
确定各支点矢量在坐标系中的坐标向量;
根据各支点矢量的坐标向量确定两伺服作动器的长度变化;
摆动中心与伺服作动器之间的支点矢量具体为摆动中心到上支点,以及摆动中心到下支点的矢量;
其中,为发动机工作时摆动中心的下沉量,表示为工作压强的函数,其中;为时摆动中心到上支点或上支点的正轴方向距离;为摆动中心到上支点的负轴方向距离,或摆动中心到上支点的负轴方向距离;为摆动中心到下支点的负轴距离,或摆动中心到下支点的负轴距离;为摆动中心到下支点或下支点的正轴方向距离,均为与喷管悬挂几何相关的常数;
其中根据各支点矢量的坐标向量确定两伺服作动器长度变化具体包括以下子步骤:
根据合成摆角确定喷管中心轴的单位矢量在坐标系中的坐标向量;具体表示为:
3.如权利要求2所述的确定伺服作动器长度变化的方法,其特征在于,伺服作动器包括俯仰伺服作动器和偏航伺服作动器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010260800.2A CN111412083B (zh) | 2020-04-03 | 2020-04-03 | 一种确定伺服作动器长度变化的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010260800.2A CN111412083B (zh) | 2020-04-03 | 2020-04-03 | 一种确定伺服作动器长度变化的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111412083A CN111412083A (zh) | 2020-07-14 |
CN111412083B true CN111412083B (zh) | 2021-09-14 |
Family
ID=71491827
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010260800.2A Active CN111412083B (zh) | 2020-04-03 | 2020-04-03 | 一种确定伺服作动器长度变化的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111412083B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1140585A (en) * | 1966-01-18 | 1969-01-22 | Moog Inc | Fluid-pressure servo mechanism |
CN106368852A (zh) * | 2016-10-14 | 2017-02-01 | 南京航空航天大学 | 一种小型液体/固体火箭矢量喷管伺服控制系统和方法 |
CN109372654A (zh) * | 2018-12-19 | 2019-02-22 | 中国航发沈阳发动机研究所 | 一种模式选择阀门控制系统 |
CN109726358A (zh) * | 2017-10-30 | 2019-05-07 | 北京精密机电控制设备研究所 | 一种基于三维坐标变换的前摆心喷管铰链耦合解耦算法 |
CN111120149A (zh) * | 2019-12-13 | 2020-05-08 | 内蒙航天动力机械测试所 | 一种伺服作动器行程检测装置 |
-
2020
- 2020-04-03 CN CN202010260800.2A patent/CN111412083B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1140585A (en) * | 1966-01-18 | 1969-01-22 | Moog Inc | Fluid-pressure servo mechanism |
CN106368852A (zh) * | 2016-10-14 | 2017-02-01 | 南京航空航天大学 | 一种小型液体/固体火箭矢量喷管伺服控制系统和方法 |
CN109726358A (zh) * | 2017-10-30 | 2019-05-07 | 北京精密机电控制设备研究所 | 一种基于三维坐标变换的前摆心喷管铰链耦合解耦算法 |
CN109372654A (zh) * | 2018-12-19 | 2019-02-22 | 中国航发沈阳发动机研究所 | 一种模式选择阀门控制系统 |
CN111120149A (zh) * | 2019-12-13 | 2020-05-08 | 内蒙航天动力机械测试所 | 一种伺服作动器行程检测装置 |
Also Published As
Publication number | Publication date |
---|---|
CN111412083A (zh) | 2020-07-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1022124C (zh) | 轴线对称可转向排气喷口 | |
CN100565406C (zh) | 一种基于四个定位器的飞机部件位姿调整系统及方法 | |
Madani et al. | Backstepping sliding mode control applied to a miniature quadrotor flying robot | |
US6981844B2 (en) | Cyclic actuation system for a controllable pitch propeller and a method of providing aircraft control therewith | |
US20070283679A1 (en) | Mechanism for a vectoring exhaust nozzle | |
CN110908278A (zh) | 一种折叠翼飞行器的动力学建模与稳定控制方法 | |
CN109176488B (zh) | 一种柔性机器人运动学标定方法及系统 | |
US11932400B2 (en) | Three-dimensional extension linkage for aircraft | |
CN111271194B (zh) | 一种滚珠丝杠驱动的推力矢量多轴摆动喷管 | |
US20060097103A1 (en) | Method and apparatus for vehicle control using variable blade pitch | |
CN111412083B (zh) | 一种确定伺服作动器长度变化的方法 | |
KR870000134B1 (ko) | 로케트 비행체 및 이를 조정하는 방법 | |
CN111322912A (zh) | 一种滚珠丝杠协同驱动的推力矢量全轴摆动喷管 | |
CN110654530A (zh) | 具有变形反馈的变弯度机翼结构 | |
Cole et al. | Transonic dynamics tunnel aeroelastic testing in support of aircraft development | |
CN112228242B (zh) | 具有短距/垂直起降功能的机械-气动复合式矢量喷管 | |
JP2002243579A (ja) | 風洞模型支持装置およびそれを用いた風洞試験装置 | |
CN112443422B (zh) | 基于准轴对称喉道偏移式气动矢量喷管的旋转垂直起降喷管及其设计方法 | |
Zhu et al. | Modeling and experimental study on orientation dynamics of a Mars rotorcraft with swashplate mechanism | |
CN109270955B (zh) | 一种基于机械臂驱动的飞行器位姿耦合快速稳定控制方法 | |
JPH09240599A (ja) | エンジンの推力調整によるロケットの制御方法 | |
CN113928538B (zh) | 一种超音速飞行器头部可偏转变形机构的控制方法 | |
Lange et al. | The kinematics of the swashplate mechanism of a VTOL unmanned aerial vehicle | |
CN105691594A (zh) | 一种新的飞翼布局飞行器控制方法及控制装置 | |
CN114967716A (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 |