System and method for selecting an operation mode of a mobile platform
11465743 · 2022-10-11
Assignee
Inventors
Cpc classification
G01C3/14
PHYSICS
H04N13/239
ELECTRICITY
B64C39/024
PERFORMING OPERATIONS; TRANSPORTING
H04N2013/0081
ELECTRICITY
International classification
G01C3/14
PHYSICS
H04N13/239
ELECTRICITY
G05D1/10
PHYSICS
Abstract
A method for selecting an operation mode of a mobile platform includes detecting a height grade of the mobile platform and selecting an operation mode of the mobile platform according to a result of the detecting.
Claims
1. A method for selecting an operation mode of an unmanned aerial vehicle (UAV), comprising: detecting a height grade of the UAV, wherein detecting the height grade comprises determining a height of the UAV and/or a disparity between first and second images of a remote object from a perspective of the UAV; selecting an operation mode of the UAV from a plurality of height modes according to the determined height grade, wherein the plurality of height modes comprises a first height mode and a second height mode, the first height mode being a monocular mode and the second height mode being a stereo vision mode; and controlling, by a processor, the UAV to operate based on the selected operation mode.
2. The method of claim 1, wherein the method further comprises categorizing the operation modes based on values of the height and/or the disparity.
3. The method of claim 1, wherein selecting the operation mode of the UAV comprises: switching the operation mode of the UAV from the first height mode to the second height mode when the height is greater than a first height threshold and the disparity is less than a first disparity threshold.
4. The method of claim 1, wherein selecting the operation mode of the UAV comprises: switching the operation mode of the UAV from the second height mode to the first height mode when the height is less than a second height threshold and the disparity is greater than a second disparity threshold.
5. The method of claim 1, wherein selecting the operation mode of the UAV comprises: switching the operation mode of the UAV from the first height mode to the second height mode when the height is greater than a first height threshold.
6. The method of claim 1, wherein selecting the operation mode of the UAV comprises: switching the operation mode of the UAV from the second height mode to the first height mode when the disparity is greater than a second disparity threshold.
7. The method of claim 1, wherein the plurality of height modes further comprises a third height mode and a fourth height mode.
8. The method of claim 1, wherein the second height mode is a stereo vision mode with a first resolution, the plurality of height modes further comprises a third height mode, and the third height mode is a stereo vision mode with an enhanced resolution.
9. The method of claim 8, wherein selecting the operation mode of the UAV comprises: switching the operation mode of the UAV from the second height mode to the third height mode when the disparity is less than or equal to a third disparity threshold.
10. The method of claim 8, wherein selecting the operation mode of the UAV comprises: switching the operation mode of the UAV from the third height mode to the second height mode when the disparity is greater than a fourth disparity threshold.
11. The method of claim 1, wherein the first height mode is a very low altitude monocular mode, the plurality of height modes further comprises a fourth height mode, the fourth height mode being a high altitude monocular mode.
12. The method of claim 11, wherein selecting the operation mode of the UAV comprises: switching the operation mode of the UAV from the third height mode to the fourth height mode when the height is greater than a third height threshold and the disparity is less than a fifth disparity threshold.
13. The method of claim 11, wherein selecting the operation mode of the UAV comprises: switching the operation mode of the UAV from the fourth height mode to the third height mode when the height is less than a fourth height threshold and the disparity is greater than a sixth disparity threshold.
14. The method of claim 1, wherein the method further comprises: assigning an initial mode to the operation mode of the UAV, the initial mode being selected from the plurality of height modes.
15. The method of claim 14, wherein the initial mode is a very low altitude monocular mode.
16. An apparatus for selecting an operation mode of an unmanned aerial vehicle (UAV), comprising: a binocular imaging device associated with the UAV; and a processor configured to: detect a height grade of the UAV, comprising: determine a height of the UAV and/or a disparity between first and second images of a remote object from the perspective of the UAV; select an operation mode of the UAV from a plurality of height modes according to the determined height grade, wherein the plurality of height modes comprises a first height mode and a second height mode, the first height mode is a monocular mode and the second height mode is a stereo vision mode; and control the UAV to operate based on the selected operation mode.
17. The apparatus of claim 16, wherein the processor is configured to: switch the operation mode of the UAV from the first height mode to the second height mode when the height is greater than a first height threshold and the disparity is less than a first disparity threshold.
18. The apparatus of claim 16, wherein the processor is configured to: switch the operation mode of the UAV from the second height mode to the first height mode when the height is less than a second height threshold and the disparity is greater than a second disparity threshold.
19. The apparatus of claim 16, wherein the processor is configured to: switch the operation mode of the UAV from the first height mode to the second height mode when the height is greater than a first height threshold.
20. The apparatus of claim 16, wherein the processor is configured to: switch the operation mode of the UAV from the second height mode to the first height mode when the disparity is greater than a second disparity threshold.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16) It should be noted that the figures are not drawn to scale and that elements of similar structures or functions are generally represented by like reference numerals for illustrative purposes throughout the figures. It also should be noted that the figures are only intended to facilitate the description of the embodiments. The figures do not illustrate every aspect of the described embodiments and do not limit the scope of the present disclosure.
DETAILED DESCRIPTION OF THE EMBODIMENTS
(17) Navigation of Unmanned Aerial Vehicles (“UAVs”) commonly is performed by using stereo vision technology for operating the UAVs. However, the precision of stereo vision technology is limited and can vary in accordance with height.
(18) Stereo vision systems typically perform navigation by considering an overlapping area of a scene as viewed by each of two lenses of the stereo vision system. A baseline length between the lenses of conventional stereo vision systems typically is between four centimeters and twenty centimeters. The applicable height range of the stereo vision technology, however, is restricted by the baseline length. In other words, the range of measurable height is limited by the baseline length.
(19) The overlapping area of the scene is relied on to operate the UAV. At low altitude, for example, a distance between the lenses of the binocular imaging system and the ground is too short to form a usable overlapping area between each scene viewed by the lenses of the binocular imaging device. Whereas, at very high altitude, a distance between the lenses of the stereo vision system and the ground is too long. In such case, the long distance generates a short baseline between the two lenses of the stereo vision system, resulting inaccurate calculation results.
(20) Since currently-available stereo vision navigation systems are restricted by baseline lengths, a mobile system and method that can meet the requirements of operating the UAV at various heights by switching among operation modes based on a height of the mobile system and a disparity can prove desirable and provide a basis for accurate measurement of depth, for systems such as UAV systems and other mobile systems. This result can be achieved, according to one embodiment disclosed in
(21) Referring now to
(22) At 130, the mobile platform 200 can use the acquired height grade, i.e. the height 121 and/or the disparity 122, to select or switch among several predetermined operation modes 131. The operation modes 131 can comprise operations involving various devices associated with the mobile platform 200, which can be included at any time. Such devices are shown and described below with reference to
(23) Although shown and described as using the height 121 and/or the disparity 122 as the criteria for selecting or switching operation modes for illustrative purposes only, other suitable condition data can be used for the criteria of selecting or switching among operation modes.
(24)
(25) In
(26) Although shown and described as using the devices 251-254 for purposes of illustrations only, any other suitable devices can also be used for detecting the conditions for determining the switching among the operation modes 131. The mobile platform 200 can comprise any conventional type of mobile platform that can have an elevation and is illustrated in
(27)
(28) At different heights or altitudes, a variation of operation modes can be used to operate the mobile platform 200. For the purposes of operating the mobile platform 200 at all heights, the operation modes can be categorized according to several height grades. Additional detail of the categorization will be shown and described below with reference to
(29) Although described as categorizing the operation modes according to different height grades for purposes of illustrations only, the categorization under this disclosure can based on any other suitable information, such as based on a combination of the height 121 and the disparity 122.
(30)
(31) The third height mode 413 is designed to be used with, for example, a third height range of three and half meters (3.5 m) to twenty meters (20 m). Within the third height range, a binocular device with a normal resolution of three hundred and twenty by two hundred and forty (320×240) cannot meet the requirements of detecting the depth and selecting an operation mode of the mobile platform 200. To deal with the issue, under the third height mode 413, an enhanced resolution binocular mode can be utilized to determine the height 121 and selecting an operation mode of the mobile platform 200. Under the enhanced resolution binocular mode, the resolution can be at least six hundred and fourth by four hundred and eighty (640×480).
(32) The second height mode 412 is designed to be used with, for example, a second height range of fifty centimeters (50 cm) to three and a half meters (3.5 m). Within the second height range, the second height mode 412 can use a normal-resolution binocular mode, which can use a resolution of three hundred and twenty by two hundred and forty (320×240).
(33) The first height mode 411 is designed to be used with, for example, a first height range of ten centimeters (10 cm) to fifty centimeters (50 cm). Within the first height range, there may not be enough overlapping between images acquired with two lenses for a binocular system because of a short distance between the lenses and an object of interest. Therefore, under the first height mode 411, a very low altitude monocular mode can be used; wherein, other distance sensors can be employed to detect a distance between an optical center of a lens and the ground level, i.e. the object depth, for selecting an operation mode of the mobile platform 200.
(34) Although shown and described as categorizing operation modes into four categories for purposes of illustration only, any suitable number of categories can be utilized under the present disclosure. In addition to the height 121 to the ground, the present disclosure can use other conditions in categorizing and/or switching among the operation modes. Such conditions can comprise the disparity 122.
(35)
(36) At 230, the height 121 and the disparity 122 information can be combined. The combined information can be used in deciding the operation mode 131, at 240. Although shown and described as using the combined information to decide the operation mode 131, either the height 121 or and disparity 122 can be used separately in deciding the operation mode 131.
(37)
(38) Additionally and/or alternatively, the ultrasonic detector 252 can be used to detect a distance 121 of an object 288 (shown in
(39) The GPS 253 is a space-based satellite navigation system that can provide a location, a height and/or time information anywhere on or near the earth where there is an unobstructed line of sight to four or more GPS satellites. The GPS 252 can comprise any GPS devices commercially available from the market. The location can be provided by the GPS 253 as longitude and latitude. The height can be a height in meters or feet to the ground level.
(40) The height 121, applicable under this disclosure, can be any vertical distance in a range of twenty-five centimeters (25 cm) to over one hundred meters (100 m) to the ground level. As shown and described with reference to
(41)
(42) In some embodiments of the mobile platform 200, the processor 910 can be provided for obtaining and processing the information obtained from the barometer 251, the ultrasonic detector 252, the GPS 253 and/or the binocular device 254. Such information includes the height 121 and the disparity 122 (collectively shown in
(43) The processor 910 can comprise any commercially available processing chip or be any custom-designed processing chips specially produced for the apparatus 900 for selecting an operation mode of the mobile platform 200. Additionally and/or alternatively, the processor 910 can include one or more general purpose microprocessors (for example, single or multi-core processors), application-specific integrated circuits, application-specific instruction-set processors, data processing units, physics processing units, digital signal processing units, coprocessors, network processing units, audio processing units, encryption processing units, and the like. The processor 910 can be configured to perform any of the methods described herein, including but not limited to, a variety of operations relating to operation mode selection. In some embodiments, the processor 910 can include specialized hardware for processing specific operations relating to operation mode selection.
(44)
(45) When operating under the first height mode 411 and two conditions are met, at 930, the mobile platform 200 can switch to a second height mode 412. The two conditions can include that the disparity 122 of the binocular imaging device 254 is less than or equal to a first disparity threshold Td1 and the height 121 of the mobile platform 200 elevates above a first height threshold Th1. In another embodiment, the operation mode can be switched from the first height mode 411 to the second height mode 412 when only the height 121 of the mobile platform 200 elevates above a first height threshold Th1.
(46) The first disparity threshold Td1 can be selected from a first disparity range of sixty-two centimeters (62 cm) to eighty-two centimeters (82 cm), and, in some embodiments, to be seventy-two centimeters (72 cm). The first height threshold Th1 can be selected from a value in a first height range of twenty centimeters (20 cm) to eighty centimeters (80 cm) and, in some embodiments, to be fifty centimeters (50 cm).
(47) When the disparity 122 of the binocular imaging device of the stereo vision system is less than or equal to a third disparity threshold Td3 the mobile platform 200 can switch to a third height mode 413. As shown and described with reference to
(48) The third disparity threshold Td3 can be selected from a third disparity range of five centimeters (5 cm) to fifteen centimeters (15 cm) and, in some embodiments, to be ten centimeters (10 cm).
(49) When two conditions are met, at 934, the operation mode can be switched to a fourth height mode 414. The two conditions can comprise that the disparity 122 of the binocular imaging device of the stereo vision system being less than or equal to a fifth disparity threshold Td5 and the height of the mobile platform 200 elevating above a third height threshold Th3. The fourth height mode 414 can comprise a high altitude monocular operation mode, which can utilize a barometer, a GPS and/or vision detector as shown and described above with reference to
(50) The fifth disparity threshold Td5 can be selected from a value in a fifth disparity range of one centimeter (1 cm) to three centimeters (3 cm), and, in some embodiments, to be two centimeters (2 cm). The third height threshold Th3 can be selected from a value in a third height range of fifteen meters (15 m) to twenty-five meters (25 m) and, in some embodiments, to be twenty meters (20 m).
(51) When operating with the fourth height mode 414, the mobile platform 200 can switch to other operation modes when any of certain conditions 931, 933 is satisfied. At 931, when the disparity 122 is greater than equal to a sixth disparity threshold Td6 and the height 121 of the mobile platform 200 is less than or equal to a fourth threshold Th4, for example, the mobile platform 200 can switch to the third height mode 413. In another embodiment, the mobile platform 200 can switch to the third height mode 413 when only the height 121 of the mobile platform 200 becomes less than or equal to the fourth threshold Th4.
(52) At 933, when the disparity 122 is greater than or equal to a fourth disparity threshold Td4, the mobile platform 200 can switch to the second height mode 412.
(53) The sixth disparity threshold Td6 can be selected from a value in a sixth disparity range of one and a half centimeters (1.5 cm) to four centimeters (4 cm), and, in some embodiments, to be two and a half centimeters (2.5 cm). The fourth height threshold, Th4, can be selected from a value in a fourth height range of fifteen meters (15 m) to twenty-two meters (22 m) and, in some embodiments, to be eighteen meters (18 m). The fourth disparity threshold Td4 can be selected from a value in a fourth disparity range of nine centimeters (9 cm) to fifteen centimeters (15 cm) and, in some embodiments, to be twelve centimeters (12 cm).
(54) When operating at the third height mode 413, if the disparity 122 gets greater than or equal to the fourth disparity threshold Td4, the mobile platform 200 can switch to the second height mode 412.
(55) When operating with the second height mode 412, the mobile platform 200 can switch to the first height mode 411 when conditions at 935 are satisfied. At 935, when the disparity 122 is greater than or equal to a second disparity threshold Td2 and the height 121 of the mobile platform 200 is less than or equal to a second height threshold Th2, the mobile platform 200 can switch to the first height mode 411. In another embodiment, the mobile platform 200 can switch to the first height mode 411 when only the height 121 of the mobile platform 200 becomes less than or equal to the second threshold Th2.
(56) The second disparity threshold Td2 can be selected from a value in a second disparity range of sixty centimeters (60 cm) to eighty centimeters (80 cm), and, in some embodiments, to be seventy centimeters (70 cm). The second height threshold, Th2, can be selected from a value in a second height range of twenty-five centimeters (25 cm) to sixty-five centimeters (65 cm), and, in some embodiments, to be forty-five centimeters (45 cm).
(57) The second disparity threshold Td2 can be greater than the first disparity threshold Td1. One or both of the first and second disparity thresholds Td1, Td2 can be greater than one or both of the third and fourth disparity thresholds Td3, Td4. The first height threshold Th1 can be greater than the second height threshold Th2. One or both of the first and second height thresholds Th1, Th2 can be greater than one or both of third and fourth height thresholds Th3, Th4. The third disparity threshold Td3 can be greater than the fourth disparity threshold Td4. One or both of the third and fourth disparity thresholds Td3, Td4 can be greater than one or both of the fifth and sixth disparity thresholds Td5, Td6. The sixth disparity threshold Td6 can be greater than the fifth disparity threshold Td5.
(58)
(59)
(60) where c.sub.x, and c.sub.y represent respective center O.sub.l, O.sub.r coordinates of the lenses 510a and 510b, and y.sub.i represent the coordinates of the object 598 of interest in each of the images 520a and 520b respectively, Tis the baseline (in other words, the distance between the center coordinates of the lenses 510a and 510b), f is a rectified focal length of the lenses 510a and 510b, i is an index over multiple objects of interest 598 and/or over multiple feature points 355 (shown in
d.sub.i=x.sub.i.sup.l−x.sub.i.sup.r Equation (4)
(61) Based on the discussion for
d=argmin.sub.d|I.sup.L(x.sub.l)−I.sup.R(x.sub.l+d)|, Equation (5)
(62) where d represents the disparity of the two lenses 510a, 510b, I.sup.L refers to the first image 520a, I.sup.R refers to the second image 520b of the same object 598 of interest, x.sub.l is the point x.sub.i.sup.l of the first image 520a.
(63) Because of possible matching errors to ascertain matching accuracy and vision range, the disparity d cannot be less or greater than certain predetermined values. In some embodiments, the disparity d is greater than 5 pixels and less than one fifth of a width of the second image 520b, which can be the same size with the first image 520a. As an illustrative example, suppose f=480, T=0.15 m, and image resolution is 320×240 pixels, an effective vision range of 1.5 m to 15.4 m can be deducted.
(64)
(65) In some embodiments, a method of using Binary Robust Independent Elementary Features (“BRIEF”) descriptors can be used for matching the point of the second image 520b with the corresponding point 355 of the first image 520a. In an exemplary embodiment, a first binary string, representing a first region around the selected feature point of the first image 520a, can be built by comparing intensities of each point pairs of the region. The first binary string can be the first BRIEF descriptor of the selected feature point of the first image 520a.
(66) Similarly, a second binary string representing a second region around the point 355 of the second image 520b can be built by comparing intensities of each point pairs of the second region. The second binary string can be a second BRIEF descriptor.
(67) A similarity between the selected feature point of the first image 520a and the point 355 of the second image 520b can be calculated by comparing a hamming distance between the first BRIEF descriptor and the second BRIEF descriptor. The point 355 of the second image 520b can be determined as matching the selected feature point of the first image 520a when a hamming distance between the first BRIEF descriptor and the second BRIEF descriptor is less than a first hamming threshold.
(68) Turning now to
(69) At 924, the selected feature points 355 can be matched from the first image 520a onto the second image 520b. In some embodiments, matching of the feature points 355 consists of two procedures as shown in
(70) At 924B, while scanning for each point, a similarity is calculated between two points in the manner shown and described above in detail herein with reference to
(71) Returning to
(72)
(73)
(74) The distance sensor 361 described herein can include, but is not limited to, an ultrasonic detector and/or a laser detection device for detecting a distance.
(75) In
(76) The mobile platform 200 can detect an operating height of a third height grade. Upon detecting the second height grade, the mobile platform 200 can select a third height mode 413 (shown in
(77) The mobile platform 200 can detect an operating height of a fourth height grade. Upon detecting the fourth height grade, the mobile platform 200 can select a fourth height mode 414 (shown in
(78)
(79) In some embodiments of the flying operation system 400, the processor 910 can be provided for obtaining and processing the measurements obtained from the sensors 360. Such measurements can include, but are not limited to, a distance to an object 288 (shown in
(80) The described embodiments are susceptible to various modifications and alternative forms, and specific examples thereof have been shown by way of example in the drawings and are herein described in detail. It should be understood, however, that the described embodiments are not to be limited to the particular forms or methods disclosed, but to the contrary, the present disclosure is to cover all modifications, equivalents, and alternatives.