A Novel Collision-Free Inverse Kinematics Method for 7-DoF Humanoid Manipulators in Dense Apple Canopies

Humanoid robots equipped with dual 7-degree-of-freedom (7-DoF) manipulators have demonstrated the ability to harvest apples in the outer canopy, whereas collision-free manipulation within dense canopies remains challenging. To address this challenge, a collision-free inverse kinematics method for humanoid manipulators, termed HMCIK, is proposed. First, the 7-DoF manipulator is represented by three obstacle-avoidance key points and a terminal rotation unit. Second, the spatial positions of the three key points are determined by integrating the Forward and Backward Reaching Inverse Kinematics (FABRIK) algorithm with a novel Global Axial Random Rotation (GARR) strategy. Finally, the joint angles of the first three pivot–hinge joint pairs are derived geometrically, and the terminal rotation angle is obtained analytically. The proposed method is evaluated in a self-collision scenario and five point-cloud environments reconstructed from a real apple tree. Under self-collision constraints, HMCIK achieves median solution times of 0.275 ms and 0.325 ms for the left and right arms, with median position solution errors below 0.037 mm and 0.038 mm and median orientation solution errors below 2×10−4 rad and 1×10−4 rad, respectively. Across the four branch-only environments, the median solution times range from 0.016 s to 0.028 s, while the median position and orientation solution errors remain below 0.149 mm and 3×10−4 rad, respectively, with success rates of 98–100%. In the foliage-containing environment, the median solution times increase to 0.855 s and 0.923 s, accompanied by increases in median position solution errors to 0.909 mm and 0.928 mm and decreases in success rates to 80% and 84%. Compared with KDL, TRAC-IK, and IKFast, HMCIK achieves higher success rates in all five point-cloud environments. Real-world experiments further demonstrate its practical feasibility.

Authors

Institutions

Publication Details

Journal
Agriculture
Published
2026-11-19
DOI
https://doi.org/10.3390/agriculture16222556
Primary Topic
Robotic Mechanisms and Dynamics
Type
article
Field-Weighted Citation Impact
0.00
Controls
|||
ALL TIME
JAN
FEB
MAR
APR
MAY
JUN
JUL
AUG
SEP
OCT
NOV
article

A Novel Collision-Free Inverse Kinematics Method for 7-DoF Humanoid Manipulators in Dense Apple Canopies

Meilin Kang, Xiaojun Yu, Qinhu Chen, Chuan Yu et al.
Agriculture
Robotic Mechanisms and Dynamics
article

A Novel Collision-Free Inverse Kinematics Method for 7-DoF Humanoid Manipulators in Dense Apple Canopies

Meilin Kang, Xiaojun Yu, Qinhu Chen, Chuan Yu, Jiarui Wang, Zeming Fan, Wenqiang Wang
article en

Abstract

Humanoid robots equipped with dual 7-degree-of-freedom (7-DoF) manipulators have demonstrated the ability to harvest apples in the outer canopy, whereas collision-free manipulation within dense canopies remains challenging. To address this challenge, a collision-free inverse kinematics method for humanoid manipulators, termed HMCIK, is proposed. First, the 7-DoF manipulator is represented by three obstacle-avoidance key points and a terminal rotation unit. Second, the spatial positions of the three key points are determined by integrating the Forward and Backward Reaching Inverse Kinematics (FABRIK) algorithm with a novel Global Axial Random Rotation (GARR) strategy. Finally, the joint angles of the first three pivot–hinge joint pairs are derived geometrically, and the terminal rotation angle is obtained analytically. The proposed method is evaluated in a self-collision scenario and five point-cloud environments reconstructed from a real apple tree. Under self-collision constraints, HMCIK achieves median solution times of 0.275 ms and 0.325 ms for the left and right arms, with median position solution errors below 0.037 mm and 0.038 mm and median orientation solution errors below 2×10−4 rad and 1×10−4 rad, respectively. Across the four branch-only environments, the median solution times range from 0.016 s to 0.028 s, while the median position and orientation solution errors remain below 0.149 mm and 3×10−4 rad, respectively, with success rates of 98–100%. In the foliage-containing environment, the median solution times increase to 0.855 s and 0.923 s, accompanied by increases in median position solution errors to 0.909 mm and 0.928 mm and decreases in success rates to 80% and 84%. Compared with KDL, TRAC-IK, and IKFast, HMCIK achieves higher success rates in all five point-cloud environments. Real-world experiments further demonstrate its practical feasibility.

AgricultureVol. 16(22)
Northwestern Polytechnical University (CN)
Robotic Mechanisms and Dynamics
AI Navigator

Ask Laika to Summarize, Analyze, and Connect papers live on the map.

Summarize Papers & Methodologies

Extract key findings, datasets, and comparative methods across publications.

Benchmark Rankings & Visual Analytics

Rank top research institutions, authors, funders, topics, and journals by Field-Weighted Citation Impact (FWCI) and paper volume with instant charts.

Connect Distant Disciplines

Bridge topological clusters on the map to find hidden collaborative intersections.

Laika access coming soon