CN102519473A - Mixed sine maneuvering path guiding method for high-paddle fundamental frequency satellite - Google Patents

Mixed sine maneuvering path guiding method for high-paddle fundamental frequency satellite Download PDF

Info

Publication number
CN102519473A
CN102519473A CN201110409470XA CN201110409470A CN102519473A CN 102519473 A CN102519473 A CN 102519473A CN 201110409470X A CN201110409470X A CN 201110409470XA CN 201110409470 A CN201110409470 A CN 201110409470A CN 102519473 A CN102519473 A CN 102519473A
Authority
CN
China
Prior art keywords
max
delta
time
theta
satellite
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
CN201110409470XA
Other languages
Chinese (zh)
Other versions
CN102519473B (en
Inventor
谈树萍
何英姿
魏春岭
宗红
雷拥军
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN201110409470.XA priority Critical patent/CN102519473B/en
Publication of CN102519473A publication Critical patent/CN102519473A/en
Application granted granted Critical
Publication of CN102519473B publication Critical patent/CN102519473B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention relates to a mixed sine maneuvering path guiding method for a high-paddle fundamental frequency satellite. The mixed sine maneuvering path guiding method for a high-paddle fundamental frequency satellite is characterized in that based on reasonable distribution of maneuvering time and stabilization time, according to a moment and an angular momentum capacity of an execution mechanism, an angular acceleration curve is designed, wherein the angular acceleration curve shows an angular acceleration change rule that an angular acceleration is changed into zero from a positive value, then is changed into a negative value from zero and then is changed into zero from the negative value; and one half of a whole period of a sine curve mixed step function is a positive value curve part and the other half is a negative value curve part. The mixed sine maneuvering path guiding method for a high-paddle fundamental frequency satellite retains the advantage of small excitation of a sine maneuvering path on a flexible paddle, combines the advantage of time optimality of a step function, harmonizes the contradiction between maneuvering rapidity and paddle excitation smoothness, is especially suitable for providing path program for a large-angle, rapid and high-paddle fundamental frequency satellite in imaging breadth increasing, instant observation on a emergency area or stereo imaging rapid maneuvering, and satisfies requirements of rapid and stable maneuvering performances of a high-paddle fundamental frequency satellite.

Description

A kind of sinusoidal motor-driven path guide method of mixing that is suitable for the higher satellite of windsurfing fundamental frequency
Technical field
The invention belongs to spacecraft attitude control field, the path guide method when relating to a kind of flexible satellite fast reserve.
Background technology
Aspect the satellite fast reserve, in order to increase the fabric width that forms images, the accident area to be realized instant observation, when perhaps carrying out three-dimensional imaging, required regular side-sway automotive and pitching motor-driven.Big when the motor-driven angle of satellite, stabilization time short, when the degree of stability index is high, the windsurfing flexible vibration that mobile process evokes will become the principal element of restriction mobility.For the lower satellite of windsurfing fundamental frequency, sinusoidal motor-driven path can effectively reduce the excitation of large angle maneuver to flexible appendage, obtains higher stability.Although sinusoidal motor-driven path is compared with time optimal Bang-Bang path; Required motor-driven arrival time will be grown; But for the lower satellite of windsurfing fundamental frequency, delaying on the time kept in reserve can be contained in the outstanding benefit that obtains aspect the vibration of reduction windsurfing in sinusoidal motor-driven path.But, for the higher situation faster of motor-driven arrival time that requires simultaneously of fundamental frequency, adopt sinusoidal motor-driven path to vibrate the effect that obtains aspect less fully and compare with sacrificing motor-driven arrival time at windsurfing, not obvious to the contribution of fast reserve performance.Therefore need to the higher new solution of situation searching faster of motor-driven arrival time that requires simultaneously of fundamental frequency.
Summary of the invention
Technology of the present invention is dealt with problems and is: overcome the deficiency of prior art, provide that a kind of response speed is fast, good stability mix the motor-driven path guide method of satellite of stepped curve based on sine.
Technical solution of the present invention is: a kind of sinusoidal motor-driven path guide method of mixing that is suitable for the higher satellite of windsurfing fundamental frequency, and step is following:
(1) confirms time kept in reserve t according to the motor-driven and stable time index of the attitude of satellite Max
(2) confirm maximum motor-driven angular acceleration a according to the topworks's ability that is disposed on the satellite Max
(3) confirm maximum motor-driven limited angular velocity omega according to topworks's angular momentum capacity that is disposed on the satellite and sensor range Max
(4) attitude of satellite is the motor-driven path time that is divided into is [t 1t 2] the rate of acceleration section of increasing progressively, time be [t 2t 3] even accelerating sections, time be [t 3t 4] rate of acceleration decline fraction, time be [t 4t 5] at the uniform velocity coasting-flight phase, time be [t 5t 6] the rate of deceleration section of increasing progressively, time be [t 6t 7] even braking section, time be [t 7t 8] rate of deceleration decline fraction, t wherein 1Be the motor-driven start time of satellite,
Figure BSA00000633196700021
t 3=t 2+ Δ T, t 5=t 4+ Δ t,
Figure BSA00000633196700023
t 7=t 6+ Δ T,
Figure BSA00000633196700024
T is the cycle of sine function, and the initial value of T does
Figure BSA00000633196700025
Δ T is the even acceleration time, and the initial value of Δ T does
Figure BSA00000633196700026
Δ t is a coasting time, and the initial value of Δ t does Δt = 2 πω max ( π - 2 ) a max + 4 | θ d | ( π - 2 ) ω max - 6 - π π - 2 t max ;
(5) be a according to the cycle T of sine function, maximum motor-driven angular acceleration MaxAnd even acceleration time Δ T, the coasting time Δ t of satellite calculate in each section satellite respectively based on the attitude angle acceleration a of sine mixing step function, and corresponding attitude angular velocity ω and attitude angle θ, wherein:
(51) the rate of acceleration section of increasing progressively, a = a max sin ( 2 π T ( t - t 1 ) ) , ω = a max T 2 π ( 1 - cos ( 2 π T ( t - t 1 ) ) ) ,
Figure BSA000006331967000210
θ wherein dBe motor-driven angle; If, then upgrade according to Δ T<0 that initial value calculates
Figure BSA000006331967000211
Δ T=0,
Figure BSA000006331967000212
If the T+2 Δ T<T that calculates according to initial value Min, then upgrade T=T Min, the renewal maximum angular acceleration does
Figure BSA000006331967000213
Δ T=0, Δ t=0, T MinBe the shortest patient time kept in reserve;
(52) even accelerating sections, a=a Max, ω = a max T 2 π + a max ( t - t 2 ) ,
θ = a max T 2 ( π - 2 ) 8 π 2 + a max T ( t - t 2 ) 2 π + a max ( t - t 2 ) 2 2 , Wherein the value of T, Δ T, Δ t is with the rate of acceleration section of increasing progressively;
(53) rate of acceleration decline fraction, a = a max sin ( 2 π T ( t - t 3 + T 4 ) ) ,
ω = a max ΔT + a max T 2 π ( 1 - cos ( 2 π T ( t - t 3 + T 4 ) ) ) , θ ( t 4 ) = a max ΔT 2 2 + a max ΔTT 4 + a max TΔT 2 π + a max T 2 4 π ,
Wherein the value of T, Δ T, Δ t is with the rate of acceleration section of increasing progressively;
(54) coasting-flight phase at the uniform velocity, a=0, ω = a max T π + a max ΔT ,
θ = a max ΔT 2 2 + a max TΔT ( 1 4 + 1 2 π ) + a max T 2 4 π + ( a max T π + a max ΔT ) ( t - t 4 ) , Wherein the value of T, Δ T, Δ t is with the rate of acceleration section of increasing progressively;
(55) rate of deceleration section of increasing progressively, a = a max sin ( 2 π T ( t - t 1 - Δt - ΔT ) ) ,
ω = a max ΔT + a max T 2 π ( 1 - cos ( 2 π T ( t - t 1 - Δt - ΔT ) ) ) ,
θ = a max ΔT 2 2 + a max TΔT ( 1 4 + 1 2 π ) + a max T 2 4 π + a max T π Δt + a max ΔT ( t - t 5 + Δt )
+ a max T 2 π ( t - t 5 ) - a max T 2 4 π 2 sin ( 2 π T ( t - t 1 - Δt - ΔT ) ) ,
If, then upgrade
Figure BSA000006331967000310
Figure BSA000006331967000311
Δ t=0 according to Δ t<0 that initial calculation goes out; If Δ T<0 that calculates according to initial value; Then upgrade
Figure BSA000006331967000312
Δ T=0 &Delta; t = &pi; a Max T ( | &theta; d | - | a Max | T 2 2 &pi; ) ; If &Delta; t = &pi; a Max T ( | &theta; d | - | a Max | T 2 2 &pi; ) < 0 , Then upgrade T = 2 &pi; | &theta; d a Max | , Δ T=0, Δ t=0;
(56) even braking section, a=-a Max, &omega; = a max T 2 &pi; + a max &Delta;T - a max ( t - t 6 ) ,
&theta; = a max &Delta;T 2 2 + a max &Delta;TT ( &pi; + 1 ) 2 &pi; + ( a max T &pi; + a max &Delta;T ) &Delta;t + a max T 2 ( 3 &pi; + 2 ) 8 &pi; 2 + ( a max T 2 &pi; + a max &Delta;T ) ( t - t 6 ) - a max ( t - t 6 ) 2 2 , Wherein the value of T, Δ T, Δ t is with the rate of deceleration section of increasing progressively;
(57) rate of deceleration decline fraction, a = a max sin ( 2 &pi; T ( t - t 1 - &Delta;t - 2 &Delta;T ) ) ,
&omega; = a max &CenterDot; T 2 &pi; ( 1 - cos ( 2 &pi; T ( t - t 1 - &Delta;t - 2 &Delta;T ) ) ) ,
&theta; = a max &Delta;TT ( &pi; + 2 ) 2 &pi; + a max &Delta;T&Delta;t + 3 a max T 2 8 &pi; + a max &Delta;T 2
+ a max T 2 &pi; ( t - t 7 + 2 &Delta;t ) - a max T 2 4 &pi; 2 sin ( 2 &pi; T ( t - t 1 - &Delta;t - 2 &Delta;T ) ) ,
Wherein the value of T, Δ T, Δ t is with the rate of deceleration section of increasing progressively;
(6) the described path of tracking step (5) during the motor-driven control of satellite.
The present invention's advantage compared with prior art is: in the fast reserve process that has the complicated satellite of the higher flexible appendage of fundamental frequency; Adopt the motor-driven path of the sine mixing step of the inventive method; On the basis of reasonable distribution time kept in reserve and stabilization time; According to the moment and the angular momentum capacity of topworks, design earlier after just be zero again for negative be zero angular acceleration curve again, value is the sinusoidal curve mixing step function curve that the part of positive and negative is respectively half period.The inventive method is compared with traditional bang-bang path and standard sine path, has both weakened that flexible appendage has shortened the time kept in reserve again to the influence of satellite degree of stability under the large angle maneuver, thereby has ensured the fast and stable time after the fast reserve.
Description of drawings
Fig. 1 is the FB(flow block) of the inventive method;
The motor-driven path of Fig. 2 for adopting the inventive method to obtain;
Fig. 3 is the motor-driven path of a bang-bang satellite axis of rolling attitude angular velocity curve;
Fig. 4 is the motor-driven path of a standard sine satellite axis of rolling attitude angular velocity curve;
The satellite axis of rolling attitude angular velocity curve of Fig. 5 for adopting the inventive method to obtain;
Fig. 6 is a satellite sailboard flexible mode coordinate displacement under the motor-driven path of bang-bang;
Fig. 7 is a satellite sailboard flexible mode coordinate displacement under the sinusoidal motor-driven path;
The satellite sailboard flexible mode coordinate displacement of Fig. 8 for adopting the inventive method to obtain.
Embodiment
Present surveillance satellite has wide-angle fast reserve and stable demand, and motor-driven angle is big, and stabilization time is short, and stability index is high, and satellite improves the windsurfing height usually in order to satisfy the fast reserve ability, and fundamental frequency is higher.Therefore, need to adopt to guarantee the time kept in reserve rapidity, can guarantee the motor-driven path of less excitation windsurfing flexible vibration again.The inventive method has kept sinusoidal motor-driven path to the less advantage of flexible windsurfing excitation; Combine simultaneously the time optimal characteristics of step function again; When slowing down the motor-driven jigger panel vibration that puts in place; Optimize the time kept in reserve as far as possible, coordinated motor-driven rapidity and windsurfing and encouraged the contradiction between the mild property, be particularly suitable for wide-angle, quick, the motor-driven path design of the higher satellite of windsurfing fundamental frequency.
As shown in Figure 1, be the process flow diagram of the inventive method.
Among the present invention, angular acceleration adopts the sinusoidal step function form of mixing, and promptly becomes accelerating sections
Figure BSA00000633196700051
Even accelerating sections a=a Max, wherein a is an angular acceleration, a MaxBe the motor-driven angular acceleration of maximum, be subject to topworks's ability and sensor range; T is the planning acceleration cycle; The even acceleration time is Δ T.Therefore, are acceleration time and deceleration time
Figure BSA00000633196700052
Consider the time kept in reserve constraint, suppose that the maximum time kept in reserve is t Max, the situation that large angle maneuver and maximum angular rate are limited supposes that limited maximum angular velocity is ω Max, the time of at the uniform velocity sliding between accelerating sections and the braking section is Δ t.
According to the attitude angular velocity after the accelerating sections end
Figure BSA00000633196700053
Can know Confirm the funtcional relationship between trigonometric function cycle T and the even acceleration time Δ T according to this inequality, promptly
Figure BSA00000633196700055
The maximum time kept in reserve is t Max, can know time kept in reserve T+2 Δ T+ Δ t≤t MaxConfirm the funtcional relationship between trigonometric function cycle T, even acceleration time Δ T, the coasting time Δ t, i.e. T+2 Δ T+ Δ t=t according to this inequality Max
If T+2 Δ T>=T Min, can further motor-driven as required angle θ dConfirm coasting time Δ t, &Delta; t = 2 &pi; &omega; Max ( &pi; - 2 ) a Max + 4 | &theta; d | ( &pi; - 2 ) &omega; Max - 6 - &pi; &pi; - 2 t Max , T in the formula MinBe the minimum period of setting according to the time kept in reserve, θ dBe motor-driven angle, and then calculate T = 2 &pi; ( t Max - &omega; Max a Max - | &theta; d | &omega; Max ) &pi; - 2 , &Delta; T = &omega; Max a Max - T &pi; ; If coasting time Δ t<0 that calculates is obviously inadvisable, then make Δ t=0, according to time function relation
Figure BSA00000633196700061
And the motor-driven angle that puts in place &theta; ( t 8 ) = a Max &Delta; TT 2 + ( a Max T &pi; + a Max &Delta; T ) &Delta; t + a Max T 2 2 &pi; + a Max T&Delta; T &pi; + a Max &Delta; T 2 , Get with Δ t=0 homographic solution
Figure BSA00000633196700063
Figure BSA00000633196700064
If T+2 Δ T<T Min, show maximum motor-driven angular acceleration a MaxShould be littler than the angular acceleration under topworks's ability and the sensor limit of range, therefore upgrade a Max, make T=T Min, Δ T=0, Δ t=0 calculates
The derivation in motor-driven path is following:
(1) the rate of acceleration section of increasing progressively: [t 1t 2], t 1Be the motor-driven start time,
Figure BSA00000633196700067
With angular acceleration a at time period [t 1T] go up time integral, can get through calculating
Figure BSA00000633196700068
Same angle speed ω is at time period [t 1T] go up time integral, can get
Figure BSA00000633196700069
At time t 1And t 2Point has a (t respectively 1)=0, a (t 2)=a Max, ω (t 1)=0, &omega; ( t 2 ) = a max T 2 &pi; , θ(t 1)=0, &theta; ( t 2 ) = a max T 2 ( &pi; - 2 ) 8 &pi; 2 .
(2) even accelerating sections: [t 2t 3], t 3=t 2+ Δ T; A=a MaxWarp is at time period [t 2T] go up angular acceleration a and carry out integration and quadratic integral respectively, can get attitude angular velocity and attitude angle is respectively &omega; = a Max T 2 &pi; + a Max ( t - t 2 ) ; &theta; = a Max T 2 ( &pi; - 2 ) 8 &pi; 2 + a Max T ( t - t 2 ) 2 &pi; + a Max ( t - t 2 ) 2 2 , At time t 3The point, &omega; ( t 3 ) = a Max T 2 &pi; + a Max &Delta; T , &theta; ( t 3 ) = a Max &CenterDot; T 2 ( &pi; - 2 ) 8 &pi; 2 + a Max T&Delta; T 2 &pi; + a Max &CenterDot; &Delta; T 2 2 .
(3) rate of acceleration decline fraction: [t 4t 4], t 4 = t 3 + T 4 ; a = a Max Sin ( 2 &pi; T ( t - t 3 + T 4 ) ) ; With angular acceleration a at time period [t 3T] go up time integral, can get through calculating &omega; = a Max &Delta; T + a Max T 2 &pi; ( 1 - Cos ( 2 &pi; T ( t - t 3 + T 4 ) ) ) ; Angle speed ω is at time period [t 3T] go up time integral, &theta; = a Max &Delta; T 2 2 + a Max &Delta; T ( t - t 3 ) + a Max T 2 &pi; ( t - t 3 + T 4 + &Delta; T ) - a Max T 2 4 &pi; 2 Sin ( 2 &pi; T ( t - t 3 + T 4 ) ) , At time t 4Point, a (t 4)=0, &omega; ( t 4 ) = a Max T &pi; + a Max &Delta; T , &theta; ( t 4 ) = a Max &Delta; T 2 2 + a Max &Delta; TT 4 + a Max T&Delta; T 2 &pi; + a Max T 2 4 &pi; .
(4) coasting-flight phase at the uniform velocity: [t 4t 5], t 5=t 4+ Δ t; A=0; Through calculating,
Figure BSA00000633196700075
&theta; = a Max &Delta; T 2 2 + a Max &Delta; TT ( 1 4 + 1 2 &pi; ) + a Max T 2 4 &pi; + ( a Max T &pi; + a Max &Delta; T ) ( t - t 4 ) , At time t 5The point &omega; ( t 5 ) = a Max T &pi; + a Max &Delta; T , &theta; ( t 5 ) = a Max &Delta; T 2 2 + a Max T&Delta; T 4 + a Max T 2 4 &pi; + ( a Max T &pi; + a Max &Delta; T ) &Delta; t .
(5) rate of deceleration section of increasing progressively: [t 5t 6], t 6 = t 5 + T 4 ; a = a Max &CenterDot; Sin ( 2 &pi; T ( t - t 1 - &Delta; t - &Delta; T ) ) ; With angular acceleration a at time period [t 5T] go up time integral, can get through calculating &omega; = a Max &CenterDot; &Delta; T + a Max T 2 &pi; ( 1 - Cos ( 2 &pi; T ( t - t 1 - &Delta; t - &Delta; T ) ) ) ; With angular velocity omega at time period [t 5T] upper integral, &theta; = a Max &Delta; T 2 2 + a Max T&Delta; T ( 1 4 + 1 2 &pi; ) + a Max T 2 4 &pi; + a Max T &pi; &Delta; t + a Max &Delta; T ( t - t 5 + &Delta; t ) + a Max T 2 &pi; ( t - t 5 ) - a Max T 2 4 &pi; 2 Sin ( 2 &pi; T ( t - t 1 - &Delta; t - &Delta; T ) ) ; At time point t 6On, a (t 6The a of)=- Max, &omega; ( t 6 ) = a Max T 2 &pi; + a Max &Delta; T ,
&theta; ( t 6 ) = a max &Delta;T 2 2 + a max &Delta;TT 2 + a max &Delta;TT 2 &pi; + ( a max T &pi; + a max &Delta;T ) &Delta;t + 3 a max T 2 8 &pi; + a max T 2 4 &pi; 2 .
(6) even braking section: [t 6t 7], t 7=t 6+ Δ T; A=-a MaxWith angular acceleration a at time period [t 6T] upward can get time integral
Figure BSA000006331967000715
With angular velocity omega at time period [t 6T] upper integral, can get through calculating
&theta; = a max &Delta;T 2 2 + a max &Delta;TT ( &pi; + 1 ) 2 &pi; + ( a max T &pi; + a max &Delta;T ) &Delta;t + a max T 2 ( 3 &pi; + 2 ) 8 &pi; 2
+ ( a max T 2 &pi; + a max &Delta;T ) ( t - t 6 ) - a max ( t - t 6 ) 2 2
At time point t 7On, calculating can get,
Figure BSA00000633196700081
&theta; ( t 7 ) = a max &Delta;TT 2 + ( a max T &pi; + a max &Delta;T ) &Delta;t + 3 a max T 2 8 &pi; + a max T&Delta;T &pi; + a max &Delta;T 2 + a max T 2 4 &pi; 2 .
(7) rate of deceleration decline fraction: [t 7t 8], t 8 = t 7 + T 4 ; a = a Max Sin ( 2 &pi; T ( t - t 1 - &Delta; t - 2 &Delta; T ) ) ; With angular acceleration a at time period [t 7T] go up time integral, can get through calculating, &omega; = a Max &CenterDot; T 2 &pi; ( 1 - Cos ( 2 &pi; T ( t - t 1 - &Delta; t - 2 &Delta; T ) ) ) ; With angular velocity omega at time period [t 7T] upper integral, can get through calculating
&theta; = a max &Delta;TT ( &pi; + 2 ) 2 &pi; + a max &Delta;T&Delta;t + 3 a max T 2 8 &pi; + a max &Delta;T 2
+ a max T 2 &pi; ( t - t 7 + 2 &Delta;t ) - a max T 2 4 &pi; 2 sin ( 2 &pi; T ( t - t 1 - &Delta;t - 2 &Delta;T ) ) ;
ω (t wherein 8)=0, &theta; ( t 8 ) = a max &Delta;TT 2 + ( a max T &pi; + a max &Delta;T ) &Delta;t + a max T 2 2 &pi; + a max T&Delta;T &pi; + a max &Delta; T 2 .
The acceleration calculation in above-mentioned each stage is only considered the situation of forward angular movement, need get negative like the motor-driven angle of reality for negative then acceleration.
Embodiment 1
Path design with the motor-driven 70 ° of processes of certain typical complicated satellite axis of rolling is an example, supposes satellite moment of inertia 2962kg.m 2, topworks is a control-moment gyro, and the maximum moment that can provide is 20Nm, and the angular momentum capacity is Nms, and sensor is a gyro, maximum angle measurement speed is 2.5 °/s, requires motor-driven and be 80s stabilization time.The maximum time kept in reserve of then obtaining satellite according to step (1) is 40s, and the maximum motor-driven angular acceleration that obtains satellite according to step (2) is 0.3869 °/s 2, obtaining maximum angular rate according to step (3) is 2.5 °/s.Consider in the Project Realization and need leave certain surplus, so to choose maximum motor-driven angular acceleration during design path be a for gyro to measure and topworks Max=0.3 °/s 2, maximum angular rate ω Max=2.4 °/s.According to step (4), calculate the sine trigonometric function cycle T = 2 &pi; ( t Max - &omega; Max a Max - &theta; d &omega; Max ) &pi; - 2 = 15.5943 s . Choose minimum period T Min=8s, the even acceleration time
Figure BSA000006331967000810
According to step (5), calculate coasting time &Delta; t = 2 &pi; &omega; Max ( &pi; - 2 ) a Max + 4 | &theta; d | ( &pi; - 2 ) &omega; Max - 6 - &pi; &pi; - 2 t Max = 18.3333 s . Suppose t 1=0s, it is following to calculate motor-driven path:
The rate of acceleration section of increasing progressively, time [0 3.8986] s, a=0.3sin (0.1283 π t) °/s 2,
ω=0.7446(1-cos(0.1283πt)),
θ=0.7446(t-2.4819sin(0.1283πt));
Even accelerating sections, time [3.89866.9348] s, a=0.3 °/s 2,
ω=0.7446+0.3(t-3.8986)°/s,
θ=1.0548+7.446(t-3.8986)+0.15(t-3.8986) 2°;
The rate of acceleration decline fraction, time [6.934810.8334] s, a=0.3sin (0.1283 (t-3.0362)) °/s 2,
ω=0.9109+0.7446(1-cos(0.1283(t-6.9348)))°/s,
θ=3.6434+1.6555(t-6.9348)-1.8480sin(0.4029(t-6.9348)))°;
Coasting-flight phase, time [10.833429.1667] s, a=0 °/s 2,
ω=2.4001°/s,
θ=13+2.4(t-10.8334)°;
The rate of deceleration section of increasing progressively, time [29.166733.0653] s, a=0.3sin (0.1283 π (t-21.3695)) °/s 2,
ω=1.6555-0.7446cos(0.1283π(t-21.3695))°/s,
θ=56.9999+1.6554(t-29.1667)-1.848sin(0.1283π(t-21.3695));
Even braking section, time [33.065336.1015] s, a=-0.3 °/s 2,
ω=1.6555-0.3(t-33.0653)°/s,
θ=65.3019+1.6554(t-33.0653)-0.15(t-33.0653) 2
Rate of deceleration decline fraction, time [36.101540.0001] s, a=0.3sin (0.1283 π (t-24.4057)) °/s 2,
ω=0.7446-0.7446cos(0.1283π(t-24.4057))°/s,
θ=67.0974+0.7446(t-36.1015)-1.848sin(0.1283π(t-24.4057))。
The direction of attitude angle acceleration a is identical with the actual motor-driven direction of satellite.
Shown in Figure 2 is attitude angle acceleration, the attitude angular velocity according to the design of above result of calculation, the reserve road diametal curve of attitude angle.
Embodiment 2
With 70 ° of processes of certain typical complicated satellite axis of rolling 80s fast reserve is example, supposes satellite moment of inertia 2962kg.m 2, flexible windsurfing fundamental frequency 0.5Hz, control cycle is 0.1s, through calculating, chooses sine trigonometric function cycle T=20s, maximum angular acceleration a Max=0.3 °/s 2, maximum angular rate ω Max2.4 °/s.Find that through mathematical simulation as shown in Figure 3, under the motor-driven path of bang-bang, the maximum tracking error of attitude angular velocity is 1.2 °/s in the mobile process; As shown in Figure 4, under sinusoidal motor-driven path, the maximum tracking error of attitude angular velocity is 0.7 °/s in the mobile process; As shown in Figure 5, mix based on sine under the motor-driven path of stepped curve, the maximum tracking error of attitude angular velocity is 0.9 °/s in the mobile process; Significantly reduce than the motor-driven path of bang-bang.As shown in Figure 6, under the motor-driven path of bang-bang, the modal coordinate displacement of flexible windsurfing is to the maximum about 0.14; As shown in Figure 7, be to the maximum about 0.08 based on the modal coordinate displacement of sinusoidal motor-driven path downwarp property windsurfing.As shown in Figure 8, the modal coordinate displacement that mixes the motor-driven path downwarp property windsurfing of stepped curve based on sine is to the maximum about 0.08.According to computational analysis, the motor-driven required time that puts in place is 41.7332 under the sinusoidal motor-driven path, and is as shown in Figure 2, and the motor-driven required time that puts in place is 40.0001 under this method.It is thus clear that; This method has bigger improvement aspect the vibration of the motor-driven path of standard bang-bang flexible windsurfing in reducing mobile process; Reducing aspect the time kept in reserve bigger improvement is arranged than the motor-driven path of standard sine, and stability is more or less the same, thereby improved the quick performance of satellite.
The content of not doing to describe in detail in the instructions of the present invention belongs to those skilled in the art's known technology.

Claims (1)

1. sinusoidal motor-driven path guide method of the mixing that is suitable for the higher satellite of windsurfing fundamental frequency is characterized in that step is following:
(1) confirms time kept in reserve t according to the motor-driven and stable time index of the attitude of satellite Max
(2) confirm maximum motor-driven angular acceleration a according to the topworks's ability that is disposed on the satellite Max
(3) confirm maximum motor-driven limited angular velocity omega according to topworks's angular momentum capacity that is disposed on the satellite and sensor range Max
(4) attitude of satellite is the motor-driven path time that is divided into is [t 1t 2] the rate of acceleration section of increasing progressively, time be [t 2t 3] even accelerating sections, time be [t 3t 4] rate of acceleration decline fraction, time be [t 4t 5] at the uniform velocity coasting-flight phase, time be [t 5t 6] the rate of deceleration section of increasing progressively, time be [t 6t 7] even braking section, time be [t 7t 8] rate of deceleration decline fraction, t wherein 1Be the motor-driven start time of satellite,
Figure FSA00000633196600011
t 3=t 2+ Δ T, t 5=t 4+ Δ t, t 7=t 6+ Δ T,
Figure FSA00000633196600014
T is the cycle of sine function, and the initial value of T does
Figure FSA00000633196600015
Δ T is the even acceleration time, and the initial value of Δ T does Δ t is a coasting time, and the initial value of Δ t does &Delta;t = 2 &pi;&omega; max ( &pi; - 2 ) a max + 4 | &theta; d | ( &pi; - 2 ) &omega; max - 6 - &pi; &pi; - 2 t max ;
(5) be a according to the cycle T of sine function, maximum motor-driven angular acceleration MaxAnd even acceleration time Δ T, the coasting time Δ t of satellite calculate in each section satellite respectively based on the attitude angle acceleration a of sine mixing step function, and corresponding attitude angular velocity ω and attitude angle θ, wherein:
(51) the rate of acceleration section of increasing progressively, a = a Max Sin ( 2 &pi; T ( t - t 1 ) ) , &omega; = a Max T 2 &pi; ( 1 - Cos ( 2 &pi; T ( t - t 1 ) ) ) , &theta; = a Max &CenterDot; T 2 &pi; ( ( t - t 1 ) - T 2 &pi; Sin ( 2 &pi; T ( t - t 1 ) ) ) , θ wherein dBe motor-driven angle; If, then upgrade according to Δ T<0 that initial value calculates T = | &pi; &omega; Max a Max | , Δ T=0, &Delta; t = &pi; a Max T ( | &theta; d | - | a Max | T 2 2 &pi; ) ; If the T+2 Δ T<T that calculates according to initial value Min, then upgrade T=T Min, the renewal maximum angular acceleration does
Figure FSA00000633196600021
Δ T=0, Δ t=0, T MinBe the shortest patient time kept in reserve;
(52) even accelerating sections, a=a Max, &omega; = a max T 2 &pi; + a max ( t - t 2 ) ,
&theta; = a max T 2 ( &pi; - 2 ) 8 &pi; 2 + a max T ( t - t 2 ) 2 &pi; + a max ( t - t 2 ) 2 2 , Wherein the value of T, Δ T, Δ t is with the rate of acceleration section of increasing progressively;
(53) rate of acceleration decline fraction, a = a max sin ( 2 &pi; T ( t - t 3 + T 4 ) ) ,
&omega; = a max &Delta;T + a max T 2 &pi; ( 1 - cos ( 2 &pi; T ( t - t 3 + T 4 ) ) ) , &theta; ( t 4 ) = a max &Delta;T 2 2 + a max &Delta;TT 4 + a max T&Delta;T 2 &pi; + a max T 2 4 &pi; ,
Wherein the value of T, Δ T, Δ t is with the rate of acceleration section of increasing progressively;
(54) coasting-flight phase at the uniform velocity, a=0, &omega; = a max T &pi; + a max &Delta;T ,
&theta; = a max &Delta;T 2 2 + a max T&Delta;T ( 1 4 + 1 2 &pi; ) + a max T 2 4 &pi; + ( a max T &pi; + a max &Delta;T ) ( t - t 4 ) , Wherein the value of T, Δ T, Δ t is with the rate of acceleration section of increasing progressively;
(55) rate of deceleration section of increasing progressively, a = a max sin ( 2 &pi; T ( t - t 1 - &Delta;t - &Delta;T ) ) ,
&omega; = a max &Delta;T + a max T 2 &pi; ( 1 - cos ( 2 &pi; T ( t - t 1 - &Delta;t - &Delta;T ) ) ) ,
&theta; = a max &Delta;T 2 2 + a max T&Delta;T ( 1 4 + 1 2 &pi; ) + a max T 2 4 &pi; + a max T &pi; &Delta;t + a max &Delta;T ( t - t 5 + &Delta;t )
+ a max T 2 &pi; ( t - t 5 ) - a max T 2 4 &pi; 2 sin ( 2 &pi; T ( t - t 1 - &Delta;t - &Delta;T ) ) ,
If, then upgrade
Figure FSA000006331966000213
Figure FSA000006331966000214
Δ t=0 according to Δ t<0 that initial calculation goes out; If Δ T<0 that calculates according to initial value; Then upgrade
Figure FSA000006331966000215
Δ T=0 &Delta; t = &pi; a Max T ( | &theta; d | - | a Max | T 2 2 &pi; ) ; If &Delta; t = &pi; a Max T ( | &theta; d | - | a Max | T 2 2 &pi; ) < 0 , Then upgrade T = 2 &pi; | &theta; d a Max | , Δ T=0, Δ t=0;
(56) even braking section, a=-a Max, &omega; = a max T 2 &pi; + a max &Delta;T - a max ( t - t 6 ) ,
&theta; = a max &Delta;T 2 2 + a max &Delta;TT ( &pi; + 1 ) 2 &pi; + ( a max T &pi; + a max &Delta;T ) &Delta;t + a max T 2 ( 3 &pi; + 2 ) 8 &pi; 2 + ( a max T 2 &pi; + a max &Delta;T ) ( t - t 6 ) - a max ( t - t 6 ) 2 2 , Wherein the value of T, Δ T, Δ t is with the rate of deceleration section of increasing progressively;
(57) rate of deceleration decline fraction, a = a max sin ( 2 &pi; T ( t - t 1 - &Delta;t - 2 &Delta;T ) ) ,
&omega; = a max &CenterDot; T 2 &pi; ( 1 - cos ( 2 &pi; T ( t - t 1 - &Delta;t - 2 &Delta;T ) ) ) ,
&theta; = a max &Delta;TT ( &pi; + 2 ) 2 &pi; + a max &Delta;T&Delta;t + 3 a max T 2 8 &pi; + a max &Delta;T 2
+ a max T 2 &pi; ( t - t 7 + 2 &Delta;t ) - a max T 2 4 &pi; 2 sin ( 2 &pi; T ( t - t 1 - &Delta;t - 2 &Delta;T ) ) ,
Wherein the value of T, Δ T, Δ t is with the rate of deceleration section of increasing progressively;
(6) the described path of tracking step (5) during the motor-driven control of satellite.
CN201110409470.XA 2011-12-08 2011-12-08 Mixed sine maneuvering path guiding method for high-paddle fundamental frequency satellite Active CN102519473B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201110409470.XA CN102519473B (en) 2011-12-08 2011-12-08 Mixed sine maneuvering path guiding method for high-paddle fundamental frequency satellite

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201110409470.XA CN102519473B (en) 2011-12-08 2011-12-08 Mixed sine maneuvering path guiding method for high-paddle fundamental frequency satellite

Publications (2)

Publication Number Publication Date
CN102519473A true CN102519473A (en) 2012-06-27
CN102519473B CN102519473B (en) 2014-05-28

Family

ID=46290476

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201110409470.XA Active CN102519473B (en) 2011-12-08 2011-12-08 Mixed sine maneuvering path guiding method for high-paddle fundamental frequency satellite

Country Status (1)

Country Link
CN (1) CN102519473B (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104375512B (en) * 2014-10-30 2017-01-11 北京控制工程研究所 Spacecraft maneuvering path optimization method based on spectral analysis
CN103970964B (en) * 2014-05-23 2017-05-24 哈尔滨工业大学 Flexible satellite modal parameter in-orbit identification method
CN107515611A (en) * 2017-07-28 2017-12-26 北京控制工程研究所 A kind of sinusoidal motor-driven paths planning method of superimposed type mixing
CN107907865A (en) * 2017-11-14 2018-04-13 北京无线电测量研究所 One kind is based on discrete system radar antenna fan sweeping method and system
CN110673617A (en) * 2019-09-23 2020-01-10 北京控制工程研究所 Point-to-point attitude maneuver intelligent track planning and adjusting method
CN118349119A (en) * 2024-06-17 2024-07-16 成都市技师学院(成都工贸职业技术学院、成都市高级技工学校、成都铁路工程学校) VR interactive control method based on data processing

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050060092A1 (en) * 2003-08-05 2005-03-17 The Boeing Company Laser range finder closed-loop pointing technology of relative navigation, attitude determination, pointing and tracking for spacecraft rendezvous
CN101723096A (en) * 2009-12-24 2010-06-09 北京航天自动控制研究所 Control method for reducing grand gesture perturbation under interative guidance

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050060092A1 (en) * 2003-08-05 2005-03-17 The Boeing Company Laser range finder closed-loop pointing technology of relative navigation, attitude determination, pointing and tracking for spacecraft rendezvous
CN101723096A (en) * 2009-12-24 2010-06-09 北京航天自动控制研究所 Control method for reducing grand gesture perturbation under interative guidance

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
柯旗等: "一种在轨改善偏置动量卫星控制精度的方法", 《空间控制技术与应用》 *
王淑一等: "敏捷卫星快速姿态机动方法研究", 《空间控制技术与应用》 *
雷拥军等: "一种航天器姿态快速机动及稳定控制方法", 《中国空间科学技术》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103970964B (en) * 2014-05-23 2017-05-24 哈尔滨工业大学 Flexible satellite modal parameter in-orbit identification method
CN104375512B (en) * 2014-10-30 2017-01-11 北京控制工程研究所 Spacecraft maneuvering path optimization method based on spectral analysis
CN107515611A (en) * 2017-07-28 2017-12-26 北京控制工程研究所 A kind of sinusoidal motor-driven paths planning method of superimposed type mixing
CN107515611B (en) * 2017-07-28 2020-11-10 北京控制工程研究所 Superposition type hybrid sine maneuvering path planning method
CN107907865A (en) * 2017-11-14 2018-04-13 北京无线电测量研究所 One kind is based on discrete system radar antenna fan sweeping method and system
CN107907865B (en) * 2017-11-14 2019-12-13 北京无线电测量研究所 radar antenna sector scanning implementation method and system based on discrete system
CN110673617A (en) * 2019-09-23 2020-01-10 北京控制工程研究所 Point-to-point attitude maneuver intelligent track planning and adjusting method
CN110673617B (en) * 2019-09-23 2020-10-23 北京控制工程研究所 Point-to-point attitude maneuver intelligent track planning and adjusting method
CN118349119A (en) * 2024-06-17 2024-07-16 成都市技师学院(成都工贸职业技术学院、成都市高级技工学校、成都铁路工程学校) VR interactive control method based on data processing

Also Published As

Publication number Publication date
CN102519473B (en) 2014-05-28

Similar Documents

Publication Publication Date Title
CN102519473B (en) Mixed sine maneuvering path guiding method for high-paddle fundamental frequency satellite
CN101033973B (en) Attitude determination method of mini-aircraft inertial integrated navigation system
CN102736518B (en) Composite anti-interference controller comprising measurement and input time delay for flexible spacecraft
CN107479566A (en) Flexible satellite attitude control method based on three-stage path planning
Farrell et al. Carrier phase GPS-aided INS-based vehicle lateral control
CN103293957A (en) Satellite attitude maneuver method for performing routing planning relative to moving coordinate system
CN104062976B (en) A kind of is sinusoidal attitude of flight vehicle fast reserve method based on angular acceleration derivative
CN103708044B (en) A kind of saturated sliding mode variable structure control method for satellite rapid attitude maneuver
JP5442071B2 (en) Ship maneuvering control apparatus, automatic ship maneuvering control system, ship maneuvering control method, and program
CN104536457A (en) Sliding-mode control method based on small unmanned aerial vehicle navigation
CN103940442A (en) Location method and device adopting accelerating convergence algorithm
CN107992063B (en) Variable-parameter nutation damping-based precession control method for variable-speed tilting momentum wheel
CN101655371A (en) Position signal damping method of inertial navigation system based on variable damping coefficient
Park et al. Vehicle positioning based on velocity and heading angle observer using low-cost sensor fusion
CN109945895A (en) Inertial navigation Initial Alignment Method based on the smooth structure changes filtering that fades
CN102997919B (en) Method for improving error inhibition effect of rotary type strapdown inertial navigation by insulation of carrier movement
CN102162733A (en) Method for correcting autonomous underwater vehicle (AUV) dead reckoning navigation error in real time based on space vector modulation (SVM)
CN105652880A (en) Non-linear anti-saturation height instruction generating method for aircraft large airspace flight
CN103941741A (en) Method for determining controlled quantity of angular speed of control moment gyro frame on basis of zero movement
CN103644917A (en) Computing method for rotation and translation parameters of laser radar of mobile measurement platform
CN101124456B (en) Method for elaborating navigation parameters and vertical place
Ryan et al. On the observability of loosely coupled global positioning system/inertial navigation system integrations with five degree of freedom and four degree of freedom inertial measurement units
CN105241319A (en) High-speed self-rotation guided cartridge aerial real-time alignment method
CN105300407B (en) A kind of marine dynamic starting method for single axis modulation laser gyro inertial navigation system
Patrikar et al. Nested saturation based guidance law for unmanned aerial vehicles

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant