×

Position USBL/DVL sensor-based navigation filter in the presence of unknown ocean currents. (English) Zbl 1235.93244

Summary: This paper presents a novel approach to the design of globally asymptotically stable (GAS) position and velocity filters for Autonomous Underwater Vehicles (AUVs) based directly on the sensor readings of an Ultra-short Baseline (USBL) acoustic array system and a Doppler Velocity Log (DVL). The proposed methodology is based on an equivalent linear time-varying (LTV) system that fully captures the dynamics of the nonlinear system, allowing for the use of powerful linear system analysis and filtering design tools that yield GAS filter error dynamics. Numerical results using Monte Carlo simulations and comparison to the Bayesian Cramér Rao Bound (BCRB) reveal that the performance of the proposed filter is tight to this theoretical estimation error lower bound. In comparison with other approaches, the present solution achieves the same level of performance of the Extended Kalman Filter (EKF), which does not offer GAS guarantees, and outperforms other classical filtering approaches designed in inertial coordinates instead of the body-fixed coordinate frame.

MSC:

93E11 Filtering in stochastic control theory
93E10 Estimation and detection in stochastic control theory
PDFBibTeX XMLCite
Full Text: DOI arXiv

References:

[1] Anderson, B., Stability properties of Kalman-Bucy filters, Journal of the Franklin Institute, 291, 2, 137-144 (1971) · Zbl 0275.93044
[2] Antsaklis, P. J.; Michel, A. N., Linear systems (2006), Birkhauser
[3] Batista, P., Silvestre, C., & Oliveira, P. (2009a). Sensor-based complementary globally asymptotically stable filters for attitude estimation. In Proceedings of the 48th IEEE conference on decision and control. Shanghai, China. December; Batista, P., Silvestre, C., & Oliveira, P. (2009a). Sensor-based complementary globally asymptotically stable filters for attitude estimation. In Proceedings of the 48th IEEE conference on decision and control. Shanghai, China. December
[4] Batista, P., Silvestre, C., & Oliveira, P. (2009b). Single range navigation in the presence of constant unknown drifts. In Proceedings of the European control conference 2009. ECC’09. Budapest, Hungary. August; Batista, P., Silvestre, C., & Oliveira, P. (2009b). Single range navigation in the presence of constant unknown drifts. In Proceedings of the European control conference 2009. ECC’09. Budapest, Hungary. August
[5] Batista, P., Silvestre, C., & Oliveira, P. (2010a). A Sensor-based long baseline position and velocity navigation filter for underwater vehicles. In Proceedings of the 8th IFAC symposium on nonlinear control systems. Bologna, Italy. September; Batista, P., Silvestre, C., & Oliveira, P. (2010a). A Sensor-based long baseline position and velocity navigation filter for underwater vehicles. In Proceedings of the 8th IFAC symposium on nonlinear control systems. Bologna, Italy. September
[6] Batista, P.; Silvestre, C.; Oliveira, P., Optimal position and velocity navigation filters for autonomous vehicles, Automatica, 46, 4, 767-774 (2010) · Zbl 1193.93171
[7] Brockett, R. W., Finite dimensional linear systems (1970), Wiley · Zbl 0216.27401
[8] Celikovsky, S.; Chen, G., Secure synchronization of a class of chaotic systems from a nonlinear observer approach, IEEE Transactions on Automatic Control, 50, 1, 76-82 (2005) · Zbl 1365.93384
[9] Do, K. D.; Jiang, Z. P.; Pan, J.; Nijmeijer, H., A global output-feedback controller for stabilization and tracking of underactuated ODIN: a spherical underwater vehicle, Automatica, 40, 1, 117-124 (2004) · Zbl 1051.93072
[10] Eustice, R. M., Whitcomb, L. L., Singh, H., & Grund, M. (2007). Experimental results in synchronous-clock one-way-travel-time acoustic navigation for autonomous underwater vehicles. In 2007 IEEE international conference on robotics and automation; Eustice, R. M., Whitcomb, L. L., Singh, H., & Grund, M. (2007). Experimental results in synchronous-clock one-way-travel-time acoustic navigation for autonomous underwater vehicles. In 2007 IEEE international conference on robotics and automation
[11] Gandhi, M. A.; Mili, L., Robust Kalman filter based on a generalized maximum-likelihood-type estimator, IEEE Transactions on Signal Processing, 58, 5, 2509-2520 (2010) · Zbl 1392.94216
[12] García, J. C., Fresneda, J. F., Sanz, P., & Marín, R. (2010). Increasing autonomy within underwater intervention scenarios: the user interface approach. In 2010 IEEE International Systems Conference. San Diego, CA, USA. Vol. 4; García, J. C., Fresneda, J. F., Sanz, P., & Marín, R. (2010). Increasing autonomy within underwater intervention scenarios: the user interface approach. In 2010 IEEE International Systems Conference. San Diego, CA, USA. Vol. 4
[13] Hermann, R.; Krener, A. J., Nonlinear controllability and observability, IEEE Transactions on Automatic Control, 22, 5, 728-740 (1977) · Zbl 0396.93015
[14] Imsland, L.; Johansen, T. A.; Fossen, T. I.; Grip, H. F.; Kalkkuhl, J. C.; Suissa, A., Vehicle velocity estimation using nonlinear observers, Automatica, 42, 12, 2091-2103 (2006) · Zbl 1104.93044
[15] Kinsey, J. C.; Whitcomb, L. L., Preliminary field experience with the DVLNAV integrated navigation system for oceanographic submersibles, Control Engineering Practice, 12, 12, 1541-1548 (2004), Invited Paper
[16] Kinsey, J. C.; Whitcomb, L. L., In situ alignment calibration of attitude and doppler sensors for precision underwater vehicle navigation: theory and experiment, IEEE Journal of Oceanic Engineering, 32, 2, 286-299 (2007)
[17] Menold, R. K., Pearson, P. H., & Allgower, F. (1999). Online outlier detection and removal. In Proceedings of MED99 7th international conference on control and automation. Haifa, Israel; Menold, R. K., Pearson, P. H., & Allgower, F. (1999). Online outlier detection and removal. In Proceedings of MED99 7th international conference on control and automation. Haifa, Israel
[18] Morgado, M.; Batista, P.; Oliveira, P.; Silvestre, C., Position USBL/DVL sensor-based navigation filter in the presence of unknown ocean currents, (2010 49th IEEE conference on decision and control. 2010 49th IEEE conference on decision and control, CDC (2010), IEEE: IEEE Atlanta, GA, USA), 2192-2197 · Zbl 1235.93244
[19] Morgado, M.; Oliveira, P.; Silvestre, C.; Vasconcelos, J. F., USBL/INS tightly-coupled integration technique for underwater vehicles, (Proceedings Of the 9th international conference on information fusion (2006), IEEE: IEEE Florence, Italy)
[20] Pascoal, A., Oliveira, P., & Silvestre, C. et al. (2000). Robotic ocean vehicles for marine science applications: the European ASIMOV project. In Proceedings of the oceans 2000. Rhode Island, USA. September; Pascoal, A., Oliveira, P., & Silvestre, C. et al. (2000). Robotic ocean vehicles for marine science applications: the European ASIMOV project. In Proceedings of the oceans 2000. Rhode Island, USA. September
[21] Pisano, A.; Usai, E., Output-feedback control of an underwater vehicle prototype by higher-order sliding modes, Automatica, 40, 9, 1525-1531 (2004) · Zbl 1055.93530
[22] Rigby, P., Pizarro, O., & Williams, S. B. (2006). Towards geo-referenced auv navigation through fusion of USBL and DVL measurements. In OCEANS 2006. September; Rigby, P., Pizarro, O., & Williams, S. B. (2006). Towards geo-referenced auv navigation through fusion of USBL and DVL measurements. In OCEANS 2006. September
[23] Snyder, D. L.; Rhodes, I. B., Filtering and control performance bounds with implications on asymptotic separation, Automatica, 747-753 (1972) · Zbl 0274.93059
[24] Ting, J. A.; Theodorou, E.; Schaal, S., A Kalman filter for robust outlier detection, (IEEE/RSJ international conference on intelligent robots and systems, 2007. IEEE/RSJ international conference on intelligent robots and systems, 2007, IROS 2007 (2007), IEEE), 1514-1519
[25] Van Trees, H. L., Bounds on the accuracy attainable in the estimation of continuous random processes, IEEE Transactions on Information Theory, 12, 298-305 (1966) · Zbl 0144.40903
[26] Van Trees, H. L., Detection, estimation, and modulation theory. Part 1: Detection, estimation, and linear modulation theory (1968), Wiley: Wiley New York · Zbl 0202.18002
[27] Van Trees, H. L.; Bell, L. K., Bayesian bounds for parameter estimation and nonlinear filtering/tracking (2007), John Wiley & Sons, IEEE Press · Zbl 1266.62022
[28] Whitcomb, L. L. (2000). Underwater robotics: out of the research laboratory and into the field. In Proceedings. ICRA ’00. IEEE International Conference on Robotics and Automation, 2000. Vol. 1; Whitcomb, L. L. (2000). Underwater robotics: out of the research laboratory and into the field. In Proceedings. ICRA ’00. IEEE International Conference on Robotics and Automation, 2000. Vol. 1
[29] Willemenot, E., Morvan, P. -Y., Pelletier, H., & Hoof, A. (2009). Subsea positioning by merging inertial and acoustic technologies. In OCEANS 2009-EUROPE, 2009. OCEANS ’09. May; Willemenot, E., Morvan, P. -Y., Pelletier, H., & Hoof, A. (2009). Subsea positioning by merging inertial and acoustic technologies. In OCEANS 2009-EUROPE, 2009. OCEANS ’09. May
This reference list is based on information provided by the publisher or from digital mathematics libraries. Its items are heuristically matched to zbMATH identifiers and may contain data conversion errors. In some cases that data have been complemented/enhanced by data from zbMATH Open. This attempts to reflect the references listed in the original paper as accurately as possible without claiming completeness or a perfect matching.