SYSTEM AND METHOD FOR DETERMINING WIND DIRECTION AND VELOCITY MEASUREMENT FROM ALTITUDE FOR AN UNMANNED AERIAL VEHICLE
20200264209 ยท 2020-08-20
Inventors
Cpc classification
B64U2201/00
PERFORMING OPERATIONS; TRANSPORTING
G05D1/106
PHYSICS
G05D1/0204
PHYSICS
G01P5/02
PHYSICS
B64C39/024
PERFORMING OPERATIONS; TRANSPORTING
G01P21/025
PHYSICS
G01P13/025
PHYSICS
B64C19/00
PERFORMING OPERATIONS; TRANSPORTING
International classification
G01P5/02
PHYSICS
B64C19/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
Wind speed and direction experienced by the UAV at altitude is determined by placing an accelerometer, gyroscope and compass on the UAV. A change in velocity experienced by the UAV is determined by the accelerometer. An orientation relative to a reference plane and an angular velocity experienced by the UAV is determined by the gyroscope. A magnetic bearing of the UAV is determined with the compass. A roll and pitch exhibited by the UAV is determined as a function of the change in velocity, orientation and change in angular velocity. Projected roll and projected pitch vectors onto a horizontal plane cutting through the center of rotation of the UAV are determined as a function of the roll and the pitch. The wind speed of the wind experienced by the UAV is determined as a function of the projected roll vector and projected pitch vector. The wind direction is determined as a function of the projected roll vector and projected pitch vector and the magnetic bearing of the UAV.
Claims
1. A method for determining wind speed and wind direction experienced by an unmanned aerial vehicle at altitude comprising the steps of: placing an accelerometer, a gyroscope and a compass on the unmanned aerial vehicle; determining a change in velocity experienced by the unmanned aerial vehicle with the accelerometer; determining an orientation of the unmanned aerial vehicle relative to a reference plane and an angular velocity experienced by the unmanned aerial vehicle with the gyroscope; determining a magnetic bearing of the unmanned aerial vehicle with the compass; determining a projected roll vector and a projected pitch vector onto a horizontal plane cutting through the center of rotation of the unmanned aerial vehicle as a function of the roll and pitch of the unmanned aerial vehicle in response to known wind conditions; determining a wind speed of a wind experienced by the unmanned aerial vehicle as a function of the projected roll vector and the projected pitch vector; and determining a wind direction as a function of the projected roll vector, projected pitch vector and magnetic bearing of the unmanned aerial vehicle.
2. The method for determining wind speed and wind direction experienced by an unmanned aerial vehicle at altitude of claim 1, wherein the accelerometer is a three-dimensional accelerometer.
3. The method for determining wind speed and wind direction experienced by an unmanned aerial vehicle at altitude of claim 1, further comprising the step of determining a correction value as a function of measuring changes in the roll, pitch and magnetic bearing of the unmanned aerial vehicle in response to known wind conditions; the wind velocity being determined in part as a function of the correction value.
4. The method for determining wind speed and wind direction experience by an unmanned aerial vehicle at altitude of claim 3, wherein the correction value is a fixed value assigned to an unmanned aerial vehicle which is specific to a make and model of a respective unmanned aerial vehicle.
5. The method for determining wind speed and wind direction experienced by an unmanned aerial vehicle at altitude of claim 1, further comprising the step of determining a predetermined time period and determining the roll, and the pitch during the predetermined time period.
6. A system for determining wind speed and wind direction experienced by an unmanned aerial vehicle at altitude comprising: an accelerometer being disposed on the unmanned aerial vehicle and determining a change in velocity experienced by the unmanned aerial vehicle; a gyroscope being disposed on the unmanned aerial vehicle and determining an orientation of the unmanned aerial vehicle relative to a reference plane and an angular velocity experienced by the unmanned aerial vehicle; a compass being disposed on the unmanned aerial vehicle and determining a magnetic bearing of the unmanned aerial vehicle; a flight controller in communication with the compass, the gyroscope, and accelerometer; the flight controller receiving the magnetic bearing and determining a projected roll vector and a projected pitch vector onto a horizontal plane cutting through the center of rotation of the unmanned aerial vehicle as a function of the roll and pitch respectively; determining a wind speed of a wind experienced by the unmanned aerial vehicle as a function of the projected roll vector and the projected pitch vector; and determining a wind direction as a function of the projected roll vector, projected pitch vector and magnetic bearing of the unmanned aerial vehicle.
7. The system for determining wind speed and wind direction experienced by an unmanned aerial vehicle at altitude of claim 6, wherein the microcontroller determines the wind speed and wind direction utilizing a correction value as a function of measured changes in the roll, pitch and magnetic bearing of the unmanned aerial vehicle in response to known wind conditions; the correction value being a fixed value assigned to an unmanned aerial vehicle which is specific to a make and model of a respective unmanned aerial vehicle.
8. The system for determining wind speed and wind direction experienced by an unmanned aerial vehicle at altitude of claim 6, further comprising a clock; the clock out putting timing signals during a predetermined time period, the accelerometer and gyroscope only providing outputs to the flight controller during the predetermined time period.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0008] The features and advantages of the present invention will become more readily apparent from the following detailed description of the invention in which like elements are labeled similarly and in which:
[0009]
[0010]
[0011]
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0012] Reference is initially made to
[0013] Reference is now made to
[0014] Electronics 100 also includes an inertial motion unit (IMU) 104 for determining roll and pitch of UAV 10. To determine motion in three dimensions, IMU 104 includes a three-dimensional accelerometer 112 which measures changes in velocity (speed and direction), and a gyroscope114 which determines orientation relative to a reference plane and angular velocity of UAV 10. Together they determine roll, pitch, yaw and velocity of UAV 10. Accelerometer 112 and gyroscope 114 may be MEMs; thus reducing the space and weight taken up by the wind detection apparatus. IMU 104 provides a motion output (roll, pitch, yaw and velocity) to flight controller 102, which as discussed below is used to determine wind direction and velocity and make corrections therefore.
[0015] The amount of roll and pitch will differ between different UAV designs as a function of aerodynamics, mass and other factors. In a first step, changes in the roll, pitch, and magnetic bearing of the UAV in response to known wind conditions are measured directly to determine a correction factor. Next, an average roll and average pitch in response to a known wind condition are determined. This can be determined utilizing electronics 100 with the following equations:
.sub.Roll,Average=.sub.i=0.sup.n.sub.Roll (1)
.sub.Pitch,Average=.sub.i=0.sup.n.sub.Pitch (2)
Where n is the number of samples and can be found by the sample rate and desired duration of the average.
[0016] The projected vectors onto the horizontal plane are then determined as follows:
Where
[0017] The present inventor has determined that the wind velocity can be determined as a function of a correction value and the projected roll and pitch vectors (
Wind Velocity=W.sub.correction{square root over (
[0018] Where W.sub.correction is the wind correction factor for each unique UAV design; determined as discussed above.
[0019] The wind direction may also be determined from the same information and as a function of the magnetic bearing of UAV 10 as determined by compass 108. Compass 108 provides a true orientation relative to the ground (magnetic bearing). Wind direction can be determined in accordance with the following equation:
Wind Direction=H+tan.sup.1(R.sup./P.sup.) (6)
Where H is the magnetic bearing of the craft as determined by compass 108.
[0020] 4851-4859-1796.1 5
[0021] As a result of the inventive use of on board lightweight, circuit-based, electronics such as accelerometer 112, gyroscope 114 and compass 108, microcomputer 110 is enabled to determine the wind direction and velocity at altitude being experienced by UAV 10 in real time and provide correction instructions for flight controller 102 relative to the desired ground position or flight path. Reference is now made to
[0022] In a step 200, a clock 106 providing an input to IMU 104 starts a timing period for accelerometer 112 and gyroscope 114 to begin measuring roll and pitch. The roll and pitch measurements are collected over a period of time, such as 30 seconds, so that normal attitude changes due to normal flight can be discriminated from long-term offsets due to wind. At the end of the time period clock 106 outputs a signal causing IMU 104 to output the measured roll and pitch as determined by accelerometer 112 and gyroscope 114 to microcontroller 110. In a step 202, a magnetic bearing is determined by compass 108 and is input to micro controller 110 along with the outputs of accelerometer 112 and gyroscope 114 for the time period determined by clock 106.
[0023] In a step 204, micro controller 110 determines the projected vectors (
[0024] It is also to be understood that the operations discussed above in connection with electronics 100 can also be accomplished at the microcontroller level. Microcontroller 110 may incorporate the accelerometer and gyroscope to determine roll and pitch without the need for IMU 104.
[0025] It should be further recognized that the invention is not limited to the particular embodiments described above. Accordingly, numerous modifications can be made without departing from the spirit of the invention and scope of the claims appended hereto.