The invention discloses a
humanoid robot grabbing method based on three-dimensional vision, and the method comprises the following specific steps: S1, environment modeling and
perception: carrying out the three-dimensional scanning of a
working environment, and constructing a three-dimensional map of the environment; s2, object identification and 6D attitude
estimation: identifying a target object, and estimating the position and attitude of the object in a camera coordinate
system; s3, coordinate conversion and target positioning, wherein the posture of the object is converted into a
robot base coordinate
system from a camera coordinate
system through TF conversion; and S4, path planning and
motion control are conducted, specifically, path planning is conducted through a cumotion
algorithm, a grabbing path is generated, and the two arms are driven to move according to the planned track to achieve grabbing. By means of environment modeling and sensing, the
robot can update environment information in real time, conduct three-dimensional scanning on the
working environment and generate the three-dimensional grid model of the environment in real time, the model is used for obstacle detection and avoidance planning, and the dynamic environment adaptability of the
robot to object grabbing is improved.