DOI QR코드

DOI QR Code

Implementation and Performance Comparison for an Underwater Robot Localization Methods Using Seabed Terrain Information

해저 지형정보를 이용하는 수중 로봇 위치추정 방법의 구현 및 성능 비교

  • Received : 2014.06.03
  • Accepted : 2015.02.04
  • Published : 2015.02.25

Abstract

This paper proposes an application of unscented Kalman filter(UKF) for localization of an underwater robot. The method compares the bathymetric measurement from the robot with the seabed terrain information. For the measurement of bathymetric range to seabed, it uses a DVL which typically yields four range data together with velocity of the robot. Usual extended Kalman filter is not appropriated for application in case of terrain navigation, since it is not feasible to derive Jacobian for the bathymetric range measurement. Though particle filter(PF) is a nice solution which doesn't require Jacobian and can deal with non-linear and non-Gaussian system and measurement, it suffers from heavy computational burden. The paper compares the localization performance and the computation time of the UKF approach and PF approach. Though there have been some UKF methods which are used for underwater navigation, application of the UKF for bathymetric localization is rare. Especially, the proposed method uses only four range data whereas many of the bathymetric navigation methods have used multibeam sonar which yields hundreds of scanned range data. The result shows feasibility of the UKF approach for terrain-based navigation using small numbers of range data.

본 논문은 수중 로봇 위치추정을 위하여 무향 칼만 필터 방법을 제안한다. 이 방법은 해저 지형 정보와 로봇으로부터 수심측정을 비교한다. 해저 수심 범위의 측정을 위해, DVL 센서를 이용한다. 일반적으로 DVL은 로봇의 속도 정보와 4개의 거리 데이터를 획득한다. 확장 칼만 필터는 지형 수심 범위 측정을 위해 자코비안을 유도하기가 가능하지 않기 때문에 지형정보를 이용한 방법에는 유용하지가 않는다. 파티클 필터는 자코비안을 필요로하지 않고, 비선형 및 비 가우시안 시스템에 좋은 해결책이지만 연산량이 많은 단점이 있다. 본 논문에서는 무향 칼만 필터와 파티클 필터의 위치추정 성능과 처리 속도를 비교한다. 수중 네비게이션에 사용되는 무향 칼만 필터 방법은 일부 있지만 해저 지형 정보를 이용한 방법은 극히 드물다. 특히, 제안된 방법은 수백개의 스캔 범위 데이터를 사용하지 않고 4개의 범위 데이터만을 이용한다. 본 논문에서는 4개의 거리 데이터를 가지고 해저 지형을 기반을 둔 위치추정을 위한 무향 칼만 필터 방법의 접근 가능성을 보인다.

Keywords

References

  1. J. C. Kinsey, R. M. Eustice, and L. L. Whitcomb, "A survey of underwater vehicle navigation: Recent advances and new challenges," IFAC Conference of Manoeuvering and Control of Marine Craft, 2006.
  2. S. W. Noh, N. Y. Ko, Y. S, Moon, C. H. Yun, and H. T. Choi, "Navigation for an Unmanned Underwater Vehicle Using Unscented Kalman Filter," Korean Unmanned Underwater Vehicle, 2014.
  3. L. Paull, S. Saeedi, M. Seto, and H. Li, "AUV Navigation and Localization: A Review," IEEE Journal of Oceanic Engineering, Vol. 39, No. 1, Jan. 2014.
  4. O. Bergem, "Bathymetric navigation of autonomous underwater vehicles using a multibeam sonar and a Kalman filter with relative measurement covariance matrices," Dr. Scient thesis, University of Trondheim, Norway, 1993.
  5. D. H. Lee and Y. M. Yang, "Two-Dimensional Localization Problem under non-Gausian Noise in Underwater Acoustic Sensor Network," Journal of Korean Instiute of Inteligent Systems, Vol.23, No.5, 2013.
  6. J. Kim and H. S. Jung, "An Approach towards Online Bathymetric SLAM," Proc. OCEANS 2011, Sept. 2011.
  7. I. Nygren and M. Jansson, "Terrain navigation for underwater vehicles using the correlator method," IEEE Journal of Oceanic Engineering, Vol.29, No.3, pp. 906-915, 2004. https://doi.org/10.1109/JOE.2004.833222
  8. Morice, Colin, Sandor Veres, and Stephen McPhail, "Terrain referencing for autonomous navigation of underwater vehicles," IEEE Oceans 2009-Europe, May 2009.
  9. S. Barkby, S. Williams, O. Pizarro, and M. Jakuba, "Incorporating prior maps with bathymetric distributed particle slam for improved auv navigation and mapping," MTS/IEEE Biloxi-Marine Technology for Our Future: Global and Local Challenges, Oct. 2009.
  10. K. B. Anonsen and O. Hallingstad, "Sigma point Kalman filter for underwater terrain-based navigation." Proc. IFAC Conf. Control Appl. Marine System, Sep. 2007.
  11. F. Teixeira and A. Pascoal, "Geophysical navigation of autonomous underwater vehicles using geomagnetic information," Proceedings of NGCUV'08-IFAC Workshop on Navigation, 2008.
  12. C. Lin, X. Feng, and Y. Li, "UKF-based Parameter Estimation Method for Precise UUV Navigation," Proceedings of the 12th International Offshore and Polar Engineering Conference, 2010.
  13. M. J. Stanway, "Delayed-state sigma point Kalman filters for underwater navigation," Autonomous Underwater Vehicles(AUV), 2010.
  14. H. Wang, G. Fu, J. Li, Z. Yan, and X. Bian, "An adaptive UKF based SLAM method for unmanned underwater vehicle," Mathematical Problems in Engineering, 2013.
  15. L. Wu, J. Ma, and J. Tian, "A self-adaptive unscented Kalman filtering for underwater gravity aided navigation," Proc. 2010 IEEE/ION Position Location and Navigation Symposium, May. 2010.
  16. T. G. Kim, "Localization Method for Navigation of an Underwater Robot," PhD thesis, Chosun University, 2013.
  17. S. J. Kim and Y. H. Joo, "Mobile Object Tracking Algorithm Using Particle Filter," Journal of Korean Instiute of Inteligent Systems, Vol.19, No.4, 2009.
  18. T. G. Kim, N. Y. Ko and S. W. Noh, "Simultaneous Estimation of Landmark Location and Robot Pose Using Particle Filter Method," Journal of Korean Instiute of Inteligent Systems, Vol.22, No.3, 2012.
  19. E. A. Wan, R. Van Der Merwe. "The unscented Kalman filter for nonlinear estimation," Adaptive Systems for Signal Processing, 2000.
  20. S. J. Julier, J. K. Uhlmann. "New extension of the Kalman filter to nonlinear systems," AeroSense'97. International Society for Optics and Photonics, 1997.
  21. J. H. Lee, K. H. Jung, J. M. Kim and S. S. Kim, "Sensor Fusion of Localization Using Unscented Kalman Filter," Journal of Korean Instiute of Inteligent Systems, Vol.21, No.5, 2011.
  22. A. R. Hwang, "Simultaneous localization and mapping based on the unscented kalman filter for unmanned underwater vehicle," Phd. thesis, Seoul University, 2007.
  23. R. Van Der Merwe, E. A. Wan. "The square-root unscented Kalman filter for state and parameter-estimation," 2001 IEEE International Conference on, 2001.
  24. C. H. Yun, Y. P. Lee, N. Y. Ko, and Y. S. Moon, "Broad-band Underwater Acoustic Transducer for Doppler Velocity Log," Journal of Institute of Control, Robotics and Systems, Vol. 19, No. 9, 2013.

Cited by

  1. Measurement of DS-CDMA Propagation Distance in Underwater Acoustic Communication Considering Attenuation and Noise vol.15, pp.1, 2015, https://doi.org/10.5391/IJFIS.2015.15.1.20
  2. Path Estimation Method in Shadow Area Using Underwater Positioning System and SVR vol.12, pp.2, 2017, https://doi.org/10.7746/jkros.2017.12.2.173