Nothing Special   »   [go: up one dir, main page]

CN107315415A - The fault-tolerant control system and control method of three bang-bang actuators - Google Patents

The fault-tolerant control system and control method of three bang-bang actuators Download PDF

Info

Publication number
CN107315415A
CN107315415A CN201610819911.6A CN201610819911A CN107315415A CN 107315415 A CN107315415 A CN 107315415A CN 201610819911 A CN201610819911 A CN 201610819911A CN 107315415 A CN107315415 A CN 107315415A
Authority
CN
China
Prior art keywords
rudder
steering engine
ammunition
time
steering
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
Application number
CN201610819911.6A
Other languages
Chinese (zh)
Other versions
CN107315415B (en
Inventor
李斌
林德福
王江
王伟
何绍溟
王辉
宋韬
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Technology BIT
Original Assignee
Beijing Institute of Technology BIT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Technology BIT filed Critical Beijing Institute of Technology BIT
Priority to CN201610819911.6A priority Critical patent/CN107315415B/en
Publication of CN107315415A publication Critical patent/CN107315415A/en
Application granted granted Critical
Publication of CN107315415B publication Critical patent/CN107315415B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种三位继电式舵机的容错控制系统,其设置在低速滚转的末制导弹药上,所述容错控制系统用于接收弹药上的制导指令信息,并根据该信息控制舵机及其上的舵片工作,进而控制弹药的运动姿态,其中,所述容错控制系统包括舵片监测模块,其用于监测舵机上舵片的工作状态,并分析舵片是否能够正常工作,根据其舵片的工作状态通知舵机指令计算模块选用不同的计算方法计算获得舵机指令,从而对舵机进行控制,即使舵机中的一对舵无法工作,舵机也能基本实现控制作业,使得弹药能够基本命中目标。

The invention discloses a fault-tolerant control system of a three-position relay steering gear, which is arranged on a low-speed rolling terminal guided ammunition. The steering gear and the rudders on it work, and then control the movement attitude of the ammunition, wherein the fault-tolerant control system includes a rudder monitoring module, which is used to monitor the working state of the rudders on the steering gear, and analyze whether the rudders can work normally According to the working state of the steering gear, the steering gear command calculation module is notified to use different calculation methods to calculate and obtain the steering gear command, so as to control the steering gear. Even if a pair of rudders in the steering gear cannot work, the steering gear can basically achieve control Operation, so that the ammunition can basically hit the target.

Description

三位继电式舵机的容错控制系统及控制方法Fault-tolerant control system and control method of three-position relay steering gear

技术领域technical field

本发明涉及一种弹药上舵机的控制系统及方法,具体涉及一种三位继电式舵机的容错控制系统及控制方法。The invention relates to a control system and method for ammunition loading steering gear, in particular to a fault-tolerant control system and control method for a three-position relay steering gear.

背景技术Background technique

执行机构是弹药姿态控制系统的重要组成部分,尤其是导弹姿态控制系统的重要组成部分,由于长时间的储存引起的性能退化或者在飞行过程中的剧烈震动都有可能引起执行机构故障,这些故障能够引起导弹姿态控制系统的性能退化,甚至引起飞行姿态失稳而自毁。目前尚无良好的应对措施,主要是通过飞前检查仿真来杜绝安全隐患,一旦在飞行过程中发生意外,往往就放弃掉发生意外的弹药了,通过数量来弥补质量的不足;容错控制是提高姿态控制系统可靠性的重要手段,因此,对导弹执行机构故障进行容错控制,以提高导弹姿态控制系统的可靠性是十分必要的。容错控制的目标是使重构后的系统性能尽量接近原系统,优点是可以充分利用系统中各部件的冗余关系,实现故障下的最优控制。The actuator is an important part of the ammunition attitude control system, especially the missile attitude control system. The performance degradation caused by long-term storage or the severe vibration during the flight may cause the actuator failure. These failures It can cause the performance degradation of the missile attitude control system, and even cause the flight attitude to become unstable and self-destruct. At present, there are no good countermeasures. The main method is to eliminate potential safety hazards through pre-flight inspection simulation. Once an accident occurs during the flight, the ammunition that caused the accident is often abandoned, and the lack of quality is made up for by quantity; fault-tolerant control is to improve Therefore, it is very necessary to carry out fault-tolerant control for the failure of the missile actuator to improve the reliability of the missile attitude control system. The goal of fault-tolerant control is to make the performance of the reconfigured system as close as possible to the original system. The advantage is that it can make full use of the redundancy relationship of each component in the system to achieve optimal control under failure.

目前一般弹药上的执行机构都包括两对舵,当其中一对舵无法正常工作时,可以通过控制改变另外一对舵的工作状态来弥补可能造成的偏差,使得执行机构所产出的力矩接近期望值,从而实现容错控制。At present, the actuators on general ammunition include two pairs of rudders. When one pair of rudders fails to work normally, the possible deviation can be compensated by changing the working state of the other pair of rudders, so that the torque produced by the actuator is close to Expected value, so as to realize fault-tolerant control.

由于上述原因,本发明人对现有的舵机控制系统及方法做了深入研究,以便设计出一种能够解决上述问题的控制系统及方法。Due to the above reasons, the present inventor has done in-depth research on existing steering gear control systems and methods in order to design a control system and method that can solve the above problems.

发明内容Contents of the invention

为了克服上述问题,本发明人进行了锐意研究,设计出一种容错控制系统,其设置在低速滚转的末制导弹药上,所述容错控制系统用于接收弹药上的制导指令信息,并根据该信息控制舵机及其上的舵片工作,进而控制弹药的运动姿态,其中,所述容错控制系统包括舵片监测模块,其用于监测舵机上舵片的工作状态,并分析舵片是否能够正常工作,并根据其舵片的工作状态通知舵机指令计算模块选用不同的计算方法计算获得舵机指令,从而对舵机进行控制,即使舵机中的一对舵无法工作,舵机也能基本实现控制作业,使得弹药能够基本命中目标,从而完成本发明。In order to overcome the above-mentioned problems, the present inventor has carried out intensive research and designed a fault-tolerant control system, which is arranged on the low-speed rolling terminal guided ammunition. The fault-tolerant control system is used to receive the guidance instruction information on the ammunition, and according to This information controls the work of the steering gear and the rudder blades on it, and then controls the movement attitude of the ammunition. Wherein, the fault-tolerant control system includes a rudder blade monitoring module, which is used to monitor the working state of the steering blades on the steering gear, and analyze whether the rudder blades are It can work normally, and according to the working state of the steering gear, it notifies the steering gear command calculation module to select different calculation methods to calculate the steering gear command, so as to control the steering gear. Even if a pair of rudders in the steering gear cannot work, the steering gear will The control operation can be basically realized, so that the ammunition can basically hit the target, thereby completing the present invention.

具体来说,本发明的目的在于提供以下方面:Specifically, the object of the present invention is to provide the following aspects:

(1)一种三位继电式舵机的容错控制系统,所述容错控制系统设置在低速滚转的末制导弹药上,所述容错控制系统用于接收弹药上的制导指令信息,并根据该信息控制舵机及其上的舵片工作,进而控制弹药的运动姿态,其特征在于,该系统包括:(1) A fault-tolerant control system of a three-position relay steering gear, the fault-tolerant control system is arranged on the low-speed rolling terminal guided ammunition, and the fault-tolerant control system is used to receive the guidance instruction information on the ammunition, and according to The information controls the steering gear and the rudder plate on it, and then controls the movement attitude of the ammunition. It is characterized in that the system includes:

舵片监测模块001,其用于监测舵机上舵片的工作状态,并将舵片的工作状态信息传递至舵机指令计算模块002,其中,所述舵片的工作状态信息包括舵片工作正常和舵片工作不正常;;The rudder monitoring module 001 is used to monitor the working state of the rudder on the steering gear, and transmits the working state information of the rudder to the steering gear command calculation module 002, wherein the working state information of the rudder includes that the rudder is working normally and rudder blades not working properly;

舵机指令计算模块002,其用于接收制导指令信息和舵片的工作状态信息,并根据接收到的信息计算获得舵机指令,所述舵机指令包括弹药每旋转一周,弹药上每对舵片的工作角度;The steering gear command calculation module 002 is used to receive the guidance command information and the working status information of the rudder blades, and calculate and obtain the steering gear commands according to the received information. The working angle of the film;

陀螺信号接收模块003,其用于接收陀螺信号,根据接收到的陀螺信号计算获得舵机位置信息和弹体旋转周期信息,并将获得的舵机位置信息和弹体旋转周期信息传输至起控时间计算模块004;和The gyro signal receiving module 003 is used to receive the gyro signal, calculate and obtain the position information of the steering gear and the rotation period information of the missile body according to the received gyro signal, and transmit the obtained position information of the steering gear and the rotation period information of the missile body to the starting control time calculation module 004; and

起控时间计算模块004,其用于接收舵机位置信息、弹体旋转周期信息和舵机指令信息,并根据接收到的信息计算获得舵机起控时间和工作时间长度。The control start time calculation module 004 is used to receive the position information of the steering gear, the rotation period information of the projectile body and the command information of the steering gear, and calculate the control start time and working time length of the steering gear according to the received information.

(2)根据上述(1)所述的三位继电式舵机的容错控制系统,其特征在于,当所述舵片监测模块001传递出的工作状态信息包括舵机上两对舵片都工作正常时,弹药每旋转一周,舵片打舵3次;当所述舵片监测模块001传递出的工作状态信息包括舵机上的两对舵片中一对舵片工作正常,另一对舵片工作不正常时,弹药每旋转一周,舵片打舵2次。(2) According to the fault-tolerant control system of the three-position relay steering gear described in the above (1), it is characterized in that, when the working status information transmitted by the steering gear monitoring module 001 includes two pairs of steering gears on the steering gear are all working Normally, every time the ammunition rotates one week, the rudder blades are ruddered 3 times; when the working state information transmitted by the rudder blade monitoring module 001 includes that one pair of rudder blades on the steering gear is working normally, and the other pair of rudder blades is working normally. When the work is not normal, the rudder blade will be ruddered 2 times every time the ammunition rotates once.

(3)根据上述(2)所述的三位继电式舵机的容错控制系统,其特征在于,所述舵机上的两对舵片交替打舵工作。(3) According to the fault-tolerant control system of the three-position relay steering gear described in the above (2), it is characterized in that the two pairs of rudder discs on the steering gear work alternately.

(4)根据上述(3)所述的三位继电式舵机的容错控制系统,其特征在于,所述打舵是指任意一对舵片执行偏转预设角度,并在预设时间后回复原位的工作过程,其中所述预设角度优选为每次打舵的舵片工作角度,所述预设时间优选为每次打舵的工作时间长度。(4) According to the fault-tolerant control system of the three-position relay steering gear described in the above (3), it is characterized in that, the said rudder means that any pair of rudder blades deflect to a preset angle, and after a preset time The working process of returning to the original position, wherein the preset angle is preferably the working angle of the rudder blade for each rudder steering, and the preset time is preferably the working time length of each rudder steering.

(5)根据上述(2)所述的三位继电式舵机的容错控制系统,其特征在于,当两对舵片都能正常工作时,舵机指令计算模块002通过下式(一)、(二)、(三)获得每次打舵的舵片工作角度,(5) According to the fault-tolerant control system of the three-position relay steering gear described in the above (2), it is characterized in that, when both pairs of rudder discs can work normally, the steering gear command calculation module 002 passes the following formula (1) , (2), (3) obtain the working angle of the rudder blade for each rudder,

其中,分别表示在弹药旋转一周的过程中第一次打舵时的舵片工作角度、第二次打舵时的舵片工作角度和第三次打舵时的舵片工作角度;δ1表示在弹药旋转一周的过程中第一次打舵时舵机的等效舵偏角,δ2表示在弹药旋转一周的过程中第二次打舵时舵机的等效舵偏角,δ3表示在弹药旋转一周的过程中第三次打舵时舵机的等效舵偏角; 其中,δ有效表示有效舵偏角指令。in, with Respectively represent the working angle of the rudder blade when the rudder is driven for the first time, the working angle of the rudder blade when the rudder is driven for the second time, and the working angle of the rudder blade when the rudder is driven for the third time during the round of ammunition rotation ; The equivalent rudder deflection angle of the steering gear when the rudder is turned for the first time in the process of one revolution of the ammunition, δ 2 represents the equivalent rudder deflection angle of the steering gear when the rudder is driven for the second time during the round of ammunition rotation, and δ 3 represents the The equivalent rudder deflection angle of the steering gear when the rudder is turned for the third time during one revolution; Among them, δ effectively represents the effective rudder deflection angle command.

(6)根据上述(5)所述的三位继电式舵机的容错控制系统,其特征在于,起控时间计算模块004通过下式(四)、(五)、(六)获得每次打舵的工作时间长度,(6) According to the fault-tolerant control system of the three-position relay steering gear described in the above-mentioned (5), it is characterized in that the control time calculation module 004 obtains each length of working time at the rudder,

其中,代表弹体的旋转周期,n代表弹药的实时转速,t1表示在弹药旋转一周的过程中第一次打舵的工作时间长度,t2表示在弹药旋转一周的过程中第二次打舵的工作时间长度,t3表示在弹药旋转一周的过程中第三次打舵的工作时间长度;in, Represents the rotation period of the projectile body, n represents the real-time rotational speed of the ammunition, t 1 represents the working time of the first rudder during the round of the ammunition rotation, t 2 represents the working time of the second rudder during the round of the ammunition rotation Working time length, t 3 represents the working time length of the third rudder during the round of ammunition rotation;

通过下式(七)、(八)、(九)获得每次打舵的舵机起控时间;Through the following formula (seven), (eight), (nine) obtain the control time of the steering gear of each rudder;

其中,T1、T1、T1分别表示在弹药旋转一周的过程中第一次打舵的舵机起控时间、第二次打舵的舵机起控时间和第三次打舵的舵机起控时间;分别表示上一周期的弹体在舵机三个位置时的时刻。Among them, T 1 , T 1 , and T 1 represent the start-up time of the steering gear for the first rudder, the start-up time of the second rudder, and the rudder for the third rudder, respectively, in the process of the round of ammunition rotation. Machine start control time; Respectively represent the moment when the projectile in the previous cycle is in the three positions of the steering gear.

(7)根据上述(2)所述的三位继电式舵机的容错控制系统,其特征在于,当两对舵片中一对能够正常工作,另一对不能正常工作时,舵机指令计算模块002通过下式(十)、(十一)获得每次打舵的舵片工作角度,(7) According to the fault-tolerant control system of the three-position relay steering gear described in the above (2), it is characterized in that, when one of the two pairs of steering discs can work normally, and the other pair cannot work normally, the steering gear command Calculation module 002 obtains the working angle of the rudder blade of each rudder through the following formulas (10) and (11),

其中,δ有效表示有效的舵偏角指令。Among them, δ effectively represents the effective rudder deflection angle command.

(8)根据上述(7)所述的三位继电式舵机的容错控制系统,其特征在于,起控时间计算模块004通过下式(十二)、(十三)获得每次打舵的工作时间长度,(8) According to the fault-tolerant control system of the three-position relay steering gear described in the above (7), it is characterized in that the start-up time calculation module 004 obtains the rudder every time by the following formula (12) and (13). length of working hours,

通过下式(十四)、(十五)获得每次打舵的舵机起控时间;Through the following formula (14), (15) obtain the starting control time of the steering gear of each rudder;

(9)一种三位继电式舵机的容错控制方法,其特征在于,该方法是通过如上述(1)~(8)所述的三位继电式舵机的容错控制系统实现的。(9) A fault-tolerant control method of a three-position relay steering gear, characterized in that the method is realized by the fault-tolerant control system of the three-position relay steering gear as described in (1) to (8) above .

根据本发明提供的控制系统的有益效果在于能够在一对舵片突然失灵的情况下及时调整控制方式,而不是按照预定的方式继续制导,从而基本能够通过一对舵机实现两对舵机的控制作业,不至于因为一对舵片失灵而使得弹药偏离目标过远,最终能够使得弹药基本命中目标。The beneficial effect of the control system provided according to the present invention is that the control mode can be adjusted in time in the case of a sudden failure of a pair of rudder blades, instead of continuing to guide according to a predetermined method, thereby basically realizing the control of two pairs of steering gears through a pair of steering gears. Control the operation so that the ammunition will not deviate too far from the target due to the failure of a pair of rudder blades, and eventually the ammunition can basically hit the target.

附图说明Description of drawings

图1示出根据本发明一种优选实施方式的三位继电式舵机的容错控制系统整体结构示意图;Fig. 1 shows a schematic diagram of the overall structure of a fault-tolerant control system of a three-position relay steering gear according to a preferred embodiment of the present invention;

图2示出根据本发明一种优选实施方式的三位继电式舵机的容错控制系统工作流程图;Fig. 2 shows the work flow diagram of the fault-tolerant control system of three relay steering gears according to a preferred embodiment of the present invention;

图3示出PWM舵指令示意图;Fig. 3 shows the schematic diagram of PWM rudder command;

图4示出末制导炮弹后视图;Figure 4 shows the rear view of the terminally guided projectile;

图5示出滚转弹控制力示意图;Figure 5 shows a schematic diagram of the control force of the rolling bomb;

图6示出目标1g机动时脱靶量;Figure 6 shows the amount of miss when the target is maneuvering at 1g;

图7示出目标2g机动时脱靶量。Figure 7 shows the amount of miss when the target is maneuvering at 2g.

附图标号说明:Explanation of reference numbers:

001-舵片监测模块001-rudder monitoring module

002-舵机指令计算模块002-Steering gear command calculation module

003-陀螺信号接收模块003-Gyro signal receiving module

004-起控时间计算模块004-start control time calculation module

具体实施方式detailed description

下面通过附图和实施例对本发明进一步详细说明。通过这些说明,本发明的特点和优点将变得更为清楚明确。The present invention will be further described in detail through the drawings and examples below. Through these descriptions, the features and advantages of the present invention will become more apparent.

在这里专用的词“示例性”意为“用作例子、实施例或说明性”。这里作为“示例性”所说明的任何实施例不必解释为优于或好于其它实施例。尽管在附图中示出了实施例的各种方面,但是除非特别指出,不必按比例绘制附图。The word "exemplary" is used exclusively herein to mean "serving as an example, embodiment, or illustration." Any embodiment described herein as "exemplary" is not necessarily to be construed as superior or better than other embodiments. While various aspects of the embodiments are shown in drawings, the drawings are not necessarily drawn to scale unless specifically indicated.

由于末制导炮弹属于低速滚转弹,采用双通道控制的三位继电式舵机,三位继电式舵机的脉宽调制(PWM)指令有三种状态,分别对应的舵偏角为-δmax、0和δmax。在每个调制周期的初始时刻,PWM指令系统对模拟指令进行采样,根据指令极性和大小计算PWM指令的宽度并生成中心时刻固定极性相同的PWM指令,如图3所示,PWM周期为TC,其指令中心时刻为τ。0~T1为舵机工作时段,Td为PWM指令宽度,由指令系统计算得到,最大PWM宽度为T1;T1~TC为舵机休整时段,该时段长度应大于舵机迟滞时间的两倍,在此期间舵偏角保持为零;Since the terminal guided projectile is a low-speed rolling projectile, a three-position relay steering gear controlled by two channels is adopted. The pulse width modulation (PWM) command of the three-position relay steering gear has three states, and the corresponding rudder deflection angles are - δ max , 0 and δ max . At the initial moment of each modulation cycle, the PWM command system samples the analog command, calculates the width of the PWM command according to the polarity and size of the command, and generates a PWM command with the same fixed polarity at the central moment, as shown in Figure 3, the PWM cycle is T C , whose instruction center time is τ. 0~T 1 is the working period of the steering gear, T d is the width of the PWM command, which is calculated by the command system, and the maximum PWM width is T 1 ; T 1 to T C is the rest period of the steering gear, and the length of this period should be greater than the delay time of the steering gear twice of , during which the rudder angle remains zero;

末制导弹药采用的继电式舵机对应于正/负/零的输入信号,可以输出+5°/-5°/0°的舵摆角,舵翼的工作状态是在舵摆角的三个工作状态做往复运动,其在各个工作状态所停留时间的长短由制导与控制系统的指令信号控制,从而产生平均控制力以操纵弹药机动,从而实现了对于弹药的线性比例控制;其中,具体的控制作业是通过舵机控制舵片实现的,而当一部分舵片因故无法工作时,舵机需要控制剩余的舵片采用另外的控制方案进行工作,以达到相同或近似的控制效果。The relay steering gear used in the terminal guided ammunition corresponds to the positive/negative/zero input signal, and can output +5°/-5°/0° rudder swing angle. Each working state makes reciprocating motion, and the length of time it stays in each working state is controlled by the command signal of the guidance and control system, so as to generate an average control force to manipulate the maneuvering of the ammunition, thereby realizing the linear proportional control of the ammunition; among them, specifically The control operation is realized by controlling the rudder slices through the steering gear, and when some rudder slices cannot work for some reason, the steering gear needs to control the remaining rudder slices to work with another control scheme to achieve the same or similar control effect.

具体来说,如图1和图2中所示,根据本发明提供的一种三位继电式舵机的容错控制系统,所述容错控制系统设置在低速滚转的末制导弹药上,所述容错控制系统用于接收弹药上的制导指令信息,并根据该信息控制舵机及其上的舵片工作,进而控制弹药的运动姿态,该系统包括:Specifically, as shown in Fig. 1 and Fig. 2, according to the fault-tolerant control system of a three-position relay steering gear provided by the present invention, the fault-tolerant control system is set on the low-speed rolling terminal guided ammunition, so The above-mentioned fault-tolerant control system is used to receive the guidance command information on the ammunition, and control the steering gear and the rudder blades on it according to the information, and then control the movement attitude of the ammunition. The system includes:

舵片监测模块001,其用于监测舵机上舵片的工作状态,并将舵片的工作状态信息传递至舵机指令计算模块002,其中,所述舵片的工作状态信息包括舵片工作正常和舵片工作不正常;The rudder monitoring module 001 is used to monitor the working state of the rudder on the steering gear, and transmits the working state information of the rudder to the steering gear command calculation module 002, wherein the working state information of the rudder includes that the rudder is working normally and rudder blades are not working properly;

舵机指令计算模块002,其用于接收制导指令信息和舵片的工作状态信息,并根据接收到的信息计算获得舵机指令,所述舵机指令包括弹药每旋转一周,弹药上每对舵片的工作角度;The steering gear command calculation module 002 is used to receive the guidance command information and the working status information of the rudder blades, and calculate and obtain the steering gear commands according to the received information. The working angle of the film;

陀螺信号接收模块003,其用于接收陀螺信号,根据接收到的陀螺信号计算获得舵机位置信息和弹体旋转周期信息,并将获得的舵机位置信息和弹体旋转周期信息传输至起控时间计算模块004;The gyro signal receiving module 003 is used to receive the gyro signal, calculate and obtain the position information of the steering gear and the rotation period information of the missile body according to the received gyro signal, and transmit the obtained position information of the steering gear and the rotation period information of the missile body to the starting control Time calculation module 004;

起控时间计算模块004,其用于接收舵机位置信息、弹体旋转周期信息和舵机指令信息,并根据接收到的信息计算获得舵机起控时间和工作时间长度。The control start time calculation module 004 is used to receive the position information of the steering gear, the rotation period information of the projectile body and the command information of the steering gear, and calculate the control start time and working time length of the steering gear according to the received information.

其中,所述舵片监测模块001包括舵偏角传感器,其用于检测舵机的打舵角度,并比较该角度是否正确,并反馈两种状态信息,其一为舵机工作正常,其二是舵机工作不正常,所述舵机工作不正常包括舵机打舵角度不正确和不打舵的情况等。Wherein, the rudder blade monitoring module 001 includes a rudder angle sensor, which is used to detect the rudder angle of the steering gear, and compares whether the angle is correct, and feeds back two kinds of status information, one of which is that the steering gear is working normally, and the other is that the steering gear is working normally. The reason is that the steering gear is not working properly. The abnormal working of the steering gear includes the situation that the steering gear is not working at the correct rudder angle or not.

所述舵机指令计算模块002接收到的制导指令信息是由弹药上的控制系统发出的,所述控制系统通过测量元件获知弹药的当前位置信息、速度信息、角度信息及目标位置信息等,并据此测算出为了命中目标弹药需要调整的方向角度,如需要在俯仰方向调整预定角度,在偏航方向调整预定角度,所述制导指令信息即包括所述需要调整的方向角度。The guidance command information received by the steering gear command calculation module 002 is sent by the control system on the ammunition, and the control system obtains the current position information, speed information, angle information and target position information of the ammunition through the measuring element, and Based on this, the directional angle that needs to be adjusted in order to hit the target ammunition is calculated. If a predetermined angle needs to be adjusted in the pitch direction and a predetermined angle is adjusted in the yaw direction, the guidance instruction information includes the directional angle that needs to be adjusted.

在一个优选的实施方式中,当所述舵片监测模块001传递出的工作状态信息包括舵机上两对舵片都工作正常时,弹药每旋转一周,舵片打舵3次;当所述舵片监测模块001传递出的工作状态信息包括舵机上两对舵片中一对工作正常,另一对工作不正常时,弹药每旋转一周,舵片打舵2次;其中,所述舵机上的两对舵片交替打舵工作,所述打舵是指任意一对舵片执行偏转预设角度,并在预设时间后回复原位的工作过程,其中所述预设角度优选为每次打舵的舵片工作角度,所述预设时间优选为每次打舵的工作时间长度。In a preferred embodiment, when the working status information transmitted by the rudder monitoring module 001 includes that both pairs of rudders on the steering gear are working normally, the rudders are ruddered 3 times for each round of ammunition rotation; The working status information transmitted by the piece monitoring module 001 includes that one of the two pairs of rudder pieces on the steering gear is working normally, and when the other pair is not working normally, the rudder pieces are ruddered 2 times for each rotation of the ammunition; Two pairs of rudder pieces work alternately, and the rudder refers to the working process that any pair of rudder pieces deflects a preset angle and returns to the original position after a preset time, wherein the preset angle is preferably each time the rudder is turned. The working angle of the rudder blade of the rudder, the preset time is preferably the working time length of each rudder.

具体来说,当弹体坐标系与准弹体坐标系重合时,末制导炮弹后视图如图4中所示。炮弹沿顺时针旋转,四片舵机沿弹体方向按照逆时针顺序呈1-2-3-4顺序分布。其中,(1-3)舵为一对同动舵,定义在如图4中所示两坐标系重合位置打正舵时产生Oy4方向的力,负舵反之;(2-4)舵为一对同动舵,定义在如图所示两坐标系重合位置打正舵产生负Oz4方向的力;Specifically, when the projectile coordinate system coincides with the quasi-projectile coordinate system, the rear view of the terminally guided projectile is shown in Figure 4. The shell rotates clockwise, and the four servos are distributed in the order of 1-2-3-4 counterclockwise along the direction of the shell. Among them, (1-3) rudders are a pair of co-moving rudders, defined as shown in Figure 4 when the two coordinate systems coincide with each other, when the rudders are positively driven, the force in the direction of Oy 4 will be generated, and vice versa for negative rudders; (2-4) rudders are A pair of co-moving rudders, define the force in the negative Oz 4 direction when the two coordinate systems overlap as shown in the figure.

由继电式舵机的工作原理可知,由于炮弹滚转时继电式舵机产生的控制力F是作用在与所需控制方向为中心的一定区域内的,所以肯定存在舵控制力不完全在所需方向的效率问题,假设需要弹体产生惯性空间内向上的控制力,则炮弹的控制力作用如图5所示,图5中,炮弹的滚转角γ由-90°~+90°变化的半周内,控制力的作用范围为(舵机舵摆角为+5°),在其余位置舵机的舵摆角为0°,即不产生控制力。在γ的变化范围内,控制力占空比为:It can be seen from the working principle of the relay steering gear that the control force F generated by the relay steering gear acts on a certain area centered on the desired control direction when the shell rolls, so there must be incomplete rudder control force In terms of efficiency in the desired direction, assuming that the projectile needs to generate an upward control force in the inertial space, the control force of the projectile is shown in Figure 5. In Figure 5, the roll angle γ of the projectile is from -90° to +90° In half a cycle of change, the range of control force is (The rudder swing angle of the steering gear is +5°). In other positions, the rudder swing angle of the steering gear is 0°, that is, no control force is generated. Within the variation range of γ, the control force duty cycle is:

当考虑由于方向不正确使控制力效率有所降低,则此时舵机在作用时间内所产生的平均控制力为:When considering that the efficiency of the control force is reduced due to the incorrect direction, the steering gear is at this time The average control force generated during the action time is:

式中,R为弹体半径,定义效率系数为则当炮弹滚转-90°~+90°时,总的平均力为: In the formula, R is the radius of the projectile, and the efficiency coefficient is defined as Then when the shell rolls -90°~+90°, the total average force is:

则可将舵机固定+5°舵摆角工作产生的平均作用力等效看作有效舵转角工作一周(2π)产生的同等的作用力,其有效舵转角的表达式为: Then the average force produced by the steering gear at a fixed +5° rudder swing angle can be regarded as the equivalent force produced by the effective rudder rotation angle for one week (2π), and the expression of the effective rudder rotation angle is:

在一个优选的实施方式中,当两对舵片都工作正常时,舵机指令计算模块002通过下式(一)、(二)、(三)获得每次打舵的舵片工作角度,In a preferred embodiment, when the two pairs of rudder blades are all working normally, the steering gear command calculation module 002 obtains the working angle of the rudder blades of each rudder through the following formulas (1), (2), and (3),

其中,表示在弹药旋转一周的过程中第一次打舵时的舵片工作角度、表示在弹药旋转一周的过程中第二次打舵时的舵片工作角度,表示在弹药旋转一周的过程中第三次打舵时的舵片工作角度;δ1表示在弹药旋转一周的过程中第一次打舵时舵机的等效舵偏角,δ2表示在弹药旋转一周的过程中第二次打舵时舵机的等效舵偏角,δ3表示在弹药旋转一周的过程中第三次打舵时舵机的等效舵偏角, 其中,δ有效表示由导引头测量得到的进动角速度转换得到的有效舵转角指令,简称为有效舵偏角指令。in, Indicates the working angle of the rudder blade when the rudder is turned for the first time during the round of ammunition rotation, Indicates the working angle of the rudder when the rudder is turned for the second time during the round of ammunition rotation, Indicates the working angle of the rudder when the rudder is turned for the third time during the round of ammunition rotation ; The equivalent rudder deflection angle of the steering gear when the rudder is turned for the second time in the process of one round of rotation, δ 3 represents the equivalent rudder deflection angle of the steering gear when the rudder is hit for the third time during the round of ammunition rotation, Among them, δ effectively represents the effective rudder rotation angle command converted from the precession angular velocity measured by the seeker, which is referred to as the effective rudder deflection angle command.

据末制导炮弹末端比例导引制导工作原理,可得有效舵转角指令δ有效与导引头进动角速度的关系可得,式中Kδ为舵转角指令利用系数,得到由导引头进动角速度引起的有效舵转角指令,如下式所示,According to the working principle of proportional guidance and guidance at the end of the terminal guided projectile, the effective rudder rotation angle command δ and the precession angular velocity of the seeker can be obtained The relationship can be obtained, In the formula, K δ is the utilization coefficient of the rudder angle command, and the effective rudder angle command caused by the precession angular velocity of the seeker is obtained, as shown in the following formula,

其中,表示导引头进动角速度,是由导引头测量得到的in, Indicates the precession angular velocity of the seeker, which is obtained from the measurement of the seeker

在一个优选的实施方式中,起控时间计算模块004通过下式(四)、(五)、(六)获得每次打舵的工作时间长度,In a preferred embodiment, the control time calculation module 004 obtains the working time length of each rudder through the following formulas (four), (five), and (six),

其中,其表示弹体的旋转周期,其中n表示弹药的实时转速,t1表示在弹药旋转一周的过程中第一次打舵的工作时间长度,t2表示在弹药旋转一周的过程中第二次打舵的工作时间长度,t3表示在弹药旋转一周的过程中第三次打舵的工作时间长度;in, It represents the rotation period of the projectile body, where n represents the real-time rotational speed of the ammunition, t 1 represents the working time of the first rudder steering during the round of the ammunition rotation, and t 2 represents the second rudder steering during the round rotation of the ammunition. The length of the working time of the rudder, t3 represents the working time of the third rudder during the round of ammunition rotation;

优选地,通过下式(七)、(八)、(九)获得每次打舵的舵机起控时间;Preferably, the steering gear start-control time of each rudder is obtained by following formula (seven), (eight), (nine);

其中,T1表示在弹药旋转一周的过程中第一次打舵的舵机起控时间,、T2表示在弹药旋转一周的过程中第二次打舵的舵机起控时间,T3表示在弹药旋转一周的过程中第三次打舵的舵机起控时间;表示上一周期的弹体在舵机第一次打舵位置时的时刻,表示上一周期的弹体在舵机第二次打舵位置时的时刻,表示上一周期的弹体在舵机第三次打舵位置时的时刻。当弹药转速6.6r/s时,末制导炮弹滚转周期约150ms,激光目标指示器发射的激光信号为周期50ms,正好将一个滚转周期均分为3份,所以,第一次打舵的中心位置为滚转角0度,第二次打舵的中心位置为滚转角120度,第三次打舵的中心位置为滚转角240度。Among them, T 1 represents the start-up time of the steering gear for the first rudder during the round of ammunition rotation, T 2 represents the start-up time of the steering gear for the second rudder during the round of ammunition rotation, T 3 represents The start-up time of the steering gear for the third rudder during the round of ammunition rotation; Indicates the moment when the projectile in the previous cycle is at the rudder position for the first time, Indicates the moment when the projectile in the previous cycle is at the second rudder position of the steering gear, Indicates the moment when the projectile in the previous cycle is at the third rudder position of the steering gear. When the speed of the ammunition is 6.6r/s, the rolling period of the terminal guided projectile is about 150ms, and the laser signal emitted by the laser target indicator has a period of 50ms, which just divides a rolling period into 3 parts. Therefore, the first rudder The center position is the roll angle of 0 degrees, the center position of the second rudder stroke is the roll angle of 120 degrees, and the center position of the third rudder stroke is the roll angle of 240 degrees.

在末制导炮弹末制导过程中,激光目标指示器发射的激光信号为周期50ms,占空比为4:1的离散信号,一个周期内,舵机工作最大时间为40ms,则舵机最大占空比为40/50=0.8,而末制导炮弹在没有干扰情况下,末制导段的滚转速率基本稳定在6.6转/秒,则一个周期内舵机最大工作角度为40ms×6.6×360°≈96°,根据前面计算末制导炮弹有效舵转角时的公式可得其效率系数为:In the terminal guidance process of the terminal guided projectile, the laser signal emitted by the laser target indicator is a discrete signal with a period of 50ms and a duty ratio of 4:1. The ratio is 40/50=0.8, and the rolling rate of the terminal guidance section is basically stable at 6.6 revolutions/second under the condition of no interference of the terminal guidance projectile, then the maximum working angle of the steering gear in one cycle is 40ms×6.6×360°≈ 96°, according to the previous formula for calculating the effective rudder angle of the terminal guided projectile, the efficiency coefficient can be obtained as:

则舵机工作的有效占空比为:0.89×0.8=0.712;Then the effective duty cycle of the steering gear is: 0.89×0.8=0.712;

对应一个周期内单轴舵机工作的最大有效舵转角为:The maximum effective rudder angle corresponding to the single-axis steering gear working in one cycle is:

δ′max=5°×0.712=3.56°δ′ max =5°×0.712=3.56°

炮弹滚转一周时间为1/6.6≈150ms。末制导炮弹在接受到目标反射激光指示器信号后舵机工作,则炮弹滚转一周舵机可工作150/50=3次。The round time of the shell rolling is 1/6.6≈150ms. After the terminal guided projectile receives the target reflected laser pointer signal, the steering gear works, and the steering gear can work 150/50=3 times after the shell rolls a circle.

由于末制导炮弹具有两对互相垂直方向的舵机,可通过两对舵机工作,产生所需合力。通过分析炮弹滚转一周舵机的工作情况,得到舵机的平均最大有效舵转角。Since the terminal guided projectile has two pairs of steering gears perpendicular to each other, it can work through the two pairs of steering gears to generate the required resultant force. The average maximum effective rudder angle of the steering gear is obtained by analyzing the working conditions of the steering gear when the shell rolls a circle.

假设舵机需产生的过载方向向上,在炮弹滚转一周之内,工作三次,三次产生的方向向上的有效舵转角分别最大为:Assuming that the overload direction of the steering gear to be generated is upward, within one round of the shell rolling, it works three times, and the effective rudder rotation angles in the upward direction generated by the three times are respectively maximum:

则弹体滚转一周其最大平均有效舵转角为:Then the maximum average effective rudder angle of the projectile rolling one week is:

在末制导炮弹比例导引末制导段,计算有效舵转角为弹体滚转一周舵机工作积分的平均值,故其最大值不应超过4.58°,舵机的有效舵转角非线性饱和阀值为±4.58°。In the final guidance section of the proportional guidance of the terminal guided projectile, the calculated effective rudder angle is the average value of the work integral of the steering gear during the roll of the projectile body, so its maximum value should not exceed 4.58°, and the effective rudder angle of the steering gear is the nonlinear saturation threshold. is ±4.58°.

在一个优选的实施方式中,当所述舵偏角传感器检测到舵机出现故障后,末制导炮弹只有一对舵工作,同时控制俯仰和偏航。另一对舵机卡死在某一位置,由于末制导炮弹的滚转特性,在滚转周期内,舵机产生的等效力为零。通过分析炮弹滚转一周舵机的工作情况,得到舵机的平均最大有效舵转角;In a preferred embodiment, when the rudder deflection sensor detects that the steering gear fails, only one pair of rudders works for the terminally guided projectile, and the pitch and yaw are controlled simultaneously. The other pair of steering gears are stuck at a certain position. Due to the rolling characteristics of the terminal guided projectile, the equivalent force produced by the steering gears is zero during the rolling period. By analyzing the working conditions of the steering gear when the shell rolls one week, the average maximum effective rudder angle of the steering gear is obtained;

具体来说,当两对舵片中一对工作正常,另一对工作不正常时,舵机指令计算模块002通过下式(十)、(十一)获得每次打舵的舵片工作角度,Specifically, when one of the two pairs of rudder blades works normally and the other pair does not work normally, the steering gear command calculation module 002 obtains the working angle of the rudder blades for each rudder through the following formulas (10) and (11) ,

优选地,起控时间计算模块004通过下式(十二)、(十三)获得每次打舵的工作时间长度,Preferably, the control time calculation module 004 obtains the working time length of each rudder through the following formula (12), (13),

通过下式(十四)、(十五)获得每次打舵的舵机起控时间;Through the following formula (14), (15) obtain the starting control time of the steering gear of each rudder;

假设舵机需产生的过载方向向上,在炮弹滚转一周之内,工作两次,两次产生的方向向上的有效舵转角分别最大为:Assuming that the overload direction of the steering gear to be generated is upward, within one round of the cannonball roll, it works twice, and the effective rudder rotation angles in the upward direction generated by the two times are respectively maximum:

则弹体滚转一周其最大平均有效舵转角为:Then the maximum average effective rudder angle of the projectile rolling one week is:

在末制导炮弹比例导引末制导段,计算有效舵转角为弹体滚转一周舵机工作积分的平均值,故其最大值不应超过3.56°,舵机的有效舵转角非线性饱和阀值为3.56°。In the final guidance section of the proportional guidance of the terminal guided projectile, the effective rudder angle is calculated as the average value of the work integral of the steering gear for one circle of the projectile body, so its maximum value should not exceed 3.56°, and the effective rudder angle of the steering gear is the nonlinear saturation threshold. is 3.56°.

当两对舵机同时工作时,炮弹滚转一周,舵机的平均最大有效舵转角4.58°时,末制导炮弹最大可用法向过载nmax=2.51g;When two pairs of steering gears work at the same time, the projectile rolls a circle, and when the average maximum effective steering angle of the steering gear is 4.58°, the maximum available normal overload n max of the terminal guided projectile is 2.51g;

当一对舵机工作时,炮弹滚转一周,舵机的平均最大有效舵转角3.56°时,末制导炮弹最大可用法向过载nmax=1.95g;When a pair of steering gears are working, the projectile rolls a circle, and when the average maximum effective rudder angle of the steering gear is 3.56°, the maximum available normal overload of the terminal guided projectile n max = 1.95g;

具体来说:Specifically:

末制导炮弹在末制导段,末制导炮弹的气动力系数变化不大,则通过最大平衡攻角αb可求得:在末制导段的最大升力:The aerodynamic coefficient of the terminal guided projectile does not change much in the terminal guidance section of the terminal guided projectile, so the maximum lift force in the terminal guidance section can be obtained through the maximum equilibrium angle of attack α b :

最大可用法向过载: Maximum available normal overload:

结合末制导炮弹飞行弹道及大气参数,可求得末制导炮弹最大可用法向过载:质量m=50.8Kg,参考面积S=0.01815m2,大气密度ρ=1.16kg/m3Combined with the flight trajectory and atmospheric parameters of the terminal guided projectile, the maximum available normal overload of the terminal guided projectile can be obtained: mass m=50.8Kg, reference area S=0.01815m 2 , atmospheric density ρ=1.16kg/m 3 ;

末制导段速度变化不大,取v=220m/s,升力系数对攻角的偏导数升力系数对舵偏角的偏导数攻角与舵转角之间的比例系数A=2,α=A×δ;The speed of the final guidance section does not change much, take v=220m/s, the partial derivative of the lift coefficient with respect to the angle of attack Partial derivative of lift coefficient with respect to rudder deflection angle Proportional coefficient between attack angle and rudder angle A=2, α=A×δ;

当两对舵机同时工作时,炮弹滚转一周,舵机的平均最大有效舵转角4.58°时,求得末制导炮弹最大可用法向过载nmax=2.51g;When two pairs of steering gears are working at the same time, the projectile rolls a circle, and when the average maximum effective steering angle of the steering gear is 4.58°, the maximum available normal overload n max of the final guided projectile is obtained = 2.51g;

当一对舵机工作时,炮弹滚转一周,舵机的平均最大有效舵转角3.56°时,求得末制导炮弹最大可用法向过载nmax=1.95g。When a pair of steering gears are working, the projectile rolls a circle, and when the average maximum effective rudder angle of the steering gear is 3.56°, the maximum available normal overload n max = 1.95g of the final guided projectile is obtained.

即,当目标1g加速度机动时,在保证末制导时间够长的情况下,脱靶量为零;当目标2g加速度机动时,在保证末制导时间够长的情况下,两对舵工作时脱靶量为零,一对舵工作时脱靶量不为零。That is, when the target is maneuvering at an acceleration of 1g, the amount of miss is zero when the final guidance time is long enough; when the target is maneuvering at an acceleration of 2g, the amount of miss is zero when the two pairs of rudders are working under the condition that the final guidance time is long enough. is zero, and the miss amount is not zero when a pair of rudders are working.

通过模拟仿真对控制舵机数量和目标机动不同时脱靶量的变化情况,获得目标1g机动时脱靶量和目标2g机动时脱靶量,如图6和图7中所示,其中当目标1g加速度机动时,在保证末制导时间够长的情况下,脱靶量为零;当目标2g加速度机动时,在保证末制导时间够长的情况下,两对舵工作时脱靶量为零,一对舵工作时脱靶量不为零,从而可知当一对舵机出现故障后,通过改变控制方法,利用一对舵机可以基本实现对末制导炮弹的控制。By simulating the change of the number of control steering gear and the amount of miss when the target maneuvers are different, the amount of miss when the target is maneuvering at 1g and the amount of miss when the target is maneuvering at 2g are obtained, as shown in Figures 6 and 7. When the terminal guidance time is ensured to be long enough, the miss amount is zero; when the target is maneuvering with an acceleration of 2g, and the terminal guidance time is ensured to be long enough, the miss amount is zero when the two pairs of rudders are working, and the one pair of rudders is working When the amount of miss is not zero, it can be seen that when a pair of steering gear fails, by changing the control method, the use of a pair of steering gear can basically realize the control of the terminal guided projectile.

根据本发明提供的一种三位继电式舵机的容错控制方法,其特征在于,该方法是通过如上述文所述的三位继电式舵机的容错控制系统实现的。A fault-tolerant control method for a three-position relay steering gear according to the present invention is characterized in that the method is realized by the fault-tolerant control system for a three-position relay steering gear as described above.

以上结合了优选的实施方式对本发明进行了说明,不过这些实施方式仅是范例性的,仅起到说明性的作用。在此基础上,可以对本发明进行多种替换和改进,这些均落入本发明的保护范围内。The present invention has been described above in conjunction with preferred embodiments, but these embodiments are only exemplary and serve as illustrations only. On this basis, various replacements and improvements can be made to the present invention, all of which fall within the protection scope of the present invention.

Claims (9)

1. The utility model provides a fault-tolerant control system of tribit relay formula steering wheel, fault-tolerant control system sets up on the last guidance ammunition of low-speed roll, fault-tolerant control system is used for receiving guidance instruction information on the ammunition to according to this information control steering wheel and the rudder piece work on it, and then the motion gesture of control ammunition, its characterized in that, this system includes:
the rudder piece monitoring module (001) is used for monitoring the working state of a rudder piece on a steering engine and transmitting the working state information of the rudder piece to the steering engine instruction calculating module (002), wherein the working state information of the rudder piece comprises normal working of the rudder piece and abnormal working of the rudder piece;
the steering engine instruction calculation module (002) is used for receiving guidance instruction information and the working state information of the rudder pieces and calculating to obtain a steering engine instruction according to the received information, wherein the steering engine instruction comprises the working angle of each pair of rudder pieces on ammunition when the ammunition rotates for one circle;
the gyro signal receiving module (003) is used for receiving gyro signals, calculating to obtain steering engine position information and projectile body rotation period information according to the received gyro signals, and transmitting the obtained steering engine position information and projectile body rotation period information to the control starting time calculating module (004); and
and the control starting time calculation module (004) is used for receiving the steering engine position information, the projectile body rotation period information and the steering engine instruction information and calculating and obtaining the control starting time and the working time length of the steering engine according to the received information.
2. The fault-tolerant control system of the three-position relay steering engine according to claim 1, wherein when the operating state information transmitted by the rudder piece monitoring module (001) comprises that two pairs of rudder pieces on the steering engine work normally, the rudder pieces steer for 3 times every time an ammunition rotates for one circle; when the working state information transmitted by the rudder piece monitoring module (001) comprises that one pair of rudder pieces in two pairs of rudder pieces on the steering engine work normally, and the other pair of rudder pieces work abnormally, the rudder pieces steer for 2 times when ammunition rotates for one circle.
3. The fault-tolerant control system of the three-position relay steering engine according to claim 2, wherein two pairs of rudder pieces on the steering engine are alternately steered.
4. The fault-tolerant control system of the three-position relay type steering engine according to claim 3, wherein the steering is performed by any one pair of rudder pieces through a preset deflection angle and a return operation process after a preset time, wherein the preset deflection angle is preferably a rudder piece operation angle of each steering, and the preset time is preferably a rudder piece operation time length of each steering.
5. The fault-tolerant control system of the three-position relay steering engine according to claim 2, wherein when two pairs of rudder pieces can work normally, the steering engine command calculation module (002) obtains the rudder piece working angle of each time of steering through the following formulas (one), (two) and (three),
wherein,the operating angle of the rudder piece when the ammunition is ruddered for the first time in the process of one circle of rotation,The rudder sheet working angle at the second helm striking in the process of one rotation of the ammunition is shown,the working angle of the rudder blade is shown when the ammunition is ruddered for the third time in the process of one rotation;1the equivalent rudder deflection angle of the steering engine when the rudder is turned for the first time in the process of one circle of ammunition rotation is shown,2shows the equivalent rudder deflection angle of the steering engine when the rudder is turned for the second time in the process of one circle of ammunition rotation,3shows the equivalent rudder deflection angle of the steering engine when the rudder is turned for the third time in the process of one rotation of ammunition, wherein,is effectiveRepresenting an effective rudder deflection angle command.
6. The fault-tolerant control system of the three-position relay steering engine according to claim 5, wherein the control starting time calculation module (004) obtains the length of the operating time of each steering by the following formulas (four), (five) and (six);
wherein,which represents the rotation period of the projectile, where n represents the real-time rotation speed of the ammunition, t1Indicating the length of operation of the first helm during one revolution of the ammunition, t2Indicating the length of operation of the second helm during one revolution of the ammunition, t3Represents the length of the third helm operation time during one rotation of the ammunition;
and (3) obtaining the starting control time of the steering engine for each steering through the following formulas (seven), (eight) and (nine):
wherein, T1Shows the starting control time of the steering engine for the first time of steering in the process of one circle of ammunition rotation, T2Shows the starting control time, T, of the steering engine for the second helm striking in the process of one rotation of ammunition3The starting control time of the steering engine for third helm striking in the process of one circle of ammunition rotation is shown;showing the moment when the projectile in the last period is in the first helm-turning position of the steering engine,showing the moment when the projectile in the last period is in the second helm-hitting position of the steering engine,showing the time when the projectile of the previous cycle is in the third helm-hitting position of the steering engine.
7. The fault-tolerant control system of the three-position relay steering engine according to claim 2, wherein when one of the two pairs of rudder pieces can work normally and the other pair can not work normally, the steering engine command calculation module (002) obtains the rudder piece working angle of each rudder turning through the following formulas (ten) and (eleven),
wherein,is effectiveIndicating a valid rudder deflection angle command.
8. The fault-tolerant control system of the three-position relay type steering engine according to claim 7, wherein the control starting time calculation module (004) obtains the working time length of each steering by the following formulas (twelve) and (thirteen),
obtaining the starting control time of the steering engine for each steering through the following formulas (fourteen) and (fifteen);
9. a fault-tolerant control method of a three-position relay steering engine is characterized by being achieved through the fault-tolerant control system of the three-position relay steering engine according to the claims 1-8.
CN201610819911.6A 2016-09-13 2016-09-13 Fault-tolerant control system and control method of three-position relay type steering engine Active CN107315415B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610819911.6A CN107315415B (en) 2016-09-13 2016-09-13 Fault-tolerant control system and control method of three-position relay type steering engine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610819911.6A CN107315415B (en) 2016-09-13 2016-09-13 Fault-tolerant control system and control method of three-position relay type steering engine

Publications (2)

Publication Number Publication Date
CN107315415A true CN107315415A (en) 2017-11-03
CN107315415B CN107315415B (en) 2020-02-14

Family

ID=60185555

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610819911.6A Active CN107315415B (en) 2016-09-13 2016-09-13 Fault-tolerant control system and control method of three-position relay type steering engine

Country Status (1)

Country Link
CN (1) CN107315415B (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108388748A (en) * 2018-03-12 2018-08-10 北京理工大学 Method is discontinuously calculated in a kind of detonation numerical simulation serial program
CN111240208A (en) * 2020-03-06 2020-06-05 北京控制工程研究所 Fault-tolerant control method and system for spacecraft actuating mechanism faults
CN111856924A (en) * 2020-08-06 2020-10-30 西安睿高测控技术有限公司 Control method of guided ammunition using relay type steering engine
CN112034702A (en) * 2020-08-06 2020-12-04 西安睿高测控技术有限公司 Intelligent control method for guided ammunition by using relay type steering engine
CN112445230A (en) * 2019-08-27 2021-03-05 北京理工大学 High-dynamic aircraft multi-mode guidance system and guidance method under large-span complex environment

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102620605A (en) * 2012-03-31 2012-08-01 林德福 Global positioning system (GPS) and inertial navigation system (INS) combination guidance system for semi-physical simulation
EP2594484A2 (en) * 2011-11-17 2013-05-22 Honeywell International Inc. Unmanned air vehicle fault tolerant flight control system and method
CN103324202A (en) * 2013-07-12 2013-09-25 无锡华航电子科技有限责任公司 Fault tolerance flight control system and method based on control surface faults
CN105157487A (en) * 2015-09-01 2015-12-16 四川航天系统工程研究所 Missile rudder fault-tolerant control method based on analytical redundancy

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2594484A2 (en) * 2011-11-17 2013-05-22 Honeywell International Inc. Unmanned air vehicle fault tolerant flight control system and method
CN102620605A (en) * 2012-03-31 2012-08-01 林德福 Global positioning system (GPS) and inertial navigation system (INS) combination guidance system for semi-physical simulation
CN103324202A (en) * 2013-07-12 2013-09-25 无锡华航电子科技有限责任公司 Fault tolerance flight control system and method based on control surface faults
CN105157487A (en) * 2015-09-01 2015-12-16 四川航天系统工程研究所 Missile rudder fault-tolerant control method based on analytical redundancy

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
张增安: "无人机容错飞行控制计算机的设计研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 *
徐国泰: "简易制导火箭弹伸缩式电磁舵机技术研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 *
杜凤怀等: "舵机卡死故障的导弹容错控制研究", 《弹箭与制导学报》 *
谢克峰等: "伸缩式鸭舵二维修正策略和修正能力", 《中国惯性技术学报》 *
靳凌等: "考虑舵机故障的空空导弹飞行控制系统主动容错控制", 《弹箭与制导学报》 *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108388748A (en) * 2018-03-12 2018-08-10 北京理工大学 Method is discontinuously calculated in a kind of detonation numerical simulation serial program
CN112445230A (en) * 2019-08-27 2021-03-05 北京理工大学 High-dynamic aircraft multi-mode guidance system and guidance method under large-span complex environment
CN112445230B (en) * 2019-08-27 2021-12-24 北京理工大学 Multi-mode guidance system and guidance method for high dynamic aircraft in large cross-domain complex environment
CN111240208A (en) * 2020-03-06 2020-06-05 北京控制工程研究所 Fault-tolerant control method and system for spacecraft actuating mechanism faults
CN111240208B (en) * 2020-03-06 2022-07-29 北京控制工程研究所 Fault-tolerant control method and system for spacecraft actuating mechanism faults
CN111856924A (en) * 2020-08-06 2020-10-30 西安睿高测控技术有限公司 Control method of guided ammunition using relay type steering engine
CN112034702A (en) * 2020-08-06 2020-12-04 西安睿高测控技术有限公司 Intelligent control method for guided ammunition by using relay type steering engine

Also Published As

Publication number Publication date
CN107315415B (en) 2020-02-14

Similar Documents

Publication Publication Date Title
CN107315415A (en) The fault-tolerant control system and control method of three bang-bang actuators
CN211918983U (en) Thrust generating rotor assembly for a vehicle
US10086932B2 (en) Moment limiting control laws for dual rigid rotor helicopters
CN109407690A (en) A kind of aircraft stable control method
JPH10264897A (en) Main rotor torque correcting device
TW381202B (en) Moving body control device
CN104062976B (en) A kind of is sinusoidal attitude of flight vehicle fast reserve method based on angular acceleration derivative
EP2223035B1 (en) Torsional spring aided control actuator for a rolling missile
CN108445753B (en) A method for balancing lateral forces and suppressing lateral reverse thrust of UAVs
CN113110539A (en) Elastic/arrow three-channel control method and control device based on duck rudder
JP2000131000A (en) Mixed missile automatic pilot
CN109900157B (en) Semi-physical simulation platform and method for guidance ammunition terminal guidance law
CN111221348B (en) Sideslip correction method applied to remote guidance aircraft
CN106354021A (en) Airplane longitudinal movement pitching angle control system PID (proportion integration differentiation) optimization method based on PSO (particle swarm optimization)
US20200363821A1 (en) System and method for stabilizing and restraining air disturbances on electrically propelled aircraft
SE1130088A1 (en) METHOD AND GNC SYSTEM FOR DETERMINING THE ANGLE OF APPROACH
CN113568418B (en) A roll stability control method and system for composite guided aircraft
JPH0733159B2 (en) Fuel controller for rotorcraft
CN115390590A (en) Large maneuvering control method and related equipment for axisymmetric aircraft
CN111216887B (en) Drive control apparatus for remote-controlled helicopter
JP2008224115A (en) Guided missile, and guidance control device and method for guided missile
US9452829B2 (en) Yaw control of co-axial rotor
CN114777577B (en) Control method for anti-second-level engine thrust disturbance of miniature tactical missile
CN116679750B (en) Aircraft guidance control method based on dynamic rudder resource control allocation
KR102395893B1 (en) Method of generating control command for aerial vehicle and system thereof

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