Kinematic Modeling and Motion Planning of the Mobile Manipulator Agri.Q for Precision Agriculture

Abstract

In recent years, the study of robotic systems for agriculture, a modern research field often shortened as “precision agriculture”, has become highly relevant, especially for those repetitive actions that can be automated thanks to innovative robotic solutions. This paper presents the kinematic model and a motion planning pipeline for a mobile manipulator specifically designed for precision agriculture applications, such as crop sampling and monitoring, formed by a novel articulated mobile base and a commercial collaborative manipulator with seven degrees of freedom. Starting from the models of the two subsystems, characterized by an adjustable position and orientation of the manipulator with respect to the mobile base, the linear mapping that describes the differential kinematics of the whole custom system is expressed as a function of the input commands. To perform pick–and–place tasks, a motion planning algorithm, based on the manipulator manipulability index mapping and a closed form inverse kinematics solution is presented. The motion of the system is based on the decoupling of the base and the arm mobility, and the paper discusses how the base can be properly used for manipulator positioning purposes. The closed form inverse kinematics solution is also provided as an open-source Matlab code.