WO2013174559A1

WO2013174559A1 - Method and device for estimating a wind field

Info

Publication number: WO2013174559A1
Application number: PCT/EP2013/057026
Authority: WO
Inventors: Alexander Philip HALL; Trygve Frederik Marton; Petter Muren
Original assignee: Prox Dynamics As
Priority date: 2012-05-25
Filing date: 2013-04-03
Publication date: 2013-11-28

Abstract

Local wind fields can be predicted if both the airspeed and the ground speed of the helicopter are known. An aircraft that uses an inertial navigation unit, autopilot and estimator allows a measure of ground speed to be known with good certainty. The embodiments herein extends this system to allow an estimate of the local wind field to be found without actively using an airspeed sensor, but instead combining the measurements of an accelerometer and a drag force model and a model of controlled aerodynamics of the aircraft to estimate the airspeed, which again can be used to estimate the local wind speed.

Description

METHOD AND DEVICE FOR ESTIMATING A WIND FIELD

Technical Field

The embodiments herein relate to navigating/controlling an aircraft by using an estimate of a wind field in the

proximity of the aircraft, for example an Unmanned Aerial Vehicles (UAV) .

Background

Modern warfare and law enforcement are characterized by an increasing need for up-to-date situational awareness. To track down, or to protect against, criminals, paramilitary forces or terrorists, law enforcement personnel and soldiers often have an immediate need for information about what is around the next corner or over the hill.

Hostile forces frequently hide themselves from view or exploit the local terrain to gain tactical advantage or escape from pursuers. In the presence of hostile forces, a simple brick wall, barbed wire fence, a body of water, buildings or even a large open area can be an insurmountable obstacle when time is of the essence and tactical resources are unavailable. An active or undetected threat can make the situation dangerous.

Visible indications, noises or predictable actions can reveal friendly forces and put them at risk. Stealth and surprise, however, are elements that can give a tactical advantage. An UAV is an aircraft with no pilot on board (Also referred to herein as NUAV, where N is an abbreviation for Nano) . UAVs can be remotely controlled (e.g. flown by a pilot/operator at a remote ground control station using a controller) or it can fly autonomously based on pre-programmed flight plans or more complex dynamic automation systems. An UAV may also be referred to as a drone. UAVs equipped with video cameras and positioning devices transmit live pictures and positioning information to the operator of the UAV and allows their operator to perform surveillance tasks and gather information from a safe position without exposing themselves.

An UAV may be operated and controlled using a remote control. Traditionally an UAV is operated by controlling such as e.g. a joystick. In addition to a joystick, the remote control configured to operate and control the UAV is usually also supplemented with a Graphical User Interface (GUI) . A GUI may be a flight display providing e.g. different dynamic

navigation information like speed, direction, waypoints etc. All aircrafts need information about their local wind field to perform navigation - this includes UAVs. Smaller UAVs are more susceptible to atmospheric influences than larger UAVs or manned aircrafts and, therefore, require some method of identifying the current local wind field. In many instances, for these aircrafts, knowing the wind field will not aid an autopilot function in order to navigate the aircraft, but rather allow the aircraft to be positioned in a more

advantageous orientation with respect to the wind.

Determination of the local wind field is most commonly achieved through the use of direct airspeed and ground speed measurements. The aircraft obtains information about its ground speed by using a combination of its GPS and inertial sensors. The aircraft obtains information about its direct airspeed by using a pilot (dynamic air pressure) probe. GPS sensor modules have become, in recent years, small and accurate enough to be carried in almost all aircrafts - this, however, does not apply to airspeed sensors.

The problem of being able to navigate the aircraft by using a measurement of the airspeed of an aircraft in one or more direction does usually not become an issue for most aircraft designers. It is simple to use a number of pressure sensors to measure airspeed on larger aircraft. This extends down to what is typically thought of as very small aircrafts, including aircrafts of only lOOg. Nano Unmanned Aerial

Vehicles, however, are an order of magnitude smaller than this - approximately 15g. Extending into this region

necessitates that some cuts to system components of the aircraft are made - often the first to go is the airspeed sensors. This eliminates the possibility navigating the aircraft by using a direct measurement of the aircraft's airspeed .

If a small aircraft does not navigate by using a direct measurement of its airspeed it is difficult to use a measure the local wind field with any level of certainty. The problem of navigating the aircraft by using a calculation of the wind field from a known ground speed and airspeed is a known, solved problem.

Summary

An objective of embodiments herein is therefore to obviate at least one of the above disadvantages and problems and to provide improved navigation of the aircraft.

According to a first aspect, the object is achieved by a method in a device for navigating an aircraft. The device measures a ground speed associated with the aircraft. The device estimates an airspeed of the aircraft based on an acceleration a_B of the aircraft and controlled aerodynamic forces applied to the aircraft and estimates a wind field experienced by the aircraft based on the ground speed and the airspeed. Based on the estimated wind field, the device navigates the aircraft

In some embodiments, the device comprises an accelerometer configured to measure the acceleration a_B of the aircraft. The aircraft may comprise a mass m. The device may multiply the acceleration a_B with the mass m resulting in a required aircraft force for experienced motion F . The device may calculate a controlled aerodynamics F- by a model of the controlled aerodynamics F- having at least a rotation rate ω and a control state 6 of the aircraft as input in addition to a current estimate for the airspeed V> . The device may subtract the controlled aerodynamics F- from the required aircraft force for experienced motion F resulting in a calculated drag force F_D . And, the device may calculate an unfiltered airspeed V- from the calculated drag force F_D by reverse calculation of a model of the drag force F_D being dependent on the unfiltered airspeed V> .

In some embodiments, the device subtracts the calculated unfiltered airspeed V* from the measured ground speed V_G resulting in a calculated unfiltered wind speed V_w .

In some embodiments, the device filters the calculated unfiltered wind speed V_w with a low pass filter resulting in a calculated filtered wind speed V_w .

In some embodiments, the device subtracts the calculated filtered wind speed V_w from the measured ground speed V_G resulting in the current estimate for the airspeed V> .

In some embodiments, the device calculates the drag force F_D is by : wherein V is the airspeed, ^CD is a drag coefficient, p is a mass density and A is a reference area.

In some embodiments, the device calculates a wind magnitude and/or wind direction from the calculated filtered wind speed

V_w , and displays an indication of the wind magnitude and/or wind direction on a screen comprised in the aircraft.

In some embodiments, the indication is represented by an arrow which direction corresponds to the wind direction.

In some embodiments, the device colors the arrow so that one certain color indicates a wind magnitude within a certain wind magnitude interval.

In some embodiments, the airspeed is a local airspeed and wherein the wind field is a local wind field located in the proximity of the aircraft.

In some embodiments, the aerodynamics responsive to control state impacts are defined by the model of controlled

aerodynamics · .

In some embodiments, the aircraft is an Unmanned Aerial Vehicle, UAV.

According to a second aspect, the object is achieved by a device adjusted to navigate an aircraft. The device

comprises means for measuring a ground speed associated with the aircraft and means for estimating an airspeed of the aircraft based on an acceleration a_B of the aircraft and controlled aerodynamic forces applied to the aircraft. The device comprises means for estimating a wind field

experienced by the aircraft based on the ground speed and the airspeed. Furthermore, the device comprises means for navigating the aircraft based on the estimated wind field. In some embodiments, the aircraft comprises a mass m. In some embodiments, the device comprises an accelerator

configured to measure the acceleration a_B of the aircraft. The device may comprise a multiplier adjusted to multiply the acceleration a_B with the mass m resulting in a required aircraft force for experienced motion F . The device may comprise means for calculating a controlled aerodynamics F_A by a model of the controlled aerodynamics F_A having at least a rotation rate ω and a control state δ of the aircraft as input in addition to a current estimate for the airspeed V; . The device may comprise a first subtractor adjusted to subtract the controlled aerodynamics F> from the required aircraft force for experienced motion F resulting in a calculated drag force F_D . The device may comprise means for calculating an unfiltered airspeed V_A from the calculated drag force F_D by reverse calculation of a model of the drag force

F_D being dependent on the unfiltered airspeed V· ·

In some embodiments, the device comprises a second subtractor adjusted to subtract the calculated unfiltered airspeed V* from the measured ground speed V_G resulting in a calculated unfiltered wind speed V_w .

In some embodiments, the device comprises a low pass filter adjusted to filter the calculated unfiltered wind speed V_w resulting in a calculated filtered wind speed V_w .

In some embodiments, the device comprises a third subtractor adjusted to subtract the calculated filtered wind speed V_w from the measured ground speed V_G resulting in the current estimate for the airspeed V· . In some embodiments, the device comprises means for

calculating the drag force F_D by:

wherein V is the airspeed, ^{is a dra}9 coefficient, p is a mass density and A is a reference area.

In some embodiments, the device comprises means for

calculating a wind magnitude and/or wind direction from the calculated filtered wind speed V_w , and means for displaying an indication of the wind magnitude and/or wind direction on a screen comprised in the aircraft.

In some embodiments, the device comprises means for coloring the arrow so that one certain color indicates a wind

magnitude within a certain wind magnitude interval.

In some embodiments, aerodynamics responsive to control state im acts are defined by the model of controlled aerodynamics

In some embodiments, the aircraft is an Unmanned Aerial Vehicle, UAV. The device may be comprised in the aircraft or in a remote control unit configured to control/navigate the aircraft .

In some embodiments, the means for measuring the ground speed is at least one of an inertial navigation unit, a Global Positioning System, GPS, unit and an autopilot.

Local wind fields can be predicted if both the airspeed and the ground speed of the aircraft are known. An aircraft that comprises an inertial navigation unit, an autopilot and an estimator allows a measure of the ground speed to be known with good or at least sufficient certainty. The embodiments herein extend this system to allow an estimate of the wind field to be found without actively using an airspeed sensor.

All the aircraft's flight motions can be modeled with a well- known set of equations of motion - most often used to

simulate aircraft motion. When examining the effect of wind upon an aircraft, the translation equations of motion are of most interest for use in prediction of the wind field.

Equation 1 shows the linear translation equations of motion as related to the aircraft motion. tnV + τη(ω X f) = mg + F 1

By using an estimator with good certainty levels, all but the applied forces can be easily calculated. This then gives a value for the applied forces ( ) that need to be predicted. These forces will be partly made up by controlled aerodynamic forces (e.g. applied to the main and tail rotors of the aircraft if the aircraft is exemplified as a helicopter) and partly by the drag applied to the aircraft's body. The controlled aerodynamic forces can be modeled as a function of the aircraft states - including airspeed, rotation rate and control settings. This can be calculated numerically by again using the estimate of the aircraft states (including control settings) . This then leaves a force prediction, body drag, which must be produced by the airspeed onto the aircraft body (shown in equation 2) . F_D = mV + πι(ω X v)— mg— F_A 2

Similar to the model for the controlled aerodynamic forces, the body drag can be modeled using the aircraft states. This model, however, will be dominated by the airspeed along the drag axis and gives a convenient method for calculating the aircraft's airspeed from the remaining body drag. Equation 3 shows this relation.

This prediction for the current airspeed is then used with the ground speed in a continuous filter to produce an

estimate of the local wind field. The filtered wind field is then used to produce a separate, filtered airspeed. The filtered version of the airspeed is then continuously used within the airspeed calculations.

In the following, when using the term local it is to be interpreted as in proximity, close to next to or near of the aircraft. Local is the opposite of a faraway wind field, which is a wind field located in a large distance from the aircraft .

A feature of this process is that it can produce an estimate for the wind speed. The estimate of the wind speed may be passively produced. A requirement of this method is that a reasonably high fidelity model of the more complicated aerodynamic components is known. Less emphasis is placed on the prediction of the airspeed and more emphasis is placed on the filtering of the output. This will minimize any errors produced within the aerodynamic model and allows a smooth stable wind field and airspeed prediction to be produced.

Generally, the embodiments herein can be said to estimate the local wind field of an aircraft by subtracting estimated airspeed from the measured ground speed, wherein the airspeed is estimated based on measured acceleration of the aircraft, the applied controlled aerodynamic forces on the aircraft determined by a model of the aircraft's controlled

aerodynamics as a function of rotation rate, control stated and airspeed estimation feedback, in addition to the

coefficients of drag and the reference areas. The estimated airspeed is further low pass filtered to remove the high frequency components coming from e.g. turbulence. The

resulting local wind field could be displayed as an arrow with an angle representing the local wind direction and a magnitude representing the wind speed projected in the horizontal plane.

The embodiments herein afford many advantages, of which a non-exhaustive list of examples follows:

An advantage of the embodiments herein is that they allow a higher overall system performance to be achieved as well as producing lower complexity when implementing the system.

Another advantage is that the embodiments herein reduces errors and allows a smooth stable wind field and airspeed prediction to be produced.

Furthermore, an advantage of the embodiments herein is that they allow positioning of the aircraft in a more advantageous orientation with respect to the wind.

Since the aircraft does not have to have a sensor for

performing direct measurements the airspeed, the embodiments herein provides an advantage of reduced weight of the

aircraft, reduced number of components comprised in the aircraft and a reduced complexity and cost of the aircraft. The embodiments herein are not limited to the features and advantages mentioned above. A person skilled in the art will recognize additional features and advantages upon reading the following detailed description. Brief description of the drawings

The embodiments herein will now be further described in more detail in the following detailed description by reference to the appended drawings illustrating the embodiments and in which :

Fig. la is a schematic drawing illustrating an

embodiment of an aircraft comprising a main rotor and a tail rotor.

Fig. lb is a schematic drawing illustrating

embodiments of a main rotor.

Fig. lc is a schematic drawing illustrating

embodiments of a tail rotor.

Fig. 2 is a flow chart illustrating a method in an aircraft for estimating a local wind field.

Fig. 3a is a schematic drawing illustrating

embodiments of an aircraft configuration and user interface.

Fig. 3b is a schematic drawing illustrating

embodiments of an aircraft configuration and user interface.

Fig. 3c is a schematic drawing illustrating

embodiments of an aircraft configuration and user interface.

Fig. 4 is a flow chart illustrating embodiments of a method . Fig. 5 is a schematic block diagram illustrating embodiments of a device.

The drawings are not necessarily to scale and the dimensions of certain features may have been exaggerated for the sake of clarity. Emphasis is instead placed upon illustrating the principle of the embodiments herein.

Detailed description

In the following, the embodiments herein will be discussed and example embodiments described by referring to the

accompanying drawings. Further, the different speeds referred to herein are defined as follows: The ground speed is the speed of the aircraft relative to the ground, the (local) wind speed is the speed of the air near the aircraft relative to the ground, the airspeed is the speed of the air near the aircraft relative to the aircraft. There exist many methods for calculating the local wind field that surrounds an aircraft. These methods, however, require that both the ground speed and the airspeed of the aircraft are known. If these values are available they can be combined within a filter to produce estimates of the aircraft's local wind field. The process of filtering these values will be covered subsequently in the discussion of calculating the aircraft's airspeed .

To provide navigation based on information about the local wind field, there should be a filter to be used to calculate the local wind field and an estimate for the airspeed of the aircraft must first be known. A reliable airspeed estimate can be found by using a model of the aircraft that easily exposes the airspeed. By examining the aircraft equations of motion in the inertial reference frame we the relation shown in equation 4 is derived. This equation 4 can be used to model the response of an aircraft with regards to both internal and external forces. mV + m(co X V) = mg + F 4

Wherein V is the airspeed, ω is the rotation rate, m is the mass, 3 is acceleration due to gravity. In the above equation 4 the external forces, not including gravity, that are applied to the aircraft are represented by F . For an aircraft such as e.g. a helicopter this can be thought of as the sum of the applied controlled aerodynamic forces (applied on the main and tail rotor), F_A , and the forces applied to the body of the helicopter as drag, F_D - this relation is shown below in equation 5.

5

The reason for breaking the applied forces into these two specific components, F_A and F_D, is due to the two distinct methods for modeling the forces. The applied controlled aerodynamic forces can be modeled with a variety of methods, but needs to have reasonable fidelity in the model. The modeling of the applied controlled aerodynamic forces must take into account the aircraft states that include airspeed, rotation rate, and control settings. This model allows the forces to be calculated easily, but does not easily allow a reverse calculation to find the airspeed. Whilst the reverse calculation may be possible, it will require significant computational overhead which is not available on many small UAVs . Conversely, calculation of the drag applied to the body of the aircraft is significantly simpler. A reasonable model can be created which allows reverse calculation to find the airspeed to be performed with minimal computational overhead. When the separated forces, F_A and F_D, are substituted into the aircraft equations of motion the resulting relation is shown in equation 6. This may then be rearranged to allow an estimate of the drag that is applied to the body to be calculated, shown in equation 7. mV + τη(ω X V) = mg + F_A + F_B 6 mV + ηι(ω X v)— mg— F_A = F_D 7

It should be noted that the estimate for the body drag that is produced by using equation 7 is the predicted force deficit that is required to produce the motion that has been observed. This includes calculating the predicted controlled aerodynamic forces. Calculation of the airspeed from the body drag estimate is covered later in the document.

Equation 7 can be rearranged to group the terms that are scaled by the aircraft mass, which produces equation 8.

Til (v + ( XV)-g)-F_A = F_D 8

It can be noted that the terms that are scaled by mass are equivalent to the body acceleration of the aircraft - shown in equation 9. a_b = V + (ωΧΥ)- g 9

This body acceleration is measured directly by the

accelerometers within an Inertial Measurement Unit (IMU) comprised in the aircraft. This relation conveniently allows the relation to calculate the body drag (equation 8) to be simplified to the one shown in equation 10.

— F = F 10

By examining equation 10 it can be seen that there is very little burden placed on the monitoring and calculating the dynamics of the aircraft. The burden is placed on calculating the aerodynamics, both controlled and body drag, of the aircraft at each function evaluation.

To be able to produce an estimate for the aircraft's body drag, a model of the aircraft's controlled aerodynamics forces (F_A ) must be known. This model will typically be a complex function that takes into account a wide variety of the aircraft states, including airspeed (V) , rotation rate

(ω) , and control stated (5) - shown in equation 11.

In the following, one example of a model of a helicopter' s controlled aerodynamics is described with reference to figures la, lb and lc. In the case of a helicopter, be it large or small, the major aerodynamic components are the main and tail rotors - this is shown in the figure la. The rotor illustrated to the left is the main rotor and the rotor illustrated to the right in figure la is the tail rotor. In the following, the letter M indicates the main motor and T indicates the tail rotor. The arrows represent a x-y-z coordinate system for the main rotor and for the tail rotor. The parameter Fx_M represents the force on the main rotor in the x-direction, Fy_M represents the force on the main rotor in the y-direction and Fz_M represents the force on the main rotor in the z-direction. The parameter Fx_T represents the force on the tail rotor in the x-direction, Fy_T represents the force on the tail rotor in the y-direction and Fz_T represents the force on the tail rotor in the z-direction. The main rotor provides the predominant forces which allow the aircraft to be held in the air and maneuvered; whilst the tail rotor provides directional stability and control. An aerodynamic model of both of these aerodynamic components can be produced by using a standard analysis tool and knowledge of any platform specific characteristics. As an example, the Prox Dynamics PD-100 Black Hornet Nano Unmanned Aircraft is used to demonstrate this procedure for a helicopter' s main and tail rotors.

Aerodynamic performance of main and tail rotors will depend largely on the current flight state of the aircraft itself.

This includes the body translational speeds {V or u, v, w ) ; the body rotational rates ( ω or p,q,r) ; and the main and tail rotor control s tates ( δ or ω_Μ, 6_C, Q_p, 6_R, ω_τ ) . These s tates

dominate the performance of the rotors and thus provide the basis for an aerodynamic model.

For the main rotor, forces in each of the three components need to be used to ensure that an accurate model is produced. A diagram of the aircraft states used and the resulting forces is shown in the figure la and the resulting force relationship, F_M, in three component form takes the form shown in equation 12.

F_M — fn(y, ω, δ ) 12

By using an existing rotor analysis tool a representative model for each axis with respect to the above listed

parameters can be found. Prox Dynamics uses a Blade Element Momentum Theory model that has been benchmarked against the physical helicopter performance to produce these models.

After generating rotor performance data for a large, random range of aircraft states, a least squares method is used to generate the polynomial models. Equations 13 to 15 below show the form that force equations for the example of Prox Dynamics PD-100 Black Hornet Nano Unmanned Aircraft take (not including the constants) , wherein the parameters are based on the definitions in figure lb, which illustrates the main rotor . F 13

XM

F, 15

ZM Ί^ωΜ ^+€2^ωΜ^θΟ ^{+ C}3^iyM ^{W + C}4^iyM^U¾ ^{+ C}5^iyM^V^P ^{+ C} ₆ ^iyM ^W¾

Producing a model for the tail rotor is completed in a similar manner to that of the main rotor and is based on the definitions in figure lc, which illustrates the tail rotor. For this tail rotor, however, as the magnitude of the forces for the tail rotor is smaller only the thrust produced by the tail {F_y ) is of interest. The relationship that is produced is shown in equation 16.

The aerodynamic controlled forces are then calculated by summing all force components. For the PD-100 this is the sum of the main and tail rotors, as shown in equation 17.

The form that calculation of the controlled aerodynamic states takes may have any other suitable form. It should, however, be noted that the calculation of these forces will depend of the current aircraft states including the filtered airspeed. This airspeed is used as a feedback from the output of the wind field estimate and therefore will be susceptible to short term errors. These errors will be quickly eliminated due to the feedback within the filter.

After calculating the controlled aerodynamic forces an estimate of the body drag can be calculated - this estimate then needs to be related to the airspeed of the aircraft. Generally the drag on a given aircraft body will be mostly dependent to the velocity at which the aircraft is

travelling. For an aircraft body this relation does not include the rotation rate of the control state. In its most simple form this relation may take the form shown in

equations 18 and 19.

Equation 19 is derived from standard aerodynamics. It is a relationship that is commonly used to represent the drag on a given aircraft body. C_D denotes the vector of the

coefficients of drag for each of the three aircraft axes, and

A denotes the vector of the reference areas for each of the three aircraft axes. It can be seen that the relation

representing body drag is only dependent on the aircraft velocity. This allows the airspeed of the aircraft to be calculated from the body drag without the need for complex inversion or too complex computation. By using this method an estimate for the airspeed of the aircraft at each time evaluation can be made, thus providing an input to the filter, with ground speed, to produce an estimate of the local wind field.

Once the airspeed and ground speed are known the wind speed can be estimated with the relation shown in equations 20 and 21. The wind speed estimate is not calculated directly from these relations, but rather an instant estimate for the wind speed is calculated and then used within a filter. This filter smooths the wind speed output and also allows the smoothed feedback of the airspeed, which is used within the controlled aerodynamic calculations. ^VW ^{= V}G ^{~ V}A ²¹

The process disclosed above that is used to produce a local wind field estimate is further illustrated in the flowchart of figure 2. On the left hand side of this flowchart, the states that are taken from the aircraft sensor/estimator are shown. This includes the rotation rates, gravity, aircraft mass, measured acceleration, control states and ground speed. These input states are then used to calculate various

parameters and finally the local wind field.

To begin, the measured acceleration used to calculate the force that is required by the aircraft to produce the

currently experienced motion (F) is calculated. In parallel the controlled aerodynamic forces (F_A ) are also calculated using the rotation rates, control states and the current estimate for the aircraft's airspeed. By combining these two values the drag which is allocated to be produced by the drag force ( F_D ) is then calculated.

After the drag caused force ( F_D ) has been calculated the airspeed { V_{A ii c} ) of the aircraft is then calculated. The model used to make this calculation depends on the aircraft being analysed. For example if a helicopter is being analysed, only the fuselage drag needs to be considered. If, however, another configuration is analysed this model will become more complex and may need to consider more aircraft states. It should be noted that the calculated airspeed is unfiltered and is not used as the airspeed within the aerodynamics calculations .

Once a prediction of the current unfiltered airspeed is known the unfiltered wind speed { V_{W r i c} ) is then calculated by combing the ground speed ( V_G ) with the airspeed. A digital filter is configured to produce a smooth estimate of the local wind field ( V_w ) . The filter that is chosen will heavily depend on the dynamic performance of the aircraft that is under examination as well as the desired characteristics of the wind field estimate that is to be produced. For the Prox Dynamics PD-100 Black Hornet Nano Unmanned Aircraft a Type II Chebyshev filter is used with appropriate characteristics for the Prox Dynamics PD-100 Black Hornet Nano Unmanned Aircraft.

The filtered wind speed is then recombined with the ground speed estimate to produce a filtered estimate for the

airspeed ( V_A ) . It is of note that this estimate should not be relied upon as an absolute reading of the aircraft's airspeed and generally should not be used within the aircraft's autopilot. In contrast to this point, this estimate is fed back to the beginning of the calculation cycle as the current estimate for the aircraft's airspeed.

By feeding back the filtered airspeed any inconsistent changes or errors produced within the estimation process to be taken into account in the next calculation. If an

erroneous estimate is created it will be fed back into the calculation, thus causing a lower reading to be produced on the next cycle. This step allows the possibility of using a lower fidelity aerodynamic or drag model to be used.

As embodiments disclosed above focuses on providing a user level estimate of the local wind field a low pass filter, e.g. a Type II Chebyshev filter, is used. This low pass filter will eliminate higher frequency components of the wind (turbulence) and give a more realistic, smooth estimate of the wind field. It should be noted that more of the wind frequency domain is able to be captured if a higher fidelity estimator and aerodynamic model is used.

Within the filtering process three components of airspeed and ground speed are used to produce a three component estimate of the wind speed. Use of a three component estimation process allows subsequent calculation of the three components of airspeed to be produced, which is feed back into the aerodynamic calculations. The wind field that is displayed to the user needs only to be shown in the plane parallel to the earth's surface. These two components are combined to give a wind reading that is read in terms of direction and

magnitude .

The above procedure should be processed at the aircraft's native autopilot frequency or as quickly as is feasible. This allows a higher overall system performance to be achieved as well as producing lower complexity when implementing the system.

As already indicated, the local predicted local wind field can be displayed in a user interface allowing the user to position the aircraft in a more advantageous orientation with respect to the wind. This can be done by displaying the calculated wind direction and wind magnitude indication on a user screen. As the wind estimate is only to be used for pilot reference, only the wind direction (with respect to north) and a traffic light wind magnitude indication need to be used by e.g. coloring the arrow in a predefined way so that one certain color indicates a local wind magnitude within a certain wind magnitude interval. The traffic light indication can be used to display either safe (green) , warning (yellow) , or unsafe (red) wind conditions are being experienced. Other suitable colors, patterns or means for indicating the wind conditions may be used instead of green, yellow and red.

Three examples of this indicating system are illustrated in figure 3 to demonstrate the function of the system. In each of the examples the aircraft configuration is shown to the left and an example of the user interface is shown to the right . Firstly, in figure 3a, the aircraft configuration shown to the left in the figure illustrates that the aircraft is

facing directly east and crabbing slowly towards the south east. During this flight configuration the aircraft is

experiencing a safe level of wind from the north west. The traffic light indication shown to the right in figure 3a

illustrates that the aircraft experiences a safe wind

condition .

Secondly, in figure 3b, the aircraft configuration shown to the left in the figure illustrates that the aircraft is

facing in a north west direction and is strafing to the left in a south westerly direction. During this flight the

aircraft is experiencing a warning level of wind from the

north shown by the traffic light indication illustrated to the right in figure 3b. The warning may be illustrated by using a yellow arrow.

Finally, in figure 3c, the aircraft configuration shown to the left in the figure illustrates that the aircraft is

placed flying forward directly to the north east. During this flight configuration an unsafe wind is striking the aircraft from the south east, directly into the aircraft's side shown by the traffic light indication illustrated to the right in figure 3b. The unsafe wind condition may be illustrated by using a red arrow.

The method implemented in a device 500 for navigating/controlling the aircraft, according to some embodiments will now be described with reference to the flowchart depicted in Figure 4. The device having the reference number 500 refers to figure 5, which will be described in more detail later. The device 500 may be comprised in the aircraft or in e.g. a remote control unit configured to control/navigate the aircraft. In some embodiments, the device 500 comprises an accelerometer configured to measure the

acceleration a_B of the aircraft. The aircraft may comprise a mass m. The aircraft may be a UAV. The method comprises the following steps, which steps may as well be carried out in another suitable order than described below.

Step 401

The device 500 measures a ground speed associated with the aircraft .

Step 402

The device 500 estimates the airspeed of the aircraft based on an acceleration a_B of the aircraft and controlled

aerodynamic forces applied to the aircraft.

The airspeed may be a local airspeed.

Step 401a

In some embodiments, the device 500 multiplies the

acceleration a_B with the mass m resulting in a required aircraft force for experienced motion F . Step 401b

In some embodiments, the device 500 calculates a controlled aerodynamics F- by a model of the controlled aerodynamics F- having at least a rotation rate ω and a control state δ of the aircraft as input in addition to a current estimate for the airspeed V_A.

aerodynamics F· . Step 401c

In some embodiments, the device 500 subtracts the controlled aerodynamics F- from the required aircraft force for

experienced motion F resulting in a calculated drag force F_D . Step 401d

In some embodiments, the device 500 calculates an unfiltered airspeed V* from the calculated drag force F_D by reverse calculation of a model of the drag force F_D being dependent on the unfiltered airspeed V> .

The drag force F_D may be calculated by: F D = sign(V)C_D ^p AV² wherein ^¥ is the airspeed, o is a drag coefficient, p is a mass density and A i s a reference area.

Step 401e

In some embodiments, the device 500 subtracts the calculated filtered wind speed V_w from the measured ground speed V_G resulting in the current estimate for the airspeed V> .

Step 403

The device 500 estimates a wind field experienced by the aircraft based on the ground speed and the airspeed.

The wind field may be a local wind field located in the proximity of the aircraft.

Step 403a

In some embodiments, the device 500 subtracts the calculated unfiltered airspeed V* from the measured ground speed V_G resulting in a calculated unfiltered wind speed V_w .

Step 403b

In some embodiments, the device 500 filters the calculated unfiltered wind speed V_w with a low pass filter resulting in a calculated filtered wind speed V_w . Step 403c

In some embodiments, the device 500 calculates a wind

magnitude and/or wind direction from the calculated filtered wind speed V_w . Step 403d

In some embodiments, the device 500 displays an indication of the wind magnitude and/or wind direction on a screen

comprised in the aircraft.

The indication may be represented by an arrow which direction corresponds to the wind direction.

Step 403e

In some embodiments, the device 500 colors the arrow so that one certain color indicates a wind magnitude within a certain wind magnitude interval.

Step 404

The device 500 navigates/controls the aircraft based on the estimated wind field.

To perform the method steps shown in figure 4 for navigating the aircraft, the device 500 comprises an arrangement as shown in Figure 5. The aircraft may comprise a mass m. In some embodiments, the aircraft is a UAV. Even though figure 5 does not illustrate any connections between the different units, the skilled person will understand that there are any type of suitable connection means between the units

illustrated in figure 5.

The device 500 comprises means 530 for measuring a ground speed associated with the aircraft. In some embodiments, the means for measuring the ground speed is at least one of an inertial navigation unit, a Global Positioning System, GPS, unit and an autopilot. The device 500 comprises means 533 for estimating the

airspeed of the aircraft based on an acceleration a_B of the aircraft and controlled aerodynamic forces applied to the aircraft. In some embodiments, the airspeed is a local airspeed .

The device 500 comprises means 535 for estimating a wind field experienced by the aircraft based on the ground speed and the airspeed. In some embodiments, the wind field is a local wind field located in the proximity of the aircraft.

The device 500 comprises means for navigating 537 the

aircraft based on the estimated wind field.

In some embodiments, the device 500 further comprises an accelerator 501 configured to measure the acceleration a_B of the aircraft.

In some embodiments, the device 500 comprises a multiplier 503 adjusted to multiply the acceleration a_B with the mass m resulting in a required aircraft force for experienced motion

F .

In some embodiments, the device 500 comprises means 505 for calculating a controlled aerodynamics F - by a model of the controlled aerodynamics F - having at least a rotation rate ω and a control state 6 of the aircraft as input in addition to a current estimate for the airspeed V> .

In some embodiments, the device 500 comprises a first

subtractor 507 adjusted to subtract the controlled

aerodynamics F_A from the required aircraft force for

experienced motion F resulting in a calculated drag force F_D . In some embodiments, the device 500 comprises means 510 for calculating an unfiltered airspeed V; from the calculated drag force F_D by reverse calculation of a model of the drag force F_D being dependent on the unfiltered airspeed V_A .

In some embodiments, the device 500 comprises a second subtractor 512 adjusted to subtract the calculated unfiltered airspeed V_A from the measured ground speed V_G resulting in a calculated unfiltered wind speed V_w .

In some embodiments, the device 500 comprises a low pass filter 513 adjusted to filter the calculated unfiltered wind speed V_w resulting in a calculated filtered wind speed V_w .

In some embodiments, the device 500 comprises a third

subtractor 515 adjusted to subtract the calculated filtered wind speed V_w from the measured ground speed V_G resulting in the current estimate for the airspeed V; .

In some embodiments, the device 500 comprises means 517 for calculating the drag force F_D by:

F _D = sign(V)C_D AV² .

wherein V is the airspeed, ^co is a drag coefficient, p is a mass density and A i s a reference area.

In some embodiments, the device 500 comprises means 519 for calculating a wind magnitude and/or wind direction from the calculated filtered wind speed V_w , and means 521 for

displaying an indication of the wind magnitude and/or wind direction on a screen comprised in the aircraft. In some embodiments, the indication is represented by an arrow which direction corresponds to the wind direction.

In some embodiments, the device 500 comprises means 523 for coloring the arrow so that one certain color indicates a wind magnitude within a certain wind magnitude interval.

The device 500 may comprise a memory 525 comprising one or more memory unit. The memory 525 is arranged to be used to store data, the measured ground speed, the estimated

airspeed, the estimated wind field, and the other parameters mentioned above, configurations, schedulings, and

applications to perform the methods herein when being

executed in the device 500.

The present mechanism for setting navigating the aircraft may be implemented through one or more processors, such as a processor 527 in device arrangement depicted in Figure 5 together with computer program code for performing the functions of the embodiments herein. The processor may be for example a Digital Signal Processor (DSP) , Application

Specific Integrated Circuit (ASIC) processor, Field- programmable gate array (FPGA) processor or microprocessor. The program code mentioned above may also be provided as a computer program product, for instance in the form of a data carrier carrying computer program code for performing the embodiments herein when being loaded into the device 500. One such carrier may be in the form of a CD ROM disc. It is however feasible with other data carriers such as a memory stick. The computer program code can furthermore be provided as pure program code on a server and downloaded to the device 500. Those skilled in the art will also appreciate that the means for measuring a ground speed, means for estimating an

airspeed, means for estimating a wind field, means for navigating the aircraft, accelerator, multiplier, means for calculating a controlled aerodynamics F- , first subtractor, means for calculating an unfiltered airspeed V* , a second subtractor, a low pass filter, a third subtractor, means for calculating the drag force F_D , means for calculating a wind magnitude and/or wind direction, means for displaying an indication of the wind magnitude and/or wind direction and means for coloring the arrow described above may refer to a combination of analog and digital circuits, and/or one or more processors configured with software and/or firmware, e.g. stored in the memory 525, that when executed by the one or more processors such as the processor 527 perform as described above. One or more of these processors, as well as the other digital hardware, may be included in a single application-specific integrated circuit (ASIC) , or several processors and various digital hardware may be distributed among several separate components, whether individually packaged or assembled into a system-on-a-chip (SoC) .

The above description discloses different example embodiments for illustrative purposes. A person skilled in the art would realize a variety of different models of the aircraft's controlled aerodynamics and measurements of aircraft body acceleration within the scope of the embodiments.

The embodiments herein are not limited to the above described embodiments. Various alternatives, modifications and

equivalents may be used. Therefore, the above embodiments should not be taken as limiting the scope of the embodiments, which is defined by the appending claims.

It should be emphasized that the term "comprises/comprising" when used in this specification is taken to specify the presence of stated features, integers, steps or components, but does not preclude the presence or addition of one or more other features, integers, steps, components or groups thereof. It should also be noted that the words "a" or "an" preceding an element do not exclude the presence of a plurality of such elements.

It should also be emphasised that the steps of the methods defined in the appended claims may, without departing from the embodiments herein, be performed in another order than the order in which they appear in the claims.

Claims

1. A method in a device for navigating an aircraft,

comprising :

measuring a ground speed associated with the aircraft; estimating an airspeed of the aircraft based on an acceleration a_B of the aircraft and controlled aerodynamic forces applied to the aircraft;

estimating a wind field experienced by the aircraft based on the ground speed and the airspeed; and

navigating the aircraft based on the estimated wind field .

2. A method according to claim 1, wherein the device

comprises an accelerometer configured to measure the

acceleration a_B of the aircraft, wherein the aircraft

comprises a mass m, and wherein the estimating the airspeed of the aircraft based further comprises:

multiplying the acceleration a_B with the mass m resulting in a required aircraft force for experienced motion F;

calculating a controlled aerodynamics F_A by a model of the controlled aerodynamics F- having at least a rotation rate ω and a control state S of the aircraft as input in addition to a current estimate for the airspeed V> ;

subtracting the controlled aerodynamics F_A from the required aircraft force for experienced motion F resulting in a calculated drag force F_D ; and

calculating an unfiltered airspeed V_A from the calculated drag force F_D by reverse calculation of a model of the drag force F_D being dependent on the unfiltered airspeed V_; .

3. A method according to claim 2, wherein the estimating the wind field experienced by the aircraft further comprises: subtracting the calculated unfiltered airspeed V* from the measured ground speed V_G resulting in a calculated unfiltered wind speed V_w .

4. A method according to claim 3, wherein the estimating the wind field experienced by the aircraft further comprises: filtering the calculated unfiltered wind speed V_w with a low pass filter resulting in a calculated filtered wind speed

5. A method according to claim 4, wherein the estimating the airspeed of the aircraft based further comprises:

subtracting the calculated filtered wind speed V_w from the measured ground speed V_G resulting in the current

estimate for the airspeed V_A.

6. A method according to claim 2 or 3, wherein the drag force F_D is calculated by:

F_D = sign(v)C_D^pAV²

wherein V is the airspeed, ^co is a drag coefficient, p is a mass density and A is a reference area.

7. A method according to claim 4, wherein the estimating the wind field experienced by the aircraft further comprises: calculating a wind magnitude and/or wind direction from the calculated filtered wind speed V_w ; and

displaying an indication of the wind magnitude and/or wind direction on a screen comprised in the aircraft.

8. A method according to claim 7, wherein the indication is represented by an arrow which direction corresponds to the wind direction.

9. A method according to claim 8, further comprising:

coloring the arrow so that one certain color indicates a wind magnitude within a certain wind magnitude interval.

10. The method according to claims 1 - 9, wherein the airspeed is a local airspeed and wherein the wind field is a local wind field located in the proximity of the aircraft.

11. The method according to claims 1 - 10, wherein

aerodynamics responsive to control state impacts are defined by the model of controlled aerodynamics F_A.

12. The method according to claims 1 - 11, wherein the aircraft is an Unmanned Aerial Vehicle, UAV.

13. A device adjusted to navigate an aircraft, the device comprising :

means for measuring a ground speed associated with the aircraft ;

means for estimating an airspeed of the aircraft based on an

acceleration a_B of the aircraft and controlled aerodynamic forces applied to the aircraft;

means for estimating a wind field experienced by the aircraft based on the ground speed and the airspeed; and

means for navigating the aircraft based on the estimated wind field.

14. A device according to claim 13, wherein the aircraft comprises a mass m, and wherein device further comprises: an accelerator configured to measure the acceleration a_B of the aircraft;

a multiplier adjusted to multiply the acceleration a_B with the mass m resulting in a required aircraft force for experienced motion F ; means for calculating a controlled aerodynamics _A by a model of the controlled aerodynamics F_A having at least a rotation rate ω and a control state δ of the aircraft as input in addition to a current estimate for the airspeed V_A;

a first subtractor adjusted to subtract the controlled aerodynamics F- from the required aircraft force for experienced motion F resulting in a calculated drag force

F_D ; and

means for calculating an unfiltered airspeed V_A from the calculated drag force F_D by reverse calculation of a model of the drag force F_D being dependent on the unfiltered airspeed V_A .

15. A device according to claim 14, further comprising:

a second subtractor adjusted to subtract the calculated unfiltered airspeed V_A from the measured ground speed V_G resulting in a calculated unfiltered wind speed V_w .

16. A device according to claim 15, further comprising:

a low pass filter adjusted to filter the calculated unfiltered wind speed V_w resulting in a calculated filtered wind speed V_w .

17. A device according to claim 16, further comprising:

a third subtractor adjusted to subtract the calculated filtered wind speed V_w from the measured ground speed V_G resulting in the current estimate for the airspeed V> .

18. A device according to claims 14-17, further comprising:

means for calculating the drag force F_D by: FD = sign(V)C_D AV² .

wherein V is the airspeed, is a drag coefficient, p is a mass density and A i s a reference area.

19. A device according to claim 18, comprising:

means for calculating a wind magnitude and/or wind direction from the calculated filtered wind speed V_w ; and means for displaying an indication of the wind magnitude and/or wind direction on a screen comprised in the aircraft.

20. A device according to claim 19, wherein the indication is represented by an arrow which direction corresponds to the wind direction.

21. A device according to claim 20, further comprising:

means for coloring the arrow so that one certain color indicates a wind magnitude within a certain wind magnitude interval .

22. The device according to claims 13 - 21, wherein the airspeed is a local airspeed and wherein the wind field is a local wind field located in the proximity of the aircraft.

23. The device according to claims 13 - 22, wherein

aerodynamics responsive to control state impacts are defined by the model of controlled aerodynamics F· .

24. The device according to claims 13 - 22, wherein the aircraft is an Unmanned Aerial Vehicle, UAV.

25. The device according to claims 13 - 24, wherein the means for measuring the ground speed is at least one of an inertial navigation unit, a Global Positioning System, GPS, unit and an autopilot.