Description:
BACKGROUND OF THE INVENTION
1. Field of the Invention
This invention relates to satellite control systems and more particularly, to systems for automatic adjustment of both orbit adjust and attitude control of a satellite.
2. Description of the Prior Art
The advancement of the art of earth surveillance and communication systems by means of artificial satellites, whether for the military, for the scientific community, or for industry, has brought constantly increasing demands on spacecraft pointing accuracy. To meet this requirement, ever-increasing improvements in attitude-sensing and attitude-control techniques have been sought.
In one class of satellites, including, for example, synchronous communications satellites, an orbit adjust capability is required. The orbit adjust subsystem comprises sets of coplanar thrusters all fixedly directed in the same direction and producing as nearly uniform thrust force as possible. These thrusters generally combust a fuel such as hydrazine to achieve thrust force. Orbit adjust is achieved by firing all the thrusters within a single set of coplanar thrusters. During this orbit adjust maneuver, it is necessary to constrain the spacecraft in attitude to ensure that the firing of the coplanar orbit adjust thrusters efficiently and accurately changes the orbit of the spacecraft. That is, if the spacecraft is not pointing in the correct direction during orbit adjust, the orbit adjust thrusters will fire in a wrong direction and thereby achieve an incorrect orbit.
The principal source of disturbance torque on the spacecraft causing pointing or attitude error during orbit adjust is the orbit-adjust engines themselves and their slight geometrical asymetries relative to the spacecraft center of gravity. With a given geometrical engine array, disturbance torques will arise from three causes: lack of parallelism of engine forces, moment-arm length differences from the spacecraft's center of gravity to the individual engines, and force profile mismatches between the engines. Under the influence of a disturbance torque, such a spacecraft will experience two basic motions: a precession in space of it total angular momentum vector, and a nutational motion of the biased momentum axis about the total angular momentum vector.
Heretofore, attitude control subsystems have been provided separate from the orbit-adjust subsystems for purposes of attitude control. Aside from the additional weight and additional cost of the subsystem required to control the spacecraft's attitude, prior art attitude control subsystems do not operate simultaneously with the orbit adjust subsystem to correct the spacecraft's attitude while the spacecraft's orbit was being changed.
One type of control subsystem includes several clusters of cold gas thrusters for expelling gas such as dry nitrogen. Each thruster within a cluster is aligned along or in relation to a body axis (pitch, roll, and yaw) of the spacecraft. One such attitude control system is described in U.S. Pat. No. 3,231,223, Flight Attitude Control System, issued to Charles E. Upper on Jan. 25, 1966. Such a separate thruster attitude control subsystem adds weight and cost to the spacecraft because it requires gas supply tanks, cold gas, nozzle, solenoid nozzle control, plumbing and electronics. In addition, the use of cold gas in such a system requires severe decontamination restraints in the "plumbing" between the supply tanks and nozzles. Additional expenditures of fuel are required after orbit adjust to correct the spacecraft's attitude.
Another type of subsystem used to control the attitude of the spacecraft uses magnetic torquing wherein a current is introduced into a coil mounted on the spacecraft and as a result, the spacecraft is urged toward a more favorable attitude or pointing direction. Up until a few years ago, these magnetic torquing schemes required GROUND processing of attitude data, the formulation of suitable control commands, and the periodic updating of the settings of the spacecraft attitude control system. In general, the accuracy of this type of system was limited to 0.5° in control of the pointing direction.
Subsequently, magnetic torquing means to achieve attitude control of a pitch biased momentum spacecraft (a spacecraft having a momentum wheel to provide pitch stability) were improved so that attitude control could be accomplished automatically by an on-board, closed loop system, with improved accuracy, assuming that roll and yaw information was available at frequent intervals. Although roll data suitable for the purposes of this type of attitude control may be readily available from many different kinds of horizon sensors, no simple means exists for monitoring yaw aboard a spacecraft suitable for this particular type of attitude control. Yaw sensing is now accomplished by means of expensive and sophisticated equipment, such as yaw gyro or a star sensor. The yaw gyro requires frequent updating and the usual star sensor, such as the Polaris sensor, present somewhat of a weight penalty. A primary disadvantage of magnetic torquing type of attitude control system is that the torques produced are too small to be effective in correcting attitude during the brief orbit adjust burns.
SUMMARY OF THE INVENTION
According to the invention, a spacecraft includes a set of orbit adjust thrusters which are fired singly or in combination to adjust the orbit of the spacecraft and also to control the attitude of the spacecraft during the orbit adjust maneuver. The spacecraft includes a thruster control system comprising an on-board computer coupled to a thruster firing control means and an attitude sensing means. The attitude of the spacecraft is related to the magnitude and direction of the total angular momentum vector of the spacecraft. The on-board computer initiates a first mode of operation wherein the thruster control means is commanded to fire all the thrusters within the set of orbit adjust thrusters to cause the spacecraft to move from a first orbit path to a second orbit path. The on-board computer receives angular attitude error information, indicating the angular position of the spacecraft's body axes to a set of attitude reference vectors, from the attitude sensing means and computes therefrom the rates of change of the angular attitude errors, the precession angle between the total angular momentum vector and one of the attitude reference vectors, and the direction of the ideal torque required to reduce the precession angle. In a precession mode of operation, the on-board computer selects a first thruster firing configuration which produces a torque in accordance with the direction of the ideal torque which is a best approximation to the direction of ideal torque to reduce the precession angle, and thereby control the direction of the total angular momentum vector whenever the precision angle equals or exceeds a predetermined precession threshold. In a rate mode of operation the onboard computer selects a second thruster firing configuration, which produces a torque to reduce the attitude angular error rates and thereby control the magnitude of the total angular momentum vector whenever an attitude angular error rate equals or exceeds a predetermined rate threshold.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 is a perspective view of a typical spacecraft embodying the system of the present invention.
FIG. 2 is a vector diagram of the relation of the body axes of the spacecraft of FIG. 1 to the axes of the local vertical orbit plane reference system of the spacecraft with attitude error.
FIG. 3 is a block diagram of a thruster control system embodying the invention in the spacecraft of FIG. 1.
FIG. 4 is a vector force diagram of the forces produced by one coplanar set of orbit adjust thrusters of the spacecraft of FIG. 1.
FIG. 5 is a vector diagram of the combination torque vectors produced by combining torques resulting from firing selected thrusters of a set of coplanar thrusters of the spacecraft of FIG. 1.
FIGS. 6A-6D are the flow diagram of the sequential operation of the thruster control system of FIG. 3.
The same reference numbers in different figures refer to the same item.
DESCRIPTION OF A TYPICAL SPACECRAFT UTILIZING THE INVENTION (FIG. 1)
FIG. 1 is a perspective view of a spacecraft 10 embodying the invention. Spacecraft 10 is moving along orbit path 12, which may be either an elliptical or circular orbit around a celestial body, such as the earth, or may be a path between any two points within space. For the present description, spacecraft 10 is assumed to be moving along orbit path 12 with the correct attitude. For the purposes of this description, a spacecraft or satellite will be defined to have correct attitude when the yaw, roll and pitch body axes of the spacecraft, represented respectively, by unit vectors 1, 2, and 3 are coincident, respectively, with the unit vector r, t, and n. For the purposes of this description the symbol will indicate a unit vector. A unit vector is directed along a particular direction and has a magnitude of one. Mutually perpendicular unit vectors r, t, and n define the local-vertical orbit plane reference system. In the local-vertical orbit plane reference system, the unit vector t is coincident with the orbit path and is positive in the direction of the spacecraft motion. The unit vector r represents the instantaneous local vertical direction and is positive in the direction shown. The unit vector n is called the normal vector, and is positive in the direction shown. The body axis unit vectors 1, 2, and 3 are coincident at the center of gravity C.G. of spacecraft 10. The spacecraft's attitude is incorrect when any one of its body axes, 1, 2, or 3 is non-coincident with respect to some tolerance limit, with its respective local-vertical orbit plane reference unit vector r, t, and n.
Spacecraft 10 is a pitch bias type of spacecraft. That is, spacecraft 10 is maintained in correct pitch attitude by a subsystem which prevents rotation about the pitch axis 3. In particular, spacecraft 10 is maintained in correct pitch attitude by means of a subsystem including momentum wheel 14 rotating about an axis parallel to the pitch axis system. Momentum wheel 14 is of such mass and is spun with such angular velocity in response to control signals from a pitch axis attitude control system, not shown, that the resultant inertia of momentum wheel 14 prevents rotation around the spacecraft's pitch axis. Although the invention will be described in relation to a pitch bias momentum spacecraft, it will be appreciated that the invention is generally useful in other types of spacecraft. For instance, the invention may be advantageously employed in a type of spacecraft stabilized by an active three axis zero momentum system wherein momentum wheels are rotating about each of the body axes.
Two sets of coplanar thrusters, A through D forming one set, and E through H forming the other set, are mounted on spacecraft 10 in a plane parallel to the plane formed by the yaw and roll axis. The location plane of thrusters A thorugh H may or may not be coincident with the plane formed by the yaw and roll axes. Each set of coplanar thrusters has individual thrusters aligned along axes which are parallel to the pitch axis. All the thrusters within a set are directed along axes parallel to the pitch axis and when fired produce forces substantially of the same magnitude and substantially parallel to the pitch axis. Thrusters A through H generally burn a combustable fuel such as hydrazine, and, depending on the physical characteristics of the thruster such as nozzle diameter, produce forces of approximately 0.1 lbs. Firing thrusters A, B, C, and D produce forces respectively represented by force vectors F A , F B , F C and F D directed in the positive pitch axis direction causing a spacecraft 10 to move in the direction of the negative pitch axis. Firing thrusters E, F, G, and H produce forces respectively represented by force vectors F E , F F , F G and F H directed in the negative pitch axis direction causing spacecraft 10 to move in the direction of the positive pitch axis. Thrusters A through H are orbit inclination adjust thrusters. For the purpose of this description, the terms "orbit inclination adjust" and "orbit adjust" are synonymous. For the remainder of the specification it is to be understood that the term "thruster" and "engine" are interchangeable. When it is desired to adjust the orbit or spacecraft 10 all the thrusters within a coplanar set are simultaneously fired. For instance, if thrusters A, B, C, and D are fired, spacecraft 10 moves along path 16 lying in the plane defined by the roll and pitch body axes, to a final position indicated in phantom.
Ideally, each thruster within a coplanar thruster set has an axis which is parallel to the pitch axis located at the same distance as every other thruster within the set from the spacecraft's center of gravity C.G. and when fired, produces the same magnitude of thrust or force as every other thruster within the set. In practice, there are thruster force imbalances and geometrical asymetries which give rise to disturbance torques when the thrusters are fixed to an orbit adjustment. These disturbing torques produce attitude errors, which is turn cause the force produced by the simultaneous firing of the orbit adjust thrusted to be directed inaccurately resulting in an incorrect final orbit. Attitude errors are also caused by imbalanced attractions of various portions of the spacecraft by celestial bodies and such phenomenon as solar torquing and the like.
Vector Diagram of Attitude Orientation (FIG. 2)
Before describing the thruster control system for spacecraft 10, the vectors of the spacecraft's attitude orientation will be described. Referring now to FIG. 2, there is shown a vector diagram of the relation of spacecraft 10's body axes (1, 2, and 3) in relation to the local vertical orbit plane reference system (r, t, and n) as the attitude of spacecraft 10 becomes displaced from the correct attitude orientation. The angle φ is the angle through which the yaw axis 1 is rotated away from the instantaneous local vertical r about the roll axis 2. The angle ψ is the angle through which the roll axis 2 is rotated away from t about the yaw axis 1. It should be noted that an angle representing rotation about the pitch axis 3 is not present since spacecraft 10 is a pitch bias momentum type of spacecraft wherein rotation about the pitch axis is prevented by a separate subsystem comprising a momentum wheel 14.
Bias momentum vector h w is directed along the pitch axis 3 and is indicative of spacecraft 10's bias toward attitude stability about the pitch axis 3 due to momentum wheel 14. The total angular momentum h of spacecraft 10 is only slightly displaced from the vector h w for reasons that will later become apparent. To bring spacecraft 10 into correct attitude, total angular momentum vector h must be brought into alignment (within some tolerance limits) with orbit normal vector n and the magnitude of total angular momentum vector h must be made equal (with some tolerance limits) to the magnitude of bias momentum vector h w . The vector ω p is called the precession vector and is perpendicular to the plane formed by orbit normal vector n and total momentum vector h and defines the axis about which total momentum vector h must be rotated into to bring it into alignment with orbit normal vector n. Angle ρ separates the vectors h and n, in the plane formed by total momentum vector h and orbit normal vector n and is the shortest angle through which total angular momentum vector h can be rotated to bring it into alignment with orbit normal vector n.
Thruster Control System (FIG. 3)
Reference is now made to FIG. 3, which is a block diagram of the thruster control system 24 of spacecraft 10 of FIG. 1. Thruster control system 24 includes orbit adjust control system 22 and attitude sensors and controls 20.
Orbit adjust control system 22 includes a suitable on-board computer 26 for derivation and routing of spacecraft control signals, including thruster control signals for thrusters A through H, thruster interface unit 28, and thruster and solenoid unit 30. On-board computer 26 generates digital control signals which manifests information pertaining to the selection of thruster combinations, as will be explained, and information pertaining to the duration of thruster burn. This information is transmitted from on-board computer 26 to thruster and solenoid unit 30 via thruster interface unit 28 upon reception of an orbit adjust signal from a source external to the spacecraft such as an earth station or the like. Alternately, the computer may be programmed, either under hardware or software control, to periodically automatically initiate orbit inclination adjustments.
The digital signals manifesting thrusting control information are coupled to the thruster interface unit 28 via control lines 32a through 32e. Control lines 32a through 32d respectively, control the operation of either one of a pair of thrusters. For example, control line 32a carries the digital signal to operate either thruster A or thruster E, whereas control line 32b carries the digital signal which controls the operation of either thruster B or thruster F. Control line 32e carries the digital signal to enable one of the two sets of coplanar thrusters. That is, the transmission of one digital signal through control line 32e will enable a thruster in the set of thrusters consisting of thrusters A, B, C, and D to fire, whereas a second digital signal on line 32e will cause a thruster in the set of thrusters consisting of thrusters E, F, G, and H to fire. For instance, if it is desired to fire thruster A, a digital signal enabling the coplanar thruster set consisting of thruster A through D will be transmitted along control line 32e while a digital signal causing either thruster A or E to fire will be transmitting along control line 32a. The digital signals transmitted by the computer along conductors 32a through 32e may be either of the level type or the type utilizing a suitable sequential code.
It is to be noted that, if spacecraft 10 had a separate system for attitude correction, lines 32a through 32d would not be present and, instead, a single control line would carry a digital control signal manifesting the command for all of the thrusters within the selected one of thrusters sets of coplanar thrusters to fire simultaneously. However, since attitude control system 24 eliminates the necessity of a separate attitude control system within spacecraft 10 by utilizing the orbit adjust thrusters A through H to also correct attitude, lines 32a through 32d are necessary to individually control individual members of a set of thrusters as will be described.
Thruster interface unit 28 has the function of receiving the digital control signals which manifest the thruster on-off commands and converting them to appropriate analog signals of suitable amplitude and duration to control the firing of thrusters A through H. The analog versions of the digital control signals carried by control lines 32a through 32e are carried by control lines 34a through 34e, respectively, to thruster and solenoid control unit 30 from interface unit 28. Each thruster is operated by the activation or deactivation of a respective solenoid, not shown, which selectively allows fuel to pass from tanks, not shown, to a respective thruster upon the reception of an analog control signal.
When orbit adjust is initiated, on-board computer 26 initiates a digital command signal to "turn on" roll and yaw integrating rate gyros, respectively 44 and 46. The digital "turn on" command signal is carried by control line 36 to A/D (analog to digital) conversion and computer interface unit 38. In response to the digital "turn on" command signal A/D conversion and interface unit 38 produce an analog "turn-on" command which is carried to gyro control electronics unit 42 by control line 40. Gyro control electronics unit 42 is coupled to roll and yaw integrating rate gyros, respectively 44 and 46, by control lines 48 and 50, respectively. Upon the reception of the analog "turn-on" control signal, gyro control electronics unit 42 transmits an analog signal to turn on each of the two integrating rate gyros, 44 and 46, which have been heretofore in an off condition.
Rate integrating gyros 44 and 46 are operated in their rate mode. The function of each integrating rate gyro 44 and 46 is to provide an anglog signal manifesting the rate of angular change of one spacecraft 10°s body axes from its correct attitude position relative to the axes of the local vertical orbit plane reference system. That is, roll integrating rate gyro 44 senses the rate of change of Δφ. Δφ is the incremental angular movement of the yaw axis 1 away from the instantaneous local vertical r about the roll axes 2. Yaw integrating rate gyro 46 senses the rate of change of ΔΨ. ΔΨ is the incremental angular movement of the roll axis 2 away from the t about the yaw axis 1. It is to be noted that roll and yaw integrating rate gyros, respectively 44 and 46, are turned off except during attitude correction because, otherwise, they would be susceptable to electronic noise signals generated in the system which would be interpreted as incremental roll and yaw attitude errors. After the orbit adjust maneuver has been completed, on-board computer 26 initiates a digital command to "turn off" roll and yaw integrating rate gyros, respectively 44 and 46, which is carried by central line 36 to A/D conversion and interface unit 38 and then by control line 40 to gyro control electronics unit 42. It is to be also noted that although rate gyros are employed in this embodiment of the invention, any other suitable transducers which are capable of sensing attitude change may be used. The analog signals manifesting the rates of change of Δφ and ΔΨ are carried by conductors 52 and 54 respectively to A/D conversion and computer interface unit 28.
A/D conversion and computer interface unit 38 receives the analog signals manifesting the rates of change of φ and Ψ respectively from roll and yaw integrating rate gyros and integrates them, as is well known in the art, to form digital signals manifesting incremental angular attitude errors Δφ and ΔΨ. These digital signals may be of the level or of the sequential code type. The digital signals manifesting the roll and yaw attitude errors carried by conductors 56 and 58, respectively, to on board computer 26. On board computer 26 contains provisions for typical computer operations such as memory storage, arithmetic computation, comparison, and the like may be controlled by a software program or may have hardware program control as is well known in the art.
On board computer 26 uses the incremental roll and yaw attitude errors to compute the total angular roll and yaw errors by a conventional computer addition process. To compute the total angular error with reference to a body axis, the resultant sum of previous incremental attitude errors stored in a memory location are read out from the memory location to the arithmetic unit where they are added to the present incremental angular attitude error. The present resultant sum is then returned to the memory location for that particular body axis attitude error for further use in computations to select the most appropriate thrust or firing configuration to eliminate the attitude error as will be described. In addition to computing the total angular yaw and roll attitude errors, the computer is also controlled to compute the rates of change of the angular yaw and roll attitude errors. To compute a rate of change with reference to a body axis, the present incremental attitude error, for instance Δφ, together with the time duration Δt φ during which it has occurred is transferred to the computer's arithmetic section. Through a suitable digital division routine, as is well known in the art, the ratio of the incremental attitude error Δφ to the time duration Δt φ during which it has occurred is computed. In this manner, the yaw and roll body rates respectively ω 1 = ΔΨ/Δ t and ω 2 = Δφ/Δ t φ are computed. These body rates are then stored in memory locations for further use in selecting the thruster firing configuration to reduce the attitude error. It is to be noted that during attitude correction the on board computer is constantly receiving new incremental attitude errors and calculating new body rates and updating the data in the corresponding memory locations.
Development of Expressions for Precession Angle ρ And Actual Torque T In Terms of the Body Axis
Before developing the mathematical expression for ρ, the shortest angular distance through which the total angular momentum vector h is to be rotated to bring it into alignment with orbit normal vector n, and actual or ideal torque T necessary to accomplish this rotation, some vector geometry used in the development is presented.
A vector A having a magnitude A may be expressed as
A = AA. (1)
where A is a unit vector having a magnitude of 1 and being directed, in the same sense, along the vector A. From this expression it should be apparent that unit vector A may be expressed as
A = A/A. (2)
the dot product of two vectors A = AA and B = BB having an angle β between them is mathematically defined as
A . B = AB cos β. (3)
It should be apparent from equation 3 that the dot product of two vectors is a scalar. The cross product of the two vectors A = AA and B = BB is a vector defined by the equation
A × B = (AB sin β) C (4)
where C is a unit vector in a direction mutually perpendicular to the vectors A and B. The positive direction of C is defined as the direction a right hand screw would progress along its axis if it were turned through the angle β from vector A to vector B. It should further be noted that the order of the vectors in a cross product is determinative of the positive sense of the resulting vector. That is,
A × B = - B × A (5)
the mathematical expressions for T and ρ will now be described with some reference to FIG. 2. If the period of application of torque T to spacecraft 10 is short compared with the period of the nutational motion of the spacecraft 10, the resultant motion is a precession of the total angular momentum vector h.
The actual or ideal torque T required to cause the precessional or rotational motion of total angular momentum vector h through angle ρ about vector ω ρ to bring it into coincidence with orbit normal vector n and thereby correct the attitude of the spacecraft is given by the expression
T = ω ρ × h (6)
Since the magnitude of force exerted on spacecraft 10 of FIG. 1 by an orbit adjust thruster when fired is fixed, and the same for each thruster A through H, the remaining portion of this development is concerned with the direction of the actual or ideal torque to achieve attitude correction rather than its magnitude. It should be apparent to those skilled in the art that if the force of thrusters A through H were variable, a similar development could be made without exceeding the scope of the invention.
Since the vectors ω ρ and h are perpendicular the result of their cross produce, ideal torque T is perpendicular to both of these vectors. Therefore, equation (6) may be written in terms of unit vectors as follows:
T = ω ρ × h (7)
The vector ω ρ is given by the expression
ω ρ = ω ρω ρ = h × n = h sin ρ ω ρ (8)
Therefore
ω ρ = (h × n/h sin ρ) = (h × n/sin ρ) (9)
Substituting equation (9) into equation (7)
T = [ h × n/sin ρ] × h (10)
It will be appreciated by those skilled in the art that equation (10) may be simplified using certain well known identities of vector analysis to become
T = [ n - (cos ρ) h/sin ρ] (11)
When ρ is a very small angle, cos ρ = 1 and sin ρ = ρ where ρ is expressed in radians. Therefore, equation (11) becomes
T = n - h/ρ (12)
Total angular momentum vector h can be expressed in terms of body axes 1, 2, and 3 by the expression
h = h 1 1 + h 2 2 + h 3 3 (13)
Unit vector h is therefore
h = (h 1 1 + h 2 2 + h 3 3) (14)
where h is the magnitude of the total angular momentum vector h and is equal to
√h 1 2 + h 2 2 + h 3 2 (15)
Orbit normal vector n may also be written in terms of body axes 1, 2, and 3 as follows:
n = -cos (90 - φ) 1 + cos (90° - Ψ) 2 + (cos Ψ cos φ) 3 (16)
or
n = - (sin φ) 1 + (sin Ψ) 2 + (cos Ψ cos φ) 3 (17)
When the yaw and roll attituted error angles, respectively Ψ and φ, are very small
n = - φ1 + Ψ2 + 3 (18)
since the sine of a very small angle is the angle itself in radians while the cosine of a small angle is 1. Substituting equation (17) into equation (12) gives
T = [(-φ -h 1 /h) 1 + (Ψ - h 2 /h) 2 + (1 - h 3 /h) 3]/ρ (19)
If the attitude controller is designed to maintain the h 1 and h 2 components of the total angular momentum vector h small and the pitch-axis attitude controller is designed such that the h 3 component of the total angular momentum vector h is always approximately equal to the magnitude h ω of bias momentum vector h ω the magnitude h (given by expression 15) of the total angular momentum vector h is approximately equal to the magnitude h ω of the bias momentum vector h ω. Under these conditions, the equation (19) becomes
T = [(-φ - h 1 /h ω) 1 + (Ψ - h 2 /h ω) 2]/ρ (20)
In a spacecraft which is designed to be geometrically and dynamically balanced such that the secondary products of inertia are negligible in comparison to the principle moments to inertia lying along the spacecraft's body axes 1, 2 and 3 the components of the total angular h 1 and h 2 momentum may be written as follows:
h 1 = I 1 ω 1 (21)
and
h 2 = I 2 ω 2 , (22)
where I 1 and I 2 are, respectively, the yaw and roll principal momentum of inertia and ω 1 and ω 2 are, respectively, the yaw and roll body axis rates of angular attitude error previously defined. Under these conditions, equation (20) becomes
T = - [φ + (I 1 /h ω) ω 1 ] 1 + [Ψ - (I 2 /h ω) ω 2 ] 2/ρ (23)
Since T is a unit vector, it should be apparent that
ρ = √ [φ + (I 1 /h ω) ω 1 ] 2 + [Ψ - (I 2 /h ω) ω 2 ] 2 (24)
It should be noted that although certain assumptions were made in the derivation of the expression for the precession angle ρ (equation 24) through which total angular momentum vector h must be rotated to bring it into alignment with orbit normal vector n, and the direction of the actual torque T (equation 23), which must be applied to achieve this rotation, such assumptions apply to specific characteristics of the spacecraft of FIG. 1 and are not necessary to practice the invention in general. It should further be noted that further approximations may be made to further simplify the form of the expressions derived. Further, other similar expressions for T and ρ may be derived in a similar manner for other spacecrafts operating under other control laws, which can be utilized in the same manner as will be described.
Development of the Torque Available From Firing Thrusters Singly or in Combination (FIGS. 4 and 5)
The actual or ideal torque T, which should be approximate to spacecraft 10 of FIG. 1 to cause the rotation total angular momentum vector h about vector ω ρ, through precession angle ρ, and into coincidence with orbit normal vector n, is not generally available from the configuration of the spacecraft 10's orbit adjust thrusters A through H. It is, however, possible to utilize orbit adjust thrusters A through H to be selectively fired in accordance with the computations of precession angle ρ and yaw and roll attitude error rates ω 1 and ω 2 , respectively, to closely approximate the actual or ideal torque T. Before describing how thrusters A through H are selectively operated to approximately actual or ideal torque T, the possible torque combinations available from the fixed orbit adjust thruster configuration of spacecraft 10 of FIG. 1 will be described. This description is directed at only one set of coplanar thrusters, that is, thrusters A through D. A similar procedure will be apparent for the coplanar thruster set consisting of thrusters E through H.
FIG. 4 is a vector force diagram of the forces available by firing thrusters A through D of spacecraft 10 of FIG. 1. Force vectors F A through F D representing respectively the forces produced by firing thrusters A through D of originals in a plane which is coincident with the plane defined by the jaw and roll unit vectors, respectively, 1 and 2, and are directed in the positive pitch axis 3 direction. The origin of the three body axes, yaw, roll and pitch, respectively unit vectors 1, 2 and 3, is located at the center of gravity C.G. of spacecraft 10.
The locations of force vectors F A , F B , F C and F D from the center of gravity C.G. are indicated respectively by the location vectors r A , r B , r C and r D . The location vectors r A , r B , r C and r D are also known as moment arm or torque arm vectors in the art.
The moment arm vectors have components along both the yaw and roll unit vectors, respectively, 1 and 2, and may therefore be written as:
r A = r A1 1 + r A2 2 (25)
r B = - r B1 1 + r B2 2 (26)
r C = - r C1 1 - r C2 2 (27)
r D = r D1 1 - r D2 2 (28)
where r A1 , r B1 , r C1 , and r D1 are the components of vectors r A , r B , r C , and r D , respectively, along the yaw 1 axis and r A2 , r B2 , r C2 , and r D2 are the components of the vectors r A , r B , r C , and r D , respectively, along the roll 2 axis
The thruster force vectors are directly along the pitch axis and therefore, may be written as:
F A = F A 3 (29)
f b = f b 3 (30)
f c = f c 3 (31)
f d = f d 3 (32)
the torque produced by a force applied at a first point whose location is defined by a vector originating at a second point is the vector cross product of the two vectors. Therefore, the torque produced by the firing of thruster A is
T A = r A × F A = r A2 F A 1 - r A1 F A 2 (33)
according to the theory of vector cross products T A is a vector perpendicular to the plane defined by vectors F A and r A and passing through center of gravity C.G.
The firing of thruster A causes a clockwise rotation about torque vector T A and passing through the center of gravity of the spacecraft, C.G.. Torque vectors T B , T C and T D may be similarly mathematically expressed by the following equations:
T B = r B × F B = r B2 F B 1 + r B1 F B 2 (34)
t c = r C × F C = - r C2 F C 1 + V C1 F C 2 (35)
t d = r D × F D = 1r D1 F D 1 - r D2 F D 2. (36)
torque vectors T A , T B , T C and T D are all coplanar in the plane defined by the yaw and roll unit vectors, respectively 1 and 2.
The combinations possible from using either one or a pair of torques T A , T B , T C , T D are given as follows:
T 1 = (T A + T B ) = (r A2 F A + r B2 F B ) 1 + (-r A1 F A + r B1 F B ) 2 (37)
t 2 = t b = (r B2 F B ) 1 + (r B2 F B ) 2 (38)
t 3 = (t b + t c ) = (r B2 F B - r C2 F C ) 1 + (r B2 F B + r C1 F C ) 2 (39)
t 4 = t c = (-r C2 F C ) + (r C1 F C ) 2 (40)
t 5 = (t c + t d ) = (-r c2 f c -r D1 F D ) 1 + (R C1 F C - r D2 F D ) 2 (41)
t 6 = t d = (-r D1 F D ) 1 + (-r D2 F D ) 2 (42)
t 7 = (t a + t d ) = (r A2 F A -r D1 F D ) 1 + (-r A1 F A -r D2 F D ) 2 (43)
t 8 = t a = (r A2 F A ) 1 + (-R A1 F A ) 2 (44)
it should now be clear that for a particular spacecraft coplanar orbit adjust thruster configuration there exists a number of torques which are combinations of primary torques created when one of the coplanar orbit adjust thrusters is fired. In particular, torque vectors T 1 through T 8 are the torque combinations available from the single firing of one of the coplanar thrusters or at most the firing of two of the coplanar thrusters of the spacecraft of FIG. 1. Since the primary torques T A , T B , T C , T D , are coplanar so are the combination torques T 1 through T 8 . If all the momentum arm vectors r A , r B , r C , and r D are equal in magnitude, that is, if all the thrusters A through D are equidistant from the center of gravity C.G. of spacecraft 10, and all the force vectors F A , F B , F C and F D are equal, the combination torques T 1 through T 8 , lie along directions which are separated from one another by 45°.
Unit vectors, T 1 through T 8 , indicating, respectively, the directions of the combination torque vectors T 1 through T 8 produced by combining torques resulting from firing selected thrusters of the set of coplanar thrusters consisting of thrusters A through D are shown in FIG. 5. The dotted lines in FIG. 5 indicate the equal zones 1 through 8 surrounding each of the unit vectors T 1 through T 8 .
OPERATION OF THE THRUSTER SYSTEM OF FIG. 3
In the operation of attitude control system 24 of FIG. 3, on board computer 26 selects the thruster firing configuration which results in a torque which best appoximates the ideal or actual torque and then initiates the control signals necessary to carry out attitude correction as will be explained. To select the thruster firing configuration on board computer 26 uses the digital angular attitude error signals φ and ψ and the digital angular error rates (ω 1 and ω 2 ) to calculate precession angle ρ and ideal torque T from equations (23) and (24) by digital arithmetic manipulations by hardware or software program control as well known in the art. In the calculation of T and ρ, it is to be noted that the only variables in equations (23) and (24) are the angles φ and ψ and angular rates ω 1 and ω 2 , which are stored in memory registers, and which are constantly updated as the maneuver progresses. Further, the constant elements in equations (23) and (24) have previously been stored in memory locations from which they are available upon demand.
Equation (23) may be simplified to the expression T = α1 + β2
where α and β are respectively the coefficients of 1 and 2 in equation (23). An examination of equation (23) shows that coefficients α and β may each lie in the range between +1.0 and -1.0, since T is a unit vector. Table 1 indicates which thruster pair of thrusters in the coplanar thruster set comprising thrusters A through D must be commanded to fire by a board computer 26 to produce a torque which best approximates the direction of actual or ideal torque T according to the values of coefficients α and β. The table also indicates in which torque zone of FIG. 5 the actual or ideal torque T resides.
________________________________________________________
__________________ COEFFICIENT VALUES TORQUE FIRE ZONE THRUSTERS ____________________________________________________________
______________ If 0.924 ≤ α ≤ 1.0 and -0.383 ≤ β ≤ +0.383 1 (T 1 ) A,B If 0.383 ≤ α ≤ 0.924 and 0.383 ≤ β ≤ 0.924 2 (T 2 ) B If -0.383 ≤ α ≤ 0.383 and 0.924 ≤ β ≤ 1.0 3 (T 3 ) B,C If -0.924 ≤ α ≤ 0.383 and 0.383 ≤ β ≤ 0.924 4 (T 4 ) C If -1.0 ≤ α ≤ -0.924 and -0.383 ≤ β ≤ 0.383 5 (T 5 ) C,D If -0.924 ≤ α ≤ -0.383 and -0.924 ≤ β ≤ -0.383 6 (T 6 ) D If -0.383 ≤ α ≤ 0.383 and -1.0 ≤ β ≤ -0.924 7 (T 7 ) A,D If 0.383 ≤ α ≤ 0.924 and -0.924 ≤ β ≤ -0.383 8 (T 8 ) A ____________________________________________________________
______________ TABLE I ____________________________________________________________
______________
It should be noted that a similar selection is made to correct the attitude error of spacecraft 10 when coplanar thrusters E through H are fired to cause an orbit adjustment in the positive pitch 3 direction. It will be apparent to those skilled in the art that if the aforesaid equality conditions for force vectors F A , F B , F C , and F D and for moment arm vectors r A R B , r C , and r D are not met, the unit vectors indicating the directions of the combination vectors available from the single or combined firings of coplanar orbit adjust thrusters will not be spaced at equal angular distances nor will the corresponding zones be equal. However, it will be further appreciated that this will not affect the general operation of attitude control system 24 to be described but rather that unequal torque zones will be defined from which the actual or ideal torque is to be approximated. In the development of equations (23) and (24) it was indicated that momentum bias type spacecraft 10 is roll/yaw stabilized when total angular momentum vector h is colinear with the orbit normal vector n and has a magnitude equal to the magnitude of the momentum bias vector h ω. Thruster control system 22 of FIG. 3 must, therefore, control the direction of total angular momentum vector h and additionally must control the angular attitude error rates ω 1 and ω 2 such that the magnitude of the total angular momentum vector h is equal to the magnitude of bias momentum vector h ω in order to achieve roll/yaw attitude stabilization.
In operation, thruster control system 24 of FIG. 3 operates in three modes under the control of on-board computer 26 to achieve attitude correction during orbit inclination adjustments.
In a first mode, all of the coplanar orbit adjust thrusters in a coplanar set of thrusters are fired simultaneously for a time T max to establish a new orbital position. T max is an input constant reflecting the numerical value of the sum of engine "on" times at which the new orbit has been reached and the orbit adjustment manuever is terminated. As was previously mentioned, while spacecraft 10 is in mode 1 operation, its attitude is being disturbed due to the causal influences of geometric and thruster force imbalances.
In mode 2, a selected configuration of thrusters within a coplanar set of thrusters are firing with the objective of controlling the direction or precession of the total angular momentum vector h. Mode 2 is activated whenever the precession angle ρ exceeds a predetermined threshold ρ DB1 . Thruster control system 24 remains in mode 2 until ρ is reduced to a minimum below a second threshold ρ DB2 .
In mode 3 operation a selected configuration of engines are controlled to fire with the objective of controlling either the roll or yaw attitude rates respective ω 2 and ω 1 , or both, thereby controlling the magnitude of the total angular momentum h. During the rate reduction cycle of mode 3 the nutational or coning motion of the bias momentum vector h ω about the total angular momentum vector h is limited. Mode 3 consists of the detection of the magnitude and sign of ω 1 and ω 2 and sequentially reducing each upon determination that predetermined rate threshold ω DB has been exceeded. A constraint on the rate control capability of thruster control system 24 is determined by the minimum impulse force of thrusters A through H. The rate threshold ω DB must be selected consistent with this minimal rate removal capacity of thruster control system 24.
Before describing the particulars of the sequential operation of on-board computer 26 to perform attitude correction, it is to be noted that thruster control system 24 has a mode hierarchy. That is normally, thruster control system 24 is in mode 1 with all the thrusters within a coplanar set of thrusters activated. Upon completion of a pass through mode 1, testing is performed to determine if mode 2 or 3 should be entered. Further, exit from mode 2, the precession mode, is always to mode 3, the rate mode, and the exit from mode 3 is always to mode 1. At least one pass through mode 1 is made before either of the other two modes are made.
FIGS. 6a through 6d are flow diagrams indicating sequential operation of on-board computer 26 in controlling the attitude of spacecraft 10 while undergoing simultaneous orbit inclination adjustment. It is well known in the art how to implement the flow diagram of FIGS. 6a through 6d in a computer either under hardware or softward control and a detailed description of the logic or the program language necessary to accomplish this embodiment is not deemed necessary.
For the purposes of the description of the operation of thruster control system 24, it will be assumed that the set of coplanar thrusters consisting of thrusters A through D are being fired thereby moving spacecraft 10 of FIG. 1 along path 16 to achieve new orbit path 12a. It should be evident that a similar control sequence is undertaken when the coplanar set of thrusters consisting of thrusters E through H are simultaneously fired to move spacecraft 10 in the positive pitch axis 3 direction.
When orbit inclination adjustment is to be performed, a preoperational period is initiated including the activation of roll and yaw integrating rate gyros, respectively 44 and 46, by the transmittal of a gyro "turn on" command to gyro control electronics unit 42. During this preoperational period gyro rate data, consisting of incremental attitude errors Δφ and Δψ, is read into on-board computer 26 and arithmatically manipulated as previously described such that the variables ψ, ω 1 , φ, ω 2 are computed and stored in memory storage location from which they are thereafter available. These variables are continuously read in and computed and stored for use over the entire orbit adjustment period. It should also be recalled that the constants equations (23) and (24) are also stored in memory locations and are available for control computations by on-board computer 26.
FIG. 6a is a flow diagram of the portion of the control sequencing which is always entered at the initiation of the orbit adjustment maneuver to provide an orderly entry into the control sequence. In this portion of the control sequencing, the initial precession angle ρ is computed and stored in memory location ρ i . The precession angle ρ i is first compared to a minimum threshold level ρ DB1 and if it is equal or greater than ρ DB1 mode 2 operation is initated. If ρ i is less than ρ DB1 a second threshold test is performed wherein ρ i is compared to maximum threshold value ρ DB2 . If ρ i is greater than ρ DB2 mode 2 operation is initiated. If ρ i is less than or equal to ρ DB2 a test is performed to determine if the magnitudes of angular rates ω 1 and ω 2 are less than or equal to the angular rate threshold ω DB . If the magnitude of either ω 1 or ω 2 exceed ω DB mode 3 operation is initiated. If the magnitude of either ω 1 and ω 2 is less than or equal to ω DB mode 1 operation is initiated. It is to be noted that two threshold determinations are made rather than one. That is, control mode 2 is only entered when the initial precession angle ρ i is between thresholds ρ DB1 and ρ DB2 . The minimum threshold ρ DB1 corresponds to the minimum angular attitude error which thruster control system 24 can correct. No attempt to correct attitude is made if ρ is less than ρ DB1 . The resultant attitude error is not considered significant in the overall performance of spacecraft 10. The maximum threshold ρ DB2 corresponds to the threshold level which, if exceeded, requires that angular attitude rates ω 1 and ω 2 may have to be reduced by mode 3 operation before proceeding. If ρ DB2 is not equaled or exceeded mode 2 is entered to reduce the precession angle ρ without requiring that angular rates ω 1 and ω 2 are reduced.
FIG. 6b is the flow diagram for the sequential operation of thruster control system 24 during "all engines on" mode 1. The mode 1 Δt counter within on-board computer 26 is set to the binary number representing the minimal thruster impulse time of a thruster. On commands which cause all the thrusters within the coplanar set consisting of thrusters A through H to fire simultaneously for Δt are stored but not yet executed. Thereafter, the engine on command for all engines are executed and a countdown sequence measuring the time duration of firing is initiated. The countdown is continued until the mode 1 Δt counter reaches zero. If at this point, the time elapsed is greater or equal to T max the time required to achieve orbit inclination, all the engines are stopped and the sequencing comes to an end. It should be noted that another precession angle ρ and angular attitude error rate could be passed through if desired before stopping engine firing. If T max has not been exceeded, the attitude of the spacecraft is evaluated by a computation of the precession angle ρ, which is stored in memory location ρ i for future use, and a comparison to threshold value ρ DB . If the binary number in memory location ρ i is greater or equal to the memory level ρ DB , a test is made to determine whether either of the magnitudes of the angular error rates ω 1 or ω 2 exceed angular threshold rate ρ DB . If the magnitudes of either error rate exceeds threshold ω DB mode 3 is initiated, whereas if neither exceeds the threshold rate ω DB , another pass of mode 1 is initiated. If the precession angle stored in memory location ρ i excceds threshold ρ DB , another test is initiated to determine if the magnitude of either the roll or yaw total angles, φ and ψ respectively, exceed a threshold angle indicated as γ DB . If γ DB is equaled or exceeded mode 3, is initiated otherwise mode 2 is initiated.
FIG. 6c is a flow diagram for the sequential operation during mode 2. During the first part of operation of thruster control system 24, the precession angle ρ is recalculated and stored, he variables α and β are calculated and stored, a test for the zone in which the actual torque T resides in (according to table 1) is made, and the engine on commands for all the thrusters within the correct planar set are set and executed. Thereafter, an additional minimum impulse firing time Δt is added to the registers controlling the firing times of the selected engines according to the zone location of actual torque T. A test is performed to determine if the mode 2 Δt register has reached zero. When the test indicates that firing time register for mode 2 is zero ρ is again calculated and stored in a memory location ρ F . Thereafter, the binary value stored in memory location ρ F is compared to threshold value ρ DB1 . If ρ F is less than ρ DB1 , a test is made to determine whether or not T max has been equaled or exceeded, and if so, the engines are stopped. If the total elapsed time has not exceeded T max , mode 2 is again initiated. If ρ F has exceeded or equaled ρ DB1 , another test is performed to determine if the difference between ρ F and ρ i is negative. If a negative result is determined, mode 3 is initiated, otherwise, mode 2 is again initiated.
FIG. 6D is the flow diagram for the sequential operation of attitude control system 24 during mode 3. This mode sequentially reduces attitude rate errors ω 1 and ω 2 as required. Upon entering mode 3, the magnitude of the yaw error rate ω 1 is compared to threshold value ω DB . If ω DB is not exceeded, location B1 of FIG. 6d is entered in which the magnitude of the yaw attitude angular rate ω 2 is compared to threshold ω DB . If the magnitude of ω 1 is equaled or exceeded ω DB , the sign of ω 1 is examined and engine commands are set to produce either torques T 1 or T 5 of Table 1. That is, if the sign of ω 1 is positive thrusters A and B are fired simultaneously whereas if the sign is negative thrusters C and D are simultaneously fired. Thereafter, all the thrusters within the coplanar set of thrusters being utilized commanded to fire and an additional minimal firing time is added to the registers which control the firing of the selected engines in accordance with Table 1. When the mode 3 firing time has reached zero, another comparison of the magnitude of ω 1 is made to threshold ω DB . If the magnitude of ω 1 has exceeded ω DB , another pass through mode 3 is initiated. Otherwise, the total duration time of this maneuver is compared to T max . If the total duration time has equaled or exceeded T max , the engines are stopped. Otherwise, a test is initiated beginning at location B 1 to determine if the magnitude of ω 2 has exceeded ω DB . Location B 1 initiates a sequence of operation concerning ω 2 , which is similar to the sequence for ω 1 , and will not be described in detail because its similarity to that of the sequence for ω 1 . When the sequencing for the ω 2 has been finished, the engines are either commanded to stop or mode 1 is again initiated.
Although the operation of thruster control system 24 was described as proceeding in accordance to a preferred mode hierarchy, it will be appreciated by those skilled in the art, that other similar mode hierarchies may be used to control the sequential operation of thruster control system 24. For instance, it is possible that mode 3 operation (rate mode) precede mode 2 operation precession.
It should now be understood that a thruster control system for a spacecraft is provided according to this invention which controls the firing of individual thrusters within a set of orbit adjust thrusters singly or in combination to perform both the function of orbit adjustment and attitude control thereby enabling attitude control during the orbit adjust maneuver overcoming the requirement for a separate attitude control system.