Path Planning of Avoiding Obstacle for Fruit-Picking Manipulator Based on Position Information

Abstract:

Motoman SV3X manipulator was used to pick fruit and chosen as research object. Under the instance of known space coordinates of fruit and space position and pose of erect obstacle, a kind of multi-joint angle computation and path planning method for Motoman SV3X was proposed. Firstly, several sets of joint angles were computed according to relative space position between fruit and erect obstacle. And then, one set of joint angle was chosen as terminal angle of path planning. Finally, algorithm was used to plan a obstacle-avoiding path from start angle to terminal angle. The method solved the computation problem of multi-joint angle, and has universality for the problem of avoiding erect obstacle for fruit-picking manipulator. Simulation tests under the environment of Matlab showed that solved joint angles of manipulator can both make Motoman SV3X avoid erect obstacle and end-effector reach preconcerted position with given position error, and validated the correctness of the path planning method.

• Periodical: Advanced Materials Research (Volumes 383-390)
• Pages: 1318-1325
• DOI: https://doi.org/10.4028/www.scientific.net/AMR.383-390.1318
• Online since: November 2011
• Authors: Yu Fei Wang, Jian Jun Yin, Shan Feng Chen
• Keywords: Avoiding Obstacle, Manipulator, Path Planning, Simulation

References

[1] Baeten, Johan; Donné, Kevin; Boedrij, Sven; et al. Autonomous fruit picking machine: A robotic apple harvester,. Advanced Robotics, vol. 42, pp.531-539, (2008).

DOI: 10.1007/978-3-540-75404-6_51

[2] Montam, Kondo N, Shibano Y. Agricultural robot in grape production system,. IEEE international Conference on Robotics and Automation, pp.2504-2509, (1995).

DOI: 10.1109/robot.1995.525635

[3] Cai Jianrong, Zhao Jiewen, Thomas Rath, et al. Path Planning of Fruits Harvesting Robot,. Transactions of the Chinese Society of Agricultural Machinery, vol. 38(3), pp.102-105, (2008).

[4] Zhao Qingbo. Research on Control and Obstacle Avoidance Technologies of Fruit Harvesting Robot, Master Thesis of Jiang Su University: Zhenjiang, (2008).

[5] LIU Peng-fei, HAN Jiu-qiang, MA Jiang-mei. Research on kinematics modeling and inverse kinematics problem based on BP network of Motoman robot,. Microelectronics & Computer, vol. 21(11), pp.6-9, (2004).

[6] Chen Ning, Jiao En-zhang. A New Scheme for Solving the inverse kinematics Equation of PUMA Robot Manipulator, Journal of Nanjing Forestry University (Natural Sciences Edition), vol. 27(4), pp.23-25, (2003).

[7] He Qing-hua, He Xiangyu. Interference Analysis of two Booms for Rock-Drilling Robot, 1994-2010 China Academic Journal, Electronic Publishing House.

[8] Chen Jing-bo, Zhao Meng, Zhang Heng. On-line Real time obstacle Avoidance Path Planning of Space Manipulator, Control Engineering of China, vol. 14(4), pp.445-450, (2007).

[9] Chen Shu-ren, Ge Zhi-yong, Wang Xin-zhong, et al. A Calculation Method of C-space obstacle for Tomato-picking Manipulator, Transactions of the Chinese Society for Agricultural Machinery, vol. 39(1), pp.445-450, (2008).

[10] Cai Zi-xin, Xu Guang-you, Artificial Intelligence: principles and applications, 3rd ed. Tsinghua University Press: Beijing, (2003).