Your browser does not support JavaScript!
http://iet.metastore.ingenta.com
1887

access icon free Adaptive particle filter based on Kullback–Leibler distance for underwater terrain aided navigation with multi-beam sonar

© The Institution of Engineering and Technology
Received 04/06/2017, Accepted 12/01/2018, Revised 07/01/2018, Published 15/01/2018

Terrain aided navigation (TAN) is a promising approach to bound accumulated errors inherent to inertial navigation system by comparing terrain measurement with a reference map. Due to the non-linear nature of terrain, particle filters (PFs) are extensively studied for TAN because of its strong capability of dealing with non-linear problems. So far, most existing PFs for TAN manually select a fixed number of sampling particles during the entire filtering process. However, it can be highly inefficient, since the probability distribution of the state often varies drastically over time. To improve the efficiency, the Fox's adaptive PF based on Kullback–Leibler distance (KLD) is introduced for TAN, referred to as the normal KLD-PF here. In the normal KLD-PF, the number of sampling particles is adjusted online by KLD-sampling according to the size of state space. However, the normal KLD-PF has a fixed bin size, which easily causes the number of particles to surge at the early filtering stage. Thus, an improved KLD-PF with a variable bin size is proposed through limiting the total number of particles below certain value. Using a multi-beam sonar, simulation experiments with real underwater reference map demonstrate the efficiency of the proposed method.

Inspec keywords: sonar signal processing; autonomous underwater vehicles; oceanographic techniques; terrain mapping; particle filtering (numerical methods); signal sampling; adaptive filters

Other keywords: real underwater reference map; sampling particles; Kullback-Leibler distance; state space size; autonomous underwater vehicles; KLD-sampling; inertial navigation system; underwater terrain aided navigation; Fox adaptive PF; nonlinear problems; adaptive particle filter; multibeam sonar; normal KLD-PF; filtering process

Subjects: Sonar and acoustic radar; Digital signal processing; Monte Carlo methods; Monte Carlo methods; Telerobotics; Filtering methods in signal processing; Marine system control; Mobile robots; Oceanographic and hydrological techniques and equipment

References

    1. 1)
      • 10. Eroglu, O., Yilmaz, G.: ‘A terrain referenced UAV localization algorithm using binary search method’, J. Intell. Robot. Syst., 2014, 73, (4), pp. 309–323.
    2. 2)
      • 19. Hagen, O.K., Anonsen, K.B.: ‘Improving terrain navigation by concurrent tidal and sound speed error estimation’. Proc. IEEE Oceans Int. Conf., San Diego, USA, September 2013, pp. 1–7.
    3. 3)
      • 8. Nygren, I.: ‘Robust and efficient terrain navigation of underwater vehicles’. Proc. IEEE Position, Location and Navigation Symp., Monterey, CA, USA, May 2008, pp. 923–932.
    4. 4)
      • 4. Carreno, S., Wilson, P., Ridao, P., et al: ‘A survey on terrain based navigation for AUVs’. Proc. IEEE Oceans Int. Conf., Seattle, USA, September 2010, pp. 1–7.
    5. 5)
      • 22. Zhou, L., Cheng, X.H., Zhu, Y.X.: ‘Terrain aided navigation for autonomous underwater vehicles with coarse maps’, Meas. Sci. Technol., 2016, 27, (9), pp. 1–9.
    6. 6)
      • 13. Teixeira, F.C., Quintas, J., Pascoal, A.: ‘AUV terrain-aided navigation using a Doppler velocity logger’, Annu. Rev. Control, 2016, 42, (2), pp. 166–176.
    7. 7)
      • 18. Stepanov, O.A., Toropov, A.B.: ‘Nonlinear filtering for map-aided navigation part 2. Trends in the algorithm development’, Gyroscopy Navig., 2016, 7, (1), pp. 82–89.
    8. 8)
      • 6. Hostetler, L., Andreas, R.: ‘Nonlinear Kalman filtering techniques for terrain-aided navigation’, IEEE Trans. Autom. Control, 1983, 28, (3), pp. 315–323.
    9. 9)
      • 9. Rock, S.M., Hobson, B., Houts, S.E.: ‘Return-to-site of an AUV using terrain-relative navigation: field trials’. Proc. IEEE/OES Autonomous Underwater Vehicles (AUV), Oxford, MS, UK, October 2014, pp. 1–8.
    10. 10)
      • 5. Golden, J.P.: ‘Terrain contour matching (TERCOM): a cruise missile guidance aid’. Proc. SPIE Image Processing for Missile Guidance, December 1980, pp. 10–18.
    11. 11)
      • 16. Bergman, N.: ‘Recursive Bayesian estimation – navigation and tracking applications’. PhD thesis, Linkoping University, 1999.
    12. 12)
      • 17. Mok, S., Choi, M., Bang, H.: ‘Performance comparison of nonlinear estimation techniques in terrain referenced navigation’. Proc. IEEE Int. Conf. Control, Automation and Systems (ICCAS), Gyeonggi-do, South Korea, October 2011, pp. 1244–1249.
    13. 13)
      • 24. Claus, B., Bachmayer, R.: ‘Terrain-aided navigation for an underwater glider’, J. Field Robot., 2015, 32, (7), pp. 935–951.
    14. 14)
      • 26. Kwok, C., Fox, D., Meila, M.: ‘Adaptive real-time particle filters for robot localization’. Proc. IEEE. Int. Conf. Robotics and Automation (ICRA), Taipei, September 2003, pp. 2836–2841.
    15. 15)
      • 28. Gustafsson, F., Gunnarsson, F., Bergman, N., et al: ‘Particle filters for positioning, navigation, and tracking’, IEEE Trans. Signal Process., 2002, 50, (2), pp. 425–437.
    16. 16)
      • 21. Donovan, G.T.: ‘Position error correction for an autonomous underwater vehicle inertial navigation system (INS) using a particle filter’, IEEE J. Ocean. Eng., 2012, 37, (3), pp. 431–445.
    17. 17)
      • 14. Nygren, I.: ‘Terrain navigation for underwater vehicles’. PhD thesis, Royal Institute of Technology (KTH), 2005.
    18. 18)
      • 11. Zhang, K., Li, Y., Zhao, J., et al: ‘A study of underwater terrain navigation based on the robust matching method’, J. Navig., 2014, 67, (4), pp. 569–578.
    19. 19)
      • 27. Doucet, A., Godsill, S., Andrieu, C.: ‘On sequential Monte Carlo sampling methods for Bayesian filtering’, Stat. Comput., 2000, 10, (3), pp. 197–208.
    20. 20)
      • 2. Stutters, L., Liu, H., Tiltman, C., et al: ‘Navigation technologies for autonomous underwater vehicles’, IEEE Trans. Syst. Man Cybern., 2008, 38, (4), pp. 581–589.
    21. 21)
      • 12. Teck, T.Y., Chitre, M., Hover, F.S.: ‘Collaborative bathymetry-based localization of a team of autonomous underwater vehicles’. Proc. IEEE Int. Conf. Robotics and Automation (ICRA), Hong Kong, China, June 2014, pp. 2475–2481.
    22. 22)
      • 25. Fox, D.: ‘Adapting the sample size in particle filters through KLD-sampling’, Int. J. Robot. Res., 2003, 22, (12), pp. 985–1003.
    23. 23)
      • 1. Paull, L., Saeedi, S., Seto, M., et al: ‘AUV navigation and localization: a review’, IEEE J. Ocean Eng., 2013, 39, (1), pp. 131–149.
    24. 24)
      • 20. Anonsen, K.B., Hallingstad, O.: ‘Terrain aided underwater navigation using point mass and PFats’. Proc. IEEE/ION Position Location and Navigation Symp., Coronado, USA, July 2006, pp. 1027–1035.
    25. 25)
      • 15. Meduna, D.K.: ‘Terrain relative navigation for sensor-limited systems with application to underwater vehicles’. PhD thesis, Stanford University, 2011.
    26. 26)
      • 23. Teixeira, F.C., Quintas, J., Maurya, P., et al: ‘Robust particle filter formulations with application to terrain-aided navigation’, Int. J. Adapt. Control Signal Process., 2016, 45, (5), pp. 132–139.
    27. 27)
      • 3. Copp, B., Subbarao, K.: ‘Nonlinear adaptive filtering in terrain-referenced navigation’, IEEE Trans. Aerosp. Electron. Syst., 2015, 51, (4), pp. 3461–3469.
    28. 28)
      • 7. Anonsen, K.B., Hagen, O.K., Hegrenaes, O., et al: ‘The HUGIN AUV terrain navigation module’. Proc. IEEE Oceans Int. Conf., San Diego, USA, September 2013, pp. 1–8.
http://iet.metastore.ingenta.com/content/journals/10.1049/iet-rsn.2017.0239
Loading

Related content

content/journals/10.1049/iet-rsn.2017.0239
pub_keyword,iet_inspecKeyword,pub_concept
6
6
Loading
Print this page
This is a required field
Please enter a valid email address