Path-Tracking Controller for Tracked Mobile Robot on Rough Terrain

Authors: Toshifumi Hiramatsu, Satoshi Morita, Manuel Pencelli, Marta Niccolini, Matteo Ragaglia, Alfredo Argiolas

Abstract:

Automation technologies for agriculture field are needed to promote labor-saving. One of the most relevant problems in automated agriculture is represented by controlling the robot along a predetermined path in presence of rough terrain or incline ground. Unfortunately, disturbances originating from interaction with the ground, such as slipping, make it quite difficult to achieve the required accuracy. In general, it is required to move within 5-10 cm accuracy with respect to the predetermined path. Moreover, lateral velocity caused by gravity on the incline field also affects slipping. In this paper, a path-tracking controller for tracked mobile robots moving on rough terrains of incline field such as vineyard is presented. The controller is composed of a disturbance observer and an adaptive controller based on the kinematic model of the robot. The disturbance observer measures the difference between the measured and the reference yaw rate and linear velocity in order to estimate slip. Then, the adaptive controller adapts “virtual” parameter of the kinematics model: Instantaneous Centers of Rotation (ICRs). Finally, target angular velocity reference is computed according to the adapted parameter. This solution allows estimating the effects of slip without making the model too complex. Finally, the effectiveness of the proposed solution is tested in a simulation environment.

Keywords: Agricultural robot, autonomous control, path-tracking control, tracked mobile robot.

Digital Object Identifier (DOI): doi.org/10.5281/zenodo.2571922

References:

[1] N. Noguchi and O. C. Barawid Jr., “Robot farming system using multiple robot tractors in Japan agriculture”, In 18th IFAC world congress, 2011.
[2] S. Blackmore, “New concepts in agricultural automation”, In HGCA conference, 2009.
[3] D. Ball, P. Ross, A. English, P. Milani, D. Richards, A. Bate, B. Upcraft, G. Wyeth and P. Corke, “Farm workers of the future”, In IEEE Robotics & Automation magazine, 2017.
[4] Y. Okada, D. Endo, K. Yoshida and K. Nagatani, “Trajectory control of crawler type mobile robot with consideration of a slip”, In The Robotics and Mechatronics Conference, 2007.
[5] N. Shalal, T. Low, C. McCarthy and N. Hancock, “A review of autonomous navigation systems in agricultural environments”, In SEAg 2013.
[6] J. Pentzer, S. Brennan and K. Reichard, “Model-based Prediction of Skid-steer Robot Kinematics Using Online Estimation of Track Instantaneous Centers of Rotation”, In Journal of Field Robotics, 2014.
[7] R. Lenain, B. Thuilot, C. Cariou and P. Martinet, “Adaptive and predictive nonlinear control for sliding vehicle guidance”, In IEEE/RSJ International conference on Intelligence Robots and Systems, 2014.
[8] H. Fang, R. Fan, B. Thuilot and P. Martinet, “Trajectory tracking control of farm vehicles in presence of sliding”, In IEEE/RSJ International conference on Intelligent Robots and Systems, 2005.
[9] C. Wen-Hua, Y. Jun, G. Lei and L. Shihua, “Disturbance-observer-based control and related methods – An overview,” In IEEE Transl. Industrial electronics., vol. 63, Feb. 2016, pp. 1083–1095
[10] S. Hyungbo, P. Gyunghoon, J. Youngjun, B. Juhoon and J. Nam Hoon, “Yet another tutorial of disturbance observer: robust stabilization and recovery of nominal performance”, In Control theory and technology. South China University of technology and academy of mathematics and systems science, vol. 14, Aug., 2016, pp. 237-249
[11] R. Gonzàlez, R. Rodoriguez and J. Guzmàn, “Autonomous Tracked Robots in Planar Off-Road Conditions”, Springer, 2014.
[12] Y. Kanayama, Y. Kimura, F. Miyazaki and T. Noguchi, “A Stable Tracking Control method for an autonomous mobile robot”, In Proceedings of IEEE International Conference on Robotics and Automation, 1990.
[13] T. M. Dar and R. G. Longoria, “Estimating traction coefficients of friction for small-scale robotic tracked vehicles”, In Proceedings of the ASME 2010 Dynamics Systems and Control Conference, 2010
[14] B. M. Nguyen, H. Fujimoto, Y. Hori, “Yaw angle control for autonomous vehicle using Kalman filter based disturbance observer”, In SAEJ. EVTeC and APE Japan, 2014.
[15] J.-J. E. Slotine and W. Li, “Applied Nonlinear Control”, Prentice Hall, 1991.
[16] F. Pourboghrat and M. P. Karlsson, “Adaptive control of dynamic mobile robots with nonholonomic constraints”, In Computers and Electrical Engineering 28, 2002.
[17] Boost-up your research work without wasting time and money, retrieved January 25, 2019 from http://www.dronyx.com/xbot-tracked-mobile-robot/.
[18] V-rep virtual robot experimentation platform, retrieved January 25, 2019 from http://www.coppeliarobotics.com/.
[19] Achieve true-to-life simulation, retrieved January 25, 2019 from https://www.cm-labs.com/vortex-studio/features/physics-based-mechanical-dynamics-engine/.
[20] S. Morita, T. Hiramatsu, M. Niccolini, A. Argiolas, M. Ragaglia, “Kinematic track modelling for fast multiple body dynamics simulation of tracked vehicle robot”, In The 24th International Conference on Methods and Models in Automation and Robotics, 2018.