Enhanced Drone Navigation in GNSS Denied Environment Using VDM and Hall Effect Sensor
Abstract
:1. Introduction
2. System Overview
2.1. Air-Odo
- L is the drag force from the airflow.
- m is the resisting plate mass.
- g is the gravity constant.
- is the deflection angle made by the resisting plate due to drag force.
2.2. Vehicle Dynamic Model
2.2.1. Thrust
- is the motor thrust coefficient which depends on the geometry of the motor.
- is air density.
- is the propellers cross section area.
- is the motor radius.
- is the motor angular velocity.
2.2.2. Torque
- is the motor torque coefficient.
- d represents the distance between the quadcopter center and the motor.
2.2.3. Quadcopter Dynamic Model Equation of Motion
- is 3 × 3 matrix defining the inertia of the quadcopter in the body frame as shown in Equation (13).
- represent the moments produced by the aerodynamic thrusts and torques on the body frame.
- is the body angular rates skew symmetric form as given in equation.
- is the body rotational rate (angular velocity).
- and are the gyroscopic forces X and Y directions, respectively.
- is the velocity of the quadcopter in the body frame (X, Y, and Z).
- m is the quadcopter total mass.
- represents the force acting on the body due to the motors thrust.
- is the gravitational force acting on the body frame.
- is the rotation from the body frame to inertial the frame.
2.3. Sensor Integration
2.4. Extended Kalman Filter Framework
- are the position, velocity, and attitude error vector, respectively.
- , and are the accelerometers bias and gyros drift, respectively.
- and are the accelerometers and gyros scale factor, respectively.
- is the state transition matrix.
- is the error states.
- is the noise coefficient matrix.
- is the predicted covariance matrix.
- is the system noise.
- is the covariance matrix of system noise.
- is the design matrix.
- is the Kalman gain.
- is the updated states.
- is the updated covariance matrix
- is the innovation sequence
3. Experiments and Results
3.1. Hardware Setup
3.2. Indoor Experiment
3.3. Outdoor Experiment
3.3.1. INS Solution in Standalone Mode (Dead-Reckoning)
3.3.2. Air-Odo/VDM/INS integration
4. Conclusions
5. Patents
Author Contributions
Funding
Conflicts of Interest
References
- Lau, T.K.; Liu, Y.; Lin, K.W. Inertial-Based Localization for Unmanned Helicopters against GNSS Outage. IEEE Trans. Aerosp. Electron. Syst. 2013, 49, 1932–1949. [Google Scholar] [CrossRef]
- Mostafa, M.M.; Moussa, A.M.; El-Sheimy, N.; Sesay, A.B. Optical Flow Based Approach for Vision Aided Inertial Navigation Using Regression Trees. In Proceedings of the 2017 International Technical Meeting of The Institute of Navigation, Monterey, CA, USA, 30 January–02 February 2017; pp. 856–865. [Google Scholar] [CrossRef]
- Chugo, D.; Yokota, S.; Matsushima, S.; Takase, K. Camera-based indoor navigation for service robots. In Proceedings of the SICE Annual Conference 2010, Taipei, Taiwan, 18–21 August 2010; pp. 1008–1013. [Google Scholar]
- Huang, K.-C.; Tseng, S.-H.; Mou, W.-H.; Fu, L.-C. Simultaneous localization and scene reconstruction with monocular camera. In Proceedings of the 2012 IEEE International Conference on Robotics and Automation, St. Paul, MN, USA, 14–18 May 2012; pp. 2102–2107. [Google Scholar] [CrossRef]
- Zarándy, Á.; Nemeth, M.; Nagy, Z.; Kiss, A.; Santha, L.; Zsedrovits, T. A real-time multi-camera vision system for UAV collision warning and navigation. J. Real-Time Image Process. 2016, 12, 709–724. [Google Scholar] [CrossRef]
- Achtelik, M.; Achtelik, M.; Weiss, S.; Siegwart, R. Onboard IMU and monocular vision based control for MAVs in unknown in- and outdoor environments. In Proceedings of the 2011 IEEE International Conference on Robotics and Automation, Shanghai, China, 9–13 May 2011; pp. 3056–3063. [Google Scholar] [CrossRef]
- Wang, C.; Wang, T.; Liang, J.; Chen, Y.; Zhang, Y.; Wang, C. Monocular visual SLAM for small UAVs in GPS-denied environments. In Proceedings of the 2012 IEEE International Conference on Robotics and Biomimetics (ROBIO), Guangzhou, China, 11–14 December 2012; pp. 896–901. [Google Scholar] [CrossRef]
- Urzua, S.; Munguía, R.; Grau, A. Vision-based SLAM system for MAVs in GPS-denied environments. Int. J. Micro Air Veh. 2017, 9, 283–296. [Google Scholar] [CrossRef]
- Chuanqi, C.; Xiangyang, H.; Zhenjie, Z.; Mandan, Z. Monocular visual odometry based on optical flow and feature matching. In Proceedings of the 2017 29th Chinese Control and Decision Conference (CCDC), Chongqing, China, 28–30 May 2017; pp. 4554–4558. [Google Scholar] [CrossRef]
- Gao, Y.; Liu, S.; Atia, M.M.; Noureldin, A. INS/GPS/LiDAR Integrated Navigation System for Urban and Indoor Environments Using Hybrid Scan Matching Algorithm. Sensors 2015, 15, 23286–23302. [Google Scholar] [CrossRef] [PubMed] [Green Version]
- Kumar, G.A.; Patil, A.K.; Patil, R.; Park, S.S.; Chai, Y.H. A LiDAR and IMU Integrated Indoor Navigation System for UAVs and Its Application in Real-Time Pipeline Classification. Sensors 2017, 17, 1268. [Google Scholar] [CrossRef]
- Mohamed, H.; Moussa, A.; Elhabiby, M.; El-Sheimy, N.; Sesay, A. A Novel Real-Time Reference Key Frame Scan Matching Method. Sensors 2017, 17, 1060. [Google Scholar] [CrossRef]
- Bailey, T.; Durrant-Whyte, H. Simultaneous localization and mapping (SLAM): part II. IEEE Robot. Autom. Mag. 2006, 13, 108–117. [Google Scholar] [CrossRef]
- Hemann, G.; Singh, S.; Kaess, M. Long-range GPS-denied aerial inertial navigation with LIDAR localization. In Proceedings of the 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Daejeon, Korea, 9–14 October 2016; pp. 1659–1666. [Google Scholar] [CrossRef]
- Tang, J.; Chen, Y.; Niu, X.; Wang, L.; Chen, L.; Liu, J.; Shi, C.; Hyyppä, J. LiDAR Scan Matching Aided Inertial Navigation System in GNSS-Denied Environments. Sensors 2015, 15, 16710–16728. [Google Scholar] [CrossRef] [PubMed] [Green Version]
- Mostafa, M.; Zahran, S.; Moussa, A.; El-Sheimy, N.; Sesay, A. Radar and Visual Odometry Integrated System Aided Navigation for UAVS in GNSS Denied Environment. Sensors 2018, 18, 2776. [Google Scholar] [CrossRef] [PubMed]
- Zahran, S.; Mostafa, M.M.; Masiero, A.; Moussa, A.; Vettore, A.; El-Sheimy, N. Micro-Radar and UWB Aided UAV Navigation In GNSS Denied Environment. In The International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences, Proceedings of the 2018 ISPRS TC I Mid-term Symposium: Innovative Sensing – From Sensors to Methods and Applications, Karlsruhe, Germany, 10–12 October 2018; ISPRS: Hannover, Germany, 2018; pp. 469–476. [Google Scholar] [CrossRef]
- Fasano, G.; Renga, A.; Vetrella, A.R.; Ludeno, G.; Catapano, I.; Soldovieri, F. Proof of concept of micro-UAV-based radar imaging, International Conference on Unmanned Aircraft Systems (ICUAS). In Proceedings of the 2017 International Conference on Unmanned Aircraft Systems (ICUAS), Miami, FL, USA, 13–16 June 2017; pp. 1316–1323. [Google Scholar] [CrossRef]
- Quist, E.B.; Beard, R.W. Radar odometry on fixed-wing small unmanned aircraft. IEEE Trans. Aerosp. Electron. Syst. 2016, 52, 396–410. [Google Scholar] [CrossRef]
- Scannapieco, A.F.; Renga, A.; Fasano, G.; Moccia, A. Ultralight radar for small and micro-UAV navigation. In The International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences, Proceedings of the International Conference on Unmanned Aerial Vehicles in Geomatics, Bonn, Germany, 4–7 September 2017; ISPRS: Hannover, Germany, 2017; pp. 333–338. [Google Scholar] [CrossRef]
- Li, R.; Liu, J.; Zhang, L.; Hang, Y. LIDAR/MEMS IMU integrated navigation (SLAM) method for a small UAV in indoor environments. In Proceedings of the 2014 DGON Inertial Sensors and Systems (ISS), Karlsruhe, Germany, 16–17 September 2014; pp. 1–15. [Google Scholar] [CrossRef]
- Hirose, M.; Xiao, Y.; Zuo, Z.; Kamat, V.R.; Zekkos, D.; Lynch, J. Implementation of UAV localization methods for a mobile post-earthquake monitoring system. In Proceedings of the 2015 IEEE Workshop on Environmental, Energy, and Structural Monitoring Systems (EESMS) Proceedings, Trento, Italy, 9–10 July 2015; pp. 66–71. [Google Scholar] [CrossRef]
- Wang, Y.-T.; Peng, C.-C.; Ravankar, A.A.; Ravankar, A. A Single LiDAR-Based Feature Fusion Indoor Localization Algorithm. Sensors 2018, 18, 1294. [Google Scholar] [CrossRef] [PubMed]
- Wang, F.; Zhao, Z. A survey of iterative closest point algorithm. In Proceedings of the Chinese Automation Congress (CAC), Jinan, China, 20–22 October 2017; pp. 4395–4399. [Google Scholar] [CrossRef]
- Rusinkiewicz, S.; Levoy, M. Efficient variants of the ICP algorithm. In Proceedings of the Third International Conference on 3-D Digital Imaging and Modeling, Quebec City, QC, Canada, 28 May–1 June 2001; pp. 145–152. [Google Scholar] [CrossRef]
- Censi, A. An ICP variant using a point-to-line metric. In Proceedings of the 2008 IEEE International Conference on Robotics and Automation, Pasadena, CA, USA, 19–23 May 2008; pp. 19–25. [Google Scholar] [CrossRef]
- Zahran, S.; Moussa, A.; El-Sheimy, N.; Sesay, A.B. Hybrid Machine Learning VDM for UAVs in GNSS-denied Environment. Nav. J. Inst. Nav. 2018, 65, 477–492. [Google Scholar] [CrossRef]
- Koifman, M.; Bar-Itzhack, I.Y. Inertial navigation system aided by aircraft dynamics. IEEE Trans. Control Syst. Technol. 1999, 7, 487–493. [Google Scholar] [CrossRef]
- Bryson, M.; Sukkarieh, S. Vehicle model aided inertial navigation for a UAV using low-cost sensors. In Proceedings of the Australasian Conference on Robotics and Automation, Canberra, Australia, 6–8 December 2004; ISBN 0-9587583-6-0. [Google Scholar]
- Vissière, D.; Bristeau, P.J.; Martin, A.P.; Petit, N. Experimental autonomous flight of a small-scaled helicopter using accurate dynamics model and low-cost sensors. IFAC Proc. Vol. 2008, 41, 14642–14650. [Google Scholar] [CrossRef]
- Khaghani, M.; Skaloud, J. Autonomous Vehicle Dynamic Model-Based Navigation for Small UAVs. Nav. J. Inst. Nav. 2016, 63, 345–358. [Google Scholar] [CrossRef]
- Philipp, F.; Lorenz, G.; Gert, F.T.; Florian, H. Unified Model Technique for Inertial Navigation Aided by Vehicle Dynamics Model. Nav. J. Inst. Nav. 2013, 60, 179–193. [Google Scholar] [CrossRef]
- Barton, J.D. Fundamentals of Small Unmanned Aircraft Flight. Johns Hopkins APL Tech. Dig. 2012, 31, 132–149. [Google Scholar]
- Cledat, E.; Cucci, D.A. Mapping GNSS Restricted Environments with a Drone Tandem and Indirect Position Control. In The International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences, Proceedings of the International Conference on Unmanned Aerial Vehicles in Geomatics, Bonn, Germany, 4–7 September 2017; ISPRS: Hannover, Germany, 2017. [Google Scholar]
- Paul, S.; Chang, J. A New Approach to Detect Mover Position in Linear Motors Using Magnetic Sensors. Sensors 2015, 15, 26694–26708. [Google Scholar] [CrossRef] [PubMed] [Green Version]
- Jezný, J.; Čurilla, M. Position Measurement with Hall Effect Sensors. Am. J. Mech. Eng. Am. J. Mech. Eng. 2013, 1, 231–235. [Google Scholar]
- Ferrazzin, D.; di Domizio, G.; Salsedo, F.; Avizzano, C.A.; Tecchia, F.; Bergamasco, M. Hall effect sensor-based linear transducer. In Proceedings of the 8th IEEE International Workshop on Robot and Human Interaction. RO-MAN ’99 (Cat. No.99TH8483), Pisa, Italy, 27–29 September 1999; pp. 219–224. [Google Scholar] [CrossRef]
- Bienczyk, K. Angle measurement using a miniature hall effect position sensor. In Proceedings of the 2009 2nd International Students Conference on Electrodynamic and Mechatronics, Silesia, Poland, 19–21 May 2009; pp. 21–22. [Google Scholar] [CrossRef]
- Mecholic. Applications, Advantages and Limitations of Pitot Tubes. Available online: http://www.mecholic.com/2017/05/applications-advantages-limitations-pitot-tube.html (accessed on 8 November 2017).
RMSE | Max Error | |
---|---|---|
North | 1.48 m | 5 m |
East | 5.49 m | 15 m |
RMSE | Max Error | |
---|---|---|
North | 1.35 m | 4.36 m |
East | 1.41 m | 3.55 m |
RMSE | Max Error | |
---|---|---|
North | 2.50 m | 7.70 m |
East | 12.40 m | 24.04 m |
RMSE | Max Error | |
---|---|---|
North | 3.64 m | 8.78 m |
East | 18.97 m | 36.29 m |
INS 60 s Outage | Proposed Approach 65 s Outage | Proposed Approach 125 s Outage | Proposed Approach 185 s Outage | |
---|---|---|---|---|
RMSE North | 415 m | 1.35 m | 2.50 m | 3.64 m |
Max Error- N | 1200 m | 4.36 m | 7.70 m | 8.78 m |
RMSE East | 450 m | 1.41 m | 12.40 m | 18.97 m |
Max Error - E | 1350 m | 3.55 m | 24.04 m | 36.29 m |
© 2019 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).
Share and Cite
Zahran, S.; Moussa, A.; El-Sheimy, N. Enhanced Drone Navigation in GNSS Denied Environment Using VDM and Hall Effect Sensor. ISPRS Int. J. Geo-Inf. 2019, 8, 169. https://doi.org/10.3390/ijgi8040169
Zahran S, Moussa A, El-Sheimy N. Enhanced Drone Navigation in GNSS Denied Environment Using VDM and Hall Effect Sensor. ISPRS International Journal of Geo-Information. 2019; 8(4):169. https://doi.org/10.3390/ijgi8040169
Chicago/Turabian StyleZahran, Shady, Adel Moussa, and Naser El-Sheimy. 2019. "Enhanced Drone Navigation in GNSS Denied Environment Using VDM and Hall Effect Sensor" ISPRS International Journal of Geo-Information 8, no. 4: 169. https://doi.org/10.3390/ijgi8040169
APA StyleZahran, S., Moussa, A., & El-Sheimy, N. (2019). Enhanced Drone Navigation in GNSS Denied Environment Using VDM and Hall Effect Sensor. ISPRS International Journal of Geo-Information, 8(4), 169. https://doi.org/10.3390/ijgi8040169