CN112596532B - Dynamic distribution method for attitude control engine control instructions of H spacecraft - Google Patents
Dynamic distribution method for attitude control engine control instructions of H spacecraft Download PDFInfo
- Publication number
- CN112596532B CN112596532B CN202011298667.6A CN202011298667A CN112596532B CN 112596532 B CN112596532 B CN 112596532B CN 202011298667 A CN202011298667 A CN 202011298667A CN 112596532 B CN112596532 B CN 112596532B
- Authority
- CN
- China
- Prior art keywords
- attitude control
- control engine
- moment
- spacecraft
- working
- 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
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000004590 computer program Methods 0.000 claims description 6
- 239000003380 propellant Substances 0.000 abstract description 4
- 230000003287 optical effect Effects 0.000 description 6
- 238000012545 processing Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 239000013307 optical fiber Substances 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000000644 propagated effect Effects 0.000 description 2
- 238000003491 array Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 230000001808 coupling effect Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0833—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using limited authority control
Landscapes
- Engineering & Computer Science (AREA)
- Computer Security & Cryptography (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
One embodiment of the invention discloses a method for dynamically distributing H spacecraft attitude control engine control instructions, which comprises the following steps: s101: establishing all working combination torque tables of the H attitude control engines and storing the working combination torque tables in a memory; s102: and selecting the attitude control engine working combination from all the stored working combination torque tables according to the preset command torque. The dynamic distribution method for the control instructions of the attitude control engines of the H spacecraft, provided by the invention, can dynamically distribute the attitude control engines in real time according to the control instructions, and has the advantages of less propellant consumption, high control precision, strong universality and good robustness.
Description
Technical Field
The invention relates to the technical field of attitude control engine control instruction dynamic distribution, in particular to a dynamic distribution method for attitude control engine control instructions of H spacecraft.
Background
The dynamic control instruction allocation method of the attitude control engine directly influences the realization of the attitude control effect and the propellant consumption, so the quality of the design of the dynamic control instruction allocation method has important influence on the performance of the whole control system. In order to obtain simple control logic, decoupling configuration is generally adopted when the attitude control engine of the spacecraft is configured, namely the attitude control engine of each shaft is configured independently, the control instruction distribution algorithm is simple, and the shafts are not coupled. With the increasing complexity of space missions and the increasing concern of economy in the design of spacecraft, some spacecraft have adopted a coupling configuration mode to some extent in recent years. This puts a higher demand on the attitude control engine control command assignment algorithm.
The traditional attitude control engine control instruction distribution method adopts a direct distribution mode and a solidified distribution list mode, namely, the torque in the control quantity direction can be generated by a special attitude control engine, and the torque and the special attitude control engine are in one-to-one correspondence. The decoupled control instruction distribution strategy is used in a high-redundancy attitude control system of the multi-attitude control engine, and the mutual coupling effect of each attitude control engine in outputting thrust and moment is required to be comprehensively considered, so that a control instruction distribution algorithm is complex, difficult to design, multiple in branches, poor in testability and low in use efficiency of the attitude control engine.
Disclosure of Invention
The invention aims to provide a dynamic distribution method for H spacecraft attitude control engine control instructions, and solves the problems that a multi-attitude control engine high-redundancy attitude control system instruction distribution algorithm is complex and testability is poor.
In order to achieve the purpose, the invention adopts the following technical scheme:
the invention provides a method for dynamically distributing H spacecraft attitude control engine control instructions on one hand, which comprises the following steps:
s101: establishing all working combination torque tables of the H attitude control engines and storing the working combination torque tables in a memory;
s102: and selecting the attitude control engine working combination from all the stored working combination torque tables according to the preset command torque.
In one embodiment, the establishing all the working combination torque tables of the H attitude control engines includes:
establishing a torque meter for each attitude control engine in the H attitude control engines to work independently and a torque meter for each D attitude control engine to work and combine;
wherein D is 2 to H in sequence.
In one embodiment, establishing the torque table for each of the attitude control engines to operate individually comprises:
calculating the moment M generated when the h-th attitude control engine works alone h :
Adding the obtained torque when all the attitude control engines work independently into a torque meter when each attitude control engine works independently;
wherein,
M xh the moment of the h attitude control engine in the X-axis direction of the spacecraft when the h attitude control engine works independently;
M yh the moment of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
M zh the moment of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
r xh the moment arm of the h attitude control engine in the X-axis direction of the spacecraft when the h attitude control engine works independently;
r yh the moment arm of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
r zh the moment arm of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
F xh the thrust of the h attitude control engine in the X-axis direction of the spacecraft when the h attitude control engine works independently;
F yh the thrust of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
F zh the thrust of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
wherein H is 1-H.
In one embodiment, establishing a torque table for each of the D attitude control engine operating combinations further comprises:
establishing a torque chart of every two attitude control engine working combinations, comprising the following steps:
when the ith attitude control engine and the jth attitude control engine work simultaneously, if M is equal to the sum of the first and the second operating parameters xi ·M xj +M yi ·M yj +M zi ·M zj Is greater than 0 and i>j, the ith and jth tools are adoptedCombining, calculating the moment of the working combination of the ith and the jth attitude control engines, and adding the moment into a moment table of every two working combinations of the attitude control engines, otherwise, not adopting the working combination, wherein i is more than or equal to 1 and is not equal to j and is less than or equal to H;
the moment of the working combination of the two attitude control engines is as follows:
wherein,
M xij the moment of the ith attitude control engine and the jth attitude control engine in the X-axis direction of the spacecraft when working simultaneously;
M yij the moment of the ith attitude control engine and the jth attitude control engine in the Y-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M zij the moment of the ith attitude control engine and the jth attitude control engine in the Z-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M xi the moment of the ith attitude control engine in the X-axis direction of the spacecraft when the ith attitude control engine works independently;
M yi the moment of the ith attitude control engine in the Y-axis direction of the spacecraft when the ith attitude control engine works independently;
M zi the moment of the ith attitude control engine in the Z-axis direction of the spacecraft when the ith attitude control engine works independently;
M xj the moment of the jth attitude control engine in the X-axis direction of the spacecraft when the jth attitude control engine works alone;
M yj the moment of the jth attitude control engine in the Y-axis direction of the spacecraft when the jth attitude control engine works alone;
M zj the moment of the jth attitude control engine in the Z-axis direction of the spacecraft when the jth attitude control engine works alone is obtained.
In one embodiment, establishing the torque table for each of the D operation combinations of the attitude control engines further includes:
establishing a torque chart of every three attitude control engine working combinations, comprising the following steps:
adding a kth attitude control engine into each adopted ith and jth attitude control engine working combination;
if M is xij ·M xk +M yij ·M yk +M zij ·M zk > 0 and k>i and k>j, calculating the moment of the working combination by adopting the ith, jth and kth working combinations, and adding the moment into a moment table of every three attitude control engine working combinations, otherwise, not adopting the working combination, wherein i is more than or equal to 1, j is not equal to k, and H is not more than or equal to k;
the moments of the working combination of the three attitude control engines are as follows:
wherein,
M xijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the X-axis direction of the spacecraft when working simultaneously;
M yijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the Y-axis direction of the spacecraft when working simultaneously;
M zijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the Z-axis direction of the spacecraft when working simultaneously;
M xk the moment of the kth attitude control engine in the X-axis direction of the spacecraft when the kth attitude control engine works independently;
M yk the moment of the kth attitude control engine in the Y-axis direction of the spacecraft when the kth attitude control engine works alone;
M zk the moment of the kth attitude control engine in the Z-axis direction of the spacecraft when the kth attitude control engine works alone.
In one embodiment, establishing the torque table for each of the D operation combinations of the attitude control engines further comprises:
and (3) deducing the establishment method of the four to H torque meters of the working combination of every three attitude control engines to obtain all the working combination torque meters of the H attitude control engines.
In one embodiment, selecting an attitude control engine operating combination from the stored list of all operating combination torques based on the predetermined command torque comprises:
calculating effective moment M according to the command moment and the starting number of the engines of the g-th working combination in all working combination torque tables of the H attitude control engines 0rg :
Calculating included angle theta between torque generated by the g-th working combination in all working combination torque tables of H attitude control engines and command torque g :
If the g-th attitude control engine working combination meets theta g < P _ CtaLim and M 0rg Selecting the attitude control engine working combination when the maximum attitude control engine working combination is selected;
wherein G is 1-G, wherein G is the total number of working combinations in all working combination torque tables of H attitude control engines;
M 0g the moment of the g-th working combination in all working combination torque tables of the H attitude control engines is obtained;
M r setting the preset command torque as the preset command torque;
ZKCnt is the number of attitude control engines corresponding to the g-th working combination;
and P _ CtaLim is a threshold value of an included angle between the working combination moment and the command moment of the attitude control engine.
Another aspect of the invention provides a computer device comprising a memory, a processor and a computer program stored on the memory and executable on the processor, the processor implementing the method as described above when executing the program.
Another aspect of the invention provides a computer-readable storage medium having stored thereon a computer program which, when executed by a processor, implements the method described above.
The invention has the following beneficial effects:
the dynamic distribution method for the control instructions of the attitude control engines of the H spacecraft, provided by the invention, can dynamically distribute the attitude control engines in real time according to the control instructions, and has the advantages of less propellant consumption, high control precision, strong universality and good robustness.
Drawings
In order to more clearly illustrate the embodiments of the present application or the prior art, the drawings needed to be used in the description of the embodiments or the prior art will be briefly described below, and it is obvious that the drawings in the following description are one embodiment of the present application, and other drawings can be obtained by those skilled in the art without creative efforts.
FIG. 1 shows a flowchart of a method for dynamically allocating H spacecraft attitude control engine control commands, according to an embodiment of the invention.
Fig. 2 shows a schematic structural diagram of a computer device according to a further embodiment of the present invention.
Detailed Description
In order to make the technical solution of the present invention more clearly understood, the present invention is further described in detail below with reference to the accompanying drawings and examples. The present invention will be described in detail with reference to the following examples, but the present invention is not limited thereto. Variations and modifications may be made by those skilled in the art without departing from the principles of the invention and should be considered within the scope of the invention.
First embodiment
The present embodiment provides a method for dynamically allocating H spacecraft attitude control engine control commands, and as shown in fig. 1, fig. 1 shows a flowchart of a method for dynamically allocating H spacecraft attitude control engine control commands according to an embodiment of the present invention. Wherein H is a natural number of 2 or more. The method comprises the following steps:
s101: establishing all working combination torque tables of the H attitude control engines and storing the working combination torque tables in a memory;
in this embodiment, the total number H of attitude control engines is taken as three for explanation; in this embodiment, establishing all the working combination torque charts of the three attitude control engines comprises:
and establishing a torque meter for each attitude control engine in the three attitude control engines to work independently, a torque meter for the working combination of every two attitude control engines and a torque meter for the working combination of every three attitude control engines.
S1011: firstly, establishing a torque table for each attitude control engine to work independently comprises the following steps:
calculating the moment M generated when the h-th attitude control engine works alone h :
Adding the obtained torque when all the attitude control engines work independently into a torque meter when each attitude control engine works independently,
wherein,
M xh the moment of the h attitude control engine in the X-axis direction of the spacecraft when the h attitude control engine works independently;
M yh the moment of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
M zh the moment of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
r xh the moment arm of the h attitude control engine in the X-axis direction of the spacecraft when the h attitude control engine works independently;
r yh the moment arm of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
r zh the moment arm of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
F xh the thrust of the h attitude control engine in the X-axis direction of the spacecraft when the h attitude control engine works independently;
F yh the thrust of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
F zh the thrust of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
wherein h is 1-3.
S1012: secondly, establish every two attitude control engine work combination's torque table, include:
if M is in the same working state when the ith attitude control engine and the jth attitude control engine work simultaneously xi ·M xj +M yi ·M yj +M zi ·M zj Is greater than 0 and i>j, calculating the moments of the ith and jth attitude control engine working combinations by adopting the ith and jth working combinations, adding the moments into a moment table of every two attitude control engine working combinations, and otherwise, not adopting the working combination, wherein i is more than or equal to 1 and is not equal to j and is less than or equal to 3;
the moment of the working combination of the two attitude control engines is as follows:
wherein,
M xij the moment of the ith attitude control engine and the jth attitude control engine in the X-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M yij the moment of the ith attitude control engine and the jth attitude control engine in the Y-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M zij the moment of the ith attitude control engine and the jth attitude control engine in the Z-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M xi the moment of the ith attitude control engine in the X-axis direction of the spacecraft when the ith attitude control engine works independently;
M yi the moment of the ith attitude control engine in the Y-axis direction of the spacecraft when the ith attitude control engine works independently;
M zi the moment of the ith attitude control engine in the Z-axis direction of the spacecraft when the ith attitude control engine works independently;
M xj the moment of the jth attitude control engine in the X-axis direction of the spacecraft when the jth attitude control engine works alone;
M yj the moment of the jth attitude control engine in the Y-axis direction of the spacecraft when the jth attitude control engine works alone;
M zj the moment of the jth attitude control engine in the Z-axis direction of the spacecraft when the jth attitude control engine works alone is obtained.
S1013: and finally, establishing a torque chart of every three attitude control engine working combinations, which comprises the following steps:
adding a kth attitude control engine into each adopted ith and jth attitude control engine working combination;
if M is xij ·M xk +M yij ·M yk +M zij ·M zk > 0 and k>i and k>j, calculating the moment of the working combination by adopting the ith, jth and kth working combinations, and adding the moment into a moment table of every three attitude control engine working combinations, otherwise, not adopting the working combination, wherein i is more than or equal to 1, j is not equal to k is not more than 3;
the moments of the working combination of the three attitude control engines are as follows:
wherein,
M xijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the X-axis direction of the spacecraft when working simultaneously;
M yijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the Y-axis direction of the spacecraft when working simultaneously;
M zijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the Z-axis direction of the spacecraft when working simultaneously;
M xij the moment of the ith attitude control engine and the jth attitude control engine in the X-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M yij the moment of the ith attitude control engine and the jth attitude control engine in the Y-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M zij the moment of the ith attitude control engine and the jth attitude control engine in the Z-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M xk the moment of the kth attitude control engine in the X-axis direction of the spacecraft when the kth attitude control engine works independently;
M yk the moment of the kth attitude control engine in the Y-axis direction of the spacecraft when the kth attitude control engine works independently;
M zk the moment of the k attitude control engine in the Z-axis direction of the spacecraft when the k attitude control engine works alone.
S102: selecting an attitude control engine working combination from all stored working combination torque tables according to a preset command torque;
s1021: according to the preset command torque, selecting the attitude control engine working combination from all the stored working combination torque tables comprises the following steps:
calculating effective moment M according to the command moment and the starting number of the engines of the g-th working combination in all working combination torque tables of the three attitude control engines 0rg :
Calculating included angle theta between torque generated by the g-th working combination in all working combination torque meters of the three attitude control engines and command torque g :
If the g-th attitude control engine working combination meets theta g < P _ CtaLim and M 0rg If the numerical value of the attitude control engine is the maximum effective moment of all the working combinations, the attitude control engine working combination is selected;
wherein G is 1-G, wherein G is the total number of working combinations in all working combination torque meters of the three attitude control engines;
M 0g the moment of the g-th working combination in all working combination torque meters of the three attitude control engines is obtained;
M r setting the preset command torque; the command torque can be understood as a control command, and is calculated according to the attitude angle deviation and the like, namely the attitude angle deviation can be eliminated only by providing the torque with the command torque;
ZKCnt is the number of attitude control engines corresponding to the g-th working combination;
and P _ CtaLim is a threshold value of an included angle between the working combination moment and the command moment of the attitude control engine.
It should be understood by those skilled in the art that the present embodiment is described by taking the total number of the attitude control engines as 3 as an example, but the present invention is not limited thereto. It is also within the scope of the invention to establish a torque chart of the operation combination of the attitude control engine by deducing three or more of the methods according to the method of step S1013 in the present embodiment.
Second embodiment
Fig. 2 shows a schematic structural diagram of a computer device according to another embodiment of the present application. The computer device 50 shown in fig. 2 is only an example and should not bring any limitation to the function and the scope of use of the embodiments of the present application. As shown in FIG. 2, computer device 50 is in the form of a general purpose computing device. The components of computer device 50 may include, but are not limited to: one or more processors or processing units 500, a system memory 516, and a bus 501 that couples various system components including the system memory 516 and the processing unit 500.
The system memory 516 may include computer system readable media in the form of volatile memory, such as Random Access Memory (RAM)504 and/or cache memory 506. The computer device 50 may further include other removable/non-removable, volatile/nonvolatile computer system storage media. By way of example only, storage system 508 may be used to read from and write to non-removable, nonvolatile magnetic media (not shown in FIG. 2, and commonly referred to as a "hard disk drive"). Although not shown in FIG. 2, a magnetic disk drive for reading from and writing to a removable, nonvolatile magnetic disk (e.g., a "floppy disk") and an optical disk drive for reading from or writing to a removable, nonvolatile optical disk (e.g., a CD-ROM, DVD-ROM, or other optical media) may be provided. In these cases, each drive may be connected to the bus 501 by one or more data media interfaces. Memory 516 may include at least one program product having a set (e.g., at least one) of program modules that are configured to carry out the functions of embodiment one.
A program/utility 510 having a set (at least one) of program modules 512 may be stored, for example, in memory 516, such program modules 512 including, but not limited to, an operating system, one or more application programs, other program modules, and program data, each of which examples or some combination thereof may comprise an implementation of a network environment. Program modules 512 generally perform the functions and/or methodologies of the embodiments described herein.
The processor unit 500 executes programs stored in the system memory 516, thereby executing various functional applications and data processing, for example, implementing a method for dynamically allocating H spacecraft attitude control engine control commands according to an embodiment of the present application.
The computer equipment for the H spacecraft attitude control engine control instruction dynamic distribution method can dynamically distribute the attitude control engines in real time according to the control instructions, and is low in propellant consumption, high in control precision, high in universality and good in robustness.
Third embodiment
Another embodiment of the present application provides a computer-readable storage medium, on which a computer program is stored, which when executed by a processor implements the method provided by the first embodiment. In practice, the computer-readable storage medium may take any combination of one or more computer-readable media. The computer readable medium may be a computer readable signal medium or a computer readable storage medium.
A computer readable storage medium may be, for example, but not limited to, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or any combination of the foregoing. More specific examples (a non-exhaustive list) of the computer readable storage medium would include the following: an electrical connection having one or more wires, a portable computer diskette, a hard disk, a Random Access Memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disc read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing. In the present embodiment, a computer readable storage medium may be any tangible medium that can contain, or store a program for use by or in connection with an instruction execution system, apparatus, or device.
A computer readable signal medium may include a propagated data signal with computer readable program code embodied therein, for example, in baseband or as part of a carrier wave. Such a propagated data signal may take many forms, including, but not limited to, electro-magnetic, optical, or any suitable combination thereof. A computer readable signal medium may be any computer readable medium that is not a computer readable storage medium and that can communicate, propagate, or transport a program for use by or in connection with an instruction execution system, apparatus, or device.
Program code embodied on a computer readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wireline, optical fiber cable, RF, etc., or any suitable combination of the foregoing. Computer program code for carrying out operations for aspects of the present application may be written in any combination of one or more programming languages, including an object oriented programming language such as Java, Smalltalk, C + +, and conventional procedural programming languages, such as the "C" programming language or similar programming languages. The program code may execute entirely on the user's computer, partly on the user's computer, as a stand-alone software package, partly on the user's computer and partly on a remote computer or entirely on the remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer through any type of network, including a Local Area Network (LAN) or a Wide Area Network (WAN), or the connection may be made to an external computer (for example, through the Internet using an Internet service provider).
It should be understood that the above-mentioned embodiments of the present invention are only examples for clearly illustrating the present invention, and are not intended to limit the embodiments of the present invention, and it will be obvious to those skilled in the art that other variations or modifications may be made on the basis of the above description, and all embodiments may not be exhaustive, and all obvious variations or modifications may be included within the scope of the present invention.
Claims (6)
1. A dynamic distribution method for H spacecraft attitude control engine control commands is characterized by comprising the following steps:
s101: establishing all working combination torque tables of the H attitude control engines and storing the working combination torque tables in a memory;
s102: selecting an attitude control engine working combination from all stored working combination torque tables according to a preset command torque;
the establishment of all working combination torque charts of the H attitude control engines comprises the following steps:
establishing a torque meter for each attitude control engine in the H attitude control engines to work independently and a torque meter for each D attitude control engine to work and combine;
wherein D is sequentially from 2 to H;
establishing the torque table of each attitude control engine working independently comprises the following steps:
calculating the moment M generated when the h-th attitude control engine works alone h :
Adding the obtained torque when all the attitude control engines work independently into a torque meter when each attitude control engine works independently;
wherein,
M xh in the X-axis direction of the spacecraft when the h-th attitude-control engine is operating aloneMoment of force;
M yh the moment of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
M zh the moment of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
r xh the moment arm of the h attitude control engine in the X-axis direction of the spacecraft when the h attitude control engine works independently;
r yh the moment arm of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
r zh the moment arm of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
F xh the thrust of the h attitude control engine in the X-axis direction of the spacecraft when the h attitude control engine works independently;
F yh the thrust of the h attitude control engine in the Y-axis direction of the spacecraft when the h attitude control engine works independently;
F zh the thrust of the h attitude control engine in the Z-axis direction of the spacecraft when the h attitude control engine works independently;
wherein H is 1-H;
establishing a torque chart of each D attitude control engine working combination further comprises the following steps:
establishing a torque chart of every two attitude control engine working combinations, comprising the following steps:
when the ith attitude control engine and the jth attitude control engine work simultaneously, if M is equal to the sum of the first and the second operating parameters xi ·M xj +M yi ·M yj +M zi ·M zj Is greater than 0 and i>j, calculating the moments of the ith and jth attitude control engine working combinations by adopting the ith and jth working combinations, adding the moments into a moment table of every two attitude control engine working combinations, and otherwise, not adopting the working combination, wherein i is more than or equal to 1 and is not equal to j and is not more than H;
the moment of the working combination of the two attitude control engines is as follows:
wherein,
M xij the moment of the ith attitude control engine and the jth attitude control engine in the X-axis direction of the spacecraft when working simultaneously;
M yij the moment of the ith attitude control engine and the jth attitude control engine in the Y-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M zij the moment of the ith attitude control engine and the jth attitude control engine in the Z-axis direction of the spacecraft when the ith attitude control engine and the jth attitude control engine work simultaneously;
M xi the moment of the ith attitude control engine in the X-axis direction of the spacecraft when the ith attitude control engine works independently;
M yi the moment of the ith attitude control engine in the Y-axis direction of the spacecraft when the ith attitude control engine works independently;
M zi the moment of the ith attitude control engine in the Z-axis direction of the spacecraft when the ith attitude control engine works independently;
M xj the moment of the jth attitude control engine in the X-axis direction of the spacecraft when the jth attitude control engine works alone;
M yj the moment of the jth attitude control engine in the Y-axis direction of the spacecraft when the jth attitude control engine works alone;
M zj the moment of the jth attitude control engine in the Z-axis direction of the spacecraft when the jth attitude control engine works alone is obtained.
2. The method of claim 1, wherein establishing the torquechart for each D attitude control engine operating combinations further comprises:
establishing a torque chart of every three attitude control engine working combinations, comprising the following steps:
adding a kth attitude control engine into each adopted ith and jth attitude control engine working combination;
if M is xij ·M xk +M yij ·M yk +M zij ·M zk > 0 and k>i and k>j, adopting the ith, jth and kth working combinations to calculate the moment of the working combination, and adding the moment into the moment table of every three attitude control engine working combinations, otherwise, not adopting the working combination, wherein the working combination is not less than 1i≠j≠k≤H;
The moments of the working combination of the three attitude control engines are as follows:
wherein,
M xijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the X-axis direction of the spacecraft when working simultaneously;
M yijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the Y-axis direction of the spacecraft when working simultaneously;
M zijk the moment of the ith attitude control engine, the jth attitude control engine and the kth attitude control engine in the Z-axis direction of the spacecraft when working simultaneously;
M xk the moment of the kth attitude control engine in the X-axis direction of the spacecraft when the kth attitude control engine works independently;
M yk the moment of the kth attitude control engine in the Y-axis direction of the spacecraft when the kth attitude control engine works alone;
M zk the moment of the kth attitude control engine in the Z-axis direction of the spacecraft when the kth attitude control engine works alone.
3. The method of claim 2, wherein establishing the torquer for each D attitude control engine operating combinations further comprises:
and (3) deducing the establishment method of the four to H torque meters of the working combination of every three attitude control engines to obtain all the working combination torque meters of the H attitude control engines.
4. The method of claim 1, wherein selecting an attitude control engine operating combination from the stored list of all operating combination torques based on a predetermined command torque comprises:
according to the instruction torque and the g-th type in all working combination torque meters of the H attitude control enginesThe effective moment M is calculated by the starting number of the engines of the working combination of the moment generated by the working combination and the attitude control engine 0rg :
Calculating included angle theta between torque generated by the g-th working combination in all working combination torque tables of H attitude control engines and command torque g :
If the g-th attitude control engine working combination meets theta g < P _ CtaLim and M 0rg Selecting the attitude control engine working combination when the maximum attitude control engine working combination is selected;
wherein G is 1-G, wherein G is the total number of working combinations in all working combination torque tables of H attitude control engines;
M 0g the moment of the g-th working combination in all working combination torque tables of the H attitude control engines is obtained;
M r setting the preset command torque as the preset command torque;
ZKCnt is the number of attitude control engines corresponding to the g-th working combination;
and P _ CtaLim is a threshold value of an included angle between the working combination moment and the command moment of the attitude control engine.
5. A computer device comprising a memory, a processor and a computer program stored on the memory and executable on the processor, characterized in that the processor implements the method according to any of claims 1-4 when executing the program.
6. A computer-readable storage medium, on which a computer program is stored which, when being executed by a processor, carries out the method according to any one of claims 1-4.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011298667.6A CN112596532B (en) | 2020-11-19 | 2020-11-19 | Dynamic distribution method for attitude control engine control instructions of H spacecraft |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011298667.6A CN112596532B (en) | 2020-11-19 | 2020-11-19 | Dynamic distribution method for attitude control engine control instructions of H spacecraft |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112596532A CN112596532A (en) | 2021-04-02 |
CN112596532B true CN112596532B (en) | 2022-09-23 |
Family
ID=75183424
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011298667.6A Active CN112596532B (en) | 2020-11-19 | 2020-11-19 | Dynamic distribution method for attitude control engine control instructions of H spacecraft |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112596532B (en) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103121514A (en) * | 2011-11-18 | 2013-05-29 | 上海宇航系统工程研究所 | Attitude control method applied to centroid transverse moving spacecraft |
CN104635741A (en) * | 2015-01-14 | 2015-05-20 | 西北工业大学 | Re-entry attitude control method of reusable launch vehicle |
CN105836161A (en) * | 2016-04-29 | 2016-08-10 | 北京零壹空间科技有限公司 | Multi-stage aircraft control system and method, aircraft, guided missile and rocket |
CN106628263A (en) * | 2016-11-23 | 2017-05-10 | 北京电子工程总体研究所 | Optimized configuration method for reentry and return spacecraft propulsion system |
CN110058603A (en) * | 2019-04-08 | 2019-07-26 | 北京电子工程总体研究所 | A kind of deformation reentry vehicle deformation is preceding to instruct torque to determine method |
CN110968103A (en) * | 2019-12-12 | 2020-04-07 | 北京中科宇航探索技术有限公司 | Boosting variable-thrust attitude adjusting method and device |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8321076B2 (en) * | 2009-12-18 | 2012-11-27 | The Boeing Company | On-line inertia estimation for use in controlling an aerospace vehicle |
-
2020
- 2020-11-19 CN CN202011298667.6A patent/CN112596532B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103121514A (en) * | 2011-11-18 | 2013-05-29 | 上海宇航系统工程研究所 | Attitude control method applied to centroid transverse moving spacecraft |
CN104635741A (en) * | 2015-01-14 | 2015-05-20 | 西北工业大学 | Re-entry attitude control method of reusable launch vehicle |
CN105836161A (en) * | 2016-04-29 | 2016-08-10 | 北京零壹空间科技有限公司 | Multi-stage aircraft control system and method, aircraft, guided missile and rocket |
CN106628263A (en) * | 2016-11-23 | 2017-05-10 | 北京电子工程总体研究所 | Optimized configuration method for reentry and return spacecraft propulsion system |
CN110058603A (en) * | 2019-04-08 | 2019-07-26 | 北京电子工程总体研究所 | A kind of deformation reentry vehicle deformation is preceding to instruct torque to determine method |
CN110968103A (en) * | 2019-12-12 | 2020-04-07 | 北京中科宇航探索技术有限公司 | Boosting variable-thrust attitude adjusting method and device |
Non-Patent Citations (4)
Title |
---|
一种姿控发动机推力优化方法;石凯宇 等;《现代防御技术》;20170228(第01期);第6-11页 * |
具有侧向脉冲推力的动能拦截弹姿控;王晓东 等;《现代防御技术》;20071231;第41-44、50页 * |
姿控发动机布局方式研究;石凯宇 等;《现代防御技术》;20120430;第44-49页 * |
小推力速度闭环交会制导律设计;陈伟跃 等;《宇航学报》;20090630(第03期);第1030-1038页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112596532A (en) | 2021-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108804376B (en) | Small heterogeneous processing system based on GPU and FPGA | |
US4293941A (en) | Memory access control system in vector processing system | |
US8610732B2 (en) | System and method for video memory usage for general system application | |
CN109871952A (en) | Electronic device, accelerator, the accelerated method of neural network and acceleration system | |
EP2473915B1 (en) | An internal processing-unit memory for general-purpose use | |
US8977637B2 (en) | Facilitating field programmable gate array accelerations of database functions | |
US11132124B2 (en) | Memory subsystem operations with unaligned and scatter gather feature to support convolution and dimension shuffle | |
CN103336672B (en) | Method for reading data, device and computing device | |
CN107704413A (en) | A kind of reinforcement type parallel information processing platform based on VPX frameworks | |
CN109241015A (en) | Method for data to be written in distributed memory system | |
US20150370706A1 (en) | Method and apparatus for cache memory data processing | |
CN112596532B (en) | Dynamic distribution method for attitude control engine control instructions of H spacecraft | |
US20220207411A1 (en) | Clustering of machine learning (ml) functional components | |
US20090228664A1 (en) | Memory Compression Implementation in a System With Directly Attached Processor Memory | |
CN101794276B (en) | Discrete cosine transform (DCT)-inverse discrete cosine transform (IDCT) coprocessor suitable for system on chip (SOC) | |
CN112507532B (en) | Planar space two-to-one tracking region classification and guidance control method | |
CN110427377B (en) | Data processing method, device, equipment and storage medium | |
US6195747B1 (en) | System and method for reducing data traffic between a processor and a system controller in a data processing system | |
CN112270066A (en) | Optimization method for calculating rigid coupling coefficient of satellite and computer equipment | |
CN112101537A (en) | CNN accelerator and electronic device | |
CN112507529B (en) | Intelligent fuel saving guidance tracking method | |
WO2005098632A2 (en) | Device to allow multiple data processing channels to share a single disk drive | |
CN1513136A (en) | Process comprising an internal memory configuration | |
CN102520910B (en) | Adapt to low delay or height to handle up the coprocessor instruction manner of execution of requirement and system | |
CN112947520B (en) | Attitude control method and device for improving stability of low-speed aircraft under stall |
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 |