Modelling and Simulation of a Redundant Agricultural Manipulator with Virtual Prototyping
DOI:
https://doi.org/10.18196/jrc.v4i1.17121Keywords:
Redundant manipulator, PID & Feed-Forward controller, Matlab/Simulink, Simscape MultibodyAbstract
The development of autonomous robots for agricultural applications includes motion planning, fruit picking, and collision avoidance with surrounding environments, and these become challenging tasks. For harvesting applications, robust control of the manipulator is needed for the effective motion of the robot. Several combinations of Proportional(P)- Integrative(I)- Derivative(D) controllers are modelled and a simulation study was performed for trajectory tracking of a redundant manipulator in virtual agricultural environments. The article presents a comprehensive study on kinematic modelling and dynamic control of redundant manipulator for fruit-picking applications in virtual environments. The collisions with surrounding environment were eliminated using ‘bounding box technique’. The joint variables are obtained by constructing Inverse Kinematics (IK) problem and are determined using a classical optimization technique. Different controllers are modelled in the ‘Simulink’ environment and are tuned to generate error-free trajectory tracking during harvesting. The task space locations (TSLs) are considered as via-points, and joint variables at each TSLs are obtained by Sequential Quadratic Programming (SQP) technique. Joint-level trajectories are generated using Quintic and B-spline polynomials. For effective trajectory tracking, torque variations are controlled using the PID and Feedforward (FF) controller. The dynamic simulations of the robot manipulator are performed in Simscape Multibody software. Results show that the during the trajectory tracking of the manipulator, the Feed-forward controller performs best with Quintic polynomial trajectory.
References
L. F. Oliveira, A. P. Moreira, and M. F. Silva, “Advances in agriculture robotics: A state-of-the-art review and challenges ahead,” Robotics, vol. 10, no. 2, p. 52, 2021.
S. Fountas, N. Mylonas, I. Malounas, E. Rodias, C. Hellmann Santos, and E. Pekkeriet, “Agricultural robotics for field operations,” Sensors, vol. 20, no. 9, p. 2672, 2020.
G. Gil, D. Casagrande, L. P. Cortes, and R. Verschae, “Why the low adoption of robotics in the farms? challenges for the establishment of commercial agricultural robots,” Smart Agricultural Technology, vol. 3, p. 100069, 2023.
N. S. Naik, V. V. Shete, and S. R. Danve, “Precision agriculture robot for seeding function,” in 2016 international conference on inventive computation technologies (ICICT), vol. 2. IEEE, 2016, pp. 1–3.
G. Belforte, R. Deboli, P. Gay, P. Piccarolo, and D. R. Aimonino, “Robot design and testing for greenhouse applications,” Biosystems Engineering, vol. 95, no. 3, pp. 309–321, nov 2006.
S. Han, S. Xueyan, Z. Tiezhong, Z. Bin, and X. Liming, “Design optimisation and simulation of structure parameters of an eggplant picking robot,” New Zealand Journal of Agricultural Research, vol. 50, no. 5, pp. 959–964, dec 2007.
J. Baeten, K. Donne, S. Boedrij, W. Beckers, and E. Claesen, “Autonomous fruit picking machine: A robotic apple harvester,” in Springer Tracts in Advanced Robotics. Springer Berlin Heidelberg, pp. 531–539.
A. Silwal, J. R. Davidson, M. Karkee, C. Mo, Q. Zhang, and K. Lewis, “Design, integration, and field evaluation of a robotic apple harvester,” Journal of Field Robotics, vol. 34, no. 6, pp. 1140–1159, apr 2017.
P. Li, S. heon Lee, and H.-Y. Hsu, “Review on fruit harvesting method for potential use of automatic fruit harvesting systems,” Procedia Engineering, vol. 23, pp. 351–366, 2011.
N. Kondo, M. Monta, Y. Shibano, and K. Mohri, “Basic mechanism of robot adapted to physical properties of tomato plant,” in Proceedings of the Korean Society for Agricultural Machinery Conference. Korean Society for Agricultural Machinery, 1993, pp. 840–849.
S. Arima, “Cucumber harvesting robot and plant training system,” Journal of Robotics and Mechatronics, vol. 11, no. 3, pp. 208–212, 1999.
J. Baur, J. Pfaff, H. Ulbrich, and T. Villgrattner, “Design and development of a redundant modular multipurpose agricultural manipulator,” in 2012 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM). IEEE, jul 2012.
S. A. Magalhaes, A. P. Moreira, F. N. d. Santos, and J. Dias, “Active perception fruit harvesting robots—a systematic review,” Journal of Intelligent & Robotic Systems, vol. 105, no. 1, pp. 1–22, 2022.
J. Jun, J. Kim, J. Seol, J. Kim, and H. I. Son, “Towards an efficient tomato harvesting robot: 3d perception, manipulation, and end-effector,” IEEE access, vol. 9, pp. 17 631–17 640, 2021.
T. Yoshida, T. Kawahara, and T. Fukao, “Fruit recognition method for a harvesting robot with rgb-d cameras,” ROBOMECH Journal, vol. 9, no. 1, pp. 1–10, 2022.
M. Korayem, R. Ahmadi, N. Jafari, Y. Jamali, M. Kioumarsi, and A. Habibnezhad, “Design, modeling, implementation and experimental analysis of 6r robot,” 2008.
J. J. Craig, Introduction to robotics: mechanics and control. Pearson Educacion, 2005.
A. Aristidou and J. Lasenby, “Inverse kinematics: a review of existing techniques and introduction of a new fast iterative solver,” 2009.
A. A. Goldenberg and D. L. Lawrence, “A generalized solution to the inverse kinematics of robotic manipulators,” Journal of Dynamic Systems, Measurement, and Control, vol. 107, no. 1, pp. 103–106, mar 1985.
S. Kumar, N. Sukavanam, and R. Balasubramanian, “An optimization approach to solve the inverse kinematics of redundant manipulator,” International Journal of Information and System Sciences (Institute for Scientific Computing and Information), vol. 6, no. 4, pp. 414–423, 2010.
A. Bagheri, N. Narimanzadeh, A. S. Siavash, and A. Khoobkar, “Gmdh type neural networks and their application to the identification of the inverse kinematics equations of robotic manipulators (research note),” 2005.
V. V. M. J. S. Chembuly and H. K. Voruganti, “An optimization based inverse kinematics of redundant robots avoiding obstacles and singularities,” in Proceedings of the Advances in Robotics on - AIR '17. ACM Press, 2017.
N. Rokbani and A. M. Alimi, “Inverse kinematics using particle swarm optimization, a statistical analysis,” Procedia Engineering, vol. 64, pp. 1602–1611, 2013.
S. Starke, N. Hendrich, S. Magg, and J. Zhang, “An efficient hybridization of genetic algorithms and particle swarm optimization for inverse kinematics,” in 2016 IEEE International Conference on Robotics and Biomimetics (ROBIO). IEEE, 2016, pp. 1782–1789.
E. Van Henten, E. Schenk, L. Van Willigenburg, J. Meuleman, and P. Barreiro, “Collision-free inverse kinematics of the redundant seven-link manipulator used in a cucumber picking robot,” Biosystems engineering, vol. 106, no. 2, pp. 112–124, 2010.
D. Puiu and F. Moldoveanu, “Real-time collision avoidance for redundant manipulators,” in 2011 6th IEEE International Symposium on Applied Computational Intelligence and Informatics (SACI). IEEE, 2011, pp. 403–408.
D. Han, H. Nie, J. Chen, and M. Chen, “Dynamic obstacle avoidance for manipulators using distance calculation and discrete detection,” Robotics and computer-integrated manufacturing, vol. 49, pp. 98–104, 2018.
L. Ye, J. Duan, Z. Yang, X. Zou, M. Chen, and S. Zhang, “Collision-free motion planning for the litchi-picking robot,” Computers and Electronics in Agriculture, vol. 185, p. 106151, 2021.
S. M. LaValle and J. J. Kuffner, “Rapidly-exploring random trees: Progress and prospects: Steven m. lavalle, iowa state university, a james j. kuffner, jr., university of tokyo, tokyo, japan,” Algorithmic and Computational Robotics, pp. 303–307, 2001.
C. W. Bac, T. Roorda, R. Reshef, S. Berman, J. Hemming, and E. J. van Henten, “Analysis of a motion planning problem for sweet-pepper harvesting in a dense obstacle environment,” Biosystems Engineering, vol. 146, pp. 85–97, jun 2016.
X. Cao, X. Zou, C. Jia, M. Chen, and Z. Zeng, “RRT-based path planning for an intelligent litchi-picking manipulator,” Computers and Electronics in Agriculture, vol. 156, pp. 105–118, jan 2019.
K. Wei and B. Ren, “A method on dynamic path planning for robotic manipulator autonomous obstacle avoidance based on an improved rrt algorithm,” Sensors, vol. 18, no. 2, p. 571, 2018.
H. Zhang, Y. Wang, J. Zheng, and J. Yu, “Path planning of industrial robot based on improved rrt algorithm in complex environments,” IEEE Access, vol. 6, pp. 53 296–53 306, 2018.
K. Zhang, K. Lammers, P. Chu, Z. Li, and R. Lu, “System design and control of an apple harvesting robot,” Mechatronics, vol. 79, p. 102644, 2021.
H. Wang, Q. Zhao, H. Li, and R. Zhao, “Polynomial-based smooth trajectory planning for fruit-picking robot manipulator,” Information Processing in Agriculture, vol. 9, no. 1, pp. 112–122, 2022.
A. Sepehri and A. M. Moghaddam, “A motion planning algorithm for redundant manipulators using rapidly exploring randomized trees and artificial potential fields,” IEEE Access, vol. 9, pp. 26 059–26 070, 2021.
S. K. Saha, Introduction to robotics. Tata McGraw-Hill Education, 2014.
P. Hsu, J. Mauser, and S. Sastry, “Dynamic control of redundant manipulators,” Journal of Robotic Systems, vol. 6, no. 2, pp. 133–148, apr 1989.
G. Zhong, C. Wang, and W. Dou, “Fuzzy adaptive PID fast terminal sliding mode controller for a redundant manipulator,” Mechanical Systems and Signal Processing, vol. 159, p. 107577, oct 2021.
R. M. Murray, Z. Li, and S. S. Sastry, A mathematical introduction to robotic manipulation. CRC press, 2017.
A. Mohammadi, M. Tavakoli, H. J. Marquez, and F. Hashemzadeh, “Nonlinear disturbance observer design for robotic manipulators,” Control Engineering Practice, vol. 21, no. 3, pp. 253–267, 2013.
C. Urrea and J. Kern, “Modeling, simulation and control of a redundant scara-type manipulator robot,” International Journal of Advanced Robotic Systems, vol. 9, no. 2, p. 58, 2012.
A. Kumar and V. Kumar, “Evolving an interval type-2 fuzzy PID controller for the redundant robotic manipulator,” Expert Systems with Applications, vol. 73, pp. 161–177, may 2017.
R. P. Borase, D. Maghade, S. Sondkar, and S. Pawar, “A review of pid control, tuning methods and applications,” International Journal of Dynamics and Control, vol. 9, no. 2, pp. 818–827, 2021.
A. Dhyani, M. K. Panda, and B. Jha, “Design of an evolving fuzzyPID controller for optimal trajectory control of a 7-DOF redundant manipulator with prioritized sub-tasks,” Expert Systems with Applications, vol. 162, p. 113021, dec 2020.
S. A. Ajwad, J. Iqbal, M. I. Ullah, and A. Mehmood, “A systematic review of current and emergent manipulator control approaches,” Frontiers of mechanical engineering, vol. 10, pp. 198–210, 2015.
M. Grotjahn and B. Heimann, “Model-based feedforward control in industrial robotics,” The International Journal of Robotics Research, vol. 21, no. 1, pp. 45–60, jan 2002.
I. F. Zidane, Y. Khattab, M. El-Habrouk, and S. Rezeka, “Trajectory control of a laparoscopic 3-puu parallel manipulator based on neural network in simscape simulink environment,” Alexandria Engineering Journal, vol. 61, no. 12, pp. 9335–9363, 2022.
E. Tatlicioglu, D. Braganza, T. C. Burg, and D. M. Dawson, “Adaptive control of redundant robot manipulators with sub-task objectives,” in 2008 American Control Conference. IEEE, jun 2008.
H. Hulako and O. Yakut, “Control of three-axis manipulator placed on heavy-duty pentapod robot,” Simulation Modelling Practice and Theory, vol. 108, p. 102264, 2021.
Y. Shaoqiang, L. Zhong, and L. Xingshan, “Modeling and simulation of robot based on matlab/simmechanics,” in 2008 27th Chinese Control Conference. IEEE, 2008, pp. 161–165.
L. Zlajpah, “Simulation in robotics,” Mathematics and Computers in Simulation, vol. 79, no. 4, pp. 879–897, 2008.
M. Gouasmi, M. Ouali, B. Fernini, and M. Meghatria, “Kinematic modelling and simulation of a 2-r robot using solidworks and verification by matlab/simulink,” International Journal of Advanced Robotic Systems, vol. 9, no. 6, p. 245, 2012.
P. T. Boggs and J. W. Tolle, “Sequential quadratic programming,” Acta Numerica, vol. 4, pp. 1–51, jan 1995.
V. V. M. J. S. Chembuly and H. K. Voruganti, “An efficient approach for inverse kinematics and redundancy resolution of spatial redundant robots for cluttered environment,” SN Applied Sciences, vol. 2, no. 6, may 2020.
A. S. Reddy, V. Chembuly, and V. Rao, “Collision-free inverse kinematics of redundant manipulator for agricultural applications through optimization techniques,” International Journal of Engineering, Transactions A: Basics, vol. 35, no. 7, pp. 1343–1354, 2022.
L. Sciavicco and B. Siciliano, Modelling and control of robot manipulators. Springer Science & Business Media, 2001.
S. Tabandeh, W. W. Melek, and C. M. Clark, “An adaptive niching genetic algorithm approach for generating multiple solutions of serial manipulator inverse kinematics with applications to modular robots,” Robotica, vol. 28, no. 4, pp. 493–507, 2010.
E. Singla, S. Tripathi, V. Rakesh, and B. Dasgupta, “Dimensional synthesis of kinematically redundant serial manipulators for cluttered environments,” Robotics and Autonomous Systems, vol. 58, no. 5, pp. 585–595, 2010.
Y. Zhang, D. Kim, Y. Zhao, and J. Lee, “Pd control of a manipulator with gravity and inertia compensation using an rbf neural network,” International Journal of Control, Automation and Systems, vol. 18, no. 12, pp. 3083–3092, 2020.
Downloads
Published
How to Cite
Issue
Section
License
Authors who publish with this journal agree to the following terms:
- Authors retain copyright and grant the journal right of first publication with the work simultaneously licensed under a Creative Commons Attribution License that allows others to share the work with an acknowledgment of the work's authorship and initial publication in this journal.
- Authors are able to enter into separate, additional contractual arrangements for the non-exclusive distribution of the journal's published version of the work (e.g., post it to an institutional repository or publish it in a book), with an acknowledgment of its initial publication in this journal.
- Authors are permitted and encouraged to post their work online (e.g., in institutional repositories or on their website) prior to and during the submission process, as it can lead to productive exchanges, as well as earlier and greater citation of published work (See The Effect of Open Access).
This journal is based on the work at https://journal.umy.ac.id/index.php/jrc under license from Creative Commons Attribution-ShareAlike 4.0 International License. You are free to:
- Share – copy and redistribute the material in any medium or format.
- Adapt – remix, transform, and build upon the material for any purpose, even comercially.
The licensor cannot revoke these freedoms as long as you follow the license terms, which include the following:
- Attribution. You must give appropriate credit, provide a link to the license, and indicate if changes were made. You may do so in any reasonable manner, but not in any way that suggests the licensor endorses you or your use.
- ShareAlike. If you remix, transform, or build upon the material, you must distribute your contributions under the same license as the original.
- No additional restrictions. You may not apply legal terms or technological measures that legally restrict others from doing anything the license permits.
• Creative Commons Attribution-ShareAlike (CC BY-SA)
JRC is licensed under an International License