In this paper we describe the experimental implementation of an online algorithm for cooperative localization of submerged autonomous underwater vehicles (AUVs) supported by an autonomous surface craft. Maintaining accurate localization of an AUV is difficult because electronic signals, such as GPS, are highly attenuated by water. The usual solution to the problem is to utilize expensive navigation sensors to slow the rate of dead-reckoning divergence. We investigate an alternative approach that utilizes the position information of a surface vehicle to bound the error and uncertainty of the on-board position estimates of a low-cost AUV. This approach uses the Woods Hole Oceanographic Institution (WHOI) acoustic modem to exchange vehicle location estimates while simultaneously estimating inter-vehicle range. A study of the system observability is presented so as to motivate both the choice of filtering approach and surface vehicle path planning. The first contribution of this paper is to the presentation of an experiment in which an extended Kalman filter (EKF) implementation of the concept ran online on-board an OceanServer Iver2 AUV while supported by an autonomous surface vehicle moving adaptively. The second contribution of this paper is to provide a quantitative performance comparison of three estimators: particle filtering (PF), non-linear least-squares optimization (NLS), and the EKF for a mission using three autonomous surface craft (two operating in the AUV role). Our results indicate that the PF and NLS estimators outperform the EKF, with NLS providing the best performance.
An, P.E., Healey, A.J., Smith, S.M. and Dunn, S.E. ( 1996) New experimental results on GPS/INS integration using Ocean Voyager II AUV. Proceedings of AUV 96, June 1996, pp. 249-255.
2.
Bahr, A. ( 2009) Cooperative Localization for Autonomous Underwater Vehicles . PhD thesis, Massachusetts Institute of Technology, Cambridge, MA, USA, February 2009.
3.
Bahr, A. and Leonard, J.J. ( 2006) Cooperative localization for autonomous underwater vehicles . International Symposium on Experimental Robotics (ISER), Rio de Janeiro, Brazil, July 2006.
4.
Bahr, A. and Leonard, J.J. ( 2007) Minimizing trilateration errors in the presence of noisy landmarks. European Conference on Mobile Robots , 2007.
5.
Curcio, J., Leonard, J.J., Vaganay, J., Patrikalakis, A., Bahr, A., Battle, D., Schmidt, H. and Grund, M. ( 2005) Experiments in moving baseline navigation using autonomous surface craft. Proceedings of the IEEE/MTS OCEANS Conference and Exhibition, September 2005, Vol. 1, pp. 730-735.
6.
Djugash, J., Singh, S. and Corke, P.I.Further results with localization and mapping using range from radio. Field and Service Robotics (FSR), July 2005.
7.
Djugash, J., Singh, S. and Grocholsky, B.P.Modeling mobile robot motion with polar representations. IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) , October 2009.
8.
Djugash, J., Singh, S., G.A. Kantor, and W. Zhang.Range-only SLAM for robots operating cooperatively with sensor networks. IEEE International Conference on Robotics and Automation (ICRA), May 2006, pp. 2078-2084.
9.
Doucet, A., de Freitas, N. and Gordon, N. (eds) ( 2000) Sequential Monte Carlo Methods in Practice. Berlin, Springer-Verlag.
10.
Eustice, R.M., Whitcomb, L.L., Singh, H. and Grund, M.Experimental results in synchronous-clock one-way-travel-time acoustic navigation for autonomous underwater vehicles. IEEE International Conference on Robotics and Automation (ICRA), Rome, Italy, April 2007, pp. 4257-4264.
11.
Fallon, M.F., Papadopoulos, G. and Leonard, J.J. ( 2010) A measurement distribution framework for cooperative navigation using multiple AUVs. IEEE International Conference on Robotics and Automation (ICRA), May 2010, pp. 4803-4808.
12.
Freitag, L., Grund, M., Singh, S., Partan, J., Koski, P. and Ball, K. ( 2005) The WHOI micro-modem: an acoustic communications and navigation system for multiple platforms. Proceedings of the IEEE/MTS OCEANS Conference and Exhibition, September 2005, Vol. 1, pp. 1086-1092.
13.
Gadre, A.S. ( 2007) Observability Analysis in Navigation Systems with an Underwater Vehicle Application. PhD thesis, Virginia Polytechnic Institute and State University, 2007.
14.
Gadre, A.S. and Stilwell, D.J. ( 2005) A complete solution to underwater navigation in the presence of unknown currents based on range measurements from a single location. IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2005.
15.
Heckman, D.B. and Abbott, R.C. ( 1973) An acoustic navigation technique. IEEE Oceans ’73, pp. 591-595.
16.
Hermann, R. and Krener, A.J. ( 1977) Nonlinear controllability and observability. IEEE Transactions on Automatic Control22: 728-740.
17.
Hunt, M., Marquet, W., Moller, D., Peal, K., Smith, W. and Spindel, R. ( 1974) An Acoustic Navigation System. Technical Report WHOI-74-6 , Woods Hole Oceanographic Institution.
18.
Isard, M.A. and Blake, A. ( 2002) iCondensation: unifying low-level and high-level tracking in a stochastic framework. Proceedings of the European Conference on Computer Vision, pp. 893-908.
19.
Kaess, M., Ranganathan, A. and Dellaert, F. ( 2008) iSAM: incremental smoothing and mapping. IEEE Transactions on Robotics, 24(6): 1365-1378.
20.
LaPointe, C.A Parallel Hypothesis Method of Autonomous Underwater Vehicle Navigation. PhD thesis, Massachusetts Institute of Technology, 2009.
Larsen, M.B. ( 2000b) Synthetic long baseline navigation of underwater vehicles . IEEE Oceans, 2000.
23.
Levine, E., Connors, D., Shell, R., Gagliardi, T. and Hanson, R.Oceanographic mapping with the Navy’s large diameter UUV. Sea Technology, 36: 49-57.
24.
Maczka, D.K., Gadre, A.S. and Stilwell, D.J.Implementation of a cooperative navigation algorithm on a platoon of autonomous underwater vehicles. Oceans 2007, pp. 1-6.
25.
Milne, P.H. ( 1983) Underwater Acoustic Positioning Systems. London, E. F. N. Spon.
26.
Mourikis, A.I. and Roumeliotis, S.I. ( 2006) Performance analysis of multirobot cooperative localization . IEEE Transactions on Robotics, 22(4): 666-681.
27.
Nerurkar, E.D., Roumeliotis, S.I. and Martinelli, A. ( 2009) Distributed maximum a posteriori estimation for multi-robot cooperative localization. IEEE International Conference on Robotics and Automation (ICRA), May 2009, pp. 1402-1409.
28.
Newman, P.M. ( 2003) MOOS-A Mission Oriented Operating Suite. Technical Report OE2003-07, Department of Ocean Engineering, MIT.
29.
Olson, E., Leonard, J.J. and Teller, S. ( 2006) Robust range-only beacon localization. IEEE Journal of Oceanic Engineering, 31(4): 949-958.
30.
Paglia, J.G. and Wyman, W.F. ( 1996) DARPA’s autonomous minehunting and mapping technologies (AMMT) program: asn overview. IEEE Oceans, Ft Lauderdale, FL, September 1996, pp. 794-799.
31.
Rigby, P., Pizarro, O. and Williams, S.B. ( 2006) Towards geo-referenced auv navigation through fusion of USBL and DVL measurements. Proceedings of the IEEE/MTS OCEANS Conference and Exhibition, September 2006.
Stokey, R. and Austin, T. ( 1999) Sequential, long baseline navigation for REMUS, an autonomous underwater vehicle. International Symposium on Information Systems for Navy Divers and Autonomous Underwater Vehicles Operating in the Surf Zone. Proceedings of SPIE, 3711: 3711-3725.
34.
Vaganay, J., Baccou, P. and Jouvencel, B. ( 2000) Homing by acoustic ranging to a single beacon. IEEE Oceans, pp. 1457-1462.
35.
Vaganay, B., Bellingham, J.G. and Leonard, J.J. ( 1996) Outlier rejection for autonomous acoustic navigation. IEEE International Conference on Robotics and Automation (ICRA) , April 1996, pp. 2174-2181.
36.
Vaganay, J., Leonard, J.J., Curcio, J.A. and Willcox, J.S.Experimental validation of the moving long base line navigation concept. 2004 IEEE/OES Autonomous Underwater Vehicles, June 2004, pp. 59-65.
37.
Webster, S.E., Eustice, R.M., Murphy, C., Singh, H. and Whitcomb, L.L. ( 2009a) Toward a platform-independent acoustic communications and navigation system for underwater vehicles. Proceedings of the IEEE/MTS OCEANS Conference and Exhibition, Biloxi, MS, 2009.
38.
Webster, S.E., Eustice, R.M., Singh, H. and Whitcomb, L.L. ( 2009b) Preliminary deep water results in single-beacon one-way-travel-time acoustic navigation for underwater vehicles. IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2009.
39.
Whitcomb, L., Yoerger, D., Singh, H. and Mindell, D. ( 1998) Towards precision robotic maneuvering, survey, and manipulation in unstructured undersea environments. Proceedings of the International Symposium of Robotics Research (ISRR), Vol. 8, pp. 45-54.
40.
Yoerger, D., Jakuba, M., Bradley, A. and Bingham, B. ( 2007) Techniques for deep sea near bottom survey using an autonomous underwater vehicle. The International Journal of Robotics Research, 26(1): 41-54.
