Inertial vision integrated navigation method based on optical flow method
A technology of combined navigation and optical flow method, applied in navigation, mapping and navigation, and navigation through speed/acceleration measurement, etc. The effect of improving adaptability
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Example Embodiment
[0021] Specific implementation mode 1: The specific process of this embodiment is: the specific process of an inertial vision integrated navigation method based on the optical flow method is:
[0022] Step 1. Define the world coordinate system O w X w Y w Z w , UAV body coordinate system O b X b Y b Z b , Camera coordinate system O c X c Y c Z c , Physical imaging coordinate system O 1 xy and pixel image plane coordinate system Ouv;
[0023] Step 2. Mount the three types of sensors: IMU, camera and altimeter on the UAV, collect images through the camera, and follow the figure 2 The process of performing pyramid LK calculation to obtain two-dimensional optical flow data;
[0024] IMU consists of gyroscope and accelerometer;
[0025] Step 3: Convert the two-dimensional optical flow data information obtained in step two into three-dimensional navigation information, that is, the position of the drone in the world coordinate system;
[0026] Step 4. Perform inertial navigation based on IMU ...
Example Embodiment
[0031] Specific embodiment two: this embodiment is different from specific embodiment one in that the world coordinate system O is defined in the step one w X w Y w Z w , UAV body coordinate system O b X b Y b Z b , Camera coordinate system O c X c Y c Z c , Physical imaging coordinate system O 1 xy and pixel image plane coordinate system Ouv; specifically:
[0032] a. World coordinate system O w X w Y w Z w :
[0033] Use the North-East-Earth coordinate system as the world coordinate system, the origin of the world coordinate system O w Is the projection of the initial position of the drone on the ground, coordinate axis O w X w Point to the north of the earth, O w Y w Point to the east of the earth, O w Z w It is perpendicular to the surface of the earth and points downward; the world coordinate system is a fixed coordinate system;
[0034] b. UAV body coordinate system O b X b Y b Z b :
[0035] Origin of body coordinate system O b Take it on the center of mass of the drone, O b X b...
Example Embodiment
[0043] Specific embodiment three: This embodiment is different from specific embodiments one or two in that in the second step, three sensors of IMU, camera and altimeter are mounted on the drone, and images are collected by the camera, and the collected images are as follows figure 2 The process of performing pyramid LK calculation to obtain two-dimensional optical flow data; the specific process is:
[0044] Step 2-1: Convert the two frames before and after the color image collected by the camera into grayscale images;
[0045] Step 2-2. Use Shi-Tomasi corner detection method to find a certain number of feature points in the previous frame, and accurate the feature point coordinates of the previous frame to sub-pixel accuracy;
[0046] Step 2-3: Use the LK algorithm of the pyramid idea to detect the position of the feature point identified in the previous frame in the next frame and determine the coordinate of the feature point in the next frame;
[0047] Steps 2-4. Finally, accordin...
PUM
Abstract
Description
Claims
Application Information
- R&D Engineer
- R&D Manager
- IP Professional
- Industry Leading Data Capabilities
- Powerful AI technology
- Patent DNA Extraction
Browse by: Latest US Patents, China's latest patents, Technical Efficacy Thesaurus, Application Domain, Technology Topic.
© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap