150 likes | 325 Views
Obstacle Detection for Low Flying UAS Using Monocular Camera. Fan Zhang, Rafik Goubran , Paul Straznicky May 16, 2012. Introduction. Autonomous navigation for low flying UAS requires accurate terrain elevation map, which demands accurate range measurement. Methods:
E N D
Obstacle Detection for Low Flying UAS UsingMonocular Camera Fan Zhang, RafikGoubran, Paul Straznicky May 16, 2012
Introduction • Autonomous navigation for low flying UAS requires accurate terrain elevation map, which demands accurate range measurement. • Methods: • Range measurement at a point: • Laser Rage Finder • Ultrasonic Signal • Range measurement for the entire field of view • 3D flash Lidar • Image sensor with computer vision algorithm Inertial Aided Inverse Depth Extended Kalman Filter (EKF)
Inertial Aided Inverse Depth Extended Kalman Filter (EKF) • Sparse terrain model by features detection and tracking. • Less noisy and faster speed • Inertial Measurement • Better prediction of sensor location • Inverse Parameterization for Features • Features at near infinity • Early integration of features into the EKF • Camera Centric Coordinate • Improve linearity when camera travels away from the world frame origin • Extended Kalman Filter • Gradually fuses new information with existing measurement
Full State Vector • World frame coordinate and orientation in camera frame. • camera motion parameters : • feature coordinate in camera frame
Measurement Model • Projection vector viewed at the predicted camera location • Projection onto image plane
Data Collection GS-111M GPS Antenna
Elevation Map from Camera vs. Ground Truth Elevation Map Constructed from Features Parameters Ground Truth Digital Elevation Map (DEM)
Elevation ErrorA Point to Point Comparison Mean Error = 15.87 meters Standard Deviation = 20.93 meters Max. Difference = 69.93 meters Min. Difference = 2.87 meters Max. Reported DEM Error = 16 meters
Conclusion • An inertial aided inverse depth Extended Kalman Filter framework • Outdoor flight video data collected using a SUAS towed by a helicopter • Result of the algorithm provides accurate estimates for features positions and the sensor’s own location • To obtain high resolution terrain elevation map, camera with high resolution and high dynamic range is required.