Collision-free Inverse Kinematics of Redundant Manipulator for Agricultural Applications through Optimization Techniques

Document Type : Original Article


1 Department of Mechanical Engineering, College of Engineering (A), Andhra University, Visakhapatnam, India

2 Department of Mechanical Engineering, Aditya College of Engineering and Technology, Surampalem, India


This article presents an optimization-based technique for solving the inverse kinematics (IK) of spatially redundant manipulators in agricultural environments (workspaces). A kinematic configuration of 9 degrees of freedom (DOF) manipulator with eight revolute and one prismatic joint has been modelled to improve the accessibility in complex workspaces. The proposed manipulator has been simulated for harvesting fruits and vegetables. To perform the desired task in the working environment, the IK solution of the robot needs to be determined. The IK problem has been formulated as a constrained optimization problem with the objective of minimizing the positional and orientational errors by avoiding obstacles. A 3D CAD environment with different fruits and vegetable plants has been modelled in Solidworks. A target location in this environment has been chosen to pluck the fruit/vegetables. The trunk, branches, and leaves are considered as obstructions. The collision avoidance technique was implemented using a bounding box approach by including a collision detection algorithm. IK simulations of the spatial redundant manipulator in a cluttered environment were performed and results are reported.  The joint trajectories of the robot while reaching desired task-space location has been depicted using Simscape Multibody. The results demonstrate that the end-effector of the robot has been reached desired task location successfully with an accurate IK solution. The approach is adaptable in a wide range of working environments based on the simulation results of the IK solution of robots.


Main Subjects

  1. Silwal, A., Davidson, J.R., Karkee, M., Mo, C., Zhang, Q. and Lewis, K., "Design, integration, and field evaluation of a robotic apple harvester", Journal of Field Robotics, 34, No. 6, (2017), 1140-1159, doi: 10.1002/rob.21715
  2. Edan, Y., Han, S. and Kondo, N., "Automation in agriculture", Springer handbook of automation, (2009), 1095-1128, doi: 1007/978-3-540-78831-7_63
  3. Pedersen, S.M., Fountas, S., Have, H. and Blackmore, B., "Agricultural robots—system analysis and economic feasibility", Precision Agriculture, 7, No. 4, (2006), 295-308, doi: 10.1007/s11119-006-9014-9
  4. Belforte, G., Deboli, R., Gay, P., Piccarolo, P. and Aimonino, D.R., "Robot design and testing for greenhouse applications", Biosystems Engineering, 95, No. 3, (2006), 309-321, doi: 10.1016/j.biosystemseng.2006.07.004
  5. Hayashi, S., Shigematsu, K., Yamamoto, S., Kobayashi, K., Kohno, Y., Kamata, J. and Kurita, M., "Evaluation of a strawberry-harvesting robot in a field test", Biosystems Engineering, 105, No. 2, (2010), 160-171, doi: 10.1016/j.biosystemseng.2009.09.011
  6. Bechar, A. and Vigneault, C., "Agricultural robots for field operations: Concepts and components", Biosystems Engineering, 149, (2016), 94-111, doi: 10.1016/j.biosystemseng.2016.06.014
  7. Kootstra, G., Wang, X., Blok, P.M., Hemming, J. and Van Henten, E., "Selective harvesting robotics: Current research, trends, and future directions", Current Robotics Reports, 2, No. 1, (2021), 95-104, doi: 10.1007/s43154-020-00034-1
  8. Maciejewski, A.A. and Klein, C.A., "Obstacle avoidance for kinematically redundant manipulators in dynamically varying environments", The International Journal of Robotics Research, 4, No. 3, (1985), 109-117, doi: 10.1177/027836498500400308
  9. Korayem, M.H., Ahmadi, R., Jafari, N., Jamali, Y., Kioumarsi, M. And Habibnezhad, A., "Design, modeling, implementation and experimental analysis of 6r robot (technical note)", International Journal of Engineering, Transactions A: Basics, 21, No. 1, (2008), 71-84.
  10. Craig, J.J., "Introduction to robotics: Mechanics and control, Pearson Educacion, (2005), ISBN-13: 9781292040042
  11. Aristidou, A. and Lasenby, J., "Inverse kinematics: A review of existing techniques and introduction of a new fast iterative solver", University of Cambridge Technical Report, (2009) CUED/F-INFENG/TR-632.
  12. Goldenberg, A.A. and Lawrence, D.L., "A generalized solution to the inverse kinematics of robotic manipulators", Journal of Dynamic Systems, Measurement, and Control, 107, No. 1, (1985), 103-106, doi: 10.1115/1.3140699
  13. Kumar, S., Sukavanam, N. and Balasubramanian, R., "An optimization approach to solve the inverse kinematics of redundant manipulator", International Journal of Information and System Sciences (Institute for Scientific Computing and Information), 6, No. 4, (2010), 414-423.
  14. Bagheri, A., Narimanzadeh, N., Siavash, A.S. And Khoobkar, A.R., "Gmdh type neural networks and their application to the identification of the inverse kinematics equations of robotic manipulators (research note)", International Journal of Engineering, 18, No. 2, (2005), 135-143.
  15. Whitney, D.E., "Resolved motion rate control of manipulators and human prostheses", IEEE Transactions on man-machine systems, 10, No. 2, (1969), 47-53, doi: 10.1109/TMMS.1969.299896
  16. Chembuly, V.S. and Voruganti, H.K., “An optimization based inverse kinematics of redundant robots avoiding obstacles and singularities”, in Proceedings of the Advances in Robotics. (2017), 1-6, doi: 1145/3132446.3134888
  17. Zhao, Y., Gong, L., Huang, Y. and Liu, C., "A review of key techniques of vision-based control for harvesting robot", Computers and Electronics in Agriculture, 127, (2016), 311-323, doi: 10.1016/j.compag.2016.06.022
  18. Hartley, R.I. and Sturm, P., "Triangulation", Computer Vision and Image Understanding, 68, No. 2, (1997), 146-157, doi: 10.1006/cviu.1997.0547
  19. Van Henten, E., Schenk, E., Van Willigenburg, L., Meuleman, J. and Barreiro, P., "Collision-free inverse kinematics of the redundant seven-link manipulator used in a cucumber picking robot", Biosystems Engineering, 106, No. 2, (2010), 112-124, doi: 10.1016/j.biosystemseng.2010.01.007
  20. Buemi, F., Massa, M., Sandini, G. and Costi, G., "The agrobot project", Advances in Space Research, 18, No. 1-2, (1996), 185-189, doi: 10.1016/0273-1177(95)00807-Q
  21. Khatib, O., Real-time obstacle avoidance for manipulators and mobile robots, in Autonomous robot vehicles. 1986, Springer.396-404, doi: 1007/978-1-4613-8997-2_29
  22. Korayem, M., Nazemizadeh, M. and Azimirad, V., "Optimal trajectory planning of wheeled mobile manipulators in cluttered environments using potential functions", Scientia Iranica, 18, No. 5, (2011), 1138-1147, doi: 10.1016/j.scient.2011.08.026
  23. Korayem, M., Nazemizadeh, M. and Rahimi, H., "Trajectory optimization of nonholonomic mobile manipulators departing to a moving target amidst moving obstacles", Acta Mechanica, 224, No. 5, (2013), 995-1008, doi: 10.1007/s00707-012-0799-5
  24. Korayem, M.H., Nazemizadeh, M. and Nohooji, H.R., "Optimal point-to-point motion planning of non-holonomic mobile robots in the presence of multiple obstacles", Journal of the Brazilian Society of Mechanical Sciences and Engineering, 36, No. 1, (2014), 221-232, doi: 10.1007/s40430-013-0063-5
  25. Tang, Z., Xu, L., Wang, Y., Kang, Z. and Xie, H., "Collision-free motion planning of a six-link manipulator used in a citrus picking robot", Applied Sciences, 11, No. 23, (2021), 11336, doi: 10.3390/app112311336
  26. Koren, Y. and Borenstein, J., "Potential field methods and their inherent limitations for mobile robot navigation", in ICRA. Vol. 2, (1991), 1398-1404, doi: 1109/ROBOT.1991.131810
  27. Gottschalk, S., Lin, M.C. and Manocha, D., "Obbtree: A hierarchical structure for rapid interference detection", in Proceedings of the 23rd annual conference on Computer graphics and interactive techniques. (1996), 171-180, doi: 1145/237170.237244
  28. Barequet, G. and Har-Peled, S., "Efficiently approximating the minimum-volume bounding box of a point set in three dimensions", Journal of Algorithms, 38, No. 1, (2001), 91-109, doi: 10.1006/jagm.2000.1127
  29. Held, M., Klosowski, J.T. and Mitchell, J.S., "Evaluation of collision detection methods for virtual reality fly-throughs", in Canadian Conference on Computational Geometry, Citeseer. (1995), 205-210.
  30. Chembuly, V. and Voruganti, H.K., "An efficient approach for inverse kinematics and redundancy resolution of spatial redundant robots for cluttered environment", SN Applied Sciences, 2, No. 6, (2020), 1-20, doi: 10.1007/s42452-020-2825-x
  31. Bac, C.W., Van Henten, E.J., Hemming, J. and Edan, Y., "Harvesting robots for high‐value crops: State‐of‐the‐art review and challenges ahead", Journal of Field Robotics,  31, No. 6, (2014), 888-911, doi: 10.1002/rob.21525
  32. Tinoco, V., Silva, M.F., Santos, F.N., Rocha, L.F., Magalhães, S. and Santos, L.C., "A review of pruning and harvesting manipulators", in 2021 IEEE International Conference on Autonomous Robot Systems and Competitions (ICARSC), IEEE. (2021), 155-160, doi: 1109/ICARSC52212.2021.9429806
  33. Wu, Y., Tang, F. and Li, H., "Image-based camera localization: An overview", Visual Computing for Industry, Biomedicine, and Art, 1, No. 1, (2018), 1-13, doi: 10.1186/s42492-018-0008-z
  34. Tabandeh, S., Melek, W.W. and Clark, C.M., "An adaptive niching genetic algorithm approach for generating multiple solutions of serial manipulator inverse kinematics with applications to modular robots", Robotica, 28, No. 4, (2010), 493-507, doi: 10.1017/S0263574709005803
  35. Singla, E., Tripathi, S., Rakesh, V. and Dasgupta, B., "Dimensional synthesis of kinematically redundant serial manipulators for cluttered environments", Robotics and Autonomous Systems, 58, No. 5, (2010), 585-595, doi: 10.1016/j.robot.2009.12.005