System for guiding a projectile
Abstract
This record has no abstract on file.
Term
No projected expiry on record.
- Priority
- Filed
- Published
- Today
8 claims: 2 independent, 6 dependent
- 128 1. A guiding system for a projectile provided with at CLAIMS least one piloting measuring means for actuator and comprising physical parameters, a guidance computer and controlling means (4) for said piloting actuator, said projectile having to follow a reference trajectory in the first flight instants and said guidance computer (3) comprising:- navigational means for determining the attitude and the position of the projectile upon a flight;- guidance means for providing guidance orders from the attitude, the position and the goal position determined by said navigational means;and - piloting means for establishing control orders, intended for said control means, from said guidance orders, characterized in that said guidance computer further comprises estimation means able to estimate, in the course of flight, the attitude and the aerodynamic speed of the projectile, as well as the variations of the speed of the wind, from said guidance orders, said reference trajectory and said measurements obtained by said measurement means, using a model of the dynamic behaviour of the projectile and a model of the wind dynamics.
Independent claims2
99 paragraphs in 1 section, as filed
1 211577/2
SYSTEM FOR GUIDING A PROJECTILE
The present invention relates to a system for guiding a projectile, for example of the shell or rocket type, without any satellite assistance, as well as a projectile provided with such a guiding system. absence of satellite the GPS type) , the projectile is first
As known, in the assistance (for example of navigation function of a implemented upon an initialization phase consisting in determining the attitude and the position of the projectile at an initial instant. Such an initialization phase is then followed with a propagation phase consisting in determining the position and the attitude of the projectile upon the flight through on-board measurement instruments within the projectile (for example, accelerometers, gyrometers, magnetometers, ...) . US6573486 describes a projectile guidance system without gyros in which the projectile has an orthogonal body coordinate system. The projectile has a triax of accelerometers providing x, y and z acceleration data measured along the x, y and z axes respectively. A GPS antenna and receiver means provides onboard GPS position and velocity data in earth referenced navigational coordinates. A computer and program means stores and accesses time indexed GPS position and GPS velocity data and transforms x, y and z axis acceleration data from body to navigation coordinates. The program means is responsive to corresponding time indexed acceleration data and to GPS velocity and position data for calculating and 2 211577/2 outputing an estimated projectile roll, pitch and yaw angle via optimal smoothing techniques with respect to local level for each time index iteration of present position to a flight control system for guiding the projectile to a predetermined location. "Dynamic modeling, guidance, and control of homing missiles" by Ozken et al, (Sep 2005) describes dynamic modeling, guidance, and control of homing missiles with two relatively rotating parts that are connected to each other by means of a roller bearing.
Now, in the case of a projectile shot from a gun, the on-board measurement instruments are unavailable during the gun shot as a result of very high lateral and axial accelerations (saturating the inertial unit of the projectile) and the environment of the gun (including the presence of ferromagnetic masses making the magnetometers of the projectile unusable). Consequently, the initialization of the navigational function cannot be carried out, the complete attitude of the projectile remaining then undetermined at the outlet of the muzzle of the gun.
For overcoming such an absence of measurement during the gun shot, it is known to determine the aerodynamic speed of the projectile from the reference trajectory at the outlet of the gun shot. However, such a determination is very approximate, as the actual trajectory of the projectile differs from the reference trajectory, making an accurate navigation of the projectile very difficult.
It is also known to estimate, in the course of flight, the attitude of the projectile using on-
2A 211577/1 board magnetometers through measurement of the terrestrial magnetic field. However, the accuracy of the measurements being carried out remains limited and no information regarding the aerodynamic speed of 5 the projectile is however available.
Moreover, for a projectile supposed to be very stable and provided with gyrometers and accelerometers, it is known to measure the gravity with such on-board measurement instruments for 10 estimating the attitude and the aerodynamic speed of the projectile during a ballistic flight phase. However, such an estimation of the aerodynamic speed could only be carried out upon the ballistic flight phase of the projectile. Moreover, the attitude 15 estimation is strongly altered by any incidence uptake of the projectile (for example, as a result of the wind).
Furthermore, when the measurement instruments on-board the projectile are of a mean or 20 bad quality, the inaccuracy on the estimation of the attitude of the projectile makes the navigation of the projectile very bad on a high flight duration.
The present invention aims at overcoming such drawbacks and more specifically, at determining, 25 with a high accuracy, the attitude and the aerodynamic speed of the projectile upon a flight, including upon 3 the ballistic flight phase and the guided-piloted flight phase.
To this end, according to the invention, the system for guiding a projectile provided with at least one piloting actuator (a mobile aerodynamic surface, a pulser, . . .) and comprising measuring means for physical parameters, a guidance computer and controlling means for said piloting actuator, said projectile having to follow a reference trajectory in the first flight instants and said guidance computer comprising: - navigational means for determining the attitude and the position of the projectile upon a flight; - guidance means for providing guidance orders from the attitude, the position and the goal position determined by said navigational means,· and - piloting means for establishing control orders, intended for said control means, from said guidance orders, is remarkable in that said guidance computer further comprises estimation means for estimating, in the course of flight, the attitude and the aerodynamic speed of the projectile, as well as the variations of the speed of the wind, from said guidance orders, said reference trajectory and said measurements obtained by said measurement means, while using a model of the dynamic behaviour of the projectile and a model of the wind dynamics.
Therefore, the estimation means of the guidance computer according to the invention allow, without any preliminary information (including about the position and the attitude of the projectile) and 4 with a high accuracy, for the estimation of the attitude and the aerodynamic speed of the projectile, from variations of the speed of the wind as well as from any parameter of the measurement means.
Furthermore, such estimations are carried out throughout the flight of the projectile (ballistic flight phase, guided-piloted flight phase, ...) and can allow to increase, more specifically, the accuracy to the impact as well as the range of the projectile.
Furthermore, although the guiding system of this invention does not require any satellite assistance, it could be coupled to satellite navigational means, for example, of the GPS type.
Advantageously, said estimation means comprise equivalent piloting means (that is, implemented by a dynamic model of the piloting means) for determining, from said guidance orders provided by said guidance means, control orders equivalent to said control orders established by said piloting means.
Furthermore, advantageously, such equivalent piloting means comprise: - a first comparator, connected to the outlet of said estimation means and to the outlet of said guidance means; - a first gain, connected to the outlet of said first comparator; - an integrator, connected to the outlet of said first gain; - a second comparator, connected to the outlet of said integrator and to the outlet of said estimation means; and - a second gain, connected to the outlet of said second comparator. 5
According to a characteristic of the invention, the wind is modelled by a white noise filtered by an appropriate order filter (for example of the second or third order) within said model of the wind dynamics.
Advantageously, said estimation means comprise an extended Kalman filter.
Moreover, said navigational means comprise preferably at least: first integration means, connected to said measurement means, able to determine the attitude and the position of the projectile from measurements obtained by said measurement means; second integration means, connected to said measurement means and to said estimation means, able to determine the attitude and the position of the projectile from measurements obtained by said measurement means and the attitude estimated by said estimation means; third integration means, connected to said estimation means, able to determine the attitude and the position of the projectile from the estimation of the attitude and of the aerodynamic speed of the projectile as well as from variations of the speed of the wind; and fourth integration means able to determine the attitude and the position of the projectile from said reference trajectory; as well as supervision means, connected to said first, second, third and fourth integration means, for selecting, based on a selection criterion, one of said integration means, so that said navigational means are able to deliver the attitude 6 and the position of the projectile determined by said selected integration means.
Advantageously, said measurement means comprise three gyrometers, three accelerometers and two magnetometers .
The present invention also relates to a guiding system such as previously specified.
The FIGS. of the appended drawing will better explain how this invention can be implemented. In these FIGS., like reference numerals relate to like components FIG. 1 schematically shows, in a block-diagram, an embodiment of the present invention. FIGS. 2 to 5 illustrate block-diagrams, respectively, of the guidance computer, the extended Kalman filter, the equivalent piloting means belonging to the extended Kalman filter and the navigational means, according to the embodiment of the present invention.
As shown on the block-diagram of FIG. 1, the guiding system 1 with no satellite assistance for a projectile (not shown), shot from a gun, comprises: - measurement means 2 on-board the projectile delivering, at the outlet, via the link LI, measurements of physical parameters. Such measurement means 2 comprise, for example, three gyrometers, three accelerometers and two magnetometers; - a guidance computer 3, receiving the measurements obtained by the measurement means 2 (link LI) and, via the link L2, a reference trajectory associated with the flight of the projectile. The guidance computer 3 is able to deliver at the outlet, 7 via the link L3, control orders transmitted to control means 4 to be further specified herein below; - control means 4 receiving said control orders (link L3) . Such control means 4 are able to point piloting actuators 5. On FIG. 1, as an illustrative example, piloting actuators 5 are illustrated by mobile aerodynamic surfaces 5 (for example, canard control surfaces) of the projectile around their rotation axis 6.
More particularly, according to the invention and as illustrated in the exemplary block-diagram of FIG. 2, the guidance computer 3 of the piloting system 1 comprises: - an extended Kalman filter 7, with which a state vector X is associated and receiving the measurements obtained by the measurement means 2 (link Ll) , the reference trajectory (link L2) as well as guidance orders delivered at the outlet by guidance means 9 (as specified herein below), via the link L4. From such information, using a model of the dynamic behaviour of the projectile and a model of the wind dynamics (detailed further on), the Kalman filter 7 is able to deliver at the outlet, via the link L5, an estimation of the attitude and the aerodynamic speed of the projectile, variations of the speed of the wind, the instantaneous rotation vector as well as any parameter associated with the measurement means 2, throughout the flight of the projectile. From such estimations, the kinematic speed of the projectile can be deduced; - navigational means 8, receiving measurements from the measurement means 2 (link Ll) , the reference trajectory (link L2) as well as 8 estimations from the extended Kalman filter 7 (link L5). The navigational means 8 are able to deliver at the outlet, via the link L6, the position and the attitude of the projectile throughout the flight; - guidance means 9, receiving the attitude and the position of the projectile (link L6) as well as estimations from the extended Kalman filter 7 (link L5) . The guidance means 9 are able to deliver at the outlet (link L4) guidance orders according to a guiding law implementing, for example, a proportional navigation with a bias allowing for a compensation and a shaping of the trajectory; and - piloting means 10, receiving the measurements obtained by the measurement means 2 (link LI), the guidance orders from the guidance means 9 (link L4), as well as the attitude and the position of the projectile delivered by the navigational means 8 (link L6) . The piloting means 10 are able to deliver at the outlet (link L3) the control orders transmitted to the control means 4 of the mobile aerodynamic surfaces 5. FIG. 3 shows an exemplary block-diagram of the extended Kalman filter 7 according to the embodiment of the invention.
Such an extended Kalman filter 7 comprises: - equivalent piloting means 11 (described hereinafter with respect to FIG. 4) , receiving at the input (link L4) the guidance orders established by the guidance means 9 and estimations of the state vector X (associated with the Kalman filter 7) delivered by resetting means 13 (described hereinafter), via the link L5. The equivalent piloting means 11 are able to 9 deliver at the outlet, via the link L7, control orders being equivalent to the control orders provided by the piloting means 10; - calculation means 12, receiving the reference trajectory (link L2) as well as the equivalent control orders (link L7) transmitted by the equivalent piloting means 11. From equations associated with the dynamics of the Kalman filter (detailed further on) , the calculation means 12 are able to deliver unset estimations of the state vector X; and - resetting means 13, receiving the measurements obtained by the measurement means 2 (link Ll) as well as the unset estimations transmitted by the calculation means 12. The resetting means are able to reset the unset estimations from the obtained measurements (link Ll) so as to deliver at the outlet (link L5) reset estimations of the state vector X associated with the Kalman filter 7.
The flight of the projectile can for example be distributed according to the three following successive flight phases: - a first initial flight phase, starting immediately after the gun shot, during which the measurement means 2 are unavailable (too high axial and lateral accelerations, disturbance of the magnetic field inside the gun); - a second ballistic flight phase during which the projectile is only submitted to the action of gravity. The measurement means 2 are from now on able to carry out measurements; and - a third guided-piloted flight phase during which the canard control surfaces 5 of the projectile 10 are extended. The projectile is then submitted, in addition to gravity, to the action of the canard control surfaces 5.
During the initial flight phase, the determination of the attitude and the aerodynamic speed of the projectile is carried out as known from the reference trajectory, as no measurement is available.
Upon the ballistic flight phase, the measurement means 2 are usable and the extended Kalman filter 7 is initialized.
For being able to estimate the attitude of the projectile, the extended Kalman filter 7 uses flight mechanics equations and the action of gravity: its direction supplies the vertical, while its amplitude supplies the pitching angle of the projectile.
In order to observe the gravity, it is necessary to write the flight mechanics equations involving the latter. Assuming the projectile is in self-rotation, it is advisable to work in the demodulated reference point as associated with the projectile comprising axes deduced from the axes (Xe,Ye,Ze) connected to the projectile, through demodulating the integral of the rolling speed, indicated φ*.
The following relations are then obtained: 11 i*=/ $>*(*) = fpW? ua ~ua va = va cos(<p*) - wa sin(4?*) wa = va sin(<p*) + wa cos(p*)
P = P q~q cos(9>*) - r sin(p*) r = q sm(?>*) + r cos(^*) where: (“a’va’wa) are the components of the aerodynamic speed vector according to the axes of the 5 reference point (Xe,Ye,Ze) associated with the projectile, with Xe being the longitudinal axis and Ye and Ze the transversal axes freezed at shot time such that (Xe, Ye, Ze) is a direct orthonormed reference point; («α,νο,ΐνσ) 10 ' are the components of the aerodynamic speed vector according to the axes of the demodulated reference point of <p* associated with the projectile; (p,q,r) are the components of the 15 instantaneous rotation vector according to the axes of the reference point associated with the projectile; and are the components of the instantaneous rotation vector according to the axes of 20 the demodulated reference point of φ* associated with the projectile. 12
In the demodulated reference point of φ* associated with the projectile, the force equations are written as follows: u a ~ -g sin((?) + Γχ + rva - qwa - uv •i . « wa = gcos(0)cos(9-^‘)+ +uaq - Wv where: the sign « · » corresponds to the derivative with respect to time; are the three Euler angles respectively representing the yaw angle, the pitching angle and the rolling angle associated with the projectile passing from the local geographical trihedron to the projectile, to the reference point of the projectile (Xe,Ye,Ze); represent respectively the incidence and the aerodynamic sideslip in the demodulated reference point of φ* associated with the projectile such that: («a,/Ja)=f arctan(wa /«fl)arcsmfva /^ua2 +va2 + wa2 r * is the axial acceleration along the longitudinal axis of the projectile; and (wv»Vv’Wv) are tjie components of the speed vector of the wind in the demodulated reference point of φ* associated with the projectile. 13
Assuming the wind is horizontal, if (jy flr o) ' x> y> 7 represents the components of the wind in the direct inertial reference point (Χο,Υο,Ζο) (Xo representing the axis along the gun-target line and Zo representing the downward oriented vertical), then:
(. < · > U v w << Vv - 2λ0->λ r, - q A K Wv 0 <r; Λ \ J with: cos(v<)cos(0) cos(pj sin(0) sin(p) - sin(pj cos(p) ^cosfy/jsm/tfjcostp) + sin(»sm(p) sin(t//)cos(0) sinO) sin(0) sin(p)+cos(p·) cos(p) sin(y) sin(0) cos(p) - cos(p) sin(p) -sin(0) ' cos(0)sin(p) cos(0)cos(py where Ro= (Χο,Υο,Ζο) and R= (Xe,Ye,Ze).
After calculation, the following El equations are obtained: ua=-gsin(0) + Γχ + rve - qwa -cos(^)cos(0)Fx- sin(y) cos(0) Wy »
Va = gsm(0)sin($)-<p*)+^Cy(Fa5^e)-«ar-(cos(v<)sm(0)sm(^)-sin.(v<)cos(^))rx - (sin( ψ) sin(0) sin(<p) + costy) cos(f))Wy » . _ * wfl = g cos(0) cos(<p - φ*) + QSref C2(Va,oca) + uaq- (cos(^)sin(0)cos(^) - sjn(Y)sa^q>))Wx - (sin( ψ) sin(0) cos(<p)+cos(^) sin(<p)) Wy
Similarly, the E2 flight mechanics moment equations are written in the demodulated reference point of φ* associated with the projectile: 14 Ή *y where: A/i — QSreflrefCm, 9 with Cmg the pitching damping coefficient, Q is the dynamic pressure, lref is the reference length and Sref is the reference surface for the definition of the projectile aerodynamics; C- and C coefficients demodulated ft are the aerodynamic moment being function of the aerodynamic speed Va, aerodynamic incidence and aerodynamic Λ sideslip ra φ* respectively in pitching and yawing modes, at the gravity centre of the projectile, in the demodulated reference point of φ* associated with the projectile; and
Ix and Iy are the respectively axial and transverse inertias .
For describing the dynamics of the projectile, the equations are used connecting the instantaneous rotation vector of the projectile (expressed in the demodulated reference point of φ* associated with the projectile), the Euler angles and their derivative. 15
The kinematics of the projectile supplies the following E3 equations:
<img img-format="tif" img-content="drawing" file="IL211577AD00021.tif" id="idf0001" />
The set of El, E2 and E3 equations describes completely the dynamics of the projectile and including the action of gravity.
When the instantaneous rotation vector and the aerodynamic speed vector are known or measured at an instant t, then the El, E2 and E3 equations allow their evolutions to be predicted.
For determining the kinematic speed of the projectile, two cases could occur: - either the speed of the wind is perfectly known (for example, by reading in a table) , then the kinematic speed of the projectile could be deduced from the aerodynamic speed V^d^ematics— ^aerodynamics + VWrnd and the El, E2 and E3 equations are sufficient for estimating the kinematic speed of the projectile; - or the speed of the wind is not known, then it is not possible to estimate the kinematic speed of the projectile. Nevertheless, assuming that the speed of the wind is known at a flight instant (for example, at the beginning of a flight), it becomes possible to estimate the variations of the wind and thus to estimate the speed of the wind in the course of flight (the derivative of the speed of the wind being directly involved in the El equations). 16
For estimating the speed of the wind, the wind is modelled by a white noise filtered by an appropriate order filter, for example, of the second order. To this end, the model of the wind dynamics is 5 used, as defined by the following E4 equations: X = jy jx=-2%a)Wx-G)2Wx jy~-%a>Wy-a)2Wy where ξ and ω are control parameters representing the 10 pulse and the damping of the model of the wind.
Thus, the El, E2, E3 and E4 equations allow the dynamics of the projectile and the wind to be described. The set of these equations allows, more specifically, the attitude of the projectile as well 15 as the aerodynamic speed and the variations of the speed of the wind to be described.
The extended Kalman filter 7 then possesses 13 states. The state vector is defined by λ a Δ £ ua s Va, Wa, p,q, r, Ψ, θ, φ, jx, J ,WX, Wy and its dynamics is 20 described by the following equations:
Ua - -gsin(ff) +Γ* + rva-qwa~-cos($)cos(&amp;)jx - sin<y)cos(0)/ 17 ν. = gm(θ)si^φ-φ')+QS^Cy(ya,βJ~ύJ-(cos(if)^6)^)-^)cos(φ^x - (sin( yz) sm(0) sin(0)+cos(i^) cos($))/;
Wa = gcos(0)cos(0-<p‘)+gS^ Ο,(ΓΛ)αο)+«ο ^-jcos^sin^oos^-sm^sinC^))/, - (sin(y) sin(0) cos(<p)+cos(^·) sin(0))/y ) = 0
<img img-format="tif" img-content="drawing" file="IL211577AD00022.tif" id="idf0002" />
^= Λ A=Jy V-2£<-<»2^ J, = -2^ -(0^ © SB Ω where and the indication « » refers to an estimation.
In order to advantageously take into account the shortcomings of the measurement means 2, 5 complementary states are added to the state vector X of the Kalman filter 7: - two states dy and dz corresponding to the off-centring of the respective pitching and yawing accelerometers; 10 18 - two states cq and cr corresponding to the setting error of the respective pitching and yawing gyrometers; and - a state fP corresponding to a scale factor of the rolling gyrometer.
The state vector of the extended Kalman filter 7 then comprises 18 states such that a a — Δ
Wx,Wyifp,c9icridyid. the dynamics of such five states is defined by the following equations: Λ=θ 3=0 cr=0 3 = θ 3 = 0
Upon the guided-piloted flight phase, the projectile is submitted to the action of canard control surfaces in the addition to gravity. The instantaneous rotation vector of the projectile has from now on two main contributions: the action of the control surfaces and the action of gravity.
In order to take into account the action of the control surfaces upon the guided-piloted flight phase, the E2 flight mechanics moment equations are modified (previously established for the ballistic flight phase). 19
The linearized as aerodynamic moment coefficients could be follows :
Cm —CmaOC + Cm-ηΤ) Cn=CnP^ + C„?C 5 where: and and yawing locks of φ* associated represent the respective pitching in the demodulated reference point with the projectile; 10 B Cma aerodynamic depending on and are the parts of the Τ’ moment coefficient m respectively ® and ; moment ζ and 15 achieved: and are coefficient
The following the parts of the aerodynamic respectively depending on relationships are further Δ Δ <3bs =g+c?pcos(<p*)-c,.psm(^*) Λ «Λ rss =r+c9p )+cr p cos(tp*)
A A 20 where $ss -, rss and represent an estimation of the measurements carried out by the gyrometers in the demodulated reference point of φ* associated with the projectile. 20
From the previous relationships, the * Δ Λ* variables ^BS and rBS are determined, subtracting again -* A* the angular speed due to gravity at ^BS and rBS. As a result, 10
<1bs = 0+ c9P cos(^>*) - ^psinCp*) + g cos(0) cos(p -<p)!V
j\* A
res - r+ c?j?sin(p*) + crpcos(<p‘) - gcos(0)sin(^ -(p)IV Λ where stands for the module of the estimated kinematic speed of the projectile.
After calculation, the following E5 pitching and yawing moment equations are obtained: r = ar
Iq QSS \ 7 ( Λ* λ
Ir — res _ Λ, Λ. Λ 8 QS ref Kef (Cma (Xa+ ¢)- prf
QSMC^Pa+Cmr)-pqIK _ Δ 4co — Qss / * λ
Ta> - res k 7 15 where the gain
<img img-format="tif" img-content="drawing" file="IL211577AD00023.tif" id="idf0003" />
with n= 2. 21
Furthermore, the equation P = ® established for the ballistic flight phase is advantageously modified by the following approximation:
p = signe(Pca - p) min (?co - p), Ptaix I where P™* represents the rolling speed saturation issued from the piloting means 10 and P™ stands for the rolling speed controlled by the guidance means 9.
For describing the projectile upon the guided-piloted flight phase, the two states Iq and Ir are introduced in the state vector X of the Kalman filter 7. bearing
Furthermore, two scale factors " and ” on the force and aerodynamic moment coefficients vector X. are also introduced into the state
Thus, according to the invention, for the piloted-guided flight phase, the extended Kalman filter 7 possesses 22 states such that:
<img img-format="tif" img-content="drawing" file="IL211577AD00024.tif" id="idf0004" />
The dynamics of the Kalman filter 7 is described by the following equations: 22 «„ =-gsm($)+rx +rva-qyva-cos(^')cos0')jx -sm^cos^)/^ va =gsm(^sin$-^ )+gS^ C,(Te Je)-wff r-(cos(^)sm(0)sin(9)-sm(^)cos^))/s - (sin(^) sin(l9) sm($)+cos(i/) cos(<p) * Λ A _ Λ £. Δ { A \
Wa = gCOs(l9) 008(^-^)+6^ Cr(^,,Cffl)+H0 #-(cOS(^)sm(0)COS(0)-Sill(l£)8111(0)}/* -(sin(v>) sin(0) cos(<p)+cos($) sin^)^ p=signup„ -p)min| ®r(pco -p), p^ I
It A —- -— — — +— I QSrefhflKc„ Cn,a (Xc+C^ q)-prlx
r = G)c I-VBS QSrflr^KCiafi k+Cmsr)-pql ' • (- .- t^= #s:in(#-9’j+?4C0S($”?’*) ♦ Λ Λ θ = q cos(0 - φ*) - r sin(0 - φ“) /cos(0) :P + gsin(^-^‘)+?'cos(P~9>*) tan(0)
A A =jx « ^=Λ Λ=-2<<-ω2^ * · fp =0,C9 =O,Cr =O,dy = O,dz =0 Kc„ =0 ^=0 λ=£, C A* λ
?«"? BS C ί* λ f” co -rss 23
The 22 state Kalman filter determined considering the guided-piloted flight phase could also be implemented for the ballistic flight phase.
Furthermore, the measurements of the three gyrometers and the three accelerometers of the measurement means 2 are implemented as follows by the resetting means 13 so as to reset the states of the Kalman filter.
Are compared: ^measure with p + fpp R.a,„r« cos(i»*)-r„eaaur.dSin(9>*) with ?+ c pcos(p*) -crpsm(</) d * Δ
Measure, sm(^D + raeasu„d cos(p‘) with r+ cp) + crpcosty*) d “ rXBuieacos(<p*)-rm*oureS sm(<p*) with +^£2cos(ip*)-<-£2 sin(p*) r„Lur;asin(<p‘) + r*aBUieacos(<p*) with QSrefKCu Cz +dyp2 sm(</) + d,p2 cos(^*) FIG. 4 shows an exemplary block-diagram of the equivalent piloting means 11 of the Kalman filter 7. The equivalent piloting means 11 comprise: - demodulation means 14, receiving the guidance orders gco and rco in the reference point connected to the projectile (link L4) . The demodulation means 14 are able to carry out a change of reference point of the guidance orders qco and rco from the reference point connected to the projectile at the demodulated reference point of φ* associated with the projectile and to deliver at the outlet, via #co the link L9, the demodulated guidance orders of φ* V co / and 24 - a first comparator 1 receiving the demodulated guidance orders from <p* ; Qeo *
Qbs and reo res (link L9) as well as the variables transmitted by the resetting means 13 (link L5) . The first comparator 15 is able to deliver at the outlet, via the link L10, a signal representative of the and difference ^c0 ^ss and the difference 100 rBS ; - the first gain Kl, referred to as 16, connected the outlet of the comparator 15. The first 10 gain 16 is able to deliver in outlet, via the link Lll, a signal representative of and * \ — Λ /'co — rss
J - an integrator 17, connected to the outlet of the gain 16. The integrator 17 is able to deliver 15 at the outlet, via the link L12, a signal representative of the integration ,· λ (I 4 co $BS &amp; and the
M integration - a second comparator 18, connected to the outlet of the integrator 17 and receiving the
reo — rBS dt Λ
rBS 4bs transmitted by the resetting means 13 (link L5) . The second comparator 18 is able to deliver at the outlet, via the link L13, a signal 20 variables and 25
eft qBS representative of the difference and r a*
Kx j ra, -rss left-rss the difference k - a second gain K2, referred to as 19, connected to the outlet of the second comparator 18. The second gain 19 is able to deliver at the outlet, via the link L14, a signal representative of f (- - * > Λ, f j (- - Ί * \ K2 dt- ~$BS K2 rco - fss dt — VBS k J and k J / 10 15 - modulation means 20, connected to the gain outlet 19, able to deliver to their outlet (link L7)
Hco ζ co control orders and equivalent to the control orders from the piloting means 10.
Thus, the equivalent control orders (before modulation by the modulation means 20) are defined by the following equations: Λ f Δ* Λ* neo = *2 Μ 3 co ~^BS 0t-<hS k J > Λ Γ- A* ' * λ c Μ Γ co — Tbs dt — rBs k k y
On FIG. 5, an exemplary block-diagram is shown, illustrating the navigational means 8 of the 20 guidance computer 3 according to the embodiment of this invention.
The navigational means 8 comprise: 26 - first integration means 21, receiving the measurements obtained by said measurement means 2 (link Ll) . The first integration means 21 are able to deliver at the outlet, via the link L15, the attitude and the position of the projectile; - second integration means 22, receiving the measurements obtained by the accelerometers of the measurement means 2 (link Ll) and the attitude estimated by the extended Kalman filter 7 (link L5) . The second integration means 22 are able to deliver at the outlet, via the link L16, the attitude and the position of the projectile; - third integration means 23, receiving the estimations of the aerodynamic speed and the variations of the speed of the wind achieved by the Kalman filter 7 (link L5). The third integration means are able to deliver at the outlet, via the link L17, the attitude and the position of the projectile; - fourth integration means 24, receiving the reference trajectory (link L2). They are able to deliver at the outlet, via the link L18, the attitude and the position of the projectile; - supervision means 25, receiving the attitude and the position of the projectile determined by the first 21, the second 22, the third 23 and the fourth 24 integration means (links respectively L15, L16, L17 and L18) . The supervision means 25 are able to select, for each flight phase of the projectile, the determined position and attitude corresponding to a maximum navigation of the projectile based on criteria such as the load factor of the projectile or the time that has elapsed. They can thereby deliver at the outlet, via the link L19, the position and the 27 attitude of the projectile determined by the integration means selected for each flight phase. They are also able to make the guidance means 9 operational; and 5 - transfer means 26, receiving the position and the attitude of the projectile determined (link L19) by the selected integration means.
10 members in 6 offices
Priority claims8
| Document | Office | Kind | Date |
|---|---|---|---|
| 0805366 | France | A | |
| 0805366 | France | A | |
| 2009001160 | France | W | |
| 2009001160 | France | W | |
| 0805366 | – | – | – |
| FR20080005366 | – | – | – |
| PCTFR2009001160 | – | – | – |
| WO2009FR01160 | – | – | – |
Members10
| Document | Office | Kind | |
|---|---|---|---|
| EP2169508A1 | European Patent Office (EPO) | A1 | |
| FR2936598A1 | France | A1 | |
| WO2010037929A1 | World Intellectual Property Organization (WIPO) | A1 | |
| FR2936598B1 | France | B1 | |
| IL211577D0 | Israel | D0 | |
| US2011198435A1 | United States of America | A1 | |
| US8669505B2 | United States of America | B2 | |
| IL211577AThis record | Israel | A | |
| EP2169508B1 | European Patent Office (EPO) | B1 | |
| ES2612463T3 | Spain | T3 |
2 legal events, as the office reported them to INPADOC
Over the term
Point at a mark for the eventEvents
| Event | Code | |
|---|---|---|
| Patent renewedKB | KB | |
| Patent grantedGrantedFF | FF |
Numbers
- Publication
- 211577
- Publication, DOCDB
- 211577
- Publication, EPODOC
- IL211577
- Application
- 211577
- Application, DOCDB
- 21157711
- Application, EPODOC
- IL20110211577
Titles2
- English
- System for guiding a projectile
- Hebrew
- מערכת להנחיית קליע
Classification
- CPC, 3
- G05D1/107
- F41G7/346
- F41G7/36
- IPC, 1
- G05D