A kind of carrier rocket grade return phase precise guidance method based on virtual proportional guidance
Technical field
The carrier rocket grade return phase precise guidance method based on virtual proportional guidance that the present invention relates to a kind of, belongs to system
It leads and control technology field.
Background technique
Active service carrier rocket is all disposable at present, and rocket research and development for a long time, production, launch cost occupy height not
Under, transporting quality 1kg substance, to enter the cost of space be about ten thousand dollars of 1-2, leverage human development space scale and
Benefit.It is about more than 5000 Wan Meiyuan as -9 rocket total cost of falcon at present inexpensively, and the cost of its propellant only has
200000 dollars.If it is possible to carry out recycle without damage to rocket grade, re-used after simplified overhauling, then it can be with
Greatly reduce launch cost.The sub- grade of active service carrier rocket one no longer applies after isolation to be controlled, atmospheric reentry after no control flight,
Impact dispersion range is very big, thereby increases and it is possible to by densely inhabited districts such as cities and towns, generate larger prestige to ground staff and property safety
The side of body, sub- grade may be decomposed into several fragments by the ablation of high speed Reentry, cannot achieve recycling and reusing, and greatly increase and search
Rope and processing difficulty.
Summary of the invention
The invention aims to solve existing carrier rocket grade settle in an area dispersion radii it is excessive and be difficult to realize repeat make
The problem of with recycle without damage, provides a kind of using grid rudder as the carrier rocket grade based on virtual proportional guidance of executing agency
Return phase precise guidance method, the technical solution taken are as follows:
A kind of carrier rocket grade return phase precise guidance method based on virtual proportional guidance, the carrier rocket grade
Return phase precise guidance method the following steps are included:
Step 1: installing grid rudder on the head of carrier rocket grade, carries GPS/INS measurement by arrow and obtains under inertial system
The position and speed vector of the carrier rocket grade;
Step 2: in conjunction with the expectation target drop point site and velocity information of task, the virtual used of carrier rocket grade is obtained
Component of the property line of sight rate under the system of ground;
Step 3: by ground system to the coordinate conversion matrix of trajectory system, inertia line of sight rate is obtained under trajectory system
Component;
Step 4: deriving virtual proportional guidance relationship, obtains the virtual proportional guidance containing gravity compensation and overloads instruction.
Further, component of the virtual inertia line of sight rate under the system of ground described in step 2 includes: relative position arrow
The angular velocity of rotation of sight relative inertness system under amount, relative velocity vector and earth axes.
Further, the acquisition process of component of the virtual inertia line of sight rate under the system of ground are as follows:
Step 1: the position vector [x, y, z] and speed of the carrier rocket grade measured according to GPS/SINS navigation
VectorDetermine the Relative position vector and relative velocity vector between the carrier rocket grade and target drop point;It is described
Relative position vector and relative velocity vector form are as follows:
Wherein, xr,yr,zrFor component of the Relative position vector of sub- grade and target under inertial system, xt,yt,ztFor target
Position vector under inertial system, x, y, z are position vector of the sub- grade under inertial system, vrx,vry,vrzExist for sub- grade and target
Relative velocity vector under inertial system,For velocity vector of the target under inertial system,It is sub- grade in inertial system
Under velocity vector;
Step 2: determining sight phase under earth axes using Relative position vector described in the first step and relative velocity vector
To the angular velocity of rotation of inertial system, the angular velocity of rotation of sight relative inertness system under the earth axes are as follows:
Wherein,For square of sub- grade and target drop point relative distance.
Further, step 3 inertia line of sight rate component under trajectory system includes: that carrier rocket grade is fallen with target
The longitudinal line-of-sight rate by line and lateral line-of-sight rate by line of point.
Further, inertia angle of sight speed is obtained by the coordinate conversion matrix of ground system to trajectory system described in step 3
Degree component under trajectory system method particularly includes:
Step 1:
By the rotational angular velocity vector of sight relative inertness system under earth axes, multiplied by ground system to the coordinate of trajectory system
It is as follows to obtain inertia line of sight rate component under trajectory system for transition matrix:
Wherein: ω2For inertia line of sight rate vector under ballistic coordinate system;Ωx2Indicate inertia line of sight rate in trajectory
It is the component of x-axis, Ωz2、Ωy2Respectively longitudinally, laterally line-of-sight rate by line;Indicate around
Y-axis rotates ψvTransition matrix,Indicate the transition matrix that θ is rotated around z-axis, andFor ground system to the coordinate conversion matrix of trajectory system, θ is
Trajectory tilt angle, ψvFor trajectory deflection angle;
Step 2: above formula being unfolded, the final longitudinal line-of-sight rate by line for obtaining carrier rocket grade and target drop point and laterally
The model of line-of-sight rate by line is as follows:
Wherein, Ωz2、Ωy2Respectively longitudinally, laterally line-of-sight rate by line.
Further, the virtual proportional guidance relationship of derivation described in step 4, obtains the virtual proportional guidance containing gravity compensation
Overload instruction method particularly includes:
Step 1: the proportional guidance containing gravity compensation overloads the vector form expression formula instructed and is
nPN=-kpV×ω2/g+kg cosθj2 (5)
Wherein, V is the velocity vector of rocket grade, kpFor virtual proportional guidance coefficient, kgCos θ is gravity compensation item, kg
For gravity compensation coefficient, j2For the unit vector of ballistic coordinate system y-axis;
Step 2: by the vector form expression formula of the proportional guidance overload instruction described in step 1 containing gravity compensation in trajectory system
Lower expansion is obtained such as drag:
Wherein, V is the velocity magnitude of rocket grade
Step 3: it obtains the virtual proportional guidance containing gravity compensation and overloads instruction, the virtual proportional guidance overload instruction is such as
Under:
Wherein, kpFor virtual proportional guidance coefficient, kgCos θ is gravity compensation item, kgFor gravity compensation coefficient;G indicates weight
Power acceleration, nycFor the virtual proportional guidance normal direction overload of virtual proportional guidance overload instruction, nzcFor virtual proportional guidance overload
The virtual proportional guidance lateral overload of instruction realizes control for input raster rudder control system.
The invention has the advantages that:
The carrier rocket grade return phase precise guidance method based on virtual proportional guidance that the invention proposes a kind of.The party
Method devise it is by executing agency of grid rudder, by arrow carry navigation output sub- grade state, bookbinding target information form it is virtual
Inertia line of sight rate model has derived the virtual proportional guidance expression formula under trajectory system, obtains sub- grade return phase high-precision and makes
Lead instruction.The present invention carries GPS/SINS Integrated Navigation Instrument using arrow and bookbinding target information realizes that virtual proportional guidance guides, can
Sub- grade is effectively improved to settle in an area and sub- grade reuse return guidance precision, it is of the present invention to be based on relative to traditional method of guidance
The carrier rocket grade return phase precise guidance method of virtual proportional guidance can make guidance precision be increased to 10 meters or so, transport
It carries rocket grade and returns to settle in an area control and reuse recycling field and have broad application prospects.
In addition, flying in carrier rocket grade return course after being guided using precise guidance method proposed by the present invention
Scanning frequency degree is big, atmosphere is relatively dense, and high dynamic pressure condition can provide higher pneumatic control efficiency, and grid rudder compares conventional rudder face
With better control characteristic, by installing grid rudder on the head of the sub- grade of carrier rocket one, cooperate guidance control system, it can be with
It realizes being substantially improved for carrier rocket grade return phase precision, and then realizes rocket grade recycle without damage, transmitting is greatly lowered
Cost.
Detailed description of the invention
Fig. 1 is the carrier rocket grade schematic diagram of the present invention in head installation grid rudder.
Fig. 2 is the process of the carrier rocket grade return phase precise guidance method of the present invention based on virtual proportional guidance
Figure.
Specific embodiment
The present invention will be further described combined with specific embodiments below, but the present invention should not be limited by the examples.
Embodiment 1:
A kind of carrier rocket grade return phase precise guidance method based on virtual proportional guidance, the carrier rocket grade
Return phase precise guidance method the following steps are included:
Step 1: installing grid rudder on the head of carrier rocket grade, carries GPS/INS measurement by arrow and obtains under inertial system
The position and speed vector of the carrier rocket grade;
Step 2: in conjunction with the expectation target drop point site and velocity information of task, the virtual used of carrier rocket grade is obtained
Component of the property line of sight rate under the system of ground;
Step 3: by ground system to the coordinate conversion matrix of trajectory system, inertia line of sight rate is obtained under trajectory system
Component;
Step 4: deriving virtual proportional guidance relationship, obtains the virtual proportional guidance containing gravity compensation and overloads instruction.
Wherein, component of the virtual inertia line of sight rate under the system of ground described in step 2 includes: Relative position vector, phase
To the angular velocity of rotation of sight relative inertness system under velocity vector and earth axes.
The acquisition process of component of the virtual inertia line of sight rate under the system of ground are as follows:
Step 1: the position vector [x, y, z] and speed of the carrier rocket grade measured according to GPS/SINS navigation
VectorDetermine the Relative position vector and relative velocity vector between the carrier rocket grade and target drop point;It is described
Relative position vector and relative velocity vector form are as follows:
Wherein, xr,yr,zrFor component of the Relative position vector of sub- grade and target under inertial system, xt,yt,ztFor target
Position vector under inertial system, x, y, z are position vector of the sub- grade under inertial system, vrx,vry,vrzExist for sub- grade and target
Relative velocity vector under inertial system,For velocity vector of the target under inertial system,It is sub- grade in inertial system
Under velocity vector;
Step 2: determining sight phase under earth axes using Relative position vector described in the first step and relative velocity vector
To the angular velocity of rotation of inertial system, the angular velocity of rotation of sight relative inertness system under the earth axes are as follows:
Wherein,For square of sub- grade and target drop point relative distance.
Step 3 inertia line of sight rate component under trajectory system includes: that carrier rocket grade and the longitudinal of target drop point regard
Line angle rate and lateral line-of-sight rate by line.
By the coordinate conversion matrix of ground system to trajectory system described in step 3, inertia line of sight rate is obtained in trajectory system
Lower component method particularly includes:
Step 1: by the rotational angular velocity vector of sight relative inertness system under earth axes, multiplied by ground system to trajectory system
Coordinate conversion matrix, obtain inertia line of sight rate component under trajectory system it is as follows:
Wherein: ω2For inertia line of sight rate vector under ballistic coordinate system;Ωx2Indicate inertia line of sight rate in trajectory
It is the component of x-axis, Ωz2、Ωy2Respectively longitudinally, laterally line-of-sight rate by line;It indicates
ψ is rotated around y-axisvTransition matrix,Indicate the transition matrix that θ is rotated around z-axis, andFor ground system to the coordinate conversion matrix of trajectory system, θ is
Trajectory tilt angle, ψvFor trajectory deflection angle;
Step 2: above formula being unfolded, the final longitudinal line-of-sight rate by line for obtaining carrier rocket grade and target drop point and laterally
The model of line-of-sight rate by line is as follows:
Wherein, Ωz2、Ωy2Respectively longitudinally, laterally line-of-sight rate by line.
The virtual proportional guidance relationship of derivation described in step 4 obtains the virtual proportional guidance overload instruction containing gravity compensation
Method particularly includes:
Step 1: the proportional guidance containing gravity compensation overloads the vector form expression formula instructed and is
nPN=-kpV×ω2/g+kg cosθj2 (5)
Wherein, V is the velocity vector of rocket grade, kpFor virtual proportional guidance coefficient, kgCos θ is gravity compensation item, kg
For gravity compensation coefficient, j2For the unit vector of ballistic coordinate system y-axis;
Step 2: by the vector form expression formula of the proportional guidance overload instruction described in step 1 containing gravity compensation in trajectory system
Lower expansion is obtained such as drag:
Wherein, V is the velocity magnitude of rocket grade
Step 3: it obtains the virtual proportional guidance containing gravity compensation and overloads instruction, the virtual proportional guidance overload instruction is such as
Under:
Wherein, kpFor virtual proportional guidance coefficient, kgCos θ is gravity compensation item, kgFor gravity compensation coefficient;G indicates weight
Power acceleration, nycFor the virtual proportional guidance normal direction overload of virtual proportional guidance overload instruction, nzcFor virtual proportional guidance overload
The virtual proportional guidance lateral overload of instruction realizes control for input raster rudder control system.
The present invention settles in an area for existing carrier rocket grade, and range is excessive and precision deficiency is recycled in reuse and proposes, draws
Enter arrow and carry the sub- grade state of navigation output, bookbinding target information, derives virtual inertia line of sight rate computation model, and pass through void
Quasi- proportional guidance obtains sub- grade return phase zero-miss guidance instruction, realizes control for input raster rudder control system.Effectively
It improves carrier rocket grade and settles in an area and reuse recycling guidance precision.
Although the present invention has been disclosed in the preferred embodiment as above, it is not intended to limit the invention, any to be familiar with this
The people of technology can do various changes and modification, therefore protection of the invention without departing from the spirit and scope of the present invention
Range should subject to the definition of the claims.