ROCKET CONTROL SYSTEM AND METHOD OF CONTROLLING LANDING OPERATION OF ROCKET
20230242281 · 2023-08-03
Assignee
Inventors
Cpc classification
B64G1/62
PERFORMING OPERATIONS; TRANSPORTING
B64G1/24
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
Provided is a method of controlling horizontal translational motion of a rocket without changing the attitude of the body and without increasing manufacturing costs and operation costs. This allows for accurate execution of rocket landing operation. A rocket control system includes a gimbal actuator that controls a steering angle of a gimbal mechanism located on a lower side of the body of the rocket with respect to the center of gravity; a fin actuator that controls a steering angle of an attitude control fin located on an upper side of the body of the rocket with respect to the center of gravity; a measurement unit that measures a physical quantity related to motion of the body of the rocket and a control unit that controls the gimbal mechanism and the attitude control fin according to a result of measurement by the measurement unit to control horizontal translational motion of the rocket.
Claims
1. A rocket control system for controlling a rocket, comprising: a gimbal actuator that controls a steering angle of a gimbal mechanism located on a lower side of a body of the rocket with respect to the center of gravity; a fin actuator that controls a steering angle of an attitude control fin located on an upper side of the body of the rocket with respect to the center of gravity; a measurement unit that measures a physical quantity related to motion of the body of the rocket; and a control unit that controls the gimbal mechanism and the attitude control fin according to a result of measurement by the measurement unit to control horizontal translational motion of the rocket.
2. The rocket control system according to claim 1, wherein the control unit is configured to: generate, according to a translational acceleration command for instructing a translational acceleration, a translational-acceleration-generation-pseudo-steering-angle command for instructing steering angles that should be applied to the gimbal mechanism and the attitude control fin in order to give the rocket a part or all of the translational acceleration without changing an attitude of the body of the rocket, and generate an attitude angle command for providing an instruction about an attitude angle that should be applied to the body of the rocket in order to give the rocket a remaining part of the translational acceleration by changing the attitude of the body of the rocket; and determine distribution to the translational-acceleration-generation-pseudo-steering-angle command and to the attitude angle command according to a physical quantity measured by the measurement unit.
3. The rocket control system according to claim 2, wherein the control unit is configured to: generate, in order to generate an angular acceleration that should be given to the body of the rocket to reach an attitude angle instructed by the attitude angle command, an angular-acceleration-generation-pseudo-steering-angle command for instructing a steering angle that should be applied to the gimbal mechanism and/or the attitude control fin based on the attitude angle command; and further control the steering angle of the gimbal mechanism and the steering angle of the attitude control fin based on the translational-acceleration-generation-pseudo-steering-angle command and the angular-acceleration-generation-pseudo-steering-angle command.
4. The rocket control system according to claim 2, wherein the control unit is configured to calculate, based on the physical quantity measured by the measurement unit, a wind disturbance acceleration that is an acceleration generated in the body due to wind around the rocket, and calculate the translational-acceleration-generation-pseudo-steering-angle command and the attitude angle command by taking the wind disturbance acceleration into account.
5. The rocket control system according to claim 4, wherein the control unit is configured to calculate the wind disturbance acceleration also based on the translational-acceleration-generation-pseudo-steering-angle command and the angular-acceleration-generation-pseudo-steering-angle command in addition to the physical quantity.
6. A method of controlling landing operation of a rocket, the rocket comprising: a gimbal mechanism located on a lower side of a body of the rocket with respect to the center of gravity, a steering angle of which can be changed; and an attitude control fin located on an upper side of the body of the rocket with respect to the center of gravity, a steering angle of which can be changed, the method comprising: measuring a physical quantity related to motion of the body of the rocket; and controlling the gimbal mechanism and the attitude control fin according to a result of measurement of the physical quantity to control horizontal translational motion of the rocket.
7. The method according to claim 6, further comprising: generating, according to a translational acceleration command for instructing a translational acceleration, a translational-acceleration-generation-pseudo-steering-angle command for instructing steering angles that should be applied to the gimbal mechanism and the attitude control fin in order to give the rocket a part or all of the translational acceleration without changing an attitude of the body of the rocket, and generating an attitude angle command for providing an instruction about an attitude angle that should be applied to the body of the rocket in order to give the rocket a remaining part of the translational acceleration by changing the attitude of the body of the rocket; and determining distribution to the translational-acceleration-generation-pseudo-steering-angle command and to the attitude angle command according to the physical quantity.
8. The method according to claim 7, further comprising: generating, in order to generate an angular acceleration that should be given to the body of the rocket to reach an attitude angle instructed by the attitude angle command, an angular-acceleration-generation-pseudo-steering-angle command for instructing a steering angle that should be applied to the gimbal mechanism and/or the attitude control fin based on the attitude angle command; and controlling the steering angle of the gimbal mechanism and the steering angle of the attitude control fin based on the translational-acceleration-generation-pseudo-steering-angle command and the angular-acceleration-generation-pseudo-steering-angle command.
9. The method according to claim 7, further comprising: calculating, based on the physical quantity, a wind disturbance acceleration that is an acceleration generated in the body due to wind around the rocket, and calculating the translational-acceleration-generation-pseudo-steering-angle command and the attitude angle command by taking the wind disturbance acceleration into account.
10. The method according to claim 9, wherein the wind disturbance acceleration is calculated also based on the translational-acceleration-generation-pseudo-steering-angle command and the angular-acceleration-generation-pseudo-steering-angle command in addition to the physical quantity.
Description
BRIEF DESCRIPTION OF DRAWINGS
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
DESCRIPTION OF EMBODIMENTS
[0024] In the following, the present embodiments will be described with reference to the attached drawings. In the attached drawings, functionally identical elements may be designated with identical numerals. The attached drawings illustrate embodiments and an implementation example in accordance with the principles of the present disclosure. However, these are provided to assist an understanding of the present disclosure and should not be construed as limiting the present disclosure. It should be understood that the descriptions that follow are for exemplary purposes only, and do not in any way represent a limitation of the scope of the claims or application examples of the present disclosure.
[0025] While the present embodiments are described in sufficient detail to enable a person skilled in the art to practice the present disclosure, it will be understood that other implementations or embodiments are also possible, and that various changes to configurations or structures and various substitutions of elements may be made without departing from the scope and spirit of the technical concepts of the present disclosure. Accordingly, the following descriptions are not to be interpreted in a limiting sense.
First Embodiment
[0026] Referring to
[0027] In the rocket 1, the attitude control fin 15 is located on the upper side (on the leading end (nose) side) with respect to the center of gravity GC and the engine 13 is located on the lower side (on the trailing end (tail) side) with respect to the center of gravity GC.
[0028] The engine 13 produces a jet with a propellant, thereby providing propulsion to the body 11. The attitude (orientation) of the engine 13 is controlled by the gimbal mechanism 14. The gimbal mechanism 14 is driven by a gimbal actuator, which will be described later. Change in the angle of the gimbal mechanism 14 (gimbal angle) changes the direction of the thrust T of the engine 13. Meanwhile, the attitude control fin 15 is rotationally driven by a fin actuator, which will be described later. Change in the angle of the attitude control fin 15 (fin angle) changes the magnitude of the lift L. The lift L is the resultant of the force produced by the body 11 according to the angle of attack a and the force produced by the attitude control fin 15 according to the angle of attack a and the steering angle.
[0029] By individually controlling the engine 13 and the attitude control fin 15, which are respectively provided below and above the center of gravity GC as described above, horizontal translational motion of the rocket 1 can be achieved during the landing operation of the rocket 1 without changing the attitude and without disabling horizontal movement because of the lift L and the horizontal component Th of the thrust T coming into balance in the middle of the landing operation.
[0030] In the conventional control system, the gimbal angle and the fin angle are used only to control moments around the center of gravity GC. In the control system of the present embodiment, the gimbal angle and the fin angle are used also to produce horizontal forces. That is, the system of the present embodiment simultaneously controls the steering angle of the gimbal mechanism 14 and the steering angle of the attitude control fin 15 from the state where the moments around the center of gravity GC are balanced, and produces ΔTh and ΔL, which are the forces of magnitudes inversely proportional to their respective distances from the center of gravity GC, in the same direction along the horizontal direction, as shown in
[0031] According to the operation of the present embodiment, since the moment generated by ΔTh around the center of gravity GC and the moment generated by ΔL around the center of gravity GC cancel each other, it is possible to directly produce the resultant force ΔTh+ΔL in the horizontal direction while maintaining the balance of the moments around the center of gravity GC. Using such a resultant force allows controlling the horizontal translational motion of the rocket 1. While a controlling force can be changed indirectly by the attitude change, the resultant force ΔTh+ΔL, which will be hereinafter called a “direct force,” does not involve the attitude change.
[0032]
[0033] The measurement device group 20 is a set of devices for detecting physical quantities (e.g., position, velocity, acceleration, attitude, angular velocity, and air attitude) related to the motion of the body 11 of the rocket 1. In one example, the measurement device group 20 includes a position detector 21 (GPS receiver, for example), a velocity detector 22 (velocity sensor, for example), an acceleration detector 23 (acceleration sensor, for example), an attitude detector 24 (gyro sensor, for example), an angular velocity detector 25 (angular velocity sensor, for example), an air attitude detector 26, and the like. The detectors 21 to 26 may be composed of sensors appropriately disposed in the body 11. The device group of
[0034] The operation control device 30 is composed of a typical computer, and includes a central processing unit, various types of memory, an input/output interface, and computer programs, for example. The operation control device 30 generates steering-angle commands for the gimbal actuator 40 and the fin actuator 50 based on the physical quantities calculated by the measurement device group 20. The gimbal actuator 40 and the fin actuator 50 generate drive signals according to the received steering-angle commands to control the steering angle of the gimbal mechanism 14 and the steering angle of the attitude control fin 15.
[0035] Next, referring to the control block diagram of
[0036] The flight path control unit 31, based on the various physical quantities (e.g., position, velocity, acceleration, attitude, and angular velocity of the rocket 1) obtained by the measurement device group 20, determines a path along which the body 11 of the rocket 1 should fly, calculates a translational acceleration for the horizontal translational movement of the body 11 of the rocket 1 relative to the ground surface, and outputs a translational acceleration command for instructing the translational acceleration. Here, the “translational acceleration command” is an instruction about the translational acceleration that should be given to the center of gravity of the body 11. In an adder, a wind disturbance acceleration estimated by the air attitude/wind disturbance acceleration estimation unit 32 is subtracted from the translational acceleration command, and the result of subtraction is transferred to the translational acceleration distribution unit 33. Such subtraction helps remove the influence of wind disturbance acceleration based on the wind around the rocket 1.
[0037] The air attitude/wind disturbance acceleration estimation unit 32, based on the data on the physical quantities (e.g., position, velocity, acceleration, attitude, and acceleration of the rocket 1) measured by the measurement device group 20, estimates an air attitude that is an attitude to the airflow (relative wind) of the body 11 of the rocket 1 and a wind disturbance acceleration caused by wind. In addition to the result of measurement by the measurement device group 20, the air attitude/wind disturbance acceleration estimation unit 32 estimates the air attitude of the rocket 1 and the wind disturbance acceleration also based on a translational-acceleration-generation-pseudo-steering-angle command fed back from the translational acceleration distribution unit 33 and an angular-acceleration-generation-pseudo-steering-angle command fed back from the attitude control unit 34 (these commands will collectively be referred to as the “steering-angle commands”). This is because the influence of the magnitudes of the steering angles of the gimbal mechanism 14 and the attitude control fin 15 needs to be removed from the result of measurement by the measurement device group 20 for estimation of the wind disturbance acceleration simply under the influence of wind.
[0038] The translational acceleration distribution unit 33 generates, according to the calculated translational acceleration command (after subtracting wind disturbance acceleration data), a translational-acceleration-generation-pseudo-steering-angle command and an attitude angle command, under the distribution rule determined based on the physical quantities measured by the measurement device group 20. The translational-acceleration-generation-pseudo-steering-angle command corresponds to the translational acceleration generated by the direct force of the gimbal mechanism 14 and the attitude control fin 15. The translational acceleration generated by the direct force of the gimbal mechanism 14 and the attitude control fin 15 and the translational acceleration generated by the attitude change can be predicted from the physical quantities measured by the measurement device group 20. Based on a relative effect of these two translational accelerations, the distribution rule serves to distribute the translational acceleration command to the translational-acceleration-generation-pseudo-steering-angle command and to the attitude angle command. Provided that A.sub.δA is a translational acceleration when a translational-acceleration-generation-pseudo-steering-angle command δ.sub.A is changed by a unit angle, and A.sub.γ is a translational acceleration when an attitude angle command γ is changed by a unit angle, the “effect” is expressed with these A.sub.δA and A.sub.γ. A final translational acceleration A is given by A=A.sub.δAδ.sub.A+A.sub.γγ. To match this A with a translational acceleration command A.sub.C (after subtracting the influence of wind), the following computation is performed. The aforementioned distribution rule is based on this computation.
δ.sub.A=η.sub.δAA.sub.δA/(η.sub.δAA.sub.δA.sup.2+η.sub.γA.sub.γ.sup.2)×A.sub.C
γ=η.sub.γA.sub.γ/(η.sub.δAA.sub.δA.sup.2+η.sub.γA.sub.γ.sup.2)×A.sub.C [Equation 1]
[0039] Where, η.sub.δA and η.sub.γ are positive real numbers for adjusting the proportion of the distribution. A.sub.C, δ.sub.A, γ each indicate a deviation from their respective target states. This computation is an implementation example of the distribution rule. Other computation or utilizing a machine-trained input/output relationship not depending on computation may also be possible, for example.
[0040] In the period in which control by the attitude change is inactive (i.e., period in which the translational acceleration A.sub.γ generated by the attitude change is zero), the translational acceleration command is entirely distributed to the translational-acceleration-generation-pseudo-steering-angle command. Since the translational-acceleration-generation-pseudo-steering-angle command and the attitude angle command are appropriately generated under this distribution rule, it is possible to avoid the period in which control by the attitude change is inactive and to continuously control translational motion of the rocket 1.
[0041] The translational-acceleration-generation-pseudo-steering-angle command is for instructing the magnitude and sign of the resultant force ΔTh+ΔL of ΔTh and ΔL shown in
[0042] The attitude control unit 34 generates, according to this attitude angle command, an angular-acceleration-generation-pseudo-steering-angle command by further taking into account the air attitude estimated by the air attitude/wind disturbance acceleration estimation unit 32 and the various physical quantities measured by the measurement device group 20 as well. The angular-acceleration-generation-pseudo-steering-angle command is for instructing the magnitude and sign of an angular acceleration (equivalent to a moment around the center of gravity) that should be given to the body 11 of the rocket 1 to reach the attitude angle instructed by the attitude angle command.
[0043] The steering angle distribution unit 35 outputs, according to the virtually-given translational-acceleration-generation-pseudo-steering-angle command and angular-acceleration-generation-pseudo-steering-angle command, a gimbal angle command and a fin angle command to be actually output to the gimbal mechanism 14 and the attitude control fin 15, respectively, by taking into account the physical quantities (e.g., position, velocity, acceleration, attitude, and acceleration) actually measured by the measurement device group 20 as well. The angular acceleration that can be produced by each of the gimbal mechanism 14 and the attitude control fin 15 can be predicted from the physical quantities measured by the measurement device group 20. Provided that δ.sub.G is a gimbal angle command, δ.sub.F is a fin angle command, and M.sub.δG, M.sub.δF are angular accelerations generated by changing δ.sub.G and δ.sub.F by a unit steering angle, respectively, the translational-acceleration-generation-pseudo-steering-angle command δ.sub.A and the angular-acceleration-generation-pseudo-steering-angle command δ.sub.M are distributed to δ.sub.G and δ.sub.F by the following computation.
δ.sub.F=M.sub.δG/(η.sub.δFM.sub.δF.sup.2+η.sub.δGM.sub.δG.sup.2)×δ.sub.A+η.sub.δFM.sub.δF/(η.sub.δFM.sub.δF.sup.2+η.sub.δGM.sub.δG.sup.2)×δ.sub.M
δ.sub.G=M.sub.δF/(η.sub.δFM.sub.δF.sup.2+η.sub.δGM.sub.δG.sup.2)×δ.sub.A+η.sub.δGM.sub.δG/(η.sub.δFM.sub.δF.sup.2+η.sub.δGM.sub.δG.sup.2)×δ.sub.M [Equation 2]
[0044] Where, η.sub.δF and η.sub.δG are positive real numbers and used for adjusting the proportion of the distribution of δ.sub.M to δ.sub.F and to δ.sub.G. δ.sub.F, δ.sub.G, and the like each indicate a deviation from their respective target states. The angular acceleration M obtained by the operation of δ.sub.F and δ.sub.G is given by M=M.sub.δFδ.sub.F+M.sub.δGδ.sub.G. Substituting the above equation can obtain M=δ.sub.M, which does not include δA. That is, the translational-acceleration-generation-pseudo-steering-angle command δ.sub.A is distributed to δ.sub.F and δ.sub.G so that an angular acceleration (equivalent to a moment) will not be generated around the center of gravity GC. The above computation is an implementation example of the steering angle distribution unit 35. Other computation or operation and processing other than computation may also be possible. Solving the above equation for δ.sub.A and δ.sub.M results as follows.
δ.sub.A=η.sub.δGM.sub.δGδ.sub.F−η.sub.δFM.sub.δFδ.sub.G
δ.sub.M=M.sub.δFδ.sub.F+M.sub.δGδ.sub.G [Equation 3]
[0045] This equation expresses how the two pseudo-steering-angle commands δ.sub.A, δ.sub.M are defined by the two physical steering angles δ.sub.F and δ.sub.G. The computation and operation performed by the steering angle distribution unit 35 and the definitions of the two pseudo-steering-angle commands have a one-to-one correspondence.
[0046] As described above, according to the system 100 of the present embodiment, it is possible to produce the direct force by appropriately controlling the steering angles of the gimbal mechanism 14 of the engine 13 and the attitude control fin 15, which are respectively disposed below and above the center of gravity GC, to control the horizontal translational acceleration. Since the system 100 of the present embodiment can control the translational acceleration with the gimbal mechanism 14 and the attitude control fin 15 by controlling their steering angles, it is possible to accurately control the translational movement without having a special engine added for the translational movement. In addition, since the steering angle given to the gimbal mechanism 14 and the steering angle given to the attitude control fin 15 are properly distributed by the translational acceleration distribution unit 33 and the steering angle distribution unit 35 according to the physical quantities measured by the measurement device group 20, while maintaining the balance of the moments around the center of gravity GC, it is possible to produce thrust (in the horizontal direction) perpendicular to the velocity vector of the rocket 1 without changing the attitude of the rocket 1 to control the translational motion (see
[0047] According to the present embodiment, it is possible to move the rocket 1 in the horizontal direction by using both of the change in the lift L and the horizontal component Th of the thrust T by changing the attitude of the body of the rocket 1 and the direct force ΔTh+ΔL produced by the gimbal mechanism 14 and the attitude control fin 15 without changing the attitude of the body of the rocket 1. In contrast, when the horizontal movement of the rocket is controlled by controlling only the attitude of the rocket 1, it is difficult to avoid a period (i.e., inactive period) in which the rocket can move neither left nor right, which results from the state of balance between the lift L and the horizontal component Th of the thrust T as shown in
[0048] It should be noted that control by the attitude control fin 15 is effective only when the velocity of the rocket 1 is at or above a predetermined value. This means that the attitude control fin 15 is not effective in the period in which the rocket 1 is about to land on the ground surface at a low velocity, where only the gimbal mechanism 14 is used to control the rocket 1 to maintain its translational movement. Specifically, the angular-acceleration-generation-pseudo-steering-angle command is converted only to the steering angle of the gimbal mechanism 14, and the steering angle of the attitude control fin 15 is not controlled. Meanwhile, the translational-acceleration-generation-pseudo-steering-angle command is set to zero, and in this period, control of the translational motion is equivalent to that in the conventional control system for controlling the translational motion only by the attitude change of the body 11. Using the above-described computation equations allows proper distribution also in this period, without giving special consideration.
Second Embodiment
[0049] Next, referring to
[0050] Referring to the control block diagram of
[0051] The present invention is not limited to the aforementioned embodiments, and includes a variety of variations. For example, although the aforementioned embodiments have been described in detail to clearly illustrate the present invention, the present invention need not include all of the configurations described in the embodiments. It is possible to replace a part of a configuration of an embodiment with a configuration of another embodiment. In addition, it is also possible to add, to a configuration of an embodiment, a configuration of another embodiment. Further, it is also possible to, for a part of a configuration of each embodiment, add, remove, or substitute a configuration of another embodiment.
REFERENCE SIGNS LIST
[0052] 1 Rocket [0053] 11 Body [0054] 12 Landing gear [0055] 13 Engine [0056] 14 Gimbal mechanism [0057] 15 Attitude control fin (aerodynamic control surface) [0058] GC Center of gravity [0059] 20 Measurement device group [0060] 30 Operation control device [0061] 40 Gimbal actuator [0062] 50 Fin actuator