Electromagnetic monitoring and control of a plurality of nanosatellites
09846023 · 2017-12-19
Assignee
Inventors
Cpc classification
G01B7/003
PHYSICS
G01B7/14
PHYSICS
B64G1/24
PERFORMING OPERATIONS; TRANSPORTING
G01B7/30
PHYSICS
International classification
G01B7/00
PHYSICS
B64G1/24
PERFORMING OPERATIONS; TRANSPORTING
B64G1/10
PERFORMING OPERATIONS; TRANSPORTING
G01B7/30
PHYSICS
B64G1/36
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A method for monitoring position of and controlling a second nanosatellite (NS) relative to a position of a first NS. Each of the first and second NSs has a rectangular or cubical configuration of independently activatable, current-carrying solenoids, each solenoid having an independent magnetic dipole moment vector, μ1 and μ2. A vector force F and a vector torque are expressed as linear or bilinear combinations of the first set and second set of magnetic moments, and a distance vector extending between the first and second NSs is estimated. Control equations are applied to estimate vectors, μ1 and μ2, required to move the NSs toward a desired NS configuration. This extends to control of N nanosatellites.
Claims
1. A method of monitoring and controlling a second nanosatellite relative to a position of a first nanosatellite, the method comprising: (i) initializing a time interval; (ii) for a present time interval, based on at least measured magnetometer data, estimating a distance vector that extends between a first location associated with a first nanosatellite and a second location associated with a second nanosatellite, the nanosatellites comprising respective first and second plurality of solenoids; (iii) estimating force vectors and torque vectors to move at least the second plurality of solenoids relative to the first nanosatellite; (iv) for at least the second nanosatellite, estimating magnetic dipole moment vectors associated with both force vectors and torque vectors; (v) causing at least the second plurality of solenoids to produce the magnetic dipole moment vectors; (vi) incrementing the present time interval, and returning to step (ii), wherein the first plurality of solenoids is arranged in a rectangular geometry.
2. The method according to claim 1, wherein the first location is on a first solenoid within the first plurality of solenoids, and the second location is on a second solenoid within the second plurality of solenoids.
3. The method according to claim 2, wherein the measured magnetometer data comprises a magnetic field vector value associated with the second solenoid.
4. The method according to claim 3, further comprising using the magnetic field vector value to estimate a magnitude of the distance vector.
5. The method according to claim 1, wherein each of the first plurality of solenoids is a current-carrying solenoid that can be independently activated.
6. The method according to claim 1, further comprising using an RF link to communicate commands from the first nanosatellite to the second nanosatellite to control the second plurality of solenoids.
7. A method of monitoring and controlling a second nanosatellite relative to a position of a first nanosatellite, the method comprising: (i) initializing a time interval; (ii) for a present time interval, based on at least measured magnetometer data, estimating a distance vector that extends between a first location associated with a first nanosatellite and a second location associated with a second nanosatellite, the nanosatellites comprising respective first and second plurality of solenoids, the first location being on a first solenoid within the first plurality of solenoids, the second location being on a second solenoid within the second plurality of solenoids, the measured magnetometer data comprising a magnetic field vector value associated with the second solenoid; (iii) estimating force vectors and torque vectors to move at least the second plurality of solenoids relative to the first nanosatellite; (iv) for at least the second nanosatellite, estimating magnetic dipole moment vectors associated with both force vectors and torque vectors; (v) causing at least the second plurality of solenoids to produce the magnetic dipole moment vectors; (vi) incrementing the present time interval, and returning to step (ii), and (vii) using the magnetic field vector value to estimate a normalized vector value associated with the distance vector.
8. The method according to claim 7, wherein each of the first plurality of solenoids is a current-carrying solenoid that can be independently activated.
9. The method according to claim 7, further comprising using an RF link to communicate commands from the first nanosatellite to the second nanosatellite to control the second plurality of solenoids.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
DESCRIPTION OF THE INVENTION
(7) One challenge in monitoring and controlling one or more nanosatellites, using electromagnetic forces and torques, is determination of all relevant components of the three dimensional distance vectors that naturally arise in description of the physical parameters and resulting forces in such an environment. Beginning with the expression in Eq. (2) for a magnetic field flux that is generated by presence of a known magnetic moment μ, one is first confronted with estimation of the distance vector d (with source at a center of the magnetic moment source or associated solenoid(s)) at the point of measurement of the magnetic field B(d). Equation (2) is analyzed to estimate the vector components of d, using the known magnetic moment vector μ and the measurable field vector B(d). Equation (2) is rewritten as
B′(d)=(4π/μ0)B(d)={μ−(μ.Math.d)d/d.sup.2}/d.sup.3={μ−(μ.Math.α)α}/d.sup.3. (3)
d=dα, (4)
where α is a normalized vector (|α|=1) whose direction is parallel to the (unknown) direction of d. The normalized distance vector α is re-expressed as a sum of components,
α=αn1^+bn2^+cn3^, (5)
where n1^, n2^ and n3^ are mutually perpendicular vectors, each of unit length, and a, b and c are to be estimated. Note that both the scalar value d and the vector α are initially unknown. One suitable set of choices for the vectors n1^, n2^ and n3^ is
n1^=μ^=μ/|μ, (6A)
n2^={B′−(B′.Math.μ^)μ^}/|B′−(B′.Math.μ^)μ^|, (6B)
n3^=n1^×n2, (6C)
(n1^).sup.2=(n2^).sup.2=(n3^).sup.2=1. (6D)
(8) Using the decompositions set forth in Eqs. (4), (5) and (6), Eq. (3) can be rewritten
(9)
where the term involving the vector n3^ is dropped here because this vector only appears in one term in Eq. (7) (equivalent to c=0). Equation (7) can be rewritten by collecting all coefficients involving the vector μ^ and all coefficients involving the perpendicular vector B′−(B′.Math.μ^)μ^ in Eq. (7),
(1/μ){B′−((B′.Math.μ^)μ^+(B′.Math.μ^)μ^}={(1−a.sup.2)μ^−ab{B′−(B′.Math.μ^)μ^}/|(B′−B′.Math.μ^)μ^|}(1/d.sup.3). (8)
Separately collecting all coefficients of each of the two vectors μ^ and B′−(B′.Math.μ^)μ^ yields the relations
(1−a.sup.2)/d.sup.3=(B′.Math.μ^)/μ, (9)
b=(−d.sup.3/aμ)|B′−((B′.Math.μ^)μ^|, (10)
1−a.sup.2−b.sup.2=(B′.Math.μ^)d.sup.3/μ,−(1/a.sup.2)|(B′−B′.Math.μ^)μ^|.sup.2d.sup.6/μ.sup.2, (11)
a.sup.2={B′.sup.2−(B′.Math.μ^).sup.2μ^}d.sup.3//μ(B′.Math.μ^) (12)
d.sup.3(B′).sup.2/(B′.Math.μ)=μ, (13)
(10) Equations (7) and (9)-(13) determine the quantities d and a, and the distance vector d. The vector quantities B′(d) and B(d) are measurable for any selected distance vector d.
(11) One suitable procedure is the following, illustrated in a flow chart in
(12) Electromagnetic forces, F12 and F21=−F12 and the corresponding torques, τ12 and τ21=τ12 are computed in this two-moment system, the center locations for each non-reference nanosatellite are incremented for a sequence of time increments Δt.
(13) A second method for estimation of the direction, in a plane P, of the normalized distance vector d uses a combined activation of two distinct solenoids to provide a first hybrid magnetic moment, μ1′=j1μ1+k1μ2, and to provide a second hybrid magnetic moment, μ2′=j2μ1+k2μ2, where μ1 and μ2 are magnetic moments of equal magnitude μ produced by activation of only the first solenoid and by activation of only the second solenoid, respectively, and j1, k1, j2 and k2 are selected coefficients, with j1/k1≠±j2/k2 and |μ1|=|μ2|=μ. Equation (3) is re-expressed for normalized magnetic moments, μ1^ and μ2^, as
B1′(d)=(4π/(μμ0)B1(d)={μ1′^−(μ1′^.Math.α)α}/d.sup.3, (14)
B2′(d)=(4π/(μμ0)B2(d)={μ2′^−(μ2′^.Math.α)α}/d.sup.3, (14)
|μ1^|=μ2^|=1. (16)
(14) The vector lengths |B1′(d)| and |B2′(d)| will generally have different values, because the scalar products (μ1′^.Math.α) and (μ2′^.Math.α) will have different values. In a graphical illustration in
L(ψ).sup.2=|μ′^−(μ′^.Math.α)α={1−(μ′^.Math.α).sup.2}=1−cos.sup.2(ψ−ψ0) (17)
is not yet known. The quantities L(ψ1).sup.2 and L(ψ2).sup.2 are measurable, using Eqs. (14)-(17), and can be re-expressed as
(15)
where the angle ψ0 is to be estimated and other quantities are determinable. The 2×2 matrix in Eqs. (18) has an associated determinant, with a value, Det=sin 2(ψ2−ψ1), whose magnitude can be made as large as possible by one of the choices ψ2−ψ1=±π/4, ±3π/4. The solutions of Eqs. (18) are
(16)
The solution angle, ψ=ψ0, provides the angle at which the normalized distance vector α is oriented relative to the direction of the first magnetic moment μ1 in the plane P=P(x,y), as illustrated in
(17)
(18) In step 43, solutions, cos ψ0 and sin ψ0, are estimated for the equations
cos(2ψ1)cos(2ψ0))+sin(2ψ1)sin(2ψ0)=1−2L(ψ1).sup.2,
cos(2ψ2)cos(2ψ0))+sin(2ψ2)sin(2ψ0)=1−2L(ψ2).sup.2.
In step 44, the solution angle, ψ=ψ0, is interpreted as the angle that distance vector d makes with a non-hybrid, magnetic moment vector μ1 or μ2. This indicates a direction in the plane P(x,y) for the normalized distance vector α. In step 45 (optional), the scalar distance value d=|d| is estimated, using, for example, Eq. (3).
(19) The developments of Eqs. (3)-(15), or (16)-(22), assume that the magnetic moment vector μ and the corresponding measured magnetic field vector B(d) are known. This requires knowledge of B(d) and μ for a single (initially unknown) distance vector d at which the field is measured. Alternatively, both the distance vector d and the direction of the moment μ may be unknown initially, although the magnitude, |μ|=μ may be known, through control of the current supplied to the solenoid. In this situation, it is assumed that two solenoids, each with the same magnetic moment magnitude, |μ1|=|μ2|=μ, are oriented at a known, non-zero angle (preferably π/2) relative to each other, that the two solenoids are associated with each other at a common end, and that the electromagnetic forces and motions are confined to a plane P(x,y). The moments are expressed as analogous to Eqs. (3) and (4):
B1(d)=(μ0/4πd.sup.3){μ1−(μ1.Math.d)d/d.sup.2)=(μ0/4πd.sup.3){μ1−(μ1.Math.α)α}, (20)
B2(d)=(μ0/4πd.sup.3){μ2−(μ2.Math.α.Math.d)d/d.sup.2)=(μ0/4πd.sup.3){μ2−(μ2.Math.α)α} (21)
d=dα, (22)
where the two solenoids have (approximately) a common distance vector d, whose angular orientation relative to the directions of the first and second solenoid sin the plane P(x,y) is initially unknown. Note that the field vectors B1 and B2 are each perpendicular to the vector d or a:
B1.Math.α=0, (23A)
B2.Math.α=0, (23B)
although generally |B1|≠|B2|, because the moments μ1 and μ2 are generally oriented differently relative to the vector α.
(20) Introduce new unit length vectors, which are measurable,
n1^=B1/|B1|, (24)
n2^=B2/|B2|, (25)
n2′^={n2^−(n1^.Math.n2)n1^}/|n2^−(n1^.Math.n2)n1^|, (26)
n3^=n1^×n2′^, (27)
where n1^, n2′^ and n3′ are mutually perpendicular and each has unit length. The normal forms of a plane P1 with normal vector B1 and of a plane P2 with normal vector B2 are
n1^.Math.s−|B1|=0, (28)
n2′^.Math.s−|B2|=0, (29)
where s=(x,y,z) is a coordinate vector in the coordinate system adopted here and |B1| and |B2| are the lengths of a first normal vector (n1^) and a second normal vector (n2′^), extending from the coordinate origin to the first plane P1 and from the coordinate origin to the second plane P2, respectively. Each of the planes, P1 and P2, contains the distance vector d, and the two normal vectors, n1^ and n2′^, (or n1^ and n2^) are not parallel. The intersection of the planes P1 and P2, therefore, defines a common line CL, which is parallel to the distance vector d.
(21) Express the common line CL, lying in the intersection P1ΩP2, as a vector
s=s1n1^+s2n2′^+s3n3^. (30)
The coefficients s1, s2 and s3 are determined using the normal forms in Eqs. (28) and (29):
n1′^.Math.s−|B1|=s1(n1^.Math.n1^)+s2(n1^.Math.n2′^)+s3(n1^.Math.n3^)−|B1|=0, (31)
n2′^.Math.s−|B2|=s1(n2′^.Math.n1^)+s2(n2′^.Math.n2′^)+s3(n2′^.Math.n3^)−|B2|=0, (32)
Taking account of the mutual orthogonality of n1^, n2′^ and n3^, a solution of Eqs. (31) and (32) is
s1=|B1|, (33A)
s2=|B2|, (33B)
s3 is not determined. (33C)
The intersection line CL is expressible as
s=|B1|n1^+|B2|n2′^+s3n3^, (34)
α=s/|s|, (35)
which defines a direction of the normalized distance vector α=d/|d|.
(22) The scalar value d of the distance vector d is estimated using the relation
|B1|.sup.2+|B2|.sup.2=(μ0/4πd.sup.3).sup.2{2μ.sup.2−μ.sup.2(cos.sup.2 ψ+sin.sup.2 ψ)}=(μ0/4πd.sup.3).sup.2μ.sup.2, (36)
where ψ is an angle between the vector α in the plane P(x,y) and the vector direction μ1^. The angle ψ itself, illustrated in
(23)
where it is assumed here that the scalar value d is already estimated and that the magnetic moments μ1 and μ2 are orthogonal to each other so that μ1, μ2=0. These procedures, using Eqs. (34)-(35) or Eqs. (36)-(37), provide third and fourth alternative approaches to estimation of the scalar value d and the normalized distance vector α, which do not require ab initio knowledge of the separate vector directions of the magnetic moments μ1 and μ2, only the requirement that μ1μ2=0.
(24) A suitable procedure for these alternatives is illustrated in a flow chart in
(25) Application of Distance Vector Information to Satellite Location and Control.
(26) In the development and application of the control law to follow, equations of motion of each of first and second solenoid rectangles (referred to herein as “cubes), relative to each other are developed. The first and second solenoid cubes lie in a common plane P(x,y), illustrated in
(27) The first or reference cube (i=1) is defined by four line segments, indexed as j=1, 2, 3, 4, and by a cube center c1. Each of the four line segments for the first cube has a pair of indices, (ij)=(1,1), (1,2), (1,3) and (1,4), as illustrated in
(28) Each of the four solenoid line segments that defines a nanosatellite solenoid (i=1 and k=2) has a line segment center. A distance vector, d=d(ij;k,m) (also written as d.sub.ijkm in the following) extending between a line segment (i,j) and a line segment (k,m) connects these two line centers in the development to follow. Each pair of solenoid line segments, (i,j) and (k,m), on the first and second cubes, respectively, has an associated pair of magnetic dipole moment vectors, μ.sub.i,j and μ.sub.k,m, independently chosen, and an associated distance vector d.sub.ijkm. Each of the quantities, μ.sub.i,j, μ.sub.km, and d.sub.ijkm will vary with time. A magnetic dipole moment, μ.sub.i,j and/or μ.sub.km may be 0 if that particular solenoid is not presently activated. More generally, each magnetic dipole moment vector, μ.sub.i,j and/or μ.sub.km may have a vector value 0 during one or more time intervals and may have a non-zero vector value during one or more other time intervals. The magnetic dipole moment vectors, μ.sub.i,j and μ.sub.km, will be chosen during each time interval to move the two cubes (more generally, to move the N cubes) toward a desired cube configuration (relative location and relative angular orientation) over the course of time, and the desired cube configuration may change with passage of time. The preceding formalism for two nanosatellites is extended to a first (reference) nanosatellite and N−1 controlled or non-reference nanosatellites, all lying in a common plane P(x,y), where N is a reasonable number (e.g., N=2-20).
(29) The length Δt of all time intervals may be uniform (e.g., Δt=0.1 sec), or the time interval length may itself vary with time (e.g., Δt=0.01-0.5 sec) according to the rate at which the present cube configuration is to approach a desired cube configuration. Movement of the different cubes toward a desired cube configuration is facilitated by temporally varying values of a force vector F.sub.ijkm and/or by a temporally varying electrical torque vector τ.sub.ijkm. The force vectors F.sub.ijkm and/or the torque vectors τ.sub.ijkm vary in response to the temporally changing (non-zero) magnetic dipole moments, μ.sub.i,j and/or μ.sub.km, and the temporally changing solenoid distance vectors d.sub.ijkm.
(30)
(31) In step 83, a force vector F and a torque vector T are estimated for each nanosatellite that are required to move each nanosatellite toward a desired cube configuration, for the present time interval (t.sub.n≦t<t.sub.n+1). In step 84, a magnetic dipole moment vector μ is estimated for each solenoid on each nanosatellite that is required to provide the force vectors F and torque vectors τ, for the present time interval (t.sub.n≦t<t.sub.n+1). In step 85, the required solenoid commands (estimated in step 84) are executed, for the present time interval (t.sub.n≦t<t.sub.n+1). In step 86, the present time interval, t.sub.n≦t<t.sub.n+1, is replaced by the next time interval, t.sub.n+1≦t<t.sub.n+2 (equivalent to incrementing the time interval index n to n+1), and the system returns to step 82.
(32) Implementation of Nanosatellite Control Commands.
(33) Returning to
(34)
where
F.sub.ijkm=M.sub.F(μ.sub.km,d.sub.ijkm)μ.sub.ij (42)
Using the far field model, we have, from Appendix I,
(35)
The symbol is the outer product operator.
(36) Similarly, the torque on a given cube is the sum of all the torque interactions between the EMs on one cube and the EMs on the other cube, plus a cross product of the moment arm from the center of the cube to the center of the EM with the force on that EM. Thus, the torque on the i.sup.th cube by the k.sup.th cube is given by
(37)
where
τ.sub.ijkm=M.sub.τ(μ.sub.km,d.sub.ijkm)μ.sub.ij, (45)
(38)
rc.sub.ij the moment arm on from the center of the i.sup.th cube to the center of the j.sup.th EM The symbol ( ).sup.T, in Eq. (46) is the skew matrix.
(39) To be able to control the nanosatellites, Eqs. (44)-(46) must be solved for the control input μ for each nanosatellite. To accomplish this, the μs will be determined in the reference frame that is attached to the body of the reference nanosatellite, referred to as the body frame.
(40) To accomplish this, a transformation from the inertial frame to the body frame is needed. These μs will go through a rotation θ from the inertial frame to the body frame. Also note that the μs are note free to point in any arbitrary direction, the μs are fixed to the body frame, and thus the x-y components of each μ will be isolated by projection matrices, I.sub.x and I.sub.y, associated with the x-axis and the y-axis. This can easily be extended to the z-axis.
(41) To demonstrate this, we will work through the equations for two nanosatellites, which is easily extended to any reasonable number N of nanosatellites. The force acting on nanosatellite 1 (reference) can be written as
Fc.sub.1=M.sub.F.sub.
(42)
is the components of the force acting on nanosatellite 1 in the inertial frame,
M.sub.F.sub.
M.sub.F.sub.
M.sub.F.sub.
M.sub.F.sub.
Resolving and isolating the components of μ in the body frame Eq. (41) is
(43)
where μ.sub.ijx and μ.sub.iky represents the μs in the body frame,
(44)
Applying the same process to the torque equation, we have
(45)
where
M.sub.τij=M.sub.τ(μ.sub.21,d.sub.ij21)+M.sub.τ(μ.sub.22,d.sub.ij22)+M.sub.τ(μ.sub.23,d.sub.ij23)+M.sub.τ(μ.sub.24,d.sub.ij24),
(46) Writing Eqs. (50), (51 and (52) in matrix form, we have
(47)
Using a pseudo inverse operator, we can solve for the μs. Note, we are using four variables to solve for three values. This is an extra degree of freedom in the control input that can be used to optimize another constraint, if desired.
Control Law Signal.
(48) In the previous section we showed that, given a desired force, torque applied to c.sub.1, the distance from each EM on c.sub.2 to each EM on c.sub.1, and the μs of c.sub.2 we can solve for the μs of c.sub.1. Here we will explore a very simple feedback control law to demonstrate in simulation that given a desired relative position and pointing angle, c.sub.1 can be driven to the desired position and angle by control of c.sub.1's μs.
(49) Because we want to exercise relative position control, we will define RelativePosition as the relative position from c.sub.2 to c.sub.1, expressed as a vector. We formulate an error signal between the relative position vector and a desired relative position we call DesiredDistance.
Error=RelativePosition−DesiredDistance. (54)
(50) For a linear time invariant plant, the proportional part of a PD controller is the Error multiplied by a gain. For an EM plant, this signal would be a force command Because force between two magnetic dipole moments is inversely proportional to the relative distance raised to the 4.sup.th power, we compensate for this non-linearity by multiplying the Error signal by |RealtivePosition|.sup.4. To include damping, we multiply the difference between the velocities by a gain. The control law has the form
pdSignal=Error kp|relativePosition|.sup.4+Error kd. (55)
(51) For the orientation of the nanosatellite we formulate an angle error signal. This will be a torque command. The torque between two magnetic dipole moments is inversely proportional to the relative distance raised to the 3rd power. Similar to above, we compensate for this by multiplying the error signal by |RelativePosition|.sup.3. To include damping, we multiply the angular velocity by a gain. The control law has the form of
pdSignalw=angleError kw|relativePosition|.sup.3+w kdw (56)
(52) To solve for the μs, we let Fx=pdSignalx, Fy=pdSignaly and τc.sub.1z=pdSignalw, the control law can be written as
(53)
APPENDIX. CONTROL SIGNAL FACTORED OUT OF FORCE EQUATION
(54) In this Appendix we introduce a matrix form of the force equation. Then we show how we write the force equation in this form. We then conclude with the general case of the force and torque acting on a nanosatellite from N−1 other nanosatellites, where N is the total number of nanosatellites.
(55) A typical form of the force acting on an electromagnet (EM) due to another electromagnet using the far field model is
(56)
where
μ.sub.0 is the permeability of free space
μ.sub.1 is the magnetic dipole of EM 1
μ.sub.2 is the magnetic dipole of EM 2
d is the distance between the dipoles and
F.sub.1 is the force acting on EM 1
(57) The identity (x.Math.y)z=(zy).Math.x is used to write Eq. (61) as
(58)
where is an outer product. Equation (62) can be written as a matrix times a vector, such as,
F.sub.1=M.sub.F(μ.sub.2,d).Math.μ.sub.1, (63)
where
(59)
The value of writing the force equation in this form is that for a give force it is a simple process to solve for the control input μ.sub.1.
Re-Expression of the Force Equation.
(60) First, we will verify the identity (x.Math.y) z=(zy).Math.x, and then will show the substitution that gives the matrix form of the force equation. We first verify that
(x.Math.y)z=(zy).Math.x, (65)
where
(61)
Multiplying out the left hand side of Eq. (65), we obtain
(62)
(63) Multiplying out the right hand side we get the same vector. We have shown that
(x.Math.y)z=(zy).Math.x (68)
Using the identity (68) to bring μ.sub.1 to the right side of each dot product, we have
(64)
Now factoring out μ.sub.1,
(65)
Then factoring (μ.sub.2□d), we have
(66)
Expressions for M.sub.F and M.sub.T.
(67) The notation that will be used here is the following.
(68) μ.sub.ij is the magnetic dipole moment of the j.sup.th EM on the cube.
(69) d.sub.ijkm is distance vector from the center of the m.sup.th EM on the k.sup.th cube to the center of the j.sup.th EM on the cube.
(70) F.sub.ijkm is the force on the i.sup.th cube, j.sup.th EM due to the k.sup.th cube m.sup.th EM.
(71) τ.sub.ijkm is the torque on the i.sup.th cube, j.sup.th EM due to the k.sup.th cube m.sup.th EM.
(72) rc.sub.ij is the moment arm from the center of the i.sup.th cube to the center of the j.sup.th EM.
(73) Using the above notation, the force and torque equations become
(74)
(75)
where
(76)
The above equations will be re-expressed to be linear in μ.sub.ij.
(77) Using the relationship (x.Math.y) z=(zy).Math.x=(z
x).Math.y to factor out μ.sub.ij from the dot products, we obtain
(78)
Factoring out (μ.sub.km□d.sub.ijkm) we obtain
(79)
We define the matrix
(80)
The force equation is now written as
F.sub.ijkm=M.sub.F(μ.sub.km,d.sub.ijkm)μ.sub.ij (79)
(81) Now factor out μ.sub.ij from the torque equation. The cross product can be written in matrix form as
(82)
We obtain
(83)
Substituting M.sub.F for F.sub.ijkm, we obtain
(84)
We define
(85)
τ.sub.ijkm=M.sub.τ(μ.sub.km,d.sub.ijkm)μ.sub.ij. (84)
(86) Equations (79) and (84) are referred to as a matrix form of the force and torque equations respectively.