CN112987768A - Unmanned aerial vehicle righting device and orientation righting method - Google Patents

Unmanned aerial vehicle righting device and orientation righting method Download PDF

Info

Publication number
CN112987768A
CN112987768A CN202110169853.8A CN202110169853A CN112987768A CN 112987768 A CN112987768 A CN 112987768A CN 202110169853 A CN202110169853 A CN 202110169853A CN 112987768 A CN112987768 A CN 112987768A
Authority
CN
China
Prior art keywords
aerial vehicle
unmanned aerial
position information
group
orientation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110169853.8A
Other languages
Chinese (zh)
Other versions
CN112987768B (en
Inventor
姜野
苏永波
周庆涛
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Huaruan Technology Co ltd
Original Assignee
Huaruan Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Huaruan Technology Co ltd filed Critical Huaruan Technology Co ltd
Priority to CN202110169853.8A priority Critical patent/CN112987768B/en
Publication of CN112987768A publication Critical patent/CN112987768A/en
Application granted granted Critical
Publication of CN112987768B publication Critical patent/CN112987768B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The embodiment of the invention discloses an unmanned aerial vehicle righting device and an orientation righting method. Unmanned aerial vehicle device of reforming includes: the landing platform is used for taking off and landing the unmanned aerial vehicle; the position adjusting device is arranged at the edge of the landing platform and used for adjusting the position of the unmanned aerial vehicle on the landing platform; the rotating platform is arranged in the middle of the landing platform and drives the unmanned aerial vehicle placed on the rotating platform to adjust the orientation through rotation; a controller for controlling the rotation of the rotary platform; the distance sensor is used for scanning to obtain real-time position information of the unmanned aerial vehicle on the rotating platform and sending the real-time position information to the controller; the controller judges the real-time position information according to the preset position information and controls the rotary platform to rotate according to the judgment result. According to the technical scheme, the position and the orientation of the unmanned aerial vehicle are adjusted through the position adjusting device and the rotating platform, and the orientation of the unmanned aerial vehicle is adjusted through the cooperation of the controller and the distance sensor.

Description

Unmanned aerial vehicle righting device and orientation righting method
Technical Field
The embodiment of the invention relates to the field of unmanned aerial vehicles, in particular to an unmanned aerial vehicle righting device and an orientation righting method.
Background
Unmanned aerial vehicle needs field personnel to use the people remote controller to control unmanned aerial vehicle because the restriction of self wireless communication distance, and the people need arrive the use scene to just can operate the aircraft in certain distance. Unmanned and intelligent remote flight is not completely realized in the aspect of long distance, so that unmanned aerial vehicle stations can be produced at will, unmanned deployment is really realized on site, and remote control and use are realized only by a network at a far end when needed.
After the unmanned aerial vehicle finishes the task, descend the recovery unit platform to the airport, its recovery unit can be through the close cooperation of motion machinery and sensor, shuts down unmanned aerial vehicle, changes actions such as battery. But recovery unit has the requirement to unmanned aerial vehicle's position, and prior art can't its position of accurate adjustment after unmanned aerial vehicle falls.
Disclosure of Invention
Therefore, the embodiment of the invention provides an unmanned aerial vehicle righting device and an orientation righting method, and aims to solve the problems that an unmanned aerial vehicle adjusting device in the prior art cannot accurately adjust the orientation of an unmanned aerial vehicle and the existing unmanned aerial vehicle position adjusting device is complex in structure.
In order to achieve the above object, an embodiment of the present invention provides the following:
in an aspect of an embodiment of the present invention, there is provided an unmanned aerial vehicle righting apparatus, including: the landing platform is used for taking off and landing the unmanned aerial vehicle; the position adjusting device is arranged at the edge of the landing platform and used for adjusting the position of the unmanned aerial vehicle on the landing platform; the rotating platform is arranged in the middle of the landing platform and drives the unmanned aerial vehicle placed on the rotating platform to adjust the orientation through rotation; a controller for controlling the rotation of the rotary platform; the distance sensor is used for scanning to obtain real-time position information of the unmanned aerial vehicle on the rotating platform and sending the real-time position information to the controller; the controller judges the real-time position information according to the preset position information and controls the rotary platform to rotate according to the judgment result.
Further, a characteristic area is arranged on the unmanned aerial vehicle and used for being matched with the distance sensor to scan to obtain position information; the position information includes distance information and direction information of points of the feature area with respect to the distance sensor.
Further, the landing platform is square, and the position adjusting device includes: the front-back adjusting device comprises a front-side push rod and a back-side push rod, the front-side push rod and the back-side push rod are respectively arranged on a group of opposite sides of the landing platform and can move on the surface of the landing platform; the left and right adjusting device comprises a left push rod and a right push rod, the left push rod and the right push rod are respectively arranged on the other pair of edges of the landing platform and can move on the surface of the landing platform; front side push rod, rear side push rod and left side push rod, right side push rod move under adjusting motor drives about and in front adjusting motor respectively to promote unmanned aerial vehicle and carry out position control.
In another aspect of the embodiments of the present invention, there is provided a drone orientation righting method, including: step 1: placing a first unmanned machine on a rotating platform, and determining the orientation of the first unmanned machine; step 2: scanning a first unmanned characteristic area to acquire a first group of position information of the first unmanned machine; and step 3: placing a second drone on a rotating platform; and 4, step 4: scanning a characteristic area of the second unmanned aerial vehicle to obtain a second group of position information of the second unmanned aerial vehicle; and 5: comparing the second set of location information with the first set of location information; step 6: judging that the second group of position information is out of the error allowable range relative to the first group of position information, controlling the rotating platform to drive the second unmanned aerial vehicle to rotate, and repeating the step 4 and the step 5; and 7: and judging that the second group of position information is within the error allowable range relative to the first group of position information, and finishing the orientation righting of the second unmanned aerial vehicle.
Further, in step 2, scanning the first unmanned characteristic area to obtain a first set of location information of the first unmanned system, specifically: step 2-1: establishing a polar coordinate system by taking the distance sensor as a pole and leading out a ray from the pole as a polar axis, wherein the intersection point of the polar axis and the first unmanned characteristic region is used as a value (theta) of a first point in the first group of position information0,r0) Wherein, theta0Is 0 degree, r0The distance from the intersection point to the distance sensor; step 2-2: the distance sensor continuously scans n groups of points of a first unmanned characteristic area by taking a first point as a starting point to obtain a first group of position information:
0,r0),(θ1,r1),(θ2,r2)…(θn,rn)
wherein n is a positive integer, theta012…θnFor the arithmetic series, the tolerance is a 1.
Further, in step 4, scanning a characteristic region of the second unmanned aerial vehicle, and acquiring a second group of location information of the second unmanned aerial vehicle, specifically: step 4-1: in the polar coordinate system, the intersection point of the polar axis and the characteristic region of the second unmanned aerial vehicle is used as the value (alpha) of the first point in the second group of position information0,d0) Wherein α is0Is 0 degree, d0The distance from the intersection point of the polar axis and the characteristic region of the second unmanned aerial vehicle to the distance sensor is obtained; step 4-2: the distance sensor uses the crossing point of polar axis and the characteristic region of second unmanned aerial vehicle as the starting point, scans the m group points of the characteristic region of second unmanned aerial vehicle in succession, obtains the second group positional information:
0,d0),(α1,d1),(α2,d2)…(αm,dm)
wherein m is a positive integer, alpha012…αmFor the arithmetic series, the tolerance is a 2.
Further, n ═ m; a1 ═ a 2; wherein the values of n and m are less than or equal to 90; the values of a1 and a2 are both 1 degree.
Further, in step 5, comparing the second group of location information with the first group of location information, specifically: step 5-1: establishing a function of a first set of location information: f (theta)n,rn)=rn(ii) a Step 5-2: establishing a function of the second set of location information: f (alpha)m,dm)=dm(ii) a Step 5-3: calculating the distance of the corresponding point in the two groups of data according to the polar coordinates of the corresponding point in the first group of position information and the second group of position information: bn=f(αn,dn)-f(θn,rn) (ii) a Step 5-4: calculating the average value of the distances of the corresponding points in the two groups of data according to the polar coordinates of the corresponding points in the first group of position information and the second group of position information:
Figure BDA0002938649980000031
step 5-5: calculating the total standard deviation sigma of the two groups of data of the first group of position information and the second group of position information according to a standard deviation formula,
Figure BDA0002938649980000032
and 5-6: will be sigma and sigma0A comparison is made, where σ0Is a fixed value.
Further, in step 6, it is determined that the second group of location information is outside the allowable error range with respect to the first group of location information, specifically: sigma is greater than sigma0(ii) a In step 7, it is determined that the second group of location information is within the allowable error range with respect to the first group of location information, specifically: sigma is less than sigma0
Further, the error data in the second set of scanned location information is filtered:
establishing a function f (alpha) of a second set of position informationm,dm)=dm(ii) a Judgment of f (. alpha.) (m,dm)>f(αm-1,dm-1) And (alpha)m,dm)>f(αm+1,dm+1) If true, f (alpha) ism+1,dm+1) Is assigned to f (α)m,dm) (ii) a Judgment of f (. alpha.) (m,dm)>f(αm-1,dm-1) And (alpha)m,dm)>f(αm+1,dm+1) If not, f (alpha) is not changedm,dm) The value of (c).
The embodiment of the invention has the following advantages:
the embodiment of the invention discloses an unmanned aerial vehicle righting device and an orientation righting method.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly described below. It should be apparent that the drawings in the following description are merely exemplary, and that other embodiments can be derived from the drawings provided by those of ordinary skill in the art without inventive effort.
The structures, ratios, sizes, and the like shown in the present specification are only used for matching with the contents disclosed in the specification, so as to be understood and read by those skilled in the art, and are not used to limit the conditions that the present invention can be implemented, so that the present invention has no technical significance, and any structural modifications, changes in the ratio relationship, or adjustments of the sizes, without affecting the effects and the achievable by the present invention, should still fall within the range that the technical contents disclosed in the present invention can cover.
Fig. 1 is a schematic structural diagram of an unmanned aerial vehicle righting device according to an embodiment of the present invention;
fig. 2 is another schematic structural diagram of an unmanned aerial vehicle righting device according to an embodiment of the present invention;
fig. 3 is a schematic flowchart of an orientation normalization method for an unmanned aerial vehicle according to an embodiment of the present invention.
In the figure: 100-unmanned aerial vehicle righting device, 10-landing platform, 20-position adjusting device, 21-front and back adjusting motor, 22-left and right adjusting motor, 30-rotating platform, 40-height adjusting device and 50-distance sensor.
Detailed Description
The present invention is described in terms of particular embodiments, other advantages and features of the invention will become apparent to those skilled in the art from the following disclosure, and it is to be understood that the described embodiments are merely exemplary of the invention and that it is not intended to limit the invention to the particular embodiments disclosed. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
In the present specification, the terms "upper", "lower", "left", "right", "middle", and the like are used for clarity of description, and are not intended to limit the scope of the present invention, and changes or modifications in the relative relationship may be made without substantial changes in the technical content.
Examples
Referring to the unmanned aerial vehicle righting device 100 shown in fig. 1 and 2, an embodiment of the present invention provides an unmanned aerial vehicle righting device 100, including: the landing platform 10 is used for taking off and landing the unmanned aerial vehicle; the position adjusting device 20 is arranged at the edge of the landing platform 10 and used for adjusting the position of the unmanned aerial vehicle on the landing platform 10; the rotating platform 30 is arranged in the middle of the landing platform 10, and the rotating platform 30 drives the unmanned aerial vehicle placed on the rotating platform 30 to adjust the orientation through rotation; a controller for controlling the rotation of the rotary platform 30; and the distance sensor 50 is used for scanning to acquire the real-time position information of the unmanned aerial vehicle on the rotating platform 30 and sending the real-time position information to the controller.
The controller judges the real-time position information according to the preset position information and controls the rotary platform to rotate according to the judgment result. Specifically, the controller passes through distance sensor 50 and acquires unmanned aerial vehicle's real-time orientation information, compare with the inside predetermined orientation information of storage at the controller through comparing real-time orientation information, compare in when predetermineeing orientation information in error range when predetermineeing when orientation information when real-time orientation information, then accomplish the adjustment to the unmanned aerial vehicle orientation, when outside error range, then controller control rotary platform 30 rotates, the unmanned aerial vehicle of placing on rotary platform is driven and is rotated, further carry out the adjustment of orientation.
Specifically, the unmanned aerial vehicle is provided with a characteristic area, and the characteristic area is used for being matched with the distance sensor 50 to scan to obtain position information; the position information includes distance information and direction information of points of the feature area with respect to the distance sensor 50.
As shown in fig. 1 and 2, the landing platform 10 has a square shape, and the position adjusting device 20 includes: the front and back adjusting device comprises a front push rod and a back push rod, the front push rod and the back push rod are respectively arranged on a group of opposite sides of the landing platform and can move on the surface of the landing platform 10; and the left and right adjusting device comprises a left push rod and a right push rod, the left push rod and the right push rod are respectively arranged on the other pair of edges of the landing platform, and can move on the surface of the landing platform 10.
Wherein, front side push rod, rear side push rod and left side push rod, right side push rod move under adjusting motor 21 and controlling the driving of adjusting motor 22 around respectively to promote unmanned aerial vehicle and carry out position control. Rotary platform 30 sets up in the middle part of descending platform 10, consequently, position adjustment device 20 can promote the unmanned aerial vehicle that descends on descending platform 10 on rotary platform 30 through under the cooperation of front side push rod, rear side push rod and left side push rod, right side push rod.
Specifically, the unmanned aerial vehicle device 100 that reforms still includes height adjustment device 40, and height adjustment device 40 sets up in rotary platform 30 week side, drives rotary platform 30 and carries out the adjustment of height.
As shown in the flowchart of the unmanned aerial vehicle orientation restoring method in fig. 3, an embodiment of the present invention provides an unmanned aerial vehicle orientation restoring method, including:
step 1: placing the first unmanned aerial vehicle on the rotating platform 30, and determining the orientation of the first unmanned aerial vehicle, specifically, the orientation of the first unmanned aerial vehicle can be set according to the orientation requirement of the recovery device on the unmanned aerial vehicle; step 2: scanning a first unmanned characteristic area, acquiring a first group of position information of the first unmanned machine, and further storing the first group of position information in a controller; and step 3: placing the second unmanned aerial vehicle on the rotary platform 30, specifically, pushing the second unmanned aerial vehicle landed on the landing platform 10 onto the rotary platform 30 through the position adjusting device 20; and 4, step 4: scanning a characteristic area of the second unmanned aerial vehicle, acquiring a second group of position information of the second unmanned aerial vehicle, and optionally sending the second group of position information to the controller; and 5: comparing the second set of location information with the first set of location information, optionally, the controller comparing the second set of location information with the stored first set of location information; step 6: judging that the second group of position information is out of the error allowable range relative to the first group of position information, controlling the rotating platform 30 to drive the second unmanned aerial vehicle to rotate, and repeating the step 4 and the step 5; and 7: and judging that the second group of position information is within the error allowable range relative to the first group of position information, and finishing the orientation righting of the second unmanned aerial vehicle.
Further, after the orientation of the second unmanned aerial vehicle is corrected, the position of the second unmanned aerial vehicle is adjusted by the position adjusting device 20.
In step 2 of the unmanned aerial vehicle orientation correcting method, scanning a first unmanned aerial vehicle feature area to obtain a first group of position information of the first unmanned aerial vehicle, specifically:
step 2-1: establishing a polar coordinate system by taking the distance sensor 50 as a pole and leading out a ray from the pole as a polar axis, wherein the intersection point of the polar axis and the first unmanned characteristic region is used as a value (theta) of a first point in the first group of position information0,r0) Wherein, theta0Is 0 degree, r0The distance from the intersection to the distance sensor 50;
step 2-2: the distance sensor 50 continuously scans n sets of points of the first unmanned characteristic region with the first point as a starting point to obtain a first set of position information:
0,r0),(θ1,r1),(θ2,r2)…(θn,rn)
wherein n is a positive integer, theta012…θnFor the arithmetic series, the tolerance is a 1.
In step 4 of the unmanned aerial vehicle orientation correcting method, scanning a characteristic area of a second unmanned aerial vehicle to acquire a second group of position information of the second unmanned aerial vehicle, specifically:
step 4-1: in the polar coordinate system, the intersection point of the polar axis and the characteristic region of the second unmanned aerial vehicle is used as the value (alpha) of the first point in the second group of position information0,d0) Wherein α is0Is 0 degree, d0The distance from the intersection point of the polar axis and the characteristic region of the second unmanned aerial vehicle to the distance sensor 50;
step 4-2: the distance sensor 50 uses the intersection point of the polar axis and the characteristic region of the second unmanned aerial vehicle as a starting point, continuously scans m groups of points of the characteristic region of the second unmanned aerial vehicle, and obtains a second group of position information:
0,d0),(α1,d1),(α2,d2)…(αm,dm)
wherein m is a positive integer, alpha012…αmFor the arithmetic series, the tolerance is a 2.
Optionally, n ═ m; a1 ═ a 2; wherein the values of n and m are less than or equal to 90; the values of a1 and a2 are both 1 degree.
In step 5 of the unmanned aerial vehicle orientation correcting method, comparing the second group of position information with the first group of position information, specifically:
step 5-1: establishing a function of a first set of location information: f (theta)n,rn)=rn
Step 5-2: establishing a function of the second set of location information: f (alpha)m,dm)=dm
Step 5-3: calculating the distance of the corresponding point in the two groups of data according to the polar coordinates of the corresponding point in the first group of position information and the second group of position information: bn=f(αn,dn)-f(θn,rn);
Step 5-4: calculating the average value of the distances of the corresponding points in the two groups of data according to the polar coordinates of the corresponding points in the first group of position information and the second group of position information:
Figure BDA0002938649980000081
step 5-5: calculating the total standard deviation sigma of the two groups of data of the first group of position information and the second group of position information according to a standard deviation formula,
Figure BDA0002938649980000082
and 5-6: will be sigma and sigma0A comparison is made, where σ0Is a fixed value.
In step 6 of the unmanned aerial vehicle orientation correcting method, it is determined that the second group of position information is outside an error allowable range with respect to the first group of position information, specifically: sigma is greater than sigma0
In step 7 of the unmanned aerial vehicle orientation correcting method, it is determined that the second group of position information is within an error allowable range with respect to the first group of position information, specifically: sigma is less than sigma0
In the unmanned aerial vehicle orientation correcting method, after the second group of position information is obtained, error data in the second group of position information obtained by scanning is filtered:
establishing a function f (alpha) of a second set of position informationm,dm)=dm
Judgment of f (. alpha.) (m,dm)>f(αm-1,dm-1) And (alpha)m,dm)>f(αm+1,dm+1) If true, f (alpha) ism+1,dm+1) Is assigned to f (α)m,dm);
Judgment of f (. alpha.) (m,dm)>f(αm-1,dm-1) And (alpha)m,dm)>f(αm+1,dm+1) If not, f (alpha) is not changedm,dm) The value of (c).
Optionally, in the filtering of error data in the second set of location information, the determination is made
f(αm,dm)<f(αm-1,dm-1) And (alpha)m,dm)<f(αm+1,dm+1) If true, f (alpha) ism+1,dm+1) Is assigned to f (α)m,dm) Optionally, mixing f (alpha)m-1,dm-1) Is assigned to f (α)m,dm)。
Although the invention has been described in detail above with reference to a general description and specific examples, it will be apparent to one skilled in the art that modifications or improvements may be made thereto based on the invention. Accordingly, such modifications and improvements are intended to be within the scope of the invention as claimed.

Claims (10)

1. An unmanned aerial vehicle righting device (100), comprising:
the landing platform (10), the landing platform (10) is used for taking off and landing of the unmanned aerial vehicle;
the position adjusting device (20) is arranged at the edge of the landing platform (10) and used for adjusting the position of the unmanned aerial vehicle on the landing platform (10);
the rotating platform (30) is arranged in the middle of the landing platform (10), and the rotating platform (30) drives the unmanned aerial vehicle placed on the rotating platform (30) to be adjusted in the direction through rotation;
a controller controlling rotation of the rotary platform (30);
the distance sensor (50) is used for scanning and acquiring real-time position information of the unmanned aerial vehicle on the rotating platform (30) and sending the real-time position information to the controller;
the controller judges the real-time position information according to preset position information and controls the rotary platform to rotate according to a judgment result.
2. The unmanned aerial vehicle righting device of claim 1,
the unmanned aerial vehicle is provided with a characteristic area, and the characteristic area is used for being matched with the distance sensor (50) to scan to acquire position information;
the position information comprises distance information and orientation information of points of the characteristic region relative to the distance sensor (50).
3. Unmanned aerial vehicle device of reforming as claimed in claim 1, wherein the landing platform (10) is square, and the position adjustment device (20) comprises:
the front-back adjusting device comprises a front-side push rod and a back-side push rod, the front-side push rod and the back-side push rod are respectively arranged on a group of opposite sides of the landing platform and can move on the surface of the landing platform (10);
the left and right adjusting device comprises a left push rod and a right push rod, the left push rod and the right push rod are respectively arranged on the other pair of edges of the landing platform and can move on the surface of the landing platform (10);
the front side push rod the rear side push rod with the left side push rod the right side push rod moves under adjusting motor (21) and controlling adjusting motor (22) drive in the front and back respectively, and promotes unmanned aerial vehicle carries out position control.
4. An unmanned aerial vehicle orientation reforming method is characterized by comprising the following steps:
step 1: placing a first drone on a rotating platform (30), determining an orientation of the first drone;
step 2: scanning the first unmanned characteristic region to acquire a first group of position information of the first unmanned machine;
and step 3: placing a second drone on the rotating platform (30);
and 4, step 4: scanning a characteristic area of the second unmanned aerial vehicle to acquire a second group of position information of the second unmanned aerial vehicle;
and 5: comparing the second set of location information with the first set of location information;
step 6: judging that the second group of position information is out of an error allowable range relative to the first group of position information, controlling the rotating platform (30) to drive the second unmanned aerial vehicle to rotate, and repeating the step 4 and the step 5;
and 7: and judging that the second group of position information is within an error allowable range relative to the first group of position information, and finishing the orientation righting of the second unmanned aerial vehicle.
5. The unmanned aerial vehicle orientation righting method of claim 4, wherein in step 2, scanning the first unmanned aerial vehicle feature area to obtain a first set of location information of the first unmanned aerial vehicle, specifically:
step 2-1: establishing a polar coordinate system by taking a distance sensor (50) as a pole and leading out a ray from the pole as a polar axis, wherein the intersection point of the polar axis and the first unmanned characteristic region is used as the value (theta) of a first point in the first group of position information0,r0) Wherein, theta0Is 0 degree, r0Is the distance of the intersection point to the distance sensor (50);
step 2-2: the distance sensor (50) continuously scans n groups of points of the first unmanned characteristic region by taking the first point as a starting point to obtain the first group of position information:
0,r0),(θ1,r1),(θ2,r2)...(θn,rn)
wherein n is a positive integer, theta0,θ1,θ2...θnFor the arithmetic series, the tolerance is a 1.
6. The unmanned aerial vehicle orientation restoration method according to claim 5, wherein in step 4, a characteristic area of the second unmanned aerial vehicle is scanned, and a second set of position information of the second unmanned aerial vehicle is acquired, specifically:
step 4-1: in the polar coordinate system, an intersection point of the polar axis and the characteristic region of the second unmanned aerial vehicle is used as a value (alpha) of a first point in the second set of position information0,d0) Wherein α is0Is 0 degree, d0The distance from the intersection point of the polar axis and the characteristic region of the second unmanned aerial vehicle to the distance sensor (50);
step 4-2: the distance sensor (50) continuously scans m groups of points of the characteristic region of the second unmanned aerial vehicle by taking the intersection point of the polar axis and the characteristic region of the second unmanned aerial vehicle as a starting point to obtain the second group of position information:
0,d0),(α1,d1),(α2,d2)...(αm,dm)
wherein m is a positive integer, alpha0,α1,α2...αmFor the arithmetic series, the tolerance is a 2.
7. The unmanned aerial vehicle orientation restoration method of claim 6,
n is m; a1 ═ a 2; wherein the values of n and m are less than or equal to 90; the values of a1 and a2 are both 1 degree.
8. The unmanned aerial vehicle orientation righting method of claim 7, wherein in step 5, comparing the second set of location information with the first set of location information specifically comprises:
step 5-1: establishing a function of the first set of location information: f (theta)n,rn)=rn
Step 5-2: establishing a function of the second set of location information: f (alpha)m,dm)=dm
Step 5-3: calculating the distance of corresponding points in two groups of data according to the polar coordinates of the corresponding points in the first group of position information and the second group of position information: bn=f(αn,dn)-f(θn,rn);
Step 5-4: calculating the average value of the distances of the corresponding points in the two groups of data according to the polar coordinates of the corresponding points in the first group of position information and the second group of position information:
Figure FDA0002938649970000031
step 5-5: calculating the total standard deviation sigma of the two groups of data of the first group of position information and the second group of position information according to a standard deviation formula,
Figure FDA0002938649970000032
and 5-6: will be sigma and sigma0A comparison is made, where σ0Is a fixed value.
9. The drone orientation righting method of claim 8,
in step 6, it is determined that the second group of location information is outside an error tolerance range with respect to the first group of location information, specifically: sigma is greater than sigma0
In step 7, it is determined that the second group of location information is within an error tolerance range with respect to the first group of location information, specifically: sigma is less than sigma0
10. The drone orientation normalization method of claim 6, wherein the error data in the second set of location information scanned is filtered:
establishing a function f (alpha) of a second set of position informationm,dm)=dm
Judgment of f (. alpha.) (m,dm)>f(αm-1,dm-1) And (alpha)m,dm)>f(αm+1,dm+1) If true, f (alpha) ism+1,dm+1) Is assigned to f (α)m,dm);
Judgment of f (. alpha.) (m,dm)>f(αm-1,dm-1) And (alpha)m,dm)>f(αm+1,dm+1) If not, f (alpha) is not changedm,dm) The value of (c).
CN202110169853.8A 2021-02-08 2021-02-08 Unmanned aerial vehicle righting device and orientation righting method Active CN112987768B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110169853.8A CN112987768B (en) 2021-02-08 2021-02-08 Unmanned aerial vehicle righting device and orientation righting method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110169853.8A CN112987768B (en) 2021-02-08 2021-02-08 Unmanned aerial vehicle righting device and orientation righting method

Publications (2)

Publication Number Publication Date
CN112987768A true CN112987768A (en) 2021-06-18
CN112987768B CN112987768B (en) 2024-07-26

Family

ID=76348996

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110169853.8A Active CN112987768B (en) 2021-02-08 2021-02-08 Unmanned aerial vehicle righting device and orientation righting method

Country Status (1)

Country Link
CN (1) CN112987768B (en)

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104699082A (en) * 2015-04-01 2015-06-10 北京象限科技有限公司 Unmanned aerial vehicle whole inertial navigation test bench
US20160325849A1 (en) * 2015-05-08 2016-11-10 Aai Corporation Utilizing an unmanned aerial vehicle platform which is equipped with a turntable assembly
US20170358221A1 (en) * 2016-06-10 2017-12-14 ETAK Systems, LLC Air traffic control of unmanned aerial vehicles via wireless networks
CN208198853U (en) * 2018-05-25 2018-12-07 星逻智能科技(苏州)有限公司 The unmanned plane that unmanned plane shuts down library, which is reformed, shuts down library with clamping device and unmanned plane
CN109131922A (en) * 2018-08-30 2019-01-04 上海复亚智能科技有限公司 A kind of automatic airport system of unmanned plane
FR3072655A1 (en) * 2017-10-23 2019-04-26 Sterblue DEVICE FORMING A UNIVERSAL RECEIVING PLATFORM FOR AN AIR VEHICLE WITHOUT PILOT
CN110108264A (en) * 2019-05-24 2019-08-09 北京韦加无人机科技股份有限公司 A kind of unmanned plane horizontally rotates school magnetism method in the air
CN209938993U (en) * 2019-06-05 2020-01-14 三一汽车制造有限公司 Unmanned aerial vehicle recovery unit
CN210149580U (en) * 2019-07-03 2020-03-17 上海寻航者智能科技有限公司 Composite wing unmanned aerial vehicle stop device
CN210882678U (en) * 2019-09-24 2020-06-30 北京京东乾石科技有限公司 Unmanned aerial vehicle mechanism and automatic airport of reforming
US20200239161A1 (en) * 2017-10-16 2020-07-30 Ford Global Technologies, Llc Positioning systems and methods
CN212290378U (en) * 2020-05-27 2021-01-05 江苏东方恒基通用航空有限公司 Platform suitable for aerial battery of changing of unmanned aerial vehicle

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104699082A (en) * 2015-04-01 2015-06-10 北京象限科技有限公司 Unmanned aerial vehicle whole inertial navigation test bench
US20160325849A1 (en) * 2015-05-08 2016-11-10 Aai Corporation Utilizing an unmanned aerial vehicle platform which is equipped with a turntable assembly
US20170358221A1 (en) * 2016-06-10 2017-12-14 ETAK Systems, LLC Air traffic control of unmanned aerial vehicles via wireless networks
US20200239161A1 (en) * 2017-10-16 2020-07-30 Ford Global Technologies, Llc Positioning systems and methods
FR3072655A1 (en) * 2017-10-23 2019-04-26 Sterblue DEVICE FORMING A UNIVERSAL RECEIVING PLATFORM FOR AN AIR VEHICLE WITHOUT PILOT
CN208198853U (en) * 2018-05-25 2018-12-07 星逻智能科技(苏州)有限公司 The unmanned plane that unmanned plane shuts down library, which is reformed, shuts down library with clamping device and unmanned plane
CN109131922A (en) * 2018-08-30 2019-01-04 上海复亚智能科技有限公司 A kind of automatic airport system of unmanned plane
CN110108264A (en) * 2019-05-24 2019-08-09 北京韦加无人机科技股份有限公司 A kind of unmanned plane horizontally rotates school magnetism method in the air
CN209938993U (en) * 2019-06-05 2020-01-14 三一汽车制造有限公司 Unmanned aerial vehicle recovery unit
CN210149580U (en) * 2019-07-03 2020-03-17 上海寻航者智能科技有限公司 Composite wing unmanned aerial vehicle stop device
CN210882678U (en) * 2019-09-24 2020-06-30 北京京东乾石科技有限公司 Unmanned aerial vehicle mechanism and automatic airport of reforming
CN212290378U (en) * 2020-05-27 2021-01-05 江苏东方恒基通用航空有限公司 Platform suitable for aerial battery of changing of unmanned aerial vehicle

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
吴永亮;王田苗;梁建宏;: "微小型无人机三轴磁强计现场误差校正方法", 航空学报, no. 02, pages 330 - 336 *
孟学斌;齐咏生;李永亭;刘利强;: "基于视觉的四旋翼无人机自主降落算法研究", 控制工程, no. 10, pages 97 - 105 *
赵昌丽;朱雅乔;: "无人机本体调校测试系统设计与应用实践", 时代农机, no. 07, pages 83 - 85 *

Also Published As

Publication number Publication date
CN112987768B (en) 2024-07-26

Similar Documents

Publication Publication Date Title
CN104298248B (en) Rotor wing unmanned aerial vehicle accurate vision positioning and orienting method
CN106607907B (en) A kind of moving-vision robot and its investigating method
CN109131922A (en) A kind of automatic airport system of unmanned plane
CN205469865U (en) Unmanned aerial vehicle that takes automatic charging device&#39;s unmanned on duty take off and land platform and system
CN106054931A (en) Unmanned aerial vehicle fixed-point flight control system based on visual positioning
US20210086913A1 (en) Method and system for housing a drone for autonomous long range drone operations
CN106909167A (en) A kind of three-dimensional task system of multimachine multistation joint and method
CN106586011A (en) Aligning method of aerial shooting unmanned aerial vehicle and aerial shooting unmanned aerial vehicle thereof
KR102069240B1 (en) Drone landing apparatus for ship and control method for drone landing using the same
DE112017008173T5 (en) UAV landing systems and procedures
CN106218912A (en) Unmanned plane battery exchanges automatically, data are transmitted and fault detect platform
CN109501747A (en) Automobile position regulating system, automobile position adjusting method and electrical changing station
CN110815825B (en) Printing method of 3D object slice layer, printing method of 3D object and printing device
CN108820215B (en) Automatic air-drop unmanned aerial vehicle capable of automatically searching target
CN109991994B (en) Flight simulator-based small unmanned aerial vehicle track and attitude correction method
CN205931251U (en) Fixed wing uavs stall descending system of hovering
CN107505953A (en) A kind of unmanned plane automatic tracking antenna system and its tracking
JP2020138681A (en) Control system for unmanned flight vehicle
CN106227230A (en) A kind of unmanned aerial vehicle (UAV) control method
CN111578904A (en) Unmanned aerial vehicle aerial surveying method and system based on equidistant spirals
CN112987768A (en) Unmanned aerial vehicle righting device and orientation righting method
WO2021134428A1 (en) Unmanned aerial vehicle landing control method and device, uav base station, and uav system
CN111476818B (en) Low-altitude unmanned aerial vehicle target tracking device with multiple cameras and tracking method
CN108803652A (en) A kind of autonomous tracking control method of rotor craft
CN110697037B (en) Hybrid flight method of tilt rotor unmanned aerial vehicle

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant