Methods and systems for guiding an object to a target using an improved guidance law

Abstract

Systems and methods for guiding an object may comprise improved guidance laws that improve the effectiveness of the PRONAV guidance law. The improved guidance laws may utilize the same parameters as the PRONAV law and may be algorithmically simpler than conventional guidance laws because they may not be based on information about an intercept point or time-to-go. The improved guidance laws may be developed based on the Lyapunov method. The improved guidance laws may augment the PRONAV law and may provide additional components based on the negative definiteness of the derivative of the Lyapunov function. The additional components may be determined based on the partial stability of the guidance system dynamics under consideration with respect to the line of sight derivative. A comparative analysis of the improved guidance laws with the PRONAV laws, for example, may show that the improved guidance laws guarantee shorter homing time requirements and larger capture areas. The object may comprise a tactical or strategic weapon, including, for example, a guided missile.

Description

BACKGROUND OF THE INVENTION

I. Field of the Invention

The present invention generally relates to providing systems and methods of guidance of an object and, in particular, to improvements in homing guidance. The present invention constitutes an improvement over prior known guidance laws. More particularly, the present invention relates to providing systems and method that use improved guidance laws that are an improvement over the proportional navigation guidance laws (PRONAV).

II. Background Information

Various methods and systems of missile guidance and missile homing guidance are known prior to the present invention. The approach that has come to dominate missile guidance research and development is known as Proportional Navigation (PN). PN was developed by C. Yuan at RCA Laboratories during World War II based on physical intuition. This guidance law states that a commanded acceleration is proportional to a line of sight (LOS) rate. A proportionality constant, associating the commanded acceleration and the LOS rate, can be broken down into the product of an effective navigation ratio times a relative missile-target closing velocity.

Two decades later, a quasi-optimality of PN was derived. The prefix “quasi” means that PN was obtained as a linear quadratic optimal solution under the following assumptions:

• • (i) the target has zero acceleration;
  • (ii) the object (a missile for example) has perfect response and complete control of its acceleration vector;
  • (iii) the object is launched on a near collision course, so that LOS angles are small; and
  • (iv) the object has zero acceleration along the LOS over all time. One or more of these assumptions, however, is not applicable in all situations.

In order to remove assumption (i), an additional term may be added to the basic PN law that is equal to the target's estimated acceleration normal to the LOS multiplied by a proportionality gain. Thus, the so-called Augmented Proportional Navigation (APN) law was developed. In order to remove assumption (iv), the PN law was presented with respect to a new parameter: time-to-go.

Guidance laws based on optimal control and game theory approaches have been proposed in the literature. These guidance laws, however, have not been implemented in practice. Guidance laws developed using the optimal control and game theory approaches are generally able to more effectively counteract target maneuvers than the ordinary PN law; however, they assume that a maneuvering target's trajectory, as well as time-to-go and intercept point are known. In practice, such information is not known and can only be evaluated approximately. The prediction accuracy of these approximations influence significantly the intercept accuracy. Moreover, optimal guidance laws obtained for the first-order models of flight control systems and applied for the third-order models, which are closer to reality, may give even worse results than the PN law.

Guidance laws developed using the game and control theory approaches analyze and offer additional improvements over PN and APN by using additional information or improving the quality of existing guidance channel information, without changing the guidance law structure, i.e., they all belong to the class of PN guidance laws ( PRONAV). Prior to the present invention, PRONAV has continued to dominate research and development activity with respect to guidance laws. Because PRONAV implements parallel navigation, which is defined by the rule {dot over (λ)}(t)=0 for the planar LOS guidance (with an additional requirement {dot over (r)}(t)<0, where λ(t) is a LOS angle with respect to the reference axis and r(t) represents the target-to-missile range) or {dot over (λ)}_s(t)=0, s=1,2,3, for the three-dimensional case (where λ_s(t) are LOS coordinates), a more general problem can be formulated to describe a class of improved guidance laws that will implement parallel navigation.

Prior known PN guidance laws (PRONAV), originated from proportional navigation which is based on an intuitive approach, give insufficient accuracy in many practical cases, especially for maneuvering targets. Thus, there remains a need for systems and methods that use improved guidance laws. In addition, there remains a need for systems and methods that improve upon the prior known PN guidance laws. Specifically, there remains a need for guidance laws that guarantee shorter time-t-go requirements and larger capture areas.

SUMMARY OF THE INVENTION

Consistent with embodiments of the present invention, systems and methods are disclosed for guiding an object.

In accordance with one embodiment, an improved method for guiding an object comprises controlling the object's movement using a guidance law, the guidance law belonging to the PRONAV class comprising an additional term for improving the accuracy of navigation relative to the PRONAV class of guidance laws.

In accordance with another embodiment, a method for guiding an object to a target comprises controlling said object's movement to said target using the following guidance law: $u_s={\mathrm{Nv}}_{\mathrm{cl}}{\stackrel{.}{\lambda }}_s+\sum _{k=1}^3{u}_{\mathrm{sk}}\mathrm{where}\begin{array}{cc}{u}_{s1}\left(t\right)=N_{1s}{\stackrel{.}{\lambda }}_s^3\left(t\right),& N_{1s}>0\\ u_{s2}\left(t\right)=N_{2s}{\lambda }_s\left(t\right)\ddot{r}\left(t\right)& \end{array}$$N_{2s}\begin{array}{c}\ge 1\\ \le 1\end{array}\mathrm{if}\mathrm{sign}\text{(}\ddot{r}\left(t\right){\stackrel{.}{\lambda }}_s\left(t\right){\lambda }_s\left(t\right)\text{)}\begin{array}{c}\le 0\\ \ge 0\end{array}$$u_{s3}\left(t\right)=N_{3s}{a}_{\mathrm{Ts}}\left(t\right)$$N_{3s}\begin{array}{c}\le 1\\ \ge 1\end{array}\mathrm{if}\mathrm{sign}\text{(}{a}_{\mathrm{Ts}}\left(t\right){\stackrel{.}{\lambda }}_s\left(t\right)\text{)}\begin{array}{c}\le 0\\ \ge 0\end{array}$

In accordance with yet another embodiment, a system for guiding an object to a target comprises a sensor unit configured to sense said target and to provide one or more sensor data corresponding to said target, an estimation unit configured to provide estimation data based on at least one or more of said one or more sensor data, a guidance unit configured to calculate guidance data based at least on said estimation data, said guidance unit being configured to calculate said guidance data using at least a PRONAV guidance law and an additional term, and a flight control unit configured to provide a control signal, said control signal being based at least on said guidance data and being configured to control said object's movement to said target.

In accordance with yet another embodiment, a system for calculating guidance data configured to be used in guiding an object to a target comprises a component configured to calculate said guidance data using at least a PRONAV guidance law and an additional term.

In accordance with yet another embodiment, a system for guiding an object to a target comprises a component configured to provide a control signal, said control signal being based at least on guidance data and being configured to control said object's movement to said target, said guidance data being calculated using at least a PRONAV guidance law and an additional term in addition to said guidance law.

In accordance with yet another embodiment, a computer-readable medium comprises a set of instructions which when executed perform a method for guiding an object, the method comprising controlling said object's movement using a guidance law, said guidance law belonging to the PRONAV class comprising an additional term for improving the accuracy of navigation relative to the PRONAV class of guidance laws.

It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory only, and should not be considered restrictive of the scope of the invention, as described and claimed. Further, features and/or variations may be provided in addition to those set forth herein. For example, embodiments of the invention may be directed to various combinations and sub-combinations of the features described in the detailed description.

BRIEF DESCRIPTION OF THE DRAWINGS

The accompanying drawings, which are incorporated in and constitute a part of this disclosure, illustrate at least one embodiment and aspect of the present invention.

FIG. 1 illustrates planar engagement geometry using a Cartesian frame of coordinates consistent with an embodiment of the present invention;

FIG. 2 is a block diagram of an exemplary system consistent with an embodiment of the present invention;

FIG. 3 is a block diagram of another exemplary system consistent with an embodiment of the present invention;

FIG. 4 is a block diagram of yet another system consistent with an embodiment of the present invention;

FIG. 5 illustrates the results of a Monte Carlo simulation for a step target maneuver consistent with an embodiment of the present invention; and

FIG. 6 illustrates the results of a Monte Carlo simulation for a weaving target maneuver consistent with an embodiment of the present invention.

DETAILED DESCRIPTION

The following detailed description refers to the accompanying drawings. Wherever possible, the same reference numbers are used in the drawings and the following description to refer to the same or similar parts. While certain embodiments and features of the invention are described herein, modifications, adaptations and other implementations are possible, without departing from the spirit and scope of the invention. For example, substitutions, additions or modifications may be made to the components illustrated in the drawings, and the exemplary methods described herein may be modified by substituting, reordering, or adding steps to the disclosed methods. Accordingly, the following detailed description does not limit the invention. Instead, the proper scope of the invention is defined by the appended claims.

Systems and methods consistent with the invention comprise improved guidance laws that may improve the effectiveness of the prior known PRONAV guidance laws, for example. Regarding embodiments of the present invention, PRONAV may be used to describe a class of known guidance laws. For example, PRONAV guidance laws may include, but are not limited to, Proportional Navigation (PN) guidance laws and Augmented Proportional Navigation (APN) guidance laws. The aforementioned guidance laws are exemplary and other may comprise the PRONAV guidance laws. The improved guidance laws may be algorithmically simpler than known guidance laws because, for example, they may not be based on information about the intercept point and/or time-to-go. The improved guidance laws may be based on the Lyapunov method, and may include additional components based on the Lyapunov function's derivative's negative definiteness. The improved guidance law may be based on the partial stability of the guidance system dynamics under consideration with respect to the LOS derivative. Furthermore, the improved guidance laws may provide shorter homing times, a larger capture area, and may be used for maneuvering or non-maneuvering targets.

The improved guidance laws may be obtained as the solution of a stability problem using the Lyapunov function. The Lyapunov function may be chosen as a square of the LOS derivative for the planar case or the sum of squares of LOS derivative components for the three-dimensional case. Moreover, the improved guidance laws may be determined by the negative definiteness of the derivative of the Lyapunov function. Furthermore, the module of the Lyapunov function derivative along the engagement system's trajectory can be used as a performance index for improved guidance laws. Also, the improved guidance laws may be determined based on the system under consideration dynamics' partial stability with respect to the LOS derivative. Moreover, the improved guidance law may implement parallel navigation which is defined by the rule {dot over (λ)}(t)=0 for the planar case (where λ(t) is a LOS angle with respect to the reference axis) or {dot over (λ)}_s(t)=0, s=1,2,3, for the three-dimensional case (where λ_s(t), s=1,2,3, are LOS coordinates).

FIG. 1 illustrates engagement geometry for the planar case using a Cartesian frame of coordinates (FOC) with an inertial reference coordinate system's origin. FIG. 2 shows the planar guidance system model. y(t) is the relative separation, for example, between a missile and a target perpendicular to the X reference axis. V_M, a_M, and V_T, and a_T are the missile and target velocity and acceleration, respectively.

Using a small angle approximation, the expressions for the LOS angle and its derivatives for the planar case may be presented in the following form: $\begin{array}{cc}\lambda \left(t\right)=\frac{y\left(t\right)}{r\left(t\right)}& \left(1\right)\\ \ddot{\lambda }=-a_1\left(t\right)\lambda \left(t\right)-a_2\left(t\right)\stackrel{.}{\lambda }\left(t\right)+b_1\ddot{y}\left(t\right)\mathrm{where}& \left(2\right)\\ a_1\left(t\right)=\frac{\ddot{r}\left(t\right)}{r\left(t\right)}& \left(3\right)\\ a_2\left(t\right)=\frac{2\stackrel{.}{r}\left(t\right)}{r\left(t\right)}& \left(4\right)\\ b\left(t\right)=\frac{1}{r\left(t\right)}& \left(5\right)\\ \ddot{y}\left(t\right)=-a_M\left(t\right)+a_T\left(t\right)& \left(6\right)\end{array}$

If x₁=λ(t) and x₂={dot over (λ)}(t), the following first order differential equation system may describe, for example, the missile-target engagement: {dot over (x)}₁=x₂ {dot over (x)}₂=−a₁(t)x₁−a₂(t)x₂−b(t)u+b(t)f   (7) where the control u=a_M(t) and disturbance f=a_T(t) .

The guidance problem may be formulated as choosing control u to guarantee asymptotic stability of (7) with respect to x₂. For a non-accelerating target, f=0.

For the Lyapunov function, $\begin{array}{cc}Q=\frac{1}{2}c{x}_2^2& \left(8\right)\end{array}$ where c is a positive coefficient, its derivative along any trajectory of (7), when f=0, equals {dot over (Q)}=cx₂(−a₁(t)x₁−a₂(t)x₂−b(t)u)   (9)

Under the near collision course assumption, {umlaut over (r)}(t)=0, a₁(t)=0, and the control law that guarantees the negative definiteness of (9), i.e., the asymptotic stability of system (7) with respect to x₂ can be presented in the form: $\begin{array}{cc}u={\mathrm{kx}}_2,\mathrm{kb}\left(t\right)+a_2\left(t\right)>0\mathrm{or}k>-\frac{a_2\left(t\right)}{b\left(t\right)}& \left(10\right)\end{array}$

Introducing the closing velocity v_cl=−{dot over (r)}(t) and the effective navigation ratio N, the expression (10) can be rewritten as k>2 v_cl, and the guidance law can be presented as: u=Nv_cl{dot over (λ)}, N>2   (11)

Equation (11) shows that the present invention may yield the prior known PN guidance law when analyzed under the assumptions under which the prior known laws are used. Because proportional navigation may implement parallel navigation ({dot over (λ)}(t)=0), the laws belonging to the PN class may be compared by their closeness to parallel navigation.

The module of the Lyapunov function derivative |{dot over (Q)}(t)| (9) may comprise the performance index for comparing the PN guidance laws to the improved guidance law.

It may be assumed, for example, that there exists a capture range domain over which the control (guidance law) u(t) (11) may guarantee engagement (x₂(t)→0) . Accordingly, the following improved guidance law may provide better performance than the prior known PN guidance law (11): u=Nv_cl{dot over (λ)}(t)+N₁{dot over (λ)}³(t), N>2,N₁>0   (12)

Using the negative definiteness of the derivative of the Lyapunov function (8) in the case of a maneuvering target (f≠0) {dot over (Q)}=cx₂(−a₁(t)x₁−a₂(t)x₂−b(t)u+b(t)f)   (13)

The negative definiteness of (13) may be established for a₁(t)≠0 and a₂(t)≦0 if the control u is as follows: $\begin{array}{cc}u={\mathrm{Nv}}_{\mathrm{cl}}\stackrel{.}{\lambda }\left(t\right)+N_1{\stackrel{.}{\lambda }}^3\left(t\right)-N_2\lambda \left(t\right)\ddot{r}\left(t\right)+N_3{a}_T\left(t\right)N>2,N_1>0,N_2\begin{array}{c}\ge 1\\ \le 1\end{array}\mathrm{if}\mathrm{sign}\text{(}\ddot{r}\left(t\right)\stackrel{.}{\lambda }\left(t\right)\lambda \left(t\right)\text{)}\begin{array}{c}\le 0\\ \ge 0\end{array}{N}_3\begin{array}{c}\le 1\\ \ge 1\end{array}\mathrm{if}\mathrm{sign}\left(a_T\left(t\right)\stackrel{.}{\lambda }\left(t\right)\right)\begin{array}{c}\le 0\\ \ge 0\end{array}& \left(14\right)\end{array}$

The improved guidance law (14) may be presented as the sum of the PN guidance law and additional correcting controls, as follows: $\begin{array}{cc}u={\mathrm{Nv}}_{\mathrm{cl}}\stackrel{.}{\lambda }+\sum _{k=1}^3{u}_k\mathrm{where}& \left(15\right)\\ u_1\left(t\right)=N_1{\stackrel{.}{\lambda }}^3\left(t\right),N_1>0& \left(16\right)\\ u_2\left(t\right)=N_2\lambda \left(t\right)\ddot{r}\left(t\right)& \left(17\right)\\ u_3\left(t\right)=N_3{a}_T\left(t\right)& \left(18\right)\end{array}$

Each of the controls u_k (k=1,2,3) may increase the effectiveness of the improved navigation law with respect to the criterion chosen. The number controls applied in practice may depend on the problem under consideration, for example, target distances, LOS angles, maneuvering or non-maneuvering targets, as well as the systems ability to realize the correction control in practice.

The coefficients N₁ through N₃ may be determined based on simulation results of the whole system taking into account, for example, the autopilot limits on a missile acceleration, airframe dynamics, and other factors. That is the coefficients may be determined in the same way as the most appropriate values N=3-4 were established for the PN laws.

The three-dimensional case may be considered analogous to the planar case ( see R. Yanushevsky, “New Multidimensional Midcourse and Homing Guidance Laws and Their Comparison with the PN and Kappa Guidance Laws,” TSC-W242-001/rty, June 2003.)

Embodiments of the present invention may be used in all phases of guiding an object, for example, to a target. For example, embodiments consistent with the invention may be used during, a boost phase, a mid-course phase, a homing phase, an intercept, a rendezvous phase, and during general battlefield guidance. Furthermore, embodiments consistent with the invention may be used in navigation comprising two (2) dimensions (planar case), three (3) dimensions; step and weaving maneuvers, homing and mid-course guidance.

An embodiment consistent with the invention may comprise a system for guiding an object to a target system. The target may be moving or non-moving. The object may comprise, for example, a tactical or strategic weapon, including for example, a guided missile. The aforementioned are exemplary, and the object may comprise any element capable of being guided to a target. The system may comprise a sensor unit, estimation unit, guidance unit, and control unit. The system, for example, may be operative to control the object's movement to the target using the following guidance law: $u_s={\mathrm{Nv}}_{\mathrm{cl}}{\stackrel{.}{\lambda }}_s+\sum _{k=1}^3{u}_{\mathrm{sk}}\mathrm{where}\begin{array}{cc}{u}_{s1}\left(t\right)=N_{1s}{\stackrel{.}{\lambda }}_s^3\left(t\right),& N_{1s}>0\\ u_{s2}\left(t\right)=N_{2s}{\lambda }_s\left(t\right)\ddot{r}\left(t\right)& \end{array}$$N_{2s}\begin{array}{c}\ge 1\\ \le 1\end{array}\mathrm{if}\mathrm{sign}\text{(}\ddot{r}\left(t\right){\stackrel{.}{\lambda }}_s\left(t\right){\lambda }_s\left(t\right)\text{)}\begin{array}{c}\le 0\\ \ge 0\end{array}$$u_{s3}\left(t\right)=N_{3s}{a}_{\mathrm{Ts}}\left(t\right)$$N_{3s}\begin{array}{c}\le 1\\ \ge 1\end{array}\mathrm{if}\mathrm{sign}\text{(}{a}_{\mathrm{Ts}}\left(t\right){\stackrel{.}{\lambda }}_s\left(t\right)\text{)}\begin{array}{c}\le 0\\ \ge 0\end{array}$

An improved method for guiding an object may comprise controlling an object's movement using a guidance law. The guidance law may belong to the PRONAV class and including an additional term (terms) for improving the accuracy of navigation relative to the PRONAV class of guidance laws. The additional term may be characterizable by the term u_s1(t)=N_1s{dot over (λ)}_s³(t), N_1s>0 for increasing the effectiveness of the PRONAV guidance law for large line of sight (LOS) rates (it may have a small effect for small line of sight (LOS) rates). Moreover, the aforementioned method may further comprise calculating a closing velocity for the object and estimating a derivative of the closing velocity. The additional term may comprise a shaping component for influencing the terminal velocity of the object. The shaping component may be characterizable by the term $u_{s2}\left(t\right)=N_{2s}{\lambda }_s\left(t\right)\ddot{r}\left(t\right)\mathrm{where}{N}_{2s}\begin{array}{c}\ge 1\\ \le 1\end{array}\mathrm{if}\mathrm{sign}\text{(}\ddot{r}\left(t\right){\stackrel{.}{\lambda }}_s\left(t\right){\lambda }_s\left(t\right)\text{)}\begin{array}{c}\le 0\\ \ge 0\end{array}.$

Furthermore, the aforementioned method may further include the additional term being sensitive to sign(a_Ts(t){dot over (λ)}_s(t)) for increasing the effectiveness of the guidance law and being characterizable by the term $u_{s3}\left(t\right)=N_{3s}{a}_{\mathrm{Ts}}\left(t\right)\mathrm{where}{N}_{3s}\begin{array}{c}\le 1\\ \ge 1\end{array}\mathrm{if}\mathrm{sign}\text{(}{a}_{\mathrm{Ts}}\left(t\right){\stackrel{.}{\lambda }}_s\left(t\right)\text{)}\begin{array}{c}\le 0\\ \ge 0\end{array}.$

The “cubic” term u_s1(t)=N_1s{dot over (λ)}_s³(t), for example, with a properly chosen gain N_1s, may increase the effectiveness of the PN guidance law for relatively large LOS rates and may have an insignificant effect for small LOS rates. The “cubic” term may not require any additional measurements compared, for example, to the PN guidance law. The “cubic” term may work with the PN law, for example, with or without other additional terms.

The term u_s2(t)=N_2sλ_s(t){umlaut over (r)}(t) may work as a shaping component and may influences an object's terminal velocity. This term may require the measurement of the closing velocity and an estimate of its derivative. Closing velocity may not be a fast changing parameter and the measurement of its derivative may be easily estimated in practice. This term can work, for example, with the PN guidance law, with or without other additional terms.

In addition, the term u_s3(t)=N_3sa_Ts(t) may be distinguished from the APN law term by the value of its gain, which may depend upon sign(a_Ts(t){dot over (λ)}_s(t)). This term can work with, for example, the PN guidance law with or without other additional terms.

By way of a non-limiting example, FIG. 3 illustrates a system in which the features and principles of the present invention may be implemented. As illustrated in the block diagram of FIG. 3, the system, implemented within a missile 300, may include a sensor unit 305, an estimation unit 310, a guidance unit 315, and a flight control unit 320.

The aforementioned units may comprise any suitable combination of hardware, software and/or firmware. Furthermore, the aforementioned units may be practiced in an electrical circuit comprising discrete electronic elements, packaged or integrated electronic chips containing logic gates, a circuit utilizing a microprocessor, or on a single chip containing electronic elements or microprocessors. Moreover, the aforementioned units may be practiced using other technologies capable of performing logical operations such as, for example, AND, OR, and NOT, including but not limited to mechanical, optical, fluidic, and quantum technologies. In addition, the aforementioned units may be practiced within a general purpose computer or in any other circuits or systems.

Sensor unit 305 may comprise a sensor unit configured to sense the target and to provide one or more sensor data corresponding to the target. The one or more sensor data may comprise one or more of line of sight rate, closing velocity, relative range, relative range rate, and target acceleration. The aforementioned sensor data are exemplary and the sensor data may comprise other elements.

Estimation unit 310 may comprise an estimation unit configured to provide estimation data based on at least one or more of the one or more sensor data. The estimation data may comprise at least line of sight, line of sight rate, closing velocity rate, time-to-go, relative range, predicted intercept point, and target acceleration. The aforementioned estimation data are exemplary and the estimation data may comprise other elements.

Guidance unit 315 may comprise a guidance unit or component configured to calculate guidance data based at least on the estimation data. The guidance unit 315 may be configured to calculate the guidance data using at least a PRONAV guidance law and an additional term as described above. Flight control unit 320 may comprise a flight control unit or component configured to provide a control signal. The control signal may be based at least on the guidance data and may be configured to control the object's movement to the target.

FIG. 4 is another embodiment consistent with the present invention. As shown in FIG. 4, sensor unit 305, estimation unit 310, and guidance unit 315 may be located remotely in location 425 from flight control unit 320 in a missile 300′. Notwithstanding, anyone or any ones of sensor unit 305, estimation unit 310, guidance unit 315, and flight control unit 320 may be located remotely from anyone or ones of the aforementioned units. Location 425 may comprise a ship, an airplane, a tank, a vehicle, an armored vehicle, or any location capable of containing anyone or ones of the aforementioned units.

Any unit or units located in location 425 may communicate via wire or wirelessly with any unit or units located in missile 300′ via communication interfaces 430 and 435. Wireless can be defined as radio transmission via the airwaves. However, it may be appreciated that various other communication techniques can be used to provide wireless transmission, including infrared line of sight, cellular, microwave, satellite, packet radio, and spread spectrum radio. The aforementioned wireless techniques are exemplary and others may be used.

OPERATIONAL EXAMPLES

FIG. 2 shows a linearized planar missile guidance model used for the above operational examples as described, for example, in R. T. Yanushevsky, “New Multidimensional Midcourse and Homing Guidance Laws and Their Comparison with the PN and Kappa Guidance Laws,” TSC-W242-001/rty, June 2003; R. T. Yanushevsky and W. J. Boord, “A New Approach to Guidance Law Design,” AIAA Guidance, Navigation, and Control Conference, Austin, 2003, AIAA-2003-4770.

Here R_TM is the range r between a missile and a target and {circumflex over (R)}_TM is its estimate. The flight control dynamics is presented by a third order transfer function as follows with damping ζ and natural frequency ω, the flight control system time constant τ, and the right-half plane zero ω_z: $W\left(s\right)=\frac{1-\frac{s^2}{{\omega }_z^2}}{\left(1+\tau s\right)\left(1+\frac{2\xi }{\omega }s+\frac{s^2}{{\omega }^2}\right)}$ Four guidance laws are considered: i) proportional navigation; ii) augmented proportional navigation; iii) nonlinear guidance as discussed above, without measurements of target acceleration; and iv) nonlinear guidance utilizing target acceleration measurements.

The effectiveness of the invention may be demonstrated by operational examples in FIG. 5 and FIG. 6 (tf is time of flight), which present Monte-Carlo simulations using the planar model in FIG. 2 for the step (FIG. 5) and weaving (FIG. 6) target maneuvers, respectively. FIG. 5 corresponds to a 3 g step target maneuver with a 10 g acceleration limit for an intercept missile flight control system with time lag 1 s, natural frequency 20 r/s, damping 0.7, and the right-half plane zero 5 r/s. For the example in FIG. 5, the proportional navigation gain N equals 4 and the closing velocity is 1219.2 m/s.

FIG. 6 corresponds to a 8 g ‘bang-bang’ target commanded acceleration that characterizes a weaving maneuver with period about 3.6 s. The target dynamics are taken into consideration (the target flight control system parameters are: time lag 0.15 s, a natural frequency 2 r/s, a damping 0.8, and the right-half plane zero 15 r/s) so that the real target acceleration is the result of the transformation of the ‘bang-bang’ periodic signal with 8 g amplitude by the third order dynamic unit with the above mentioned parameters. The intercept missile flight control system has an acceleration limit 40 g, time lag 0.1 s, a natural frequency of 5 r/s, a damping 0.65, and the right-half plane zero 30 r/s. The proportional navigation gain N equals 3 and closing velocity is 7000 m/s.

FIG. 5 and FIG. 6 show the result of Monte-Carlo simulation (50 runs with a measurement noise standard deviation of 1 mr) for the flight time 10 s and 15 s, respectively. Dotted lines correspond to the PN law (lines 505 and 605 in FIG. 5 and FIG. 6 respectively.) Dash-dotted lines correspond to the APN law (lines 510 and 610 in FIG. 5 and FIG. 6 respectively.) Consistent with embodiments of the inventions, the solid lines (lines 515 and 615 in FIG. 5 and FIG. 6 respectively) reflect the influence of the “cubic” term with gain N₁=40000 V_cl. And the lines with asterisk (lines 520 and 620 in FIG. 5 and FIG. 6 respectively) reflect the influence of the “cubic” term and the target acceleration term with gain 0.5/1.25 and 1/1.75, respectively. Because here the closing velocity is constant, the shaping terms do not influence the result. As shown in FIG. 5 and FIG. 6, the influence of the “cubic” term and a target acceleration term, for example, may provide a vast improvement over the PN and APN guidance laws.

While certain features and embodiments of the invention have been described, other embodiments of the invention will be apparent to those skilled in the art from consideration of the specification and practice of the embodiments of the invention disclosed herein. Furthermore, although embodiments of the present invention have been described as being associated with data stored in memory and other storage mediums, one skilled in the art will appreciate that these aspects can also be stored on or read from other types of computer-readable media, such as secondary storage devices, hard disks, floppy disks, a CD-ROM, a carrier wave from the Internet, or other forms of RAM or ROM. Further, the steps of the disclosed methods may be modified in any manner, including by reordering steps and/or inserting or deleting steps, without departing from the principles of the invention.

It is intended, therefore, that the specification be considered as exemplary only, with the true scope and spirit of the invention being indicated by the following claims and their full scope of equivalents.

Claims

1. An improved method for guiding an object, comprising controlling said object's movement using a guidance law, said guidance law comprising a PRONAV guidance law further comprising one or more additional terms for improving the accuracy of guidance relative to the PRONAV guidance law.

2. The method of claim 1, wherein said additional term being characterizable by the term us1(t)=N1s{dot over (λ)}s3(t), N1s>0, for increasing the effectiveness of said PRONAV guidance law for large line of sight (LOS) rates and has a small effect for small line of sight (LOS) rates.

3. The method of claim 1, further comprising: calculating a closing velocity for said object; and estimating a derivative of said closing velocity, said additional term comprising a shaping component for influencing the terminal velocity of said object, said shaping component being characterizable by the term us2⁡(t)=N2⁢s⁢λs⁡(t)⁢r¨⁡(t)⁢ ⁢where⁢ ⁢N2⁢s⁢≥1≤1⁢ ⁢if⁢ ⁢sign⁢ ⁢(r¨⁡(t)⁢λ.s⁡(t))⁢≤0≥0.

4. The method of claim 1, further comprising said additional term being sensitive to sign(aTs(t){dot over (λ)}s(t)) for increasing the effectiveness of said guidance law and being characterizable by the term

5. A method for guiding an object to a target, the method comprising controlling said object's movement to said target using the following guidance law:

6. The method of claim 5, further comprising selecting said us1(t)=N1s{dot over (λ)}s3(t) term wherein said term N1s is selected to increase the effectiveness of said guidance law for large relative line of sight rates and has a minimal effect for small line of sight rates, to provide a more accurate result in a proportional navigation law than if said us1(t)=N1s{dot over (λ)}s3(t) term is zero.

7. The method of claim 5, further comprising selecting said term us2(t)=N2sλs(t){umlaut over (r)}(t), wherein selecting said term us2(t)=N2sλs(t){umlaut over (r)}(t) further comprises: measuring a closing velocity of said object; and calculating a derivative of said measured closing velocity wherein the effectiveness of said guidance law provides a more accurate result in said proportional navigation law than if said us2(t)=N2sλs(t){umlaut over (r)}(t) term were zero.

8. The method of claim 7, wherein calculating said derivative of said measured closing velocity further comprises estimating said derivative of said measured closing velocity.

9. The method of claim 5, further comprising selecting said term us3(t)=N3saTs(t) comprising measuring an acceleration of said target to provide a more accurate result than the augmented proportional navigation law (APN) that does not contain sign(aTs(t){dot over (λ)}s(t)).

10. The method of claim 9, further comprising calculating said target acceleration comprising estimating said measured target acceleration.

11. The method of claim 5, wherein said target is maneuvering.

12. The method of claim 5, wherein said target is non-maneuvering.

13. A system for guiding an object to a target, the system comprising: a sensor unit configured to sense said target and to provide one or more sensor data corresponding to said target; an estimation unit configured to provide estimation data based on at least one or more of said one or more sensor data; a guidance unit configured to calculate guidance data based at least on said estimation data, said guidance unit being configured to calculate said guidance data using at least a PRONAV guidance law and one or more additional terms; and a flight control unit configured to provide a control signal, said control signal being based at least on said guidance data and being configured to control said object's movement to said target.

14. The system of claim 13, wherein said one or more sensor data comprises at least one of line of sight rate, closing velocity, relative range, relative range rate, and target acceleration.

15. The system of claim 13, wherein said estimation data comprises at least line of sight, line of sight rate, closing velocity rate, time-to-go, relative range, predicted intercept point, and target acceleration.

16. The system of claim 13, wherein said additional term comprises one of: a) a first term; b) a second term; c) a third term; d) a summation of two of said first term, said second term, and said third term; and e) a summation of said first term, said second term, and said third term, wherein: said first term is characterizable by the following expression: us1(t)=N1s{dot over (λ)}s3(t), N1s>0, said second term is characterizable by the following expression: us2⁡(t)=N2⁢s⁢λs⁡(t)⁢r¨⁡(t),where⁢ N2⁢s⁢≥1≤1⁢ ⁢if⁢ ⁢sign⁢ ⁢(r¨⁡(t)⁢λ.s⁡(t)⁢λs⁡(t))⁢≤0≥0,andsaid third term is characterizable by the following expression: us3⁡(t)=N3⁢s⁢aTs⁡(t),where⁢ ⁢N3⁢s⁢≤1≥1⁢ ⁢if⁢ ⁢sign⁢ ⁢(aTs⁡(t)⁢λ.s⁡(t))⁢≤0≥0

17. The system of claim 13, wherein said additional term comprises one or more terms selected from the group consisting of: a) a first term; b) a second term; and c) a third term, wherein: said first term is characterizable by the following expression: us1(t)=N1s{dot over (λ)}s3(t), N1s>0, said second term is characterizable by the following expression: us2⁡(t)=N2⁢s⁢λs⁡(t)⁢r¨⁡(t),where⁢ N2⁢s⁢≥1≤1⁢ ⁢if⁢ ⁢sign⁢ ⁢(r¨⁡(t)⁢λ.s⁡(t)⁢λs⁡(t))⁢≤0≥0,andsaid third term is characterizable by the following expression: us3⁡(t)=N3⁢s⁢aTs⁡(t),where⁢ ⁢N3⁢s⁢≤1≥1⁢ ⁢if⁢ ⁢sign⁢ ⁢(aTs⁡(t)⁢λ.s⁡(t))⁢≤0≥0

18. The system of claim 13, wherein any one or more of said sensor unit, said estimation unit, said guidance unit, and said flight control unit is located remote from said object.

19. A system for calculating guidance data configured to be used in guiding an object to a target, the system comprising a component configured to calculate said guidance data using at least a PRONAV guidance law and an additional term.

20. The system of claim 19, wherein said guidance law is selected from the group consisting of: proportional navigation guidance law, and augmented proportional navigation guidance law, a modified proportional navigation guidance law, and a modified augmented proportional navigation guidance law.

21. The system of claim 19, wherein said additional term is selected from the group consisting of: a) a first term; b) a second term; c) a third term; d) a summation of two of said first term, said second term, and said third term; and e) a summation of said first term, said second term, and said third term, wherein said first term increases effectiveness of controlling said object's movement to said target for relatively large LOS rates than if said first term were zero, said second term works as a shaping component, influences missile terminal velocity, and requires the measurement of the closing velocity and an estimate of its derivative, and said third term depends on a target acceleration or its estimate.

22. The system of claim 19, wherein said additional term comprises one of: a) a first term; b) a second term; c) a third term; d) a summation of two of said first term, said second term, and said third term; and e) a summation of said first term, said second term, and said third term, wherein said first term is characterizable by the following expression us1(t)=N1s{dot over (λ)}s3(t), N1s>0, said second term is characterizable by the following expression: us2⁡(t)=N2⁢s⁢λs⁡(t)⁢r¨⁡(t),where⁢ N2⁢s⁢≥1≤1⁢ ⁢if⁢ ⁢sign⁢ ⁢(r¨⁡(t)⁢λ.s⁡(t)⁢λs⁡(t))⁢≤0≥0,andsaid third term is characterizable by the following expression: us3⁡(t)=N3⁢s⁢aTs⁡(t),where⁢ ⁢N3⁢s⁢≤1≥1⁢ ⁢if⁢ ⁢sign⁢ ⁢(aTs⁡(t)⁢λ.s⁡(t))⁢≤0≥0.

23. The system of claim 19, wherein said additional term comprises one or more terms selected from the group consisting of: a) a first term; b) a second term; and c) a third term, wherein said first term is characterizable by the following expression: us1(t)=N1s{dot over (λ)}s3(t), N1s>0, said second term is characterizable by the following expression: us2⁡(t)=N2⁢s⁢λs⁡(t)⁢r¨⁡(t),where⁢ N2⁢s⁢≥1≤1⁢ ⁢if⁢ ⁢sign⁢ ⁢(r¨⁡(t)⁢λ.s⁡(t)⁢λs⁡(t))⁢≤0≥0,andsaid third term is characterizable by the following expression: us3⁡(t)=N3⁢s⁢aTs⁡(t),where⁢ ⁢N3⁢s⁢≤1≥1⁢ ⁢if⁢ ⁢sign⁢ ⁢(aTs⁡(t)⁢λ.s⁡(t))⁢≤0≥0

24. The system of claim 19, wherein said component configured to calculate said guidance data is located remote from said object.

25. A system for guiding an object to a target, the system comprising a component configured to provide a control signal, said control signal being based at least on guidance data and being configured to control said object's movement to said target, said guidance data being calculated using at least a PRONAV guidance law and one or more additional terms.

26. The system of claim 25, wherein said guidance law is selected from the group consisting of: proportional navigation guidance law, and augmented proportional navigation guidance law, a modified proportional navigation guidance law, and a modified augmented proportional navigation guidance law.

27. The system of claim 25, wherein said additional term is selected from the group consisting of: a) a first term; b) a second term; c) a third term; d) a summation of two of said first term, said second term, and said third term; and e) a summation of said first term, said second term, and said third term, wherein said first term increases effectiveness of controlling said object's movement to said target for relatively large LOS rates than if said first term were zero, said second term works as a shaping component, influences missile terminal velocity, and requires the measurement of the closing velocity and an estimate of its derivative, and said third term depends on a target acceleration or its estimate.

28. The system of claim 25, wherein said additional term comprises one of: a) a first term; b) a second term; c) a third term; d) a summation of two of said first term, said second term, and said third term; and e) a summation of said first term, said second term, and said third term, wherein said first term is characterizable by the following expression: us1(t)=N1s{dot over (λ)}s3(t), N1s>0, said second term is characterizable by the following expression: us2⁡(t)=N2⁢s⁢λs⁡(t)⁢r¨⁡(t),⁢where⁢ ⁢N2⁢s⁢≥1≤1⁢ ⁢if⁢ ⁢sign⁢ ⁢(r¨⁡(t)⁢λ.s⁡(t)⁢λs⁡(t))⁢≤0≥0,andsaid third term is characterizable by the following expression: us3⁡(t)=N3⁢s⁢aTs⁡(t),where⁢ ⁢N3⁢s⁢≤1≥1⁢ ⁢if⁢ ⁢sign⁢ ⁢(aTs⁡(t)⁢λ.s⁡(t))⁢≤0≥0

29. The system of claim 25, wherein said additional term comprises one or more terms selected from the group consisting of: a) a first term; b) a second term; and c) a third term, wherein said first term is characterizable by the following expression: us1(t)=N1s{dot over (λ)}s3(t), N1s>0, said second term is characterizable by the following expression: us2⁡(t)=N2⁢s⁢λs⁡(t)⁢r¨⁡(t),⁢where⁢ ⁢N2⁢s⁢≥1≤1⁢ ⁢if⁢ ⁢sign⁢ ⁢(r¨⁡(t)⁢λ.s⁡(t)⁢λs⁡(t))⁢≤0≥0,andsaid third term is characterizable by the following expression: us3⁡(t)=N3⁢s⁢aTs⁡(t),where⁢ ⁢N3⁢s⁢≤1≥1⁢ ⁢if⁢ ⁢sign⁢ ⁢(aTs⁡(t)⁢λ.s⁡(t))⁢≤0≥0

30. The system of claim 25, wherein said component configured to provide said control signal is located remote from said object.

31. The system of claim 25, wherein said additional term provides better miss distance accuracy than using one of the PRONAV law, without said additional term.

32. A computer-readable medium comprising a set of instructions which when executed perform a method for guiding an object, the method comprising controlling said object's movement using a guidance law, said guidance law comprising a PRONAV guidance law further comprising one or more additional terms, for improving the accuracy of guidance relative to the PRONAV class of guidance laws.

33. The computer-readable medium of claim 32, wherein said guidance law is a PRONAV guidance law, and said additional term being characterizable by the term us1(t)=N1s{dot over (λ)}s3(t) (N1s>0) for increasing the effectiveness of said PRONAV guidance law for large line of sight (LOS) rates and has a small effect for small line of sight (LOS) rates.

34. The computer-readable medium of claim 32, wherein said guidance law is a PRONAV guidance law, the computer-readable medium further comprising: calculating a closing velocity for said object; and estimating a derivative of said closing velocity, said additional term comprises a shaping component for influencing the terminal velocity of said object, said shaping component being characterizable by the term us2⁡(t)=N2⁢s⁢λs⁡(t)⁢r¨⁡(t)where⁢ ⁢N2⁢s⁢≥1≤1⁢ ⁢if⁢ ⁢sign⁢ ⁢(r¨⁡(t)⁢λ.s⁡(t)⁢λs⁡(t))⁢≤0≥0.

35. The computer-readable medium of claim 32, wherein said guidance law is a PRONAV guidance law, further comprising said additional term being sensitive to sign(aTs(t){dot over (λ)}s(t)) for increasing the effectiveness of said guidance law and being characterizable by the term