CN105022402A - Method for determining shortest time of coupled rigid-body spacecraft rapid maneuver - Google Patents

Method for determining shortest time of coupled rigid-body spacecraft rapid maneuver Download PDF

Info

Publication number
CN105022402A
CN105022402A CN201510515288.0A CN201510515288A CN105022402A CN 105022402 A CN105022402 A CN 105022402A CN 201510515288 A CN201510515288 A CN 201510515288A CN 105022402 A CN105022402 A CN 105022402A
Authority
CN
China
Prior art keywords
vector
platform
omega
attitude
payload platform
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201510515288.0A
Other languages
Chinese (zh)
Other versions
CN105022402B (en
Inventor
耿云海
黄思萌
侯志立
李东柏
叶东
陈雪芹
张刚
方向
李海勤
史明明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201510515288.0A priority Critical patent/CN105022402B/en
Publication of CN105022402A publication Critical patent/CN105022402A/en
Application granted granted Critical
Publication of CN105022402B publication Critical patent/CN105022402B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Medicines That Contain Protein Lipid Enzymes And Other Medicines (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention relates to a method for determining the shortest time of coupled rigid-body spacecraft rapid maneuver, and aims to solve problems of small effective operating range and long maneuvering time of a non-contact actuator of an existing undisturbed load satellite. The method is implemented through the following technical scheme which comprises the steps of 1, establishing a load platform coordinate system O<s>x<a>y<a>z<a> and a service platform coordinate system O<b>x<b>y<b>z<b>, and marking the load platform coordinate system O<s>x<a>y<a>z<a> and the service platform coordinate system O<b>x<b>y<b>z<b> as an Sa system and an Sb system respectively; 2, writing rotation inertia matrixes of a load platform and a service platform in regards to a system mass center of the coupled rigid-body spacecraft; 3, writing an attitude kinematics equation and an angular momentum conservation equation of the coupled rigid-body spacecraft; 4, calculating an Euler axis e and a rotation angle Phi<f>; 5, writing expressions of the angular acceleration Phi<..>(t), the angular speed Phi<.>(t) and the angle degree Phi(t); 6, writing expressions of an attitude quaternion q<m0> and an attitude quaternion q<m> of the load platform, an attitude matrix C<ao> of the load platform , an attitude matrix C<bo> of the service platform, the attitude angular speed Omega<al><a> of the load platform, the attitude angular speed Omega<bl><b> of the service platform, the attitude angular acceleration Omega<.><al><a> of the load platform and the attitude angular acceleration Omega<.><bl><a> of the service platform; 7, acquiring T<e><a>, T<w><b> and H<w><b> in regards to Phi<..>max, Phi<.>max and t; and 8, solving the constrained shortest maneuvering time by using a Matlab optimization toolbox according to the rotation angle Phi<f>, the T<e><a>, the T<w><b> and the H<w><b>. The method provided by the invention is applied to the field of spacecrafts.

Description

The shortest time defining method of a kind of pair of rigid body spacecraft fast reserve
Technical field
The present invention relates to the shortest time defining method of two rigid body spacecraft fast reserve.
Background technology
The fast reserve that the present invention be directed to " unperturbed load " satellite proposes.The Objective Concept NelsonPedreior of " unperturbed load " satellite proposes, and is applied to the satellite of high precision sensing and high stability demand for control." unperturbed load " satellite is a kind of two rigid body spacecraft, be made up of payload platform and service platform two parts, the attitude of contactless actuator control load platform, extra topworks (as reaction wheel etc.) controls the attitude of service platform, contactless actuator can be isolated extra topworks and be acted on the vibration of external environmental interference of service platform, makes useful load realize high precision and points to and high stability control.But, because the efficient working range of contactless actuator only has several millimeters, therefore the attitude of service platform must follow the tracks of the attitude of payload platform, in large angle maneuver process, in essence, service platform and payload platform carry out motor-driven as a whole, are equivalent to a motor-driven single rigid body satellite, time kept in reserve mainly limits by extra topworks, and the time kept in reserve is long.For " unperturbed load " satellite carrying large-scale useful load, existing configuration cannot meet the demand of fast reserve.
Summary of the invention
The present invention is that the efficient working range of the contactless actuator solving existing unperturbed load satellite and time kept in reserve are long, the problem of the unperturbed load satellite fast reserve of carrying large-scale useful load cannot be met, and propose the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve.
Above-mentioned goal of the invention is achieved through the following technical solutions:
Step one, set up payload platform coordinate system O sx ay az awith service platform coordinate system O bx by bz b, payload platform coordinate system is designated as S asystem, service platform coordinate system is designated as S bsystem, wherein, O sbe positioned at ball pivot center, O bbe positioned at service platform barycenter, O afor payload platform barycenter, O cfor two rigid body Space Vehicle System barycenter, the true origin of payload platform coordinate system is positioned at O s, payload platform and service platform form two rigid body spacecraft, and payload platform is connected by ball pivot with service platform;
Step 2, the S obtained according to step one asystem and S bsystem, writes out payload platform and the service platform moment of inertia matrix about two rigid body Space Vehicle System barycenter;
Step 3, the payload platform obtained according to step 2 and service platform, about the moment of inertia matrix of two rigid body Space Vehicle System barycenter, write out the attitude kinematics equations of two rigid body spacecraft and the conservation of angular momentum equation of two rigid body spacecraft;
Step 4, assumed (specified) load platform are by initial attitude motor-driven Euler's axle e to targeted attitude and corner Φ f;
Step 5, the corner Φ drawn according to step 4 f, write out the angular acceleration of payload platform pursuit path angular velocity with the expression formula of angle Φ (t);
The angular acceleration of the payload platform pursuit path that step 6, the Euler's axle e drawn according to step 4 and step 5 draw angular velocity with the expression formula of angle Φ (t), write out payload platform attitude quaternion q m0and q m, payload platform attitude matrix C ao, service platform attitude matrix C bo, payload platform attitude angular velocity the attitude angular velocity of service platform the attitude angle acceleration of payload platform with the attitude angle acceleration of service platform expression formula;
Step 7, by step 5 with Φ (t), and the C in step 6 ao, c bo, with substitute into the attitude dynamic equations of the two rigid body spacecrafts in step 3 and the conservation of angular momentum equation of pair rigid body spacecraft, obtain about with t's with
Step 8, the corner Φ drawn according to step 4 f, in step 7 with use Matlab Optimization Toolbox, solve the shortest time kept in reserve containing constraint.
Invention effect
The gesture stability that the present invention be directed to two rigid body satellites of monitoring for disaster emergency proposes, and two rigid body spacecraft is made up of payload platform and service platform, and payload platform carries useful load, and service platform carries topworks, and the two is connected by ball pivot.The meaning of the two rigid body spacecraft of research is: (1) payload platform can carry more useful load; (2) there are motor and flywheel in the topworks of two rigid body spacecraft, and compared to single rigid body spacecraft of homogenous quantities and moment of inertia, its controllable velocity is faster; (3) payload platform separates with service platform, can reduce the impact of vibration on useful load of topworks.Because one of main task of two rigid body spacecraft is the payload platform fast reserve making to carry useful load, so to the attitude no requirement (NR) of service platform of carrying topworks.The situation that the present invention have chosen makes payload platform fast reserve, service platform keeps absolute orientation.
Achieve the fast reserve of two rigid body spacecraft, motor-driven ball pivot is added between payload platform and service platform, relieve the restriction of contactless actuator efficient working range, the relative attitude making payload platform and service platform can carry out larger angle moves, the moment of inertia matrix become during by introducing two, give the attitude dynamic equations of detailed two rigid body spacecrafts, by introducing reasonable assumption, there are two points of rigid bodies of serious coupling in decoupling zero, give the objective function of time optimal problem and the expression formula of constraint function, use Matlab Optimization Toolbox can obtain the shortest time kept in reserve and corresponding maximum angular acceleration and maximum angular rate easily, carry out in the process of Large Angle Attitude Maneuver at payload platform, because the attitude of service platform is without the need to following the tracks of the attitude of payload platform, namely, without the need to motor-driven whole satellite, only need maneuver load terrace part, greatly can shorten the time kept in reserve, and original technology needs maneuver load platform and service platform simultaneously, assumed load platform and service platform quality close, the fast reserve method that this patent proposes can technically original, time kept in reserve will shorten 50%.The situation that the present invention have chosen makes payload platform fast reserve, service platform keeps absolute orientation, meets the problem of carrying the unperturbed load satellite fast reserve of large-scale useful load.
Accompanying drawing explanation
Fig. 1 is process flow diagram of the present invention;
Fig. 2 is the schematic diagram of coordinate system described in embodiment two, wherein, and O efor earth centroid, O cfor two rigid body Space Vehicle System barycenter, O afor payload platform barycenter, O bfor service platform barycenter, O sfor ball pivot barycenter, [i aj ak a] tfor S athe coordinate base of system, i afor S athe z-axis of system, j afor S athe x-axis of system, k afor S athe y-axis of system, T is transposition, [i bj bk b] tfor S bthe coordinate base of system, i bfor S bthe x-axis of system, j bfor S bthe y-axis of system, k bfor S bthe z-axis of system, dm afor payload platform quality infinitesimal, dm bfor service platform quality infinitesimal, R afor by O epoint to O avector, R bfor by O epoint to O bvector, R cfor by O epoint to O cvector, r afor by O epoint to dm avector, r bfor by O epoint to dm bvector, d 1for by O spoint to O avector, d 2for by O bpoint to O svector, p 1for by O apoint to O cvector, p 2for by O bpoint to O cvector, q 1for by O spoint to dm avector, q 2for by O spoint to dm bvector;
Fig. 3 is the schematic diagram of payload platform pursuit path described in embodiment six, wherein, and t 0for motor-driven start time, t 1for accelerating finish time, t 2for at the uniform velocity finish time, t ffor motor-driven finish time, for the angular velocity of payload platform pursuit path, for the maximum angular acceleration of payload platform pursuit path, for the maximum angular rate of payload platform pursuit path, for the angular acceleration of payload platform pursuit path;
Fig. 4 is the attitude angle acceleration plots of figure payload platform in embodiment 1, °/s degree of being/second;
Fig. 5 is figure motor torque modulus value curve map in embodiment 1, and Nm is ox rice;
Fig. 6 is figure flywheel moment modulus value curve map in embodiment 1;
Fig. 7 is figure flywheel angular momentum curve map in embodiment 1.
Embodiment
Embodiment one: composition graphs 1 illustrates present embodiment, the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve specifically carries out according to the following steps:
Step one, set up payload platform coordinate system O sx ay az awith service platform coordinate system O bx by bz b, payload platform coordinate system is designated as S asystem, service platform coordinate system is designated as S bsystem, wherein, O sbe positioned at ball pivot center, O bbe positioned at service platform barycenter, O afor payload platform barycenter, O cfor two rigid body Space Vehicle System barycenter, the true origin of payload platform coordinate system is positioned at O s, payload platform and service platform form two rigid body spacecraft, and payload platform is connected by ball pivot with service platform;
Step 2, the S obtained according to step one asystem and S bsystem, writes out payload platform and the service platform moment of inertia matrix about two rigid body Space Vehicle System barycenter;
Step 3, the payload platform obtained according to step 2 and service platform, about the moment of inertia matrix of two rigid body Space Vehicle System barycenter, write out the attitude kinematics equations of two rigid body spacecraft and the conservation of angular momentum equation of two rigid body spacecraft;
Step 4, assumed (specified) load platform are by initial attitude motor-driven Euler's axle e to targeted attitude and corner Φ f;
Step 5, the corner Φ drawn according to step 4 f, write out the angular acceleration of payload platform pursuit path angular velocity with the expression formula of angle Φ (t);
The angular acceleration of the payload platform pursuit path that step 6, the Euler's axle e drawn according to step 4 and step 5 draw angular velocity with the expression formula of angle Φ (t), write out payload platform attitude quaternion q m0and q m, payload platform attitude matrix C ao, service platform attitude matrix C bo, payload platform attitude angular velocity the attitude angular velocity of service platform the attitude angle acceleration of payload platform with the attitude angle acceleration of service platform expression formula;
Step 7, based on a zero momentum system, ignore disturbance torque, by step 5 with Φ (t), and the C in step 6 ao, c bo, with substitute into the attitude dynamic equations of the two rigid body spacecrafts in step 3 and the conservation of angular momentum equation of pair rigid body spacecraft, obtain about with t's with
Step 8, the corner Φ drawn according to step 4 f, in step 7 with use Matlab Optimization Toolbox, solve the shortest time kept in reserve containing constraint.
Embodiment two: composition graphs 2 illustrates present embodiment, present embodiment and embodiment one unlike: set up payload platform coordinate system O in described step one sx ay az awith service platform coordinate system O bx by bz b, payload platform coordinate system is designated as S asystem, service platform coordinate system is designated as S bsystem, wherein, O sbe positioned at ball pivot center, O bbe positioned at service platform barycenter, O afor payload platform barycenter, O cfor two rigid body Space Vehicle System barycenter, the true origin of payload platform coordinate system is positioned at O s, payload platform and service platform form two rigid body spacecraft, and payload platform is connected by ball pivot with service platform; Detailed process is:
Set up payload platform coordinate system O sx ay az awith service platform coordinate system O bx by bz b, payload platform coordinate system O sx ay az abe designated as S asystem, service platform coordinate system is designated as S bsystem, wherein, O sfor ball pivot center, O bfor service platform barycenter, x afor payload platform coordinate system x-axis, y afor payload platform coordinate system y-axis, z afor payload platform coordinate system z-axis, x bfor service platform coordinate system x-axis, y bfor service platform coordinate system y-axis, z bfor service platform coordinate system z-axis; O afor payload platform barycenter, O cfor two rigid body Space Vehicle System barycenter, for convenience of the attitude dynamic equations of the two rigid body spacecraft of follow-up derivation, the true origin of payload platform coordinate system is not positioned at O a, and be positioned at O s.
Other step and parameter identical with embodiment one.
Embodiment three: present embodiment and embodiment one or two unlike: according to the S that step one obtains in described step 2 asystem and S bsystem, writes out payload platform and the service platform moment of inertia matrix about two rigid body Space Vehicle System barycenter; Detailed process is:
Payload platform is about O cangular-momentum vector be:
In formula, dm afor the quality infinitesimal of payload platform, q 1for by O spoint to dm avector, p 1for by O apoint to O cvector, v aIfor dm aabsolute velocity vector, for O babsolute velocity vector, I 1for payload platform is about O sinertia dyad, H afor payload platform is about O cangular-momentum vector, d 1for by O spoint to O avector, ω aIfor S athe absolute angular velocities vector of system, ω bIfor S bthe absolute angular velocities vector of system, d 2for by O spoint to O bvector;
Service platform is about O cangular-momentum vector be:
In formula, dm bfor the quality infinitesimal of service platform, q 2for by O bpoint to dm bvector, p 2for by O bpoint to O cvector, v bIfor dm babsolute velocity vector, I 2for service platform is about O binertia dyad, H bfor service platform is about O cangular-momentum vector, ω bIfor S bthe absolute angular velocities vector of system;
Two rigid body Space Vehicle System is about O ctotal angular momentum be:
In formula, for O babsolute velocity vector, H wfor the angular-momentum vector of flywheel, H is that two rigid body Space Vehicle System is about O cangular-momentum vector;
Because m ap 1+ m bp 2=0, and p 2-p 1=d 1+ d 2, so
p 1 = - m b m a + m b ( d 1 + d 2 ) - - - ( 29 )
p 2 = m a m a + m b ( d 1 + d 2 ) - - - ( 30 )
Formula (29) and formula (30) are substituted into formula (28), obtains
In formula, E is unit inertia dyad;
Therefore payload platform and service platform are about O cinertia dyad be respectively:
In formula, I afor payload platform is about O cinertia dyad, I bfor service platform is about O cinertia dyad;
Then formula (31) can be expressed as
H=I a·ω aI+I b·ω bI+H w(34)
I aat S acomponent Matrices under system is payload platform about O cmoment of inertia matrix:
I a a = I 1 a - m a m b m a + m b &lsqb; ( d 1 a ) &times; ( d 1 a ) &times; + ( d 1 a ) &times; C a b ( d 2 b ) &times; C b a &rsqb; - - - ( 35 )
In formula, for payload platform is about O cmoment of inertia matrix, for payload platform is about O smoment of inertia matrix, m afor the quality of payload platform, m bfor the quality of service platform, for by O spoint to O athe component array of vector, for by O spoint to O bthe component array of vector, C abfor S abe relative S bthe attitude matrix of system, C bafor S bbe relative S athe attitude matrix of system, for multiplication cross matrix, for multiplication cross matrix;
I bat S bcomponent Matrices under system is service platform about O cmoment of inertia matrix:
I b b = I 2 b - m a m b m a + m b &lsqb; ( d 2 b ) &times; ( d 2 b ) &times; + ( d 2 b ) &times; C b a ( d 1 a ) &times; C a b &rsqb; - - - ( 36 )
In formula, superscript a and b is respectively vector or dyad at S asystem and S bcomponent array under system or Component Matrices, for service platform is about O cmoment of inertia matrix, for service platform is about O bmoment of inertia matrix;
And with first order derivative be respectively
I &CenterDot; a a = m a m b m a + m b ( d 1 a ) &times; &lsqb; ( &omega; a I a - C a b &omega; b I b ) &times; C a b d 2 b &rsqb; &times; - - - ( 37 )
I &CenterDot; b b = m a m b m a + m b ( d 2 b ) &times; &lsqb; ( &omega; b I b - C b a &omega; a I a ) &times; C b a d 1 a &rsqb; &times; - - - ( 38 )
In formula, for S athe absolute angular velocities vector of system is at S acomponent array under system, for S bthe absolute angular velocities vector of system is at S bcomponent array under system, for multiplication cross matrix, for multiplication cross matrix.
Other step and parameter identical with embodiment one or two.
Embodiment four: present embodiment and embodiment one, two or three unlike: the payload platform obtained according to step 2 in step 3 described in described step 3 and service platform, about the moment of inertia matrix of two rigid body Space Vehicle System barycenter, write out the attitude kinematics equations of two rigid body spacecraft and the conservation of angular momentum equation of two rigid body spacecraft; Detailed process is:
The payload platform obtained according to step 2 and service platform, about the moment of inertia matrix of two rigid body Space Vehicle System barycenter, write out attitude kinematics equations and the conservation of angular momentum equation of two rigid body spacecraft:
The attitude kinematics equations of two rigid body spacecraft is as formula (3), (4):
&lsqb; I 1 a - m a m b m a + m b ( d 1 a ) &times; ( d 1 a ) &times; &rsqb; &omega; &CenterDot; a I a - m a m b m a + m b ( d 1 a ) &times; C a b ( d 2 b ) &times; &omega; &CenterDot; b I b = T e a + T d a a - ( &omega; a I a ) &times; I 1 a &omega; a I a + ( d 1 a ) &times; { &mu;m a C a o ( R c o R c 3 - R a o R a 3 ) - m a m b m a + m b ( &omega; a I a ) &times; ( &omega; a I a ) &times; d 1 a + C a b ( &omega; b I b ) &times; ( &omega; b I b ) &times; d 2 b } - - - ( 3 )
C b a I a a &omega; &CenterDot; a I a + I b b &omega; &CenterDot; b I b = T w b + T d b - { C b a &lsqb; ( &omega; a I a ) &times; I a a &omega; a I a + I &CenterDot; a a &omega; a I a &rsqb; + ( &omega; b I b ) &times; I b b &omega; b I b + I &CenterDot; b b &omega; b I b + ( &omega; b I b ) &times; H w b } - - - ( 4 )
The conservation of angular momentum equation of two rigid body spacecraft is as formula (5):
C b a I a a &omega; a I a + I b b &omega; b I b + H w b = H 0 b - - - ( 5 )
In formula, for derivative, for derivative, for derivative, for derivative, superscript o is component array under the orbital coordinate system of two rigid body spacecraft of vector or dyad or Component Matrices, for S athe component array of the absolute angular velocities vector of system, for S bthe component array of the absolute angular velocities vector of system, C aofor S abe the attitude matrix of relative orbit system, for the coordinate array of motor torque vector, for the coordinate array of flywheel moment vector, for acting on the component array of the disturbance torque vector of payload platform, for acting on the component array of the disturbance torque vector of two rigid body Space Vehicle System, for the component array of flywheel angular-momentum vector, for the component array of two rigid body Space Vehicle System angular-momentum vector, μ is geocentric gravitational constant, for being pointed to the component array of the vector of payload platform barycenter by the earth's core, for being pointed to the component array of the vector of two rigid body Space Vehicle System barycenter by the earth's core, R cfor mould, R afor mould, for multiplication cross matrix, for multiplication cross matrix;
Payload platform is around O athe attitude kinematics equations rotated is:
In formula, for vector or dyad are at S aderivative under system, T efor motor torque vector, T bafor service platform acts on the moment vector of payload platform, T dafor acting on the disturbance torque vector of payload platform, ω aIfor S athe absolute angular velocities vector of system;
Act on the power F making a concerted effort to be acted on by service platform payload platform of payload platform baand external environment acts on the perturbed force F of payload platform dacomposition, according to Newton second law, has
F b a + F d a = m a d I 2 R a dt 2 = m a d I 2 ( R c - p 1 ) dt 2 - - - ( 43 )
In formula, the derivative under inertial system for vector or dyad, R afor pointing to O by the earth's core avector, R cfor pointing to O by the earth's core cvector, p 1for by O apoint to O cvector;
Based on the earth-spacecraft two system, have
d I 2 | R c | dt 2 = - &mu; | R c | 3 R c - - - ( 44 )
In formula, μ is Gravitational coefficient of the Earth; | R c| be R cmodulus value;
Because F dafor terrestrial attraction, so get
F d a = - &mu;m a | R a | 3 R a - - - ( 45 )
In formula, | R a| be R amodulus value;
Formula (29), formula (44) and formula (45) are substituted into formula (43), obtains
F b a = &mu;m a ( R a | R a | 3 - R c | R c | 3 ) + m a m b m a + m b &lsqb; &omega; a I &times; ( &omega; a I &times; d 1 ) + d a &omega; a I d t &times; d 1 + &omega; b I &times; ( &omega; b I &times; d 2 ) + d b &omega; b I d t &times; d 2 &rsqb; - - - ( 46 )
In formula, for vector or dyad are at S bderivative under system;
Again by T ba=-d 1× F basubstitution formula (42), obtains payload platform around O athe attitude kinematics equations rotated:
Above formula is at S acomponent type under system is
&lsqb; I 1 a - m a m b m a + m b ( d 1 a ) &times; ( d 1 a ) &times; &rsqb; &omega; &CenterDot; a I a - m a m b m a + m b ( d 1 a ) &times; C a b ( d 2 b ) &times; &omega; &CenterDot; b I b = T e a + T d a a - ( &omega; a I a ) &times; I 1 a &omega; a I a + ( d 1 a ) &times; { &mu;m a C a o ( R c o | R c | 3 - R a o | R a | 3 ) - m a m b m a + m b ( &omega; a I a ) &times; ( &omega; a I a ) &times; d 1 a + C a b ( &omega; b I b ) &times; ( &omega; b I b ) &times; d 2 b } - - - ( 48 )
In formula, for multiplication cross matrix, for multiplication cross matrix, for S athe absolute angular velocities vector of system is at S acomponent array under system, for S bthe absolute angular velocities vector of system is at S bcomponent array under system, for multiplication cross matrix, for multiplication cross matrix, for being pointed to the component array of the vector of payload platform barycenter by ball pivot center, for being pointed to the component array of the vector of service platform barycenter by ball pivot center, for derivative, for derivative, for motor torque vector is at S acomponent array under system, for disturbance torque vector is at S acomponent array under system;
To formula (34) differentiate, obtain two Rigid-body System around O cthe attitude kinematics equations rotated:
In formula, T wfor flywheel moment vector, T dfor acting on the disturbance torque vector H of two rigid body Space Vehicle System wfor flywheel angular-momentum vector, ω aIfor S athe absolute angular velocities vector of system, ω bIfor S bthe absolute angular velocities vector of system, H wfor the angular-momentum vector of flywheel, I afor payload platform is about O cinertia dyad, I bfor service platform is about O cinertia dyad;
Formula (49) is at S bcomponent type under system is:
C b a I a a &omega; &CenterDot; a I a + I b b &omega; &CenterDot; b I b = T w b + T d b - { C b a &lsqb; ( &omega; a I a ) &times; I a a &omega; a I a + I &CenterDot; a a &omega; a I a &rsqb; + ( &omega; b I b ) &times; I b b &omega; b I b + I &CenterDot; b b &omega; b I b + ( &omega; b I b ) &times; H w b } - - - ( 50 )
In formula, C bafor S bbe relative S athe attitude matrix of system, for I aat S acomponent Matrices under system, for I bat S bcomponent Matrices under system, for T wat S bcomponent array under system, for T dat S bcomponent array under system, for derivative, for derivative, for H wat S bcomponent array under system;
Formula (34) is at S bcomponent type under system is
C b a I a a &omega; a I a + I b b &omega; b I b + H w b = H 0 b - - - ( 41 )
In formula, for the total angular momentum vector of two rigid body spacecraft is at S bcomponent array under system;
Other step and parameter and embodiment one, two or three identical.
Embodiment five: present embodiment and embodiment one, two, three or four unlike: calculate payload platform in described step 4 by initial attitude motor-driven Euler's axle e to targeted attitude and corner Φ f; Detailed process is:
Φ f=2arccosq m0(6)
e = 1 s i n &Phi; f 2 q m - - - ( 7 )
In formula, q m0for payload platform is by the motor-driven hypercomplex number Q to targeted attitude of initial attitude mmark portion, q mfor payload platform is by the motor-driven hypercomplex number Q to targeted attitude of initial attitude marrow portion, Q m=[q m0q m] tbe four-vector, expression formula is:
Q m = Q 0 * &CircleTimes; Q f - - - ( 8 )
In formula, Q 0for the initial attitude hypercomplex number of payload platform, Q ffor the targeted attitude hypercomplex number of payload platform, Q mfor the hypercomplex number of targeted attitude, * is hypercomplex number transposition, for hypercomplex number multiplication, T is the transposition of array;
Other step and parameter and embodiment one, two, three or four identical.
Embodiment six: composition graphs 3 illustrates present embodiment, present embodiment and embodiment one, two, three, four or five unlike: according to the corner Φ that step 4 draws in described step 5 f, write out the angular acceleration of payload platform pursuit path angular velocity with the expression formula of angle Φ (t); Detailed process is:
If Φ is (t 0)=0, Φ (t f)=Φ f
&Phi; &CenterDot;&CenterDot; ( t ) = &Phi; &CenterDot;&CenterDot; m a x t 0 &le; t &le; t 1 0 t 1 < t < t 2 - &Phi; &CenterDot;&CenterDot; m a x t 2 &le; t &le; t f - - - ( 9 )
&Phi; &CenterDot; ( t ) = &Phi; &CenterDot;&CenterDot; m a x ( t - t 0 ) t 0 &le; t &le; t 1 &Phi; &CenterDot; m a x t 1 < t < t 2 &Phi; &CenterDot; max - &Phi; &CenterDot;&CenterDot; m a x ( t - t 2 ) t 2 &le; t &le; t f - - - ( 10 )
&Phi; ( t ) = 1 2 &Phi; &CenterDot;&CenterDot; max ( t - t 0 ) 2 t 0 &le; t &le; t 1 1 2 &Phi; &CenterDot;&CenterDot; max ( t 1 - t 0 ) 2 + &Phi; &CenterDot; max ( t - t 1 ) t 1 < t < t 2 1 2 &Phi; &CenterDot;&CenterDot; max ( t 1 - t 0 ) 2 + &Phi; &CenterDot; max ( t - t 1 ) - 1 2 &Phi; &CenterDot;&CenterDot; max ( t - t 2 ) 2 t 2 &le; t &le; t f - - - ( 11 )
In formula, for the angular acceleration of payload platform pursuit path, for the angular velocity of payload platform pursuit path, Φ (t) is the angle of payload platform pursuit path, for the maximum angular acceleration of payload platform pursuit path, for the maximum angular rate of payload platform pursuit path, t 0for motor-driven start time, t 1for accelerating finish time, t 2for at the uniform velocity finish time, t ffor motor-driven finish time, t is the time, and unit is second.
Other step and parameter and embodiment one, two, three, four or five identical.
Embodiment seven: present embodiment and embodiment one, two, three, four, five or six are unlike the angular acceleration of the payload platform pursuit path that the Euler's axle e drawn according to step 4 in described step 6 and step 5 draw angular velocity with the expression formula of angle Φ (t), write out payload platform attitude quaternion q m0and q m, payload platform attitude matrix C ao, service platform attitude matrix C bo, payload platform attitude angular velocity the attitude angular velocity of service platform the attitude angle acceleration of payload platform with the attitude angle acceleration of service platform expression formula; Detailed process is:
Payload platform pursuit path followed the tracks of by assumed load platform, and service platform is stablized;
Then payload platform attitude quaternion, as formula (12) (13):
q m 0 = c o s &Phi; ( t ) 2 - - - ( 12 )
q m = e s i n &Phi; ( t ) 2 - - - ( 13 )
The attitude matrix of payload platform, as formula (14):
C ao=q mq m T+[q m0E-(q m) ×] 2(14)
The attitude angular velocity of payload platform, as formula (15):
&omega; a I a = &Phi; &CenterDot; ( t ) e + C a o &omega; o I o - - - ( 15 )
The attitude angle acceleration of payload platform, as formula (16):
&omega; &CenterDot; a I a = &Phi; &CenterDot;&CenterDot; ( t ) e - &Phi; &CenterDot; ( t ) e &times; C a o &omega; o I o - - - ( 16 )
The attitude matrix of service platform, as formula (17):
C bo=E (17)
The attitude angular velocity of service platform, as formula (18):
&omega; b I b = &omega; o I o - - - ( 18 )
The attitude angle acceleration of service platform, as formula (19):
&omega; &CenterDot; b I b = 0 - - - ( 19 )
In formula, q m0for payload platform is by the motor-driven hypercomplex number Q to targeted attitude of initial attitude mmark portion, q mfor payload platform is by the motor-driven hypercomplex number Q to targeted attitude of initial attitude marrow portion, C bofor S bbe the attitude matrix of relative orbit system, C obfor the relative S of track system bthe attitude matrix of system, E is unit matrix, and e is Euler's axle of payload platform pursuit path, q m tfor q mtransposition, (q m) ×for q mmultiplication cross matrix, for the coordinate array of orbit angular velocity vector under spacecraft orbit system, e ×for the multiplication cross matrix of e, Φ (t) is the angle of payload platform pursuit path, for the angular velocity of payload platform pursuit path, for the angular acceleration of payload platform pursuit path, C bofor S bbe relative S othe attitude matrix of system;
Other step and parameter and embodiment one, two, three, four, five or six identical.
Embodiment eight: present embodiment and embodiment one, two, three, four, five, six or seven unlike: based on a zero momentum system in described step 7, ignore disturbance torque, by step 5 with Φ (t), and the C in step 6 ao, c bo, with substitute into the attitude dynamic equations of the two rigid body spacecrafts in step 3 and the conservation of angular momentum equation of pair rigid body spacecraft, obtain about with t's with detailed process is:
By the q in step 6 m0and q msubstitute into C ao, obtain the C about Φ (t) ao, then by C aosubstitute into with in, obtain about with Φ's (t) and about with Φ's (t) finally by C ao, c bo, with substitute into the attitude dynamic equations of the two rigid body spacecrafts in step 3 and the conservation of angular momentum equation of two rigid body spacecraft, available represent with t; available represent with t; available represent with t, obtain about with Φ's (t) with
In formula, for the component array of motor torque vector, for the component array of flywheel moment vector, for the component array of flywheel angular-momentum vector;
Wherein, for the maximum angular acceleration of payload platform pursuit path function, for the maximum angular rate of payload platform pursuit path function, for the function of time t.
Other step and parameter and embodiment one, two, three, four, five, six or seven identical.
Embodiment nine: present embodiment and embodiment one, two, three, four, five, six, seven or eight unlike: according to the corner Φ that step 4 draws in described step 8 f, in step 7 with use Matlab Optimization Toolbox, solve the shortest time kept in reserve containing constraint; Detailed process is:
Use Matlab Optimization Toolbox, separate the minimum value containing constraint, wherein, variable is with objective function is the time kept in reserve:
&Delta; t = &Phi; f &Phi; &CenterDot; m a x + &Phi; &CenterDot; m a x &Phi; &CenterDot;&CenterDot; m a x - - - ( 20 )
Constraint function is:
| T e a | &le; T e m a x - - - ( 21 )
| T w b | &le; T w m a x - - - ( 22 )
| H w b | &le; H w m a x - - - ( 23 )
In formula, T emaxfor the minimum envelop radius of motor torque, T wmaxfor the minimum envelop radius of flywheel moment, H wmaxfor the minimum envelop radius of flywheel angular momentum, Φ ffor corner, Δ t is the time kept in reserve, for the component array of motor torque vector, for the component array of flywheel moment vector, for the component array of flywheel angular-momentum vector;
The shortest time kept in reserve is gone out according to objective function and constraint function call.
Other step and parameter and embodiment one, two, three, four, five, six, seven or eight identical.
Embodiment
Adopt following experimental verification beneficial effect of the present invention:
Embodiment 1
The shortest time defining method of a kind of pair of rigid body spacecraft fast reserve specifically carries out according to the following steps:
Step one, set up payload platform coordinate system O sx ay az awith service platform coordinate system O bx by bz b, payload platform coordinate system is designated as S asystem, service platform coordinate system is designated as S bsystem, wherein, O sbe positioned at ball pivot center, O bbe positioned at service platform barycenter, O afor payload platform barycenter, O cfor two rigid body Space Vehicle System barycenter, the true origin of payload platform coordinate system is positioned at O s, payload platform and service platform form two rigid body spacecraft, and payload platform is connected by ball pivot with service platform;
Step 2, the S obtained according to step one asystem and S bsystem, writes out payload platform and the service platform moment of inertia matrix about two rigid body Space Vehicle System barycenter;
Step 3, the payload platform obtained according to step 2 and service platform, about the moment of inertia matrix of two rigid body Space Vehicle System barycenter, write out the attitude kinematics equations of two rigid body spacecraft and the conservation of angular momentum equation of two rigid body spacecraft;
Step 4, assumed (specified) load platform are by initial attitude motor-driven Euler's axle e to targeted attitude and corner Φ f;
Step 5, the corner Φ drawn according to step 4 f, write out the angular acceleration of payload platform pursuit path angular velocity with the expression formula of angle Φ (t);
The angular acceleration of the payload platform pursuit path that step 6, the Euler's axle e drawn according to step 4 and step 5 draw angular velocity with the expression formula of angle Φ (t), write out payload platform attitude quaternion q m0and q m, payload platform attitude matrix C ao, service platform attitude matrix C bo, payload platform attitude angular velocity the attitude angular velocity of service platform the attitude angle acceleration of payload platform with the attitude angle acceleration of service platform expression formula;
Step 7, based on a zero momentum system, ignore disturbance torque, by step 5 with Φ (t), and the C in step 6 ao, c bo, with substitute into the attitude dynamic equations of the two rigid body spacecrafts in step 3 and the conservation of angular momentum equation of pair rigid body spacecraft, obtain about with t's with
Step 8, the corner Φ drawn according to step 4 f, in step 7 with use Matlab Optimization Toolbox, solve the shortest time kept in reserve containing constraint;
The moment of inertia matrix of payload platform and service platform is respectively
I 1 = 2000 - 10 15 - 10 1000 - 20 15 - 20 3000 k g &CenterDot; m 2 ,
I 2 = 2500 12 - 5 12 2000 - 10 - 5 - 10 3200 k g &CenterDot; m 2 .
The quality of payload platform is m a=500kg, the quality of service platform is m b=600kg. d 1 a = 0 0 1 T m , d 2 b = 0 0 1 T m . Orbit angular velocity is ω o=0.0011rad/s, the position in the relative the earth's core of payload platform barycenter is R a o = 0 0 - 7 &times; 10 6 + 0.5 T m , The position in the relative the earth's core of two rigid body Space Vehicle System barycenter is R c o = 0 0 - 1 &times; 10 6 T m . Motor-driven start time is t 0=100s, payload platform initial angular velocity is &omega; ao a ( t 0 ) = 0 0 0 oT / s , Target angular velocity is &omega; ao a ( t f ) = 0 0 0 oT / s . The initial attitude of payload platform is over the ground [0 0 0] oT, targeted attitude is over the ground [50 7 12] oTthen Euler's axle is e=[0.9600 0.2300 0.1599] t, target rotation angle is Φ f=51.0603 °.Service platform keeps three-axis stabilization over the ground in whole mobile process.Attitude angle error is three axles 5 × 10 -4o(3 σ), attitude angular velocity measuring error is three axles 10 -4o/ s (3 σ).The disturbance torque acting on payload platform and two rigid body Space Vehicle System is respectively
T d a a = ( 1 &times; 10 - 4 sin ( &omega; o t ) 0.75 &times; 10 - 4 cos ( &omega; o t ) 1 &times; 10 - 4 sin ( &omega; o t ) + 0.5 &times; 10 - 4 0.5 &times; 10 - 4 0.5 &times; 10 - 4 ) N m ,
T d b = ( 2 &times; 10 - 4 sin ( &omega; o t ) 1.5 &times; 10 - 4 cos ( &omega; o t ) 2 &times; 10 - 4 sin ( &omega; o t ) + 1 &times; 10 - 4 1 &times; 10 - 4 1 &times; 10 - 4 ) N m .
In controller, take from angular frequency of shaking n=0.2rad/s, damping ratio ξ=0.9, then K pn 2=0.04, K d=2 ξ ω n=0.36.Flywheel adopts four angle mount configurations, and the maximum moment that flywheel can provide is 0.4Nm, and maximum angular momentum is 32Nm × s, and the maximum moment that motor can provide is 0.5Nm.
According to the method for the invention, try to achieve maximum angular acceleration maximum angular rate time kept in reserve Δ t=151.8272s.Analogous diagram is as Fig. 4, Fig. 5, Fig. 6 and Fig. 7;
From analogous diagram Fig. 4, Fig. 5, Fig. 6 and Fig. 7, flywheel moment reaches the upper limit, and motor torque and flywheel angular momentum all do not reach the upper limit, explanation with value meet the constraint of motor torque, flywheel moment and flywheel angular momentum, time kept in reserve optimization method is feasible.Why time kept in reserve cannot be faster, is because the flywheel moment upper limit is relatively little.

Claims (9)

1. a shortest time defining method for two rigid body spacecraft fast reserve, is characterized in that, the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve specifically carries out according to the following steps:
Step one, set up payload platform coordinate system O sx ay az awith service platform coordinate system O bx by bz b, payload platform coordinate system is designated as S asystem, service platform coordinate system is designated as S bsystem, wherein, O sbe positioned at ball pivot center, O bbe positioned at service platform barycenter, O afor payload platform barycenter, O cfor two rigid body Space Vehicle System barycenter, the true origin of payload platform coordinate system is positioned at O s, payload platform and service platform form two rigid body spacecraft, and payload platform is connected by ball pivot with service platform;
Step 2, the S obtained according to step one asystem and S bsystem, writes out payload platform and the service platform moment of inertia matrix about two rigid body Space Vehicle System barycenter;
Step 3, the payload platform obtained according to step 2 and service platform, about the moment of inertia matrix of two rigid body Space Vehicle System barycenter, write out the attitude kinematics equations of two rigid body spacecraft and the conservation of angular momentum equation of two rigid body spacecraft;
Step 4, assumed (specified) load platform are by initial attitude motor-driven Euler's axle e to targeted attitude and corner Φ f;
Step 5, the corner Φ drawn according to step 4 f, write out the angular acceleration of payload platform pursuit path angular velocity with the expression formula of angle Φ (t);
The angular acceleration of the payload platform pursuit path that step 6, the Euler's axle e drawn according to step 4 and step 5 draw angular velocity with the expression formula of angle Φ (t), write out payload platform attitude quaternion q m0and q m, payload platform attitude matrix C ao, service platform attitude matrix C bo, payload platform attitude angular velocity the attitude angular velocity of service platform the attitude angle acceleration of payload platform with the attitude angle acceleration of service platform expression formula;
Step 7, by step 5 with Φ (t), and the C in step 6 ao, c bo, with substitute into the attitude dynamic equations of the two rigid body spacecrafts in step 3 and the conservation of angular momentum equation of pair rigid body spacecraft, obtain about with t's with
Step 8, the corner Φ drawn according to step 4 f, in step 7 with use Matlab Optimization Toolbox, solve the shortest time kept in reserve containing constraint.
2. the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve according to claim 1, is characterized in that, sets up payload platform coordinate system O in described step one sx ay az awith service platform coordinate system O bx by bz b, payload platform coordinate system is designated as S asystem, service platform coordinate system is designated as S bsystem, wherein, O sbe positioned at ball pivot center, O bbe positioned at service platform barycenter, O afor payload platform barycenter, O cfor two rigid body Space Vehicle System barycenter, the true origin of payload platform coordinate system is positioned at O s, payload platform and service platform form two rigid body spacecraft, and payload platform is connected by ball pivot with service platform;
Detailed process is:
Set up payload platform coordinate system O sx ay az awith service platform coordinate system O bx by bz b, payload platform coordinate system O sx ay az abe designated as S asystem, service platform coordinate system is designated as S bsystem, wherein, O sfor ball pivot center, O bfor service platform barycenter, x afor payload platform coordinate system x-axis, y afor payload platform coordinate system y-axis, z afor payload platform coordinate system z-axis, x bfor service platform coordinate system x-axis, y bfor service platform coordinate system y-axis, z bfor service platform coordinate system z-axis; O afor payload platform barycenter, O cfor two rigid body Space Vehicle System barycenter, the true origin of payload platform coordinate system is positioned at O s.
3. the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve according to claim 2, is characterized in that, according to the S that step one obtains in described step 2 asystem and S bsystem, writes out payload platform and the service platform moment of inertia matrix about two rigid body Space Vehicle System barycenter; Detailed process is:
Payload platform is about O cangular-momentum vector be:
In formula, dm afor the quality infinitesimal of payload platform, q 1for by O spoint to dm avector, p 1for by O apoint to O cvector, v aIfor dm aabsolute velocity vector, for O babsolute velocity vector, for payload platform is about O sinertia dyad, H afor payload platform is about O cangular-momentum vector, d 1for by O spoint to O avector, ω aIfor S athe absolute angular velocities vector of system, ω bIfor S bthe absolute angular velocities vector of system, d 2for by O spoint to O bvector;
Service platform is about O cangular-momentum vector be:
In formula, dm bfor the quality infinitesimal of service platform, q 2for by O bpoint to dm bvector, p 2for by O bpoint to O cvector, v bIfor dm babsolute velocity vector, for service platform is about O binertia dyad, H bfor service platform is about O cangular-momentum vector, ω bIfor S bthe absolute angular velocities vector of system;
Two rigid body Space Vehicle System is about O ctotal angular momentum be:
In formula, for O babsolute velocity vector, H wfor the angular-momentum vector of flywheel, H is that two rigid body Space Vehicle System is about O cangular-momentum vector;
Because m ap 1+ m bp 2=0, and p 2-p 1=d 1+ d 2, so
p 1 = - m b m a + m b ( d 1 + d 2 ) - - - ( 29 )
p 2 = m a m a + m b ( d 1 + d 2 ) - - - ( 30 )
Formula (29) and formula (30) are substituted into formula (28), obtains
In formula, for unit inertia dyad;
Therefore payload platform and service platform are about O cinertia dyad be respectively:
In formula, for payload platform is about O cinertia dyad, for service platform is about O cinertia dyad;
Then formula (31) can be expressed as
at S acomponent Matrices under system is payload platform about O cmoment of inertia matrix:
I a a = I 1 a - m a m b m a + m b &lsqb; ( d 1 a ) &times; ( d 1 a ) &times; + ( d 1 a ) &times; C a b ( d 2 b ) &times; C b a &rsqb; - - - ( 35 )
In formula, for payload platform is about O cmoment of inertia matrix, for payload platform is about O smoment of inertia matrix, m afor the quality of payload platform, m bfor the quality of service platform, for by O spoint to O athe component array of vector, for by O spoint to O bthe component array of vector, C abfor S abe relative S bthe attitude matrix of system, C bafor S bbe relative S athe attitude matrix of system, for multiplication cross matrix, for multiplication cross matrix;
at S bcomponent Matrices under system is service platform about O cmoment of inertia matrix:
I b b = I 2 b - m a m b m a + m b &lsqb; ( d 2 b ) &times; ( d 2 b ) &times; + ( d 2 b ) &times; C b a ( d 1 a ) &times; C a b &rsqb; - - - ( 36 )
In formula, superscript a and b is respectively vector or dyad at S asystem and S bcomponent array under system or Component Matrices, for service platform is about O cmoment of inertia matrix, for service platform is about O bmoment of inertia matrix;
And with first order derivative be respectively
I &CenterDot; a a = m a m b m a + m b ( d 1 a ) &times; &lsqb; ( &omega; a I a - C a b &omega; b I b ) &times; C a b d 2 b &rsqb; &times; - - - ( 37 )
I &CenterDot; b b = m a m b m a + m b ( d 2 b ) &times; &lsqb; ( &omega; b I b - C b a &omega; a I a ) &times; C b a d 1 a &rsqb; &times; - - - ( 38 )
In formula, for S athe absolute angular velocities vector of system is at S acomponent array under system, for S bthe absolute angular velocities vector of system is at S bcomponent array under system, for multiplication cross matrix, for multiplication cross matrix.
4. the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve according to claim 3, it is characterized in that, the payload platform obtained according to step 2 in described step 3 and service platform, about the moment of inertia matrix of two rigid body Space Vehicle System barycenter, write out the attitude kinematics equations of two rigid body spacecraft and the conservation of angular momentum equation of two rigid body spacecraft; Detailed process is:
The payload platform obtained according to step 2 and service platform, about the moment of inertia matrix of two rigid body Space Vehicle System barycenter, write out attitude kinematics equations and the conservation of angular momentum equation of two rigid body spacecraft:
The attitude kinematics equations of two rigid body spacecraft is as formula (3), (4):
&lsqb; I 1 a - m a m b m a + m b ( d 1 a ) &times; ( d 1 a ) &times; &rsqb; &omega; &CenterDot; a I a - m a m b m a + m b ( d 1 a ) &times; C a b ( d 2 a ) &times; &omega; &CenterDot; b I b = T e a + T d a a - ( &omega; a I a ) &times; I 1 a &omega; a I a + ( d 1 a ) &times; { &mu;m a C a o ( R c o R c 3 - R a o R a 3 ) - m a m b m a + m b ( &omega; a I a ) &times; ( &omega; a I a ) &times; d 1 a + C a b ( &omega; b I b ) &times; ( &omega; b I b ) &times; d 2 b } - - - ( 3 )
C b a I a a &omega; &CenterDot; a I a + I b b &omega; &CenterDot; b I b = T w b + T d b - { C b a &lsqb; ( &omega; a I a ) &times; I a a &omega; a I a + I &CenterDot; a a &omega; a I a &rsqb; + ( &omega; b I b ) &times; I b b &omega; b I b + I &CenterDot; b b &omega; b I b + ( &omega; b I b ) &times; H w b } - - - ( 4 )
The conservation of angular momentum equation of two rigid body spacecraft is as formula (5):
C b a I a a &omega; a I a + I b b &omega; b I b + H w b = H 0 b - - - ( 5 )
In formula, for derivative, for derivative, for derivative, for derivative, superscript o is component array under the orbital coordinate system of two rigid body spacecraft of vector or dyad or Component Matrices, for S athe component array of the absolute angular velocities vector of system, for S bthe component array of the absolute angular velocities vector of system, C aofor S abe the attitude matrix of relative orbit system, for the coordinate array of motor torque vector, for the coordinate array of flywheel moment vector, for acting on the component array of the disturbance torque vector of payload platform, for acting on the component array of the disturbance torque vector of two rigid body Space Vehicle System, for the component array of flywheel angular-momentum vector, for the component array of two rigid body Space Vehicle System angular-momentum vector, μ is geocentric gravitational constant, for being pointed to the component array of the vector of payload platform barycenter by the earth's core, for being pointed to the component array of the vector of two rigid body Space Vehicle System barycenter by the earth's core, R cfor mould, R afor mould, for multiplication cross matrix, for multiplication cross matrix;
Payload platform is around O athe attitude kinematics equations rotated is:
In formula, for vector or dyad are at S aderivative under system, T efor motor torque vector, T bafor service platform acts on the moment vector of payload platform, T dafor acting on the disturbance torque vector of payload platform, ω aIfor S athe absolute angular velocities vector of system;
Act on the power F making a concerted effort to be acted on by service platform payload platform of payload platform baand external environment acts on the perturbed force F of payload platform dacomposition, according to Newton second law, has
F b a + F d a = m a d I 2 R a dt 2 = m a d I 2 ( R c - p 1 ) dt 2 - - - ( 43 )
In formula, the derivative under inertial system for vector or dyad, R afor pointing to O by the earth's core avector, R cfor pointing to O by the earth's core cvector, p 1for by O apoint to O cvector;
Based on the earth-spacecraft two system, have
d I 2 | R c | dt 2 = - &mu; | R c | 3 R c - - - ( 44 )
In formula, μ is Gravitational coefficient of the Earth; | R c| be R cmodulus value;
Because F dafor terrestrial attraction, so get
F d a = - &mu;m a | R a | 3 R a - - - ( 45 )
In formula, | R a| be R amodulus value;
Formula (29), formula (44) and formula (45) are substituted into formula (43), obtains
F b a = &mu;m a ( R a | R a | 3 - R c | R c | 3 ) + m a m b m a + m b &lsqb; &omega; a I &times; ( &omega; a I &times; d 1 ) + d a &omega; a I d t &times; d 1 + &omega; b I &times; ( &omega; b I &times; d 2 ) + d b &omega; b I d t &times; d 2 &rsqb; - - - ( 46 )
In formula, for vector or dyad are at S bderivative under system;
Again by T ba=-d 1× F basubstitution formula (42), obtains payload platform around O athe attitude kinematics equations rotated:
Above formula is at S acomponent type under system is
&lsqb; I 1 a - m a m b m a + m b ( d 1 a ) &times; ( d 1 a ) &times; &rsqb; &omega; &CenterDot; a I a - m a m b m a + m b ( d 1 a ) &times; C a b ( d 1 a ) &times; &omega; &CenterDot; b I b = T e a + T d a a - ( &omega; a I a ) &times; I 1 a &omega; a I a + ( d 1 a ) &times; { &mu;m a C a o ( R c o | R c | 3 - R a o | R a | 3 ) - m a m b m a + m b ( &omega; a I a ) &times; ( &omega; a I a ) &times; d 1 a + C a b ( &omega; b I b ) &times; ( &omega; b I b ) &times; d 2 b } - - - ( 48 )
In formula, for multiplication cross matrix, for multiplication cross matrix, for S athe absolute angular velocities vector of system is at S acomponent array under system, for S bthe absolute angular velocities vector of system is at S bcomponent array under system, for multiplication cross matrix, for multiplication cross matrix, for being pointed to the component array of the vector of payload platform barycenter by ball pivot center, for being pointed to the component array of the vector of service platform barycenter by ball pivot center, for derivative, for derivative, for motor torque vector is at S acomponent array under system, for disturbance torque vector is at S acomponent array under system;
To formula (34) differentiate, obtain two Rigid-body System around O cthe attitude kinematics equations rotated:
In formula, T wfor flywheel moment vector, T dfor acting on the disturbance torque vector H of two rigid body Space Vehicle System wfor flywheel angular-momentum vector, ω aIfor S athe absolute angular velocities vector of system, ω bIfor S bthe absolute angular velocities vector of system, H wfor the angular-momentum vector of flywheel, for payload platform is about O cinertia dyad, for service platform is about O cinertia dyad;
Formula (49) is at S bcomponent type under system is:
C b a I a a &omega; &CenterDot; a I a + I b b &omega; &CenterDot; b I b = T w b + T d b - { C b a &lsqb; ( &omega; a I a ) &times; I a a &omega; a I a + I &CenterDot; a a &omega; a I a &rsqb; + ( &omega; b I b ) &times; I b b &omega; b I b + I &CenterDot; b b &omega; b I b + ( &omega; b I b ) &times; H w b } - - - ( 50 )
In formula, C bafor S bbe relative S athe attitude matrix of system, for at S acomponent Matrices under system, for at S bcomponent Matrices under system, for T wat S bcomponent array under system, for T dat S bcomponent array under system, for derivative, for derivative, for H wat S bcomponent array under system;
Formula (34) is at S bcomponent type under system is
C b a I a a &omega; a I a + I b b &omega; b I b + H w b = H 0 b - - - ( 41 )
In formula, for the total angular momentum vector of two rigid body spacecraft is at S bcomponent array under system.
5. the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve according to claim 4, is characterized in that, calculates payload platform by initial attitude motor-driven Euler's axle e to targeted attitude and corner Φ in described step 4 f; Detailed process is:
Φ f=2arccosq m0(6)
e = 1 s i n &Phi; f 2 q m - - - ( 7 )
In formula, q m0for payload platform is by the motor-driven hypercomplex number Q to targeted attitude of initial attitude mmark portion, q mfor payload platform is by the motor-driven hypercomplex number Q to targeted attitude of initial attitude marrow portion, Q m=[q m0q m] tbe four-vector, expression formula is:
Q m = Q 0 * &CircleTimes; Q f - - - ( 8 )
In formula, Q 0for the initial attitude hypercomplex number of payload platform, Q ffor the targeted attitude hypercomplex number of payload platform, Q mfor the hypercomplex number of targeted attitude, * is hypercomplex number transposition, for hypercomplex number multiplication, T is the transposition of array.
6. the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve according to claim 5, is characterized in that, according to the corner Φ that step 4 draws in described step 5 f, write out the angular acceleration of payload platform pursuit path angular velocity with the expression formula of angle Φ (t); Detailed process is:
If Φ is (t 0)=0, Φ (t f)=Φ f
&Phi; &CenterDot;&CenterDot; ( t ) = &Phi; &CenterDot;&CenterDot; m a x t 0 &le; t &le; t 1 0 t 1 < t < t 2 - &Phi; &CenterDot;&CenterDot; m a x t 2 &le; t &le; t f - - - ( 9 )
&Phi; &CenterDot; ( t ) = &Phi; &CenterDot;&CenterDot; m a x ( t - t 0 ) t 0 &le; t &le; t 1 &Phi; &CenterDot; m a x t 1 < t < t 2 &Phi; &CenterDot; m a x - &Phi; &CenterDot;&CenterDot; m a x ( t - t 2 ) t 2 &le; t &le; t f - - - ( 10 )
&Phi; ( t ) = 1 2 &Phi; &CenterDot;&CenterDot; max ( t - t 0 ) 2 t 0 &le; t &le; t 1 1 2 &Phi; &CenterDot;&CenterDot; max ( t 1 - t 0 ) 2 + &Phi; &CenterDot; max ( t - t 1 ) t 1 < t < t 2 1 2 &Phi; &CenterDot;&CenterDot; max ( t 1 - t 0 ) 2 + &Phi; &CenterDot; max ( t - t 1 ) - 1 2 &Phi; &CenterDot;&CenterDot; max ( t - t 2 ) 2 t 2 &le; t &le; t f - - - ( 11 )
In formula, for the angular acceleration of payload platform pursuit path, for the angular velocity of payload platform pursuit path, Φ (t) is the angle of payload platform pursuit path, for the maximum angular acceleration of payload platform pursuit path, for the maximum angular rate of payload platform pursuit path, t 0for motor-driven start time, t 1for accelerating finish time, t 2for at the uniform velocity finish time, t ffor motor-driven finish time, t is the time, and unit is second.
7. the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve according to claim 6, is characterized in that, the angular acceleration of the payload platform pursuit path that the Euler's axle e drawn according to step 4 in described step 6 and step 5 draw angular velocity with the expression formula of angle Φ (t), write out payload platform attitude quaternion q m0and q m, payload platform attitude matrix C ao, service platform attitude matrix C bo, payload platform attitude angular velocity the attitude angular velocity of service platform the attitude angle acceleration of payload platform with the attitude angle acceleration of service platform expression formula; Detailed process is:
Payload platform pursuit path followed the tracks of by assumed load platform, and service platform is stablized;
Then payload platform attitude quaternion, as formula (12) (13):
q m 0 = c o s &Phi; ( t ) 2 - - - ( 12 )
q m = e s i n &Phi; ( t ) 2 - - - ( 13 )
The attitude matrix of payload platform, as formula (14):
C ao=q mq m T+[q m0E-(q m) ×] 2(14)
The attitude angular velocity of payload platform, as formula (15):
&omega; a I a = &Phi; &CenterDot; ( t ) e + C a o &omega; o I o - - - ( 15 )
The attitude angle acceleration of payload platform, as formula (16):
&omega; &CenterDot; a I a = &Phi; &CenterDot;&CenterDot; ( t ) e - &Phi; &CenterDot; ( t ) e &times; C a o &omega; o I o - - - ( 16 )
The attitude matrix of service platform, as formula (17):
C bo=E (17)
The attitude angular velocity of service platform, as formula (18):
&omega; b I b = &omega; o I o - - - ( 18 )
The attitude angle acceleration of service platform, as formula (19):
&omega; &CenterDot; b I b = 0 - - - ( 19 )
In formula, q m0for payload platform is by the motor-driven hypercomplex number Q to targeted attitude of initial attitude mmark portion, q mfor payload platform is by the motor-driven hypercomplex number Q to targeted attitude of initial attitude marrow portion, C bofor S bbe the attitude matrix of relative orbit system, C obfor the relative S of track system bthe attitude matrix of system, E is unit matrix, and e is Euler's axle of payload platform pursuit path, q m tfor q mtransposition, (q m) ×for q mmultiplication cross matrix, for the coordinate array of orbit angular velocity vector under spacecraft orbit system, e ×for the multiplication cross matrix of e, Φ (t) is the angle of payload platform pursuit path, for the angular velocity of payload platform pursuit path, for the angular acceleration of payload platform pursuit path, C bofor S bbe relative S othe attitude matrix of system.
8. the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve according to claim 7, is characterized in that, by step 5 in described step 7 with Φ (t), and the C in step 6 ao, c bo, with substitute into the attitude dynamic equations of the two rigid body spacecrafts in step 3 and the conservation of angular momentum equation of pair rigid body spacecraft, obtain about with t's with detailed process is:
By the q in step 6 m0and q msubstitute into C ao, obtain the C about Φ (t) ao, then by C aosubstitute into with in, obtain about with Φ's (t) and about with Φ's (t) finally by C ao, c bo, with substitute into the attitude dynamic equations of the two rigid body spacecrafts in step 3 and the conservation of angular momentum equation of pair rigid body spacecraft, obtain about with Φ's (t) with
In formula, for the component array of motor torque vector, for the component array of flywheel moment vector, for the component array of flywheel angular-momentum vector;
Wherein, for the maximum angular acceleration of payload platform pursuit path function, for the maximum angular rate of payload platform pursuit path function, for the function of time t.
9. the shortest time defining method of a kind of pair of rigid body spacecraft fast reserve according to claim 8, is characterized in that, according to the corner Φ that step 4 draws in described step 8 f, in step 7 with use Matlab Optimization Toolbox, solve the shortest time kept in reserve containing constraint; Detailed process is:
Use Matlab Optimization Toolbox, separate the minimum value containing constraint, wherein, variable is with objective function is the time kept in reserve:
&Delta; t = &Phi; f &Phi; &CenterDot; m a x + &Phi; &CenterDot; m a x &Phi; &CenterDot;&CenterDot; m a x - - - ( 20 )
Constraint function is:
| T e a | &le; T e m a x - - - ( 21 )
| T w b | &le; T w m a x - - - ( 22 )
| H w b | &le; H w m a x - - - ( 23 )
In formula, T emaxfor the minimum envelop radius of motor torque, T wmaxfor the minimum envelop radius of flywheel moment, H wmaxfor the minimum envelop radius of flywheel angular momentum, Φ ffor corner, △ t is the time kept in reserve, for the component array of motor torque vector, for the component array of flywheel moment vector, for the component array of flywheel angular-momentum vector;
The shortest time kept in reserve is gone out according to objective function and constraint function call.
CN201510515288.0A 2015-08-20 2015-08-20 The shortest time of a kind of pair of rigid body spacecraft fast reserve determines method Active CN105022402B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510515288.0A CN105022402B (en) 2015-08-20 2015-08-20 The shortest time of a kind of pair of rigid body spacecraft fast reserve determines method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510515288.0A CN105022402B (en) 2015-08-20 2015-08-20 The shortest time of a kind of pair of rigid body spacecraft fast reserve determines method

Publications (2)

Publication Number Publication Date
CN105022402A true CN105022402A (en) 2015-11-04
CN105022402B CN105022402B (en) 2017-11-03

Family

ID=54412442

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510515288.0A Active CN105022402B (en) 2015-08-20 2015-08-20 The shortest time of a kind of pair of rigid body spacecraft fast reserve determines method

Country Status (1)

Country Link
CN (1) CN105022402B (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107870063A (en) * 2017-09-21 2018-04-03 深圳航天东方红海特卫星有限公司 Spacecraft rotary inertia inflight measurement method based on the conservation of momentum
CN108646775A (en) * 2018-06-08 2018-10-12 北京控制工程研究所 One kind three surpassing the quick motor-driven and fast and stable control method of platform
CN108657468A (en) * 2018-04-20 2018-10-16 北京控制工程研究所 A kind of momenttum wheel driving moment distribution method with maximum angular momentum envelope
CN109033604A (en) * 2018-07-18 2018-12-18 哈尔滨工业大学 The determination method of stress at satellite dynamics modeling and bearing containing spin load
CN109774977A (en) * 2019-03-28 2019-05-21 上海微小卫星工程中心 A kind of time optimal satellite attitude rapid maneuver method based on quaternary number
CN111413995A (en) * 2020-03-24 2020-07-14 北京科技大学 Method and system for tracking relative position and synchronously controlling posture between double rigid body characteristic points
CN108762073B (en) * 2018-05-23 2021-07-13 北京控制工程研究所 Control law design method for active pointing hyperstatic platform

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6068218A (en) * 1997-05-14 2000-05-30 Hughes Electronics Corporation Agile, spinning spacecraft with sun-steerable solar cell array and method
US6360996B1 (en) * 2000-02-24 2002-03-26 Hughes Electronics Corporation Steering control for skewed scissors pair CMG clusters
US20080046138A1 (en) * 2004-12-15 2008-02-21 The Boeing Company Method for compensating star motion induced error in a stellar inertial attitude determination system
EP2316736A1 (en) * 2009-11-03 2011-05-04 Honeywell International Inc. Methods and systems for imposing a momentum boundary while reorienting an agile vehicle with control moment gyroscopes
US20110169689A1 (en) * 2005-11-23 2011-07-14 The Boeing Company Ultra-tightly coupled gps and inertial navigation system for agile platforms
CN102865866A (en) * 2012-10-22 2013-01-09 哈尔滨工业大学 Satellite attitude determination method and attitude determination error analytical method based on two star sensors
US8640994B1 (en) * 2010-09-27 2014-02-04 The Boeing Company Agile dedicated spacecraft for spinning microwave imagers and sounders
CN104462810A (en) * 2014-12-05 2015-03-25 哈尔滨工业大学 SDRE parameter adjustment method suitable for attitude maneuver and tracking control of wheel-controlled satellites

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6068218A (en) * 1997-05-14 2000-05-30 Hughes Electronics Corporation Agile, spinning spacecraft with sun-steerable solar cell array and method
US6360996B1 (en) * 2000-02-24 2002-03-26 Hughes Electronics Corporation Steering control for skewed scissors pair CMG clusters
US20080046138A1 (en) * 2004-12-15 2008-02-21 The Boeing Company Method for compensating star motion induced error in a stellar inertial attitude determination system
US20110169689A1 (en) * 2005-11-23 2011-07-14 The Boeing Company Ultra-tightly coupled gps and inertial navigation system for agile platforms
EP2316736A1 (en) * 2009-11-03 2011-05-04 Honeywell International Inc. Methods and systems for imposing a momentum boundary while reorienting an agile vehicle with control moment gyroscopes
US8640994B1 (en) * 2010-09-27 2014-02-04 The Boeing Company Agile dedicated spacecraft for spinning microwave imagers and sounders
CN102865866A (en) * 2012-10-22 2013-01-09 哈尔滨工业大学 Satellite attitude determination method and attitude determination error analytical method based on two star sensors
CN104462810A (en) * 2014-12-05 2015-03-25 哈尔滨工业大学 SDRE parameter adjustment method suitable for attitude maneuver and tracking control of wheel-controlled satellites

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
KAI SUN 等: "Mission Planning and Action Planning for Agile Earth-Observing Satellite with genetic Algorithm", 《JOURNAL OF HARBIN INSTITUTE OF TECHNOLOGY ( NEW SERIES)》 *
赵浩: "双体卫星在指向控制中的建模与仿真研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 *

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107870063A (en) * 2017-09-21 2018-04-03 深圳航天东方红海特卫星有限公司 Spacecraft rotary inertia inflight measurement method based on the conservation of momentum
CN107870063B (en) * 2017-09-21 2020-01-03 深圳航天东方红海特卫星有限公司 Spacecraft rotational inertia on-orbit measurement method based on momentum conservation
CN108657468A (en) * 2018-04-20 2018-10-16 北京控制工程研究所 A kind of momenttum wheel driving moment distribution method with maximum angular momentum envelope
CN108657468B (en) * 2018-04-20 2020-08-14 北京控制工程研究所 Momentum wheel driving moment distribution method with maximum angular momentum envelope
CN108762073B (en) * 2018-05-23 2021-07-13 北京控制工程研究所 Control law design method for active pointing hyperstatic platform
CN108646775A (en) * 2018-06-08 2018-10-12 北京控制工程研究所 One kind three surpassing the quick motor-driven and fast and stable control method of platform
CN108646775B (en) * 2018-06-08 2021-03-26 北京控制工程研究所 Three-super-platform agile maneuvering and rapid stable control method
CN109033604A (en) * 2018-07-18 2018-12-18 哈尔滨工业大学 The determination method of stress at satellite dynamics modeling and bearing containing spin load
CN109774977A (en) * 2019-03-28 2019-05-21 上海微小卫星工程中心 A kind of time optimal satellite attitude rapid maneuver method based on quaternary number
CN111413995A (en) * 2020-03-24 2020-07-14 北京科技大学 Method and system for tracking relative position and synchronously controlling posture between double rigid body characteristic points

Also Published As

Publication number Publication date
CN105022402B (en) 2017-11-03

Similar Documents

Publication Publication Date Title
CN105022402A (en) Method for determining shortest time of coupled rigid-body spacecraft rapid maneuver
Hu et al. Robust fault-tolerant tracking control for spacecraft proximity operations using time-varying sliding mode
CN109573105B (en) Attitude control method for terminal sub-level orbit-reserving application subsystem
CN103092208B (en) Spacecraft high-accuracy speediness attitude maneuver method based on single gimbal control moment gyro (SGCMG) and reaction wheel (RW)
CN104570742B (en) Feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of noncoplanar rendezvous orbit
Rastegari et al. Multiple impedance control of space free-flying robots via virtual linkages
Richie et al. Simultaneous attitude control and energy storage using VSCMGs: Theory and simulation
CN107861386A (en) A kind of anti-interference attitude control ground checking system and its control method based on angular speed observer
Zhang et al. Optimal path planning-based finite-time control for agile CubeSat attitude maneuver
Brown et al. Energetics of control moment gyroscopes as joint actuators
CN105799949B (en) A kind of pressure heart design method, attitude control method and the system of Asia orbiter
Xiaokui et al. Postcapture stabilization of space robots considering actuator failures with bounded torques
CN111806734B (en) Gravity compensation system, spacecraft relative motion ground suspension experiment system and method
Jung et al. An experimental comparison of CMG steering control laws
Qingxuan et al. Motion control of a novel spherical robot equipped with a flywheel
Ni et al. Design and posture control of a wheel-legged robot with actively passively transformable suspension system
CN104850128B (en) A kind of momenttum wheel layout collocation method for being used to accumulate spacecraft with large inertia
Jia et al. Analysis of actuation for a spherical robot
Darabi et al. Coupled rotational and translational modeling of two satellites connected by a tether and their robust attitude control using optimal offset approach
CN113447025B (en) Inertial navigation high-precision attitude angle resolving method and system based on Krafft angle
CN114706413B (en) Near-earth orbit micro-nano satellite centroid-changing gesture control method and system
Liu et al. Compensator-based 6-DOF control for probe asteroid-orbital-frame hovering with actuator limitations
Kravets et al. Dynamic design of ground transport with the help of computational experiment
CN114295145B (en) Method for designing strapdown inertial navigation system track generator based on vehicle-mounted emission platform
Liao et al. Finite-time stabilization for a novel non-contact spacecraft with a small air-clearance range constraint

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant