Abstract:
A method of guiding aerial vehicles to a target site in adverse weather conditions wherein the method regulates the range indirectly by regulating heading error to an offset target that revolves around the true target site. The improved guidance architecture is effective in adverse weather conditions, such as high winds.

Description:
CROSS-REFERENCE TO RELATED APPLICATIONS 
       [0001]    This application claims priority to U.S. Provisional Patent Application Nos. 61/220,772 entitled “An Improved Method of Guidance of Unmanned Aerial Vehicles in Challenging Environmental Conditions” filed on Jun. 26, 2009, which is incorporated fully herein by reference. 
     
    
     TECHNICAL FIELD 
       [0002]    The present invention relates to unmanned aerial vehicle guidance and more particularly, relates to a method of guiding aerial vehicles to a target site in adverse weather conditions. 
       BACKGROUND INFORMATION 
       [0003]    The primary field of application for this invention is to guidance of unmanned aerial vehicles (UAVs). A common characteristic among unmanned aerial vehicles is that they are capable of flying at air speeds that are marginally greater than winds speeds that are commonly encountered when flying at a low altitude and/or close to the ground, or around nearby buildings when flown in an urban environment. In such situations, a critical issue is maintaining an intended maneuver (such as flying a precise turn or circling over a target site), flying through confined air space, or maintaining a formation with respect to another air vehicle (for purposes of collision avoidance). 
         [0004]    Ideally a guidance system in such cases should be as robust as possible in its ability to reject the disturbing effects of winds and wind gusts using only GPS data. Presented herewith is a method for precise circling about a target site based on the concept of minimizing the relative degree of the output being regulated, which is an improvement over current guidance strategy. These concepts are generally applicable to other guidance objectives as well. 
       SUMMARY 
       [0005]    The present invention features a method of guiding an aerial vehicle to an intended target site and for maintaining a circular path above an intended target site by the aerial vehicle, and for regulating range error to the target site by regulating heading error to an offset target site. The method comprises the acts of obtaining information relative to estimated horizontal distance between the aerial vehicle and the intended target site, and then calculating an instantaneous heading between a current position of the aerial vehicle and an offset target site thereby utilizing the calculated instantaneous heading between a current position of the aerial vehicle and an offset target site for guiding the aerial vehicle to the intended target site. 
         [0006]    Also disclosed is a method of guiding aerial vehicles to a target site comprising the acts of calculating a desired heading error, δψ d , using a first equation δψ d =V h /R d K ψ ; calculating an angle θ using a second equation: θ=π/2−δψ d ; calculating cos φ using a third equation cos φ=1−2 cos 2 θ; calculating an angle ε using a fourth equation 
         [0000]    
       
         
           
             
               ɛ 
               = 
               
                 
                   tan 
                   
                     - 
                     1 
                   
                 
                  
                 
                   ( 
                   
                     
                       
                         R 
                         d 
                       
                        
                       sin 
                        
                       
                           
                       
                        
                       φ 
                     
                     
                       
                         R 
                         e 
                       
                       - 
                       
                         
                           R 
                           d 
                         
                          
                         cos 
                          
                         
                             
                         
                          
                         φ 
                       
                     
                   
                   ) 
                 
               
             
             ; 
           
         
       
     
         [0000]    and calculating a heading error relative to an offset target site (δψ) by first calculating the heading error relative to a true target site and subtracting the calculated angle ε. 
     
    
     
       BRIEF DESCRIPTION OF THE DRAWINGS 
         [0007]    These and other features and advantages of the present invention will be better understood by reading the following detailed description, taken together with the drawings wherein: 
           [0008]      FIG. 1  is a block diagram of a conventional, prior art guidance architecture for regulating range to a fixed point; 
           [0009]      FIG. 2  is a block diagram of the guidance architecture of the present invention; 
           [0010]      FIG. 3  details the geometry at the tangent point; 
           [0011]      FIG. 4  details the geometry for an improved circling approach; and 
           [0012]      FIG. 5  details the geometry on the way to the target site. 
       
    
    
     DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 
       [0013]    One of the issues with regard to operating in a high wind environment concerns the ability to maintain a precise trajectory. An example is flying a precision circle at a desired range (R d ) over a target site. The classical approach to this problem, which is well known to those skilled in guidance system development, is to use a guidance architecture in which range error (δR) is regulated in the guidance law. A typical block diagram of such an architecture is depicted in  FIG. 1  in which a proportional plus integral (P+I) guidance law is used to regulate the range error in the outer loop, and a proportional plus derivative (P+D) inner loop feedback control of heading error (δψ) is used to improve the stability characteristics of the UAV. The heading error in this case is computed relative to a desired heading that is perpendicular to the line-of-sight (LOS) to the target. 
         [0014]    Range error is more difficult to regulate than heading error because of its relative degree, which is the number of times it has to be differentiated with respect to time before the effect of the control variable (u) appears, is higher. It is apparent from  FIG. 1  that the relative degree of range (R) is one greater than the relative degree of heading error since δψ is proportional to range rate and has to be integrated once to obtain R. 
         [0015]    It is advantageous from a dynamics viewpoint to regulate range indirectly by regulating heading error to an offset target that revolves around the true target site. A typical block diagram illustrating this architecture is shown in  FIG. 2 . 
         [0016]    In one embodiment of the invention, it would be preferable to calculate the desired heading to an offset target site. Circular motion about a target site can be achieved by guiding towards a point that is offset from the target in a direction that is perpendicular to the instantaneous LOS to the target site. As the target is approached, the offset point naturally begins to rotate about the target. One possibility is to choose a constant value for the offset. This is adequate in the absence of winds, but will typically result in distorted motions about the target site under high wind conditions. A better approach is to make the offset value a function of horizontal velocity, and choose it so that the turn rate commanded by the guidance law matches the turn rate needed to maintain the offset distance from the target site (maintain a circular trajectory) at the point where the flight direction first becomes perpendicular to the LOS. Assuming the guidance law commands a turn rate proportional to the heading error, then: 
         [0000]      {dot over (ψ)}&amp; com   =K   psi *δψ  (1),
 
         [0000]    where δψ is the heading error. It is desirable that the command turn rate match the turn rate needed to maintain a circular path around the target site when the velocity is tangent to that circle. 
         [0017]      FIG. 3  shows that δψ=π/4. The turn rate needed for circular motion is V h /offset, where V h  is the instantaneous horizontal velocity. Therefore, substituting π/4 for δψ in (1) and equating the result to V h /offset, we obtain: 
         [0000]      offset= V   h /( K   psi *δψ)=4 V   h   /πK   psi   (2).
 
         [0000]    While this guidance law does degenerate into a circular motion about the target site, it does not provide an independent means for regulating the radius of the circle. 
         [0018]    An alternate embodiment of the present invention is to command an offset equal to the desired range, and instead use the angle that the offset radius makes with the instantaneous LOS as the control variable. This is depicted as the angle θ in  FIG. 4 .  FIG. 4  shows the aerial vehicle flying a circular path of desired radius R d  about the target site  12 , with its horizontal velocity  14  vector perpendicular to the LOS  16 , and chasing the offset target  18  located at the same distance from the target site  12 . The heading error (δψ d ) relative to the desired heading C is also depicted. This is the heading error, which when multiplied by K psi  (see Eq. (2)) results in a turn rate (V h /R d ) consistent with maintaining a circular path. From  FIG. 4  it can be seen that: 
         [0000]      θ=π/2−δψ d   (3)
 
         [0000]    From the geometry it follows that: 
         [0000]        C   2 =2 R   d   2 (1−cos φ)  (4)
 
         [0000]      and: 
         [0000]        R   d   2   +C   2 −2 R   d   C  cos θ= R   d   2   (5)
 
         [0000]    Using Eq. (4) to eliminate C in Eq. (5) we get: 
         [0000]      cos φ=1−2 cos 2 θ  (6)
 
         [0000]    as one of the main conditions required in order to maintain a circular path about the target site  12 , regardless of the desired radius, R d . Since Eq. (1) also has to be satisfied, then: 
         [0000]      {dot over (ψ)}&amp; c   =K   psi *δψ d   =V   h   /R   d   (7)
 
       Solving Eq. (7) for δψ d  we get: 
       [0019]      δψ d   =V   h   /R   d   K   ψ   (8)
 
         [0000]    as the second required condition. 
         [0020]      FIG. 5  depicts the geometry that exists as the aerial vehicle is flying towards the target site area  112 , prior to entering its spiraling turn. The GPS estimated horizontal distance to the target  112  is denoted R e . The angle δψ is the heading error relative to the offset target site  118 , whose offset angle satisfies Eq. (8). From this geometry the angle ε satisfies: 
         [0000]    
       
         
           
             
               
                 
                   ɛ 
                   = 
                   
                     
                       tan 
                       
                         - 
                         1 
                       
                     
                      
                     
                       ( 
                       
                         
                           
                             R 
                             d 
                           
                            
                           sin 
                            
                           
                               
                           
                            
                           φ 
                         
                         
                           
                             R 
                             e 
                           
                           - 
                           
                             
                               R 
                               d 
                             
                              
                             cos 
                              
                             
                                 
                             
                              
                             φ 
                           
                         
                       
                       ) 
                     
                   
                 
               
               
                 
                   ( 
                   9 
                   ) 
                 
               
             
           
         
       
     
         [0000]    The sequence of calculations for the improved logic for spiraling into a circular path at a specified radius, R d , is summarized by the following computational steps:
       1. Calculate the desired heading error, δψ d , using Eq. (8).   2. Calculate the angle θ using Eq. (3).   3. Calculate cos φ using Eq. (6)   4. Calculate the angle ε using Eq. (9).   5. Calculate the heading error relative to the offset target site  118  (δψ in  FIG. 5 ) by first calculating the heading error relative to the true target site  112  and subtracting the angle ε.       
 
         [0026]      FIG. 5  is an illustration of how the guidance problem of regulating range error to a target site can be converted into an equivalent guidance problem of regulating heading error to an offset target. The equivalent problem is obtained by deriving a nonlinear transformation of desired range into an equivalent desired heading error as outlined in steps 1-5 above. This transformation is utilized to calculate the desired heading to offset target  210  as shown in  FIG. 2 . The resulting guidance architecture in  FIG. 2  is a more robust approach to guidance under high wind conditions because the relative degree of heading error is one less than the relative degree of range error. In general, those familiar with the art of guidance law development should appreciate the fact that this same concept of transforming a guidance problem into an equivalent problem of regulating an error signal of lesser relative degree can be applied to other mission oriented guidance objectives such as flying through a narrow corridor or maintaining a fixed position relative to another UAV for purposes of formation flight. The ultimate goal should be to seek an equivalent guidance architecture that requires regulating of an error signal having minimum relative degree. This approach to guidance law development can be regarded as more natural (perhaps even biologically inspired) method for achieving precision maneuvering in high wind environments, because the lower the degree of the regulated output variable, the more accurately the guidance objective can be achieved under difficult environmental conditions such as those due to high winds. 
         [0027]    Modifications and substitutions by one of ordinary skill in the art are considered to be within the scope of the present invention, which is not to be limited except by the following claims.