“Unscented Multi-Point Smoother for Fusion of Delayed Displacement Measurements: Application to Agricultural Robots”

Authors: Mathias Hauan Arbo, Trygve Utstumo, Edmund Brekke and Jan T. Gravdahl,
Affiliation: NTNU, Department of Engineering Cybernetics and Adigo AS
Reference: 2017, Vol 38, No 1, pp. 1-9.

Keywords: Robot Navigation, Sensor fusion, Agricultural Robotics

Abstract: Visual Odometry (VO) is increasingly a useful tool for robotic navigation in a variety of applications, including weed removal for agricultural robotics. The methods of evaluating VO are often computationally expensive and can cause the VO measurements to be significantly delayed with respect to a compass, wheel odometry, and GPS measurements. In this paper we present a Bayesian formulation of fusing delayed displacement measurements. We implement solutions to this problem based on the unscented Kalman filter (UKF), leading to what we term an unscented multi-point smoother. The proposed methods are tested in simulations of an agricultural robot. The simulations show improvements in the localization RMS error when including the VO measurements with a variety of latencies.

PDF PDF (1221 Kb)        DOI: 10.4173/mic.2017.1.1

DOI forward links to this article:
[1] Lars Grimstad and Pål From (2017), doi:10.3390/robotics6040024
[2] Tianshuang Gao, Hamid Emadi, Homagni Saha, Jiaoping Zhang, Alec Lofquist, Arti Singh, Baskar Ganapathysubramanian, Soumik Sarkar, Asheesh Singh and Sourabh Bhattacharya (2018), doi:10.3390/robotics7040061
[3] Lanjiao Wen and Lioudmila Chatalova (2021), doi:10.3390/su13020733
[4] Ahmed Yahia Kallel, Zheng Hu and Olfa Kanoun (2022), doi:10.3390/app12020591
[5] Lars Grimstad and Pal Johan From (2018), doi:10.1109/REMAR.2018.8449834
[6] Dongbo Xie, Liang Chen, Lichao Liu, Liqing Chen and Hai Wang (2022), doi:10.3390/machines10100913
References:
[1] Bogue, R. (2016). Bogue, R, Robots poised to revolutionise agriculture. Industrial Robot: An International Journal. 43(5):450--456. doi:10.1108/IR-05-2016-0142
[2] Cruz, C. D.L. and Carelli, R. (2006). Cruz, C, D.L. and Carelli, R. Dynamic Modeling and Centralized Formation Control of Mobile Robots. In IECON 2006 - 32nd Annual Conference on IEEE Industrial Electronics. pages 3880--3885. doi:10.1109/IECON.2006.347299
[3] Forster, C., Pizzoli, M., and Scaramuzza, D. (2014). Forster, C, , Pizzoli, M., and Scaramuzza, D. SVO: Fast semi-direct monocular visual odometry. Proceedings - IEEE International Conference on Robotics and Automation. pages 15--22. doi:10.1109/ICRA.2014.6906584
[4] Goldberg, S.B. and Matthies, L. (2011). Goldberg, S, B. and Matthies, L. Stereo and IMU assisted visual odometry on an OMAP3530 for small robots. In IEEE Computer Society Conference on Computer Vision and Pattern Recognition Workshops. IEEE. doi:10.1109/CVPRW.2011.5981842
[5] Grimstad, L., Pham, C.D., Phan, H.T., and From, P.J. (2016). Grimstad, L, , Pham, C.D., Phan, H.T., and From, P.J. On the design of a low-cost, light-weight, and highly versatile agricultural robot. Proceedings of IEEE Workshop on Advanced Robotics and its Social Impacts, ARSO. 2016-March(October). doi:10.1109/ARSO.2015.7428210
[6] Grimstad, L., Phan, H. N.T., Pham, C.D., and Bjugstad, N. (2015). Grimstad, L, , Phan, H. N.T., Pham, C.D., and Bjugstad, N. Initial field-testing of Thorvald , a versatile robotic platform for agricultural applications. IEEE International Workshop on Advanced Robotics and its Social Impacts, 2015. .
[7] Jorgensen, R.N., Sorensen, C.G., Pedersen, J.M., Havn, I., Jensen, K., Sogaard, H.T., and Sorensen, L. (2007). Jorgensen, R, N., Sorensen, C.G., Pedersen, J.M., Havn, I., Jensen, K., Sogaard, H.T., and Sorensen, L. Hortibot: A system design of a robotic tool carrier for high-tech plant nursing. CIGR Ejournal. IX:Manuscript ATOE 07 006. .
[8] Julier, S.J. and Uhlmann, J.K. (1997). Julier, S, J. and Uhlmann, J.K. New extension of the kalman filter to nonlinear systems. 1997. doi:10.1117/12.280797
[9] Julier, S.J. and Uhlmann, J.K. (2002). Julier, S, J. and Uhlmann, J.K. Reduced sigma point filters for the propagation of means and covariances through nonlinear transformations. Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301). 2:887--892 vol.2. doi:10.1109/ACC.2002.1023128
[10] Martins, F. (2013). Martins, F, Velocity-based dynamic model and adaptive controller for differential steered mobile robot. Mathworks Fileexchange 44850. .
[11] Vander Merwe, R. (2004). Vander Merwe, R, Sigma-point Kalman filters for probabilistic inference in dynamic state-space models. Ph.D. thesis, Oregon Health & Science University. .
[12] Vander Merwe, R. and Wan, E.A. (2004). Vander Merwe, R, and Wan, E.A. Sigma-Point Kalman Filters for Integrated Navigation. In Proceedings of the 60th Annual Meeting of the Institute of Navigation (ION). pages 641--654. .
[13] Molstad, L., ReentKoester, J., Bakken, L., Doersch, P., Lien, T., Overskeid, O., Utstumo, T., Lovaas, D., and Brevik, A. (2014). Molstad, L, , ReentKoester, J., Bakken, L., Doersch, P., Lien, T., Overskeid, O., Utstumo, T., Lovaas, D., and Brevik, A. A field robot for autonomous laser-based n2o flux measurements. In EGU General Assembly Conference Abstracts, volume16. page 16109. .
[14] Mourikis, A.I. and Roumeliotis, S.I. (2007). Mourikis, A, I. and Roumeliotis, S.I. A multi-state constraint Kalman filter for vision-aided inertial navigation. Proceedings - IEEE International Conference on Robotics and Automation. pages 3565--3572. doi:10.1109/ROBOT.2007.364024
[15] Mourikis, A.I., Roumeliotis, S.I., and Burdick, J.W. (2007). Mourikis, A, I., Roumeliotis, S.I., and Burdick, J.W. SC-KF mobile robot localization: A stochastic cloning Kalman filter for processing relative-state measurements. IEEE Transactions on Robotics. 23(4):717--730. doi:10.1109/TRO.2007.900610
[16] Mourikis, A.I., Trawny, N., Roumeliotis, S.I., Johnson, A.E., Ansar, A., and Matthies, L. (2009). Mourikis, A, I., Trawny, N., Roumeliotis, S.I., Johnson, A.E., Ansar, A., and Matthies, L. Vision-aided inertial navigation for spacecraft entry, descent, and landing. IEEE Transactions on Robotics. doi:10.1109/TRO.2009.2012342
[17] Romanovas, M., Schwarze, T., Schwaab, M., and Traechtler, M. (2013). Romanovas, M, , Schwarze, T., Schwaab, M., and Traechtler, M. Stochastic Cloning Kalman Filter for Visual Odometry and Inertial / Magnetic Data Fusion. Information Fusion (FUSION), 2013. pages 1434--1441. .
[18] Slaughter, D.C., Giles, D.K., and Downey, D. (2008). Slaughter, D, C., Giles, D.K., and Downey, D. Autonomous robotic weed control systems: A review. Computers and Electronics in Agriculture. 61(1):63--78. doi:10.1016/j.compag.2007.05.008
[19] Thrun, S., Burgard, W., and Fox, D. (2005). Thrun, S, , Burgard, W., and Fox, D. Probabilistic robotics. MIT press. .
[20] Urdal, F., Utstumo, T., Vatne, J.K., Ellingsen, S. A.A., and Gravdahl, J.T. (2014). Urdal, F, , Utstumo, T., Vatne, J.K., Ellingsen, S. A.A., and Gravdahl, J.T. Design and control of precision drop-on-demand herbicide application in agricultural robotics. In 2014 13th International Conference on Control Automation Robotics and Vision, ICARCV 2014. IEEE, Singapore, pages 1689--1694. doi:10.1109/ICARCV.2014.7064570
[21] Utstumo, T., Berge, T.W., and Gravdahl, J.T. (2015). Utstumo, T, , Berge, T.W., and Gravdahl, J.T. Non-linear model predictive control for constrained robot navigation in row crops. 2015 IEEE International Conference on Industrial Technology (ICIT). (July):357--362. doi:10.1109/ICIT.2015.7125124
[22] Utstumo, T. and Gravdahl, J.T. (2013). Utstumo, T, and Gravdahl, J.T. Implementation and comparison of attitude estimation methods for agricultural robotics. IFAC Proceedings Volumes (IFAC-PapersOnline). 4(PART 1):52--57. doi:10.3182/20130828-2-SF-3019.00051


BibTeX:
@article{MIC-2017-1-1,
  title={{Unscented Multi-Point Smoother for Fusion of Delayed Displacement Measurements: Application to Agricultural Robots}},
  author={Arbo, Mathias Hauan and Utstumo, Trygve and Brekke, Edmund and Gravdahl, Jan T.},
  journal={Modeling, Identification and Control},
  volume={38},
  number={1},
  pages={1--9},
  year={2017},
  doi={10.4173/mic.2017.1.1},
  publisher={Norwegian Society of Automatic Control}
};