CN105388902A - Control moment gyro singularity avoidance method based on instruction moment vector adjustment - Google Patents

Control moment gyro singularity avoidance method based on instruction moment vector adjustment Download PDF

Info

Publication number
CN105388902A
CN105388902A CN201510860445.1A CN201510860445A CN105388902A CN 105388902 A CN105388902 A CN 105388902A CN 201510860445 A CN201510860445 A CN 201510860445A CN 105388902 A CN105388902 A CN 105388902A
Authority
CN
China
Prior art keywords
control
vector
unusual
moment
singularity
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
CN201510860445.1A
Other languages
Chinese (zh)
Other versions
CN105388902B (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 CN201510860445.1A priority Critical patent/CN105388902B/en
Publication of CN105388902A publication Critical patent/CN105388902A/en
Application granted granted Critical
Publication of CN105388902B publication Critical patent/CN105388902B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0205Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
    • G05B13/021Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a variable is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Artificial Intelligence (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Combustion & Propulsion (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • Chemical & Material Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

A control moment gyro singularity avoidance method based on instruction moment vector adjustment comprises the steps of first acquiring a frame angular vector of control moment gyros, then calculating a Jacobian matrix, a singularity metric value and an instruction moment vector adjustment coefficient of a control moment gyro motion equation, next obtaining a control moment instruction adjustment vector and a zero motion singularity avoidance strength coefficient based on a control moment instruction given by an attitude controller, and finally obtaining a control moment gyro frame angular velocity instruction vector based on the control moment instruction adjustment vector and the zero motion singularity avoidance strength coefficient so as to control the moment gyro frame angular velocity. The invention overcomes the situation in which a moment instruction coincides with a particular direction thereof when a frame is "locked", thereby making separation impossible; solves the problem of a "locked" frame angle during singularity avoidance in the prior art; and achieves effective avoidance of the control moment gyro singularity.

Description

The unusual bypassing method of a kind of control-moment gyro based on instruction Torque vector control
Technical field
The present invention relates to spacecraft attitude deterministic finite automata field, particularly the unusual bypassing method of a kind of control-moment gyro based on instruction Torque vector control.
Background technology
The quick spacecraft with attitude fast reserve requirement generally adopts control-moment gyro group as topworks.Because attitude of satellite maneuverability is strong, when control-moment gyro group frame movement to during certain configuration can close to and be in the unusual state of framework, thus cause topworks cannot by expection output spacecraft three axle control moment.For avoiding the singular problem of control-moment gyro frame movement, existing technical method is the zero Kinematics singularity bypassing method and the unusual bypassing method of robust researched and proposed for singular problem, wherein, zero Kinematics singularity bypassing method only can realize effectively evading hidden unusual the evading in unusual type, the unusual bypassing method of robust is mainly for the insurmountable aobvious unusual evasion of zero Kinematics singularity bypassing method, but the latter relatively produce certain disturbance to spacecraft attitude evading in process the former.Although although therefore adopt zero conventional Kinematics singularity to evade the unusual algorithm of evading with robust can avoid this problem to a certain extent, spacecraft can be caused temporarily to lose gesture stability ability because the method exists control-moment gyro framework configuration " locked " phenomenon and affect attitude maneuver performance.
When take conventional unusual evade algorithm after occur that framework " locked " phenomenon is found and (WieBong after obtaining reasonable mathematic(al) treatment, et.al., SingularityRobustSteeringLogicforRedundantSingle-GimbalC ontrolMomentGyros, AIAAGuidance, Navigation, andControlConferenceandExhibit, Denver, 2000), relevant scholar has carried out the research avoiding this phenomenon.Follow-up major part research mainly improves the unusual algorithm of evading of robust, wherein, the most typically American scholar WieBong, its technological approaches taked is that the off diagonal element being zero is transformed into multi-form nonzero element (WieBong in singular divisor matrix anti-in unusual for traditional robust bypassing method, Newsingularityescape/avoidancesteeringlogicforcontrolmom entgyrosystems, JournalofGuidanceControlandDynamics, 28 (5), 2005), particularly off diagonal element is that time to time change is with the problem avoiding framework locked, and applied for that multinomial patent is (as WieB., et.al., RobustSingularityAvoidanceinSatelliteAttitudeControl, U.S.Patent6, 039, 290, 2000, WieB., SingularityEscape/AvoidanceSteeringLogicforControlMoment GyroSystems, U.S.PatentNo.6,917,862,2005. etc.).Existingly to improve one's methods above-mentioned, unusual evading and simultaneously as far as possible little to celestial body attitude disturbance requirement is realized in order to reach, need to select the multiparameter emulation examination mode of gathering in algorithm, therefore evade the locked and follow-up study of framework and improve one's methods generally to be difficult to take into account for conventional frame is unusual simultaneously and unusually evade the problem little with spacecraft attitude disturbance.
Summary of the invention
The technical matters that the present invention solves is: overcome the deficiencies in the prior art, provide and a kind ofly evade the unusual bypassing method with robust, unusual basis of evading algorithm introduced and independently regulate with unusual tolerance based on control moment instruction vector at zero Kinematics singularity, can enter unusual or hightail from singular point by anti-locking system, avoiding the phenomenon occurring control-moment gyro framework configuration " locked ".
Technical solution of the present invention is: the unusual bypassing method of a kind of control-moment gyro based on instruction Torque vector control, comprises the steps:
(1) control-moment gyro group frame corners vector δ is gathered, then according to the Jacobian matrix J of control-moment gyro equation of motion Computational frame angular motion;
(2) calculating Singularity Degree value Sv is
Sv=det(J·J T)
And then obtain command force moment vector adjustment factor υ and be
υ = 0 i f S v > D s 3 - k t m p υ · ( S v - D s 3 ) i f S v ≤ D s 3
When | υ | > υ limttime, υ=sgn (υ) υ limt, wherein, k tmp υfor regulating gain, D s3for vector regulates threshold value, υ limtfor vector adjustment factor amplitude limit value, sgn (υ) is for getting the symbolic operation of υ;
(3) according to the control moment instruction τ that attitude controller provides cobtain control moment instruction and regulate vector τ cAdfor
τ c A d = 1 - υ υ υ 1 - υ - υ υ 1 · τ c
(4) as Sv < D s1time, zero Kinematics singularity evades strength factor
Work as D s1≤ Sv < D s2time, zero Kinematics singularity evades strength factor
As Sv>=D s2time, zero Kinematics singularity evades strength factor α s1=0;
Wherein, D s1startup threshold value is evaded, D for robust is unusual s2be that zero Kinematics singularity evades startup threshold value, C 1be that zero Kinematics singularity evades intensity gain coefficient, α s10for amount of bias;
(5) as Sv < D s1time, robust is unusual evades strength factor α s2=
As Sv>=D s1time, robust is unusual evades strength factor α s2=0, wherein, C 2intensity gain coefficient is evaded for robust is unusual;
(6) vector τ is regulated according to control moment instruction cAd, unusually evade strength factor α s1and α s2obtain control-moment gyro frame corners speed command vector for
&delta; &CenterDot; d = - 1 H c m g 0 J T ( J &CenterDot; J T + &alpha; s 2 I 3 ) - 1 &tau; c A d + &alpha; s 1 ( I 3 - J T ( J &CenterDot; J T + &alpha; s 2 I 3 ) - 1 J ) &part; S v ( &delta; ) &part; &delta; .
Use control-moment gyro frame corners speed command vector control-moment gyro frame corners speed in adjustment control-moment gyro group, wherein, H cmg0for control-moment gyro angular momentum, I 3be 3 rank unit matrixs, for Sv is to the partial derivative of frame corners vector δ ,-1 is matrix inversion operation symbol.
Described adjustment gain k tmp υspan be-100≤k tmp υ≤ 100, vector regulates threshold value D s3> 0, vector adjustment factor amplitude limit value υ limtspan be 0≤υ limt< 1, robust unusual evading starts threshold value D s1> 0, zero Kinematics singularity evades startup threshold value D s2>=D s1, zero Kinematics singularity evades intensity gain coefficient C 1>=0, amount of bias α s10>=0, robust is unusual evades intensity gain coefficient C 2>=0.
Described step (5) also comprises amplitude limit value α s20, work as α s2> α s20time, α s2s20, wherein, α s20> 0.
Described k tmp υ=2, D s3=0.7, υ limt=0.7, D s1=0.5, D s2=2.0, C 1=0.18, C 2=0.1, α s10=0, α s20=0.5.
The present invention's advantage is compared with prior art:
(1) the present invention unusual to control-moment gyro framework by instruction Torque vector control under control moment instruction direction vector and amplitude carry out with unusual tolerance size from main deflection regulate means, overcome the torque command when framework " locked " to overlap with its specific direction and the situation that cannot depart from, solve and evade frame corners " locked " problem existing in process in prior art unusual, achieve unusual effectively the evading of control-moment gyro, there is form simple, explicit physical meaning and make parameter choose easy, the advantages such as engineer applied is strong,
(2) the present invention selects off diagonal element to be the technological means of antisymmetric matrix operator by the algorithm that regulates at vector, solve vector regulate after cause contrary with former instruction polarity of control moment instruction round pass through singular surface and the possibility problem making Spacecraft During Attitude Maneuver failure cannot be departed from, achieve control-moment gyro framework in subsequent control and can to depart from completely and away from corresponding unusual state;
(3) the present invention by comprising, zero Kinematics singularity is evaded, robust unusual evade call with the reasonable logic of instruction Torque vector control algorithm, vector adjustment factor and evade strength factor continuously adjustable design means, avoiding the unusual initial stage directly calls unusual algorithm and the vector evaded of robust and regulates algorithm or celestial body attitude is brought to the problem of disturbance because the adjustment factor that respectively calls algorithm and action intensity suddenly change, and achieves unusually to evade target little to celestial body attitude disturbance in overall process.
Accompanying drawing explanation
Fig. 1 is the unusual bypassing method process flow diagram of a kind of control-moment gyro based on instruction Torque vector control of the present invention;
Fig. 2 is the control-moment gyro frame corners curve that the present invention gathers;
Fig. 3 is control-moment gyro group configuration singularity value curve of the present invention;
Fig. 4 is that controller of the present invention exports comparison diagram before and after control moment instruction adjustment;
Fig. 5 is the control-moment gyro frame corners speed command curve that the present invention calculates.
Embodiment
The present invention is directed to the deficiencies in the prior art, propose the unusual bypassing method of a kind of control-moment gyro based on instruction Torque vector control, to comprise concrete implementing procedure as follows for the inventive method as shown in Figure 1:
1) (control-moment gyro is by the momentum flywheel of permanent rotating speed to gather control-moment gyro group frame corners vector δ, the framework of support flying wheel and frame member servo-drive system composition, the vector be made up of control-moment gyro frame corner each in control-moment gyro group is referred to as control-moment gyro group frame corners vector), according to the Jacobian matrix J of control-moment gyro equation of motion Computational frame angular motion (equation of motion describe and Jacobian matrix ask for can be see: ParadisoJ.A., GlobalSteeringofSingleGimballedControlMomemtGyroscopeUsi ngaDirectedSearch, J.ofGuidance, Control, andDynamics, 15 (5), 1992:1236-1244), Singularity Degree value Sv and Sv is to the partial derivative of frame corners vector δ value (local derviation specific algorithm can see document: Zhang Renwei, satellite orbit and attitude dynamics and control, publishing house of BJ University of Aeronautics & Astronautics, 1998:293), and by Singularity Degree value Sv computations Torque vector control coefficient υ, and control moment instruction τ is provided to Spacecraft Control device ccarry out vector and regulate the adjusted vector τ of computing cAd.Be specially:
(1) Sv is matrix J J tdeterminant, namely
Sv=det(J·J T)
Wherein, J tfor the transposed matrix of matrix J.
(2) by Singularity Degree value Sv computations Torque vector control coefficient υ be
&upsi; = 0 i f S v > D s 3 - k t m p &upsi; &CenterDot; ( S v - D s 3 ) i f S v &le; D s 3
If | υ | > υ limtshi Ze carries out amplitude limiting processing: υ=sgn (υ) υ limt, wherein, k tmp υ(-100≤k tmp υ≤ 100) for regulating gain, D s3(D s3> 0) be vector adjustment threshold value, υ limt(0≤υ limt< 1) be vector adjustment factor amplitude limit value, sgn (υ), for getting the symbolic operation of υ, is namely taken as 1 when υ is greater than zero, otherwise is taken as 0.
(3) to the control moment instruction τ that attitude controller provides ccarry out vector and regulate computing:
&tau; c A d = 1 - &upsi; &upsi; &upsi; 1 - &upsi; - &upsi; &upsi; 1 &CenterDot; &tau; c
2) calculate zero Kinematics singularity and evade strength factor α s1strength factor α is evaded with robust is unusual s2.Be specially:
(1) zero Kinematics singularity evades strength factor α s1computing formula is
If Sv < is D s1time, &alpha; s 1 = C 1 ( 1 D s 1 - 1 D s 2 ) ;
If D s1≤ Sv < D s2time, &alpha; s 1 = C 1 ( 1 S v - 1 D s 2 ) + &alpha; s 10 ;
If Sv>=D s2time, α s1=0;
Wherein, D s1(D s1> 0) evade startup threshold value for robust is unusual, D s2(D s2> 0, and meet D s2>=D s1) be that zero Kinematics singularity evades startup threshold value, C 1(C 1>=0) be that zero Kinematics singularity evades intensity gain coefficient, amount of bias α s10>=0.
(2) robust is unusual evades strength factor α s2computing formula is
If Sv < is D s1time, &alpha; s 2 = C 2 &CenterDot; ( 1 S v + 10 - 6 - 1 D s 1 + 10 - 6 )
If Sv>=D s1time, α s2=0
If above-mentioned result of calculation meets α s2> α s20time, then put α s2s20, wherein, C 2(C 2>=0) intensity gain coefficient is evaded for robust is unusual, α s20s20> 0) be α s2amplitude limit value.
3) the control moment instruction provided according to attitude controller regulates vector τ cAd, unusually evade strength factor α s1, α s2, take zero Kinematics singularity to evade frame corners speed command that the unusual bypassing method with robust carries out control-moment gyro group calculate, be specially:
&delta; &CenterDot; d = - 1 H c m g 0 J T ( J &CenterDot; J T + &alpha; s 2 I 3 ) - 1 &tau; c A d + &alpha; s 1 ( I 3 - J T ( J &CenterDot; J T + &alpha; s 2 I 3 ) - 1 J ) &part; S v ( &delta; ) &part; &delta; .
Wherein, for control-moment gyro frame corners speed command to be asked vector, H cmg0for control-moment gyro angular momentum, I 3be 3 rank unit matrixs, for Sv is to the partial derivative (specific formula for calculation can see document: Zhang Renwei, satellite orbit and attitude dynamics and control, publishing house of BJ University of Aeronautics & Astronautics, 1998:P293) of frame corners vector δ, upper right footmark "-1 " is matrix inversion operation symbol.Below in conjunction with embodiment, the inventive method is described in detail.
Embodiment 1: adopt angular momentum H cmg0the system of 6 control-moment gyro composition pentagonal pyramid configuration topworkies configuration of=25Nms is carried out+45 °/-45 ° (rolling/pitching) twin shafts by zero attitude and is combined motor-driven.In order to make control-moment gyro group configuration more easily close to unusual state, only adopt 5 control-moment gyro ginseng Spacecraft During Attitude Maneuvers to control at this, wherein control-moment gyro 1 frame corners is locked in 0 ° and does not participate in control.The unusual bypassing method of a kind of control-moment gyro based on instruction Torque vector control is specifically implemented as follows:
Setup parameter: k tmp υ=2, D s3=0.7, υ limt=0.7, D s1=0.5, D s2=2.0, C 1=0.18, C 2=0.1, α s10=0, α s20=0.5.
Implementing procedure when following steps are the inventive method application in a control cycle:
1) control-moment gyro group frame corners vector is gathered:
δ=[0.00.5450689-0.468502.573360.577711.30145] T(rad);
The instruction moment exported by Spacecraft Control device is:
τ c=[0.041250.03748-0.65202] T
Can calculate according to the equation of motion:
J = 0 0.12433106 0.512692519 - 0.93114051 - 0.66814621 - 0.2661014 0 - 0.93949406 - 0.81231845 - 0.15234310 0.66372979 - 0.96394501 0 - 0.31920635 0.278001998 - 0.3313139 - 0.3362192 0 ;
Sv=0.69644;
&part; S v &part; &delta; = 0 2.7919939 - 1.0193131 0.8514346 0.3620309 - 0.7564965 T ;
υ=0.007116;
2) zero motion is evaded strength factor calculate with the unusual motion of robust:
α s1=0.16845669,α s2=0。
3) according to τ cAd, α s1, α s2, take zero Kinematics singularity to evade frame corners speed command that the unusual bypassing method with robust carries out control-moment gyro group for
&delta; &CenterDot; d = 0 - 3.0220 - 0.61098 4.3513 - 6.36854 - 1.51161 T ( deg / s )
Whole attitude maneuver application overall process the results are shown in Figure shown in 2 ~ Fig. 5.Wherein, Fig. 2 (a), Fig. 2 (b), Fig. 2 (c), Fig. 2 (d), Fig. 2 (e), Fig. 2 (f) sets forth the frame corners (unit: degree) of the control-moment gyro 1 ~ 6 collected; Regulating and unusually evading algorithm appears reducing and triggers vector in framework Singularity Degree value in Spacecraft During Attitude Maneuver process as shown in Figure 3, will raise to some extent evading unusual tolerance under algorithm effect; As shown in Figure 4, under regulating action, the deflection of control moment vector travel direction and amplitude are to a certain degree regulated, wherein, Fig. 4 (a), Fig. 4 (b), Fig. 4 (c) sets forth the component (unit: Nm) of control moment vector on celestial body rolling, pitching and driftage three axle after former control moment vector and vector adjustment, solid line is the component of control moment vector on celestial body rolling, pitching and driftage three axle of former control moment vector, and dotted line is the component of control moment vector on celestial body rolling, pitching and driftage three axle after vector regulates; As shown in Figure 5, the severe degree of the frame corners speed command change of calculating when Singularity Degree value is less compare singular value greatly time change little, thus describe the inventive method and have and good unusually evade characteristic, wherein, Fig. 5 (a), Fig. 5 (b), Fig. 5 (c), Fig. 5 (d), Fig. 5 (e), 5 (f) sets forth the frame corners speed command (unit: degree/second) of control-moment gyro 1 ~ 6; From experimental verification, the inventive method achieves close to effectively evading during unusual state, and overcomes frame corners " locked " situation that conventional unusual bypassing method exists, and ensures the motor-driven superperformance of system.
The content be not described in detail in instructions of the present invention belongs to the known technology of those skilled in the art.

Claims (4)

1., based on the unusual bypassing method of control-moment gyro of instruction Torque vector control, it is characterized in that comprising the steps:
(1) control-moment gyro group frame corners vector δ is gathered, then according to the Jacobian matrix J of control-moment gyro equation of motion Computational frame angular motion;
(2) calculating Singularity Degree value Sv is
Sv=det(J·J T)
And then obtain command force moment vector adjustment factor υ and be
&upsi; = 0 i f S v > D s 3 - k t m p &upsi; &CenterDot; ( S v - D s 3 ) i f S v &le; D s 3
When | υ | > υ limttime, υ=sgn (υ) υ limt, wherein, k tmp υfor regulating gain, D s3for vector regulates threshold value, υ limtfor vector adjustment factor amplitude limit value, sgn (υ) is for getting the symbolic operation of υ;
(3) according to the control moment instruction τ that attitude controller provides cobtain control moment instruction and regulate vector τ cAdfor
&tau; c A d = 1 - &upsi; &upsi; &upsi; 1 - &upsi; - &upsi; &upsi; 1 &CenterDot; &tau; c
(4) determine that zero Kinematics singularity evades strength factor α according to Singularity Degree value Sv s1, robust is unusual evades strength factor α s2, strength factor α is evaded for zero Kinematics singularity s1,
Work as Sv<D s1time, zero Kinematics singularity evades strength factor
Work as D s1≤ Sv<D s2time, zero Kinematics singularity evades strength factor
As Sv>=D s2time, zero Kinematics singularity evades strength factor α s1=0;
Wherein, D s1startup threshold value is evaded, D for robust is unusual s2be that zero Kinematics singularity evades startup threshold value, C 1be that zero Kinematics singularity evades intensity gain coefficient, α s10for amount of bias;
(5) strength factor α is evaded for robust is unusual s2, work as Sv<D s1time, robust is unusual evades strength factor &alpha; s 2 = C 2 &CenterDot; ( 1 S v + 10 - 6 - 1 D s 1 + 10 - 6 ) ;
As Sv>=D s1time, robust is unusual evades strength factor α s2=0, wherein, C 2intensity gain coefficient is evaded for robust is unusual;
(6) vector τ is regulated according to control moment instruction cAd, unusually evade strength factor α s1and α s2obtain control-moment gyro frame corners speed command vector for &delta; &CenterDot; d = - 1 H c m g 0 J T ( J &CenterDot; J T + &alpha; s 2 I 3 ) - 1 &tau; c A d + &alpha; s 1 ( I 3 - J T ( J &CenterDot; J T + &alpha; s 2 I 3 ) - 1 J ) &part; S v ( &delta; ) &part; &delta; .
Use control-moment gyro frame corners speed command vector control-moment gyro frame corners speed in adjustment control-moment gyro group, wherein, H cmg0for control-moment gyro angular momentum, I 3be 3 rank unit matrixs, for Sv is to the partial derivative of frame corners vector δ ,-1 is matrix inversion operation symbol.
2. the unusual bypassing method of a kind of control-moment gyro based on instruction Torque vector control according to claim 1 and 2, is characterized in that: described adjustment gain k tmp υspan be-100≤k tmp υ≤ 100, vector regulates threshold value D s3>0, vector adjustment factor amplitude limit value υ limtspan be 0≤υ limt<1, robust unusual evading starts threshold value D s1>0, zero Kinematics singularity evades startup threshold value D s2>=D s1, zero Kinematics singularity evades intensity gain coefficient C 1>=0, amount of bias α s10>=0, robust is unusual evades intensity gain coefficient C 2>=0.
3. the unusual bypassing method of a kind of control-moment gyro based on instruction Torque vector control according to claim 1 and 2, is characterized in that: described step (5) also evades strength factor α to robust is unusual s2limit, work as α s2> α s20time, α s2s20, wherein, amplitude limit value α s20>0.
4. the unusual bypassing method of a kind of control-moment gyro based on instruction Torque vector control according to claim 1 and 2, is characterized in that: described k tmp υ=2, D s3=0.7, υ limt=0.7, D s1=0.5, D s2=2.0 ,c 1=0.18, C 2=0.1, α s10=0, α s20=0.5.
CN201510860445.1A 2015-11-30 2015-11-30 A kind of unusual bypassing method of control-moment gyro based on instruction Torque vector control Active CN105388902B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510860445.1A CN105388902B (en) 2015-11-30 2015-11-30 A kind of unusual bypassing method of control-moment gyro based on instruction Torque vector control

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510860445.1A CN105388902B (en) 2015-11-30 2015-11-30 A kind of unusual bypassing method of control-moment gyro based on instruction Torque vector control

Publications (2)

Publication Number Publication Date
CN105388902A true CN105388902A (en) 2016-03-09
CN105388902B CN105388902B (en) 2018-04-27

Family

ID=55421274

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510860445.1A Active CN105388902B (en) 2015-11-30 2015-11-30 A kind of unusual bypassing method of control-moment gyro based on instruction Torque vector control

Country Status (1)

Country Link
CN (1) CN105388902B (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108333944A (en) * 2018-02-27 2018-07-27 北京控制工程研究所 The CMG method of operating and system adaptively adjusted based on frame corners
CN109445451A (en) * 2018-12-27 2019-03-08 深圳市行者机器人技术有限公司 A method of for controlling the balancing device of more parallel control-moment gyros
CN109871025A (en) * 2019-02-28 2019-06-11 北京控制工程研究所 A kind of variable speed control moment gyro manipulation rule design method
CN110597062A (en) * 2019-09-19 2019-12-20 北京控制工程研究所 Control moment gyro time delay characteristic modeling and compensation control method
CN110990943A (en) * 2019-11-13 2020-04-10 上海航天控制技术研究所 Singular point judgment method based on singular geometric meaning of control moment gyro group
CN111099040A (en) * 2019-10-18 2020-05-05 上海航天控制技术研究所 System polarity determination method based on control moment gyro group control
CN112099519A (en) * 2020-09-23 2020-12-18 北京理工大学 Rapid singularity avoidance planning method for spacecraft control moment gyroscope
EP4032816A4 (en) * 2019-09-16 2023-11-22 Beijing Institute of Control Engineering Manipulation method suitable for non-redundant sgcmg group

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101694570A (en) * 2009-10-19 2010-04-14 航天东方红卫星有限公司 High-precision moment output control method for control moment gyro group
CN103235515A (en) * 2013-04-25 2013-08-07 哈尔滨工业大学 Method for preventing single frame from controlling rotating speed dead zone of moment gyros group frame shaft by utilizing zero movement
CN103941741A (en) * 2014-04-28 2014-07-23 北京控制工程研究所 Method for determining controlled quantity of angular speed of control moment gyro frame on basis of zero movement
US9038958B1 (en) * 2012-05-29 2015-05-26 United States Of America As Represented By The Secretary Of The Navy Method and apparatus for contingency guidance of a CMG-actuated spacecraft

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101694570A (en) * 2009-10-19 2010-04-14 航天东方红卫星有限公司 High-precision moment output control method for control moment gyro group
US9038958B1 (en) * 2012-05-29 2015-05-26 United States Of America As Represented By The Secretary Of The Navy Method and apparatus for contingency guidance of a CMG-actuated spacecraft
CN103235515A (en) * 2013-04-25 2013-08-07 哈尔滨工业大学 Method for preventing single frame from controlling rotating speed dead zone of moment gyros group frame shaft by utilizing zero movement
CN103941741A (en) * 2014-04-28 2014-07-23 北京控制工程研究所 Method for determining controlled quantity of angular speed of control moment gyro frame on basis of zero movement

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
JIAWEI ZHANG等: "Spacecraft Maneuvers Via Singularity-Avoidance of Control Moment Gyros Based on Dual-Mode Model Predictive Control", 《IEEE: TRANSACTIONS ON AERROSPACE AND ELECTRONTC SYSTEMS》 *
李力文等: "附加框架角速度的SGCMG操纵律设计", 《宇航学报》 *
牟夏等: "姿态机动中SGCMG的一种改进奇异鲁棒操纵律设计", 《空间控制技术与应用》 *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108333944A (en) * 2018-02-27 2018-07-27 北京控制工程研究所 The CMG method of operating and system adaptively adjusted based on frame corners
CN109445451A (en) * 2018-12-27 2019-03-08 深圳市行者机器人技术有限公司 A method of for controlling the balancing device of more parallel control-moment gyros
CN109445451B (en) * 2018-12-27 2021-09-17 深圳市行者机器人技术有限公司 Method for controlling balancing device of multi-parallel control moment gyroscope
CN109871025A (en) * 2019-02-28 2019-06-11 北京控制工程研究所 A kind of variable speed control moment gyro manipulation rule design method
EP4032816A4 (en) * 2019-09-16 2023-11-22 Beijing Institute of Control Engineering Manipulation method suitable for non-redundant sgcmg group
CN110597062A (en) * 2019-09-19 2019-12-20 北京控制工程研究所 Control moment gyro time delay characteristic modeling and compensation control method
CN110597062B (en) * 2019-09-19 2020-11-10 北京控制工程研究所 Control moment gyro time delay characteristic modeling and compensation control method
CN111099040A (en) * 2019-10-18 2020-05-05 上海航天控制技术研究所 System polarity determination method based on control moment gyro group control
CN111099040B (en) * 2019-10-18 2021-10-29 上海航天控制技术研究所 System polarity determination method based on control moment gyro group control
CN110990943A (en) * 2019-11-13 2020-04-10 上海航天控制技术研究所 Singular point judgment method based on singular geometric meaning of control moment gyro group
CN110990943B (en) * 2019-11-13 2023-10-20 上海航天控制技术研究所 Singular point judgment method based on singular geometric meaning of control moment gyro group
CN112099519A (en) * 2020-09-23 2020-12-18 北京理工大学 Rapid singularity avoidance planning method for spacecraft control moment gyroscope

Also Published As

Publication number Publication date
CN105388902B (en) 2018-04-27

Similar Documents

Publication Publication Date Title
CN105388902A (en) Control moment gyro singularity avoidance method based on instruction moment vector adjustment
Shao et al. Active disturbance rejection based trajectory linearization control for hypersonic reentry vehicle with bounded uncertainties
CN101708780B (en) Method for controlling rigid spacecraft for target attitude tracking
CN104176275B (en) A kind of rate damping method that uses momenttum wheel to combine with magnetic torquer
CN112445234B (en) Attitude control method and device for spacecraft
CN104570742B (en) Feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of noncoplanar rendezvous orbit
CN104950678A (en) Neural network inversion control method for flexible manipulator system
CN106707751A (en) Collision avoidance control method based on limited time saturation for spacecraft terminal approaching
CN103625637B (en) A kind of large aircraft side direction fitful wind mitigation process
CN107402516B (en) Rank saturation the fuzzy PD attitude control method is passed based on joint executing agency
CN105353790B (en) A kind of space rope system robot target arrests rear complex stable control method
CN104881035A (en) Method and system for aircraft control coupling compensation, and method and system for attitude motion control
CN103412571B (en) A kind of spacecraft relative Attitude Control for Spacecraft method based on feedback linearization technology
CN103941741B (en) Based on the control moment gyro frame corners speed control method for determination of amount of zero motion
Liu et al. Antisaturation fixed-time attitude tracking control based low-computation learning for uncertain quadrotor UAVs with external disturbances
CN102707616B (en) Aircraft triangle model-based controller area design method
CN105676674B (en) Unmanned plane front-wheel steer control method based on instruction wave filter
CN102880049B (en) Adaptive vibrating control method based on sailboard flexible deformation measurement
CN106292297A (en) Based on PID controller and the attitude control method of L1 adaptive controller
CN102707629B (en) Design method of full-dimensional controller region based on aircraft switching model
Khebbache et al. Robust stabilization of a quadrotor aerial vehicle in presence of actuator faults
CN106017456B (en) A kind of satellite stared to ground point expects angular velocity Analytical Solution method
Horiuchi Evaluation of chassis control algorithms using controllability region analysis
CN103954289B (en) The quick motor-driven attitude determination method of a kind of Optical Imaging Satellite
CN116009594A (en) Hypersonic aircraft state constraint fault tolerance control method based on zero and game

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