US 12,109,710 B2
Method and apparatus for motion planning of robot, method and apparatus for path planning of robot, and method and apparatus for grasping of robot
Xi Li, Beijing (CN); Xinv Zhu, Beijing (CN); Youshuang Ding, Beijing (CN); Tianlan Shao, Beijing (CN); Wenjie Duan, Beijing (CN); Bing Liu, Beijing (CN); and Zheng Wang, Beijing (CN)
Assigned to MECH-MIND ROBOTICS TECHNOLOGIES LTD., Beijing (CN)
Filed by MECH-MIND ROBOTICS TECHNOLOGIES LTD., Beijing (CN)
Filed on Jan. 13, 2022, as Appl. No. 17/574,798.
Application 17/574,798 is a continuation of application No. PCT/CN2020/122219, filed on Oct. 20, 2020.
Claims priority of application No. 202010440673.4 (CN), filed on May 22, 2020.
Prior Publication US 2022/0134559 A1, May 5, 2022
Int. Cl. B25J 9/16 (2006.01); B25J 15/06 (2006.01)
CPC B25J 9/1666 (2013.01) [B25J 9/1669 (2013.01); B25J 15/0683 (2013.01)] 8 Claims
OG exemplary drawing
 
1. A method for motion planning of a robot, characterized in performing collision degree detection on an object, the method comprising:
loading a space model of a real scene where the object is located;
performing collision detection on the object and each of at least one collision subject in the space model; and
determining a motion planning scheme for the robot corresponding to a result of the collision detection based on a collision sensitivity of the object and a collision sensitivity of each of the at least one collision subject, the motion planning scheme being formed by the robot operating on the object,
wherein the robot is configured to move based on the determined motion planning scheme when operating the object,
wherein said performing the collision detection on the object and each of the at least one collision subject in the space model comprises:
determining a degree of overlap between a collision model of the object and a subject model of the collision subject; and
determining a collision degree of the collision subject based on the degree of overlap and resolutions of the collision model and the subject model in the space model,
wherein the collision model comprises a set of cubes formed by dividing a space occupied by the object at a first resolution in the space model, and the subject model comprises a set of cubes formed by dividing a space occupied by the collision subject at a second resolution in the space model, and
wherein said determining the collision degree of the collision subject based on the degree of overlap and the resolutions of the collision model and the subject model in the space model comprises:
determining a set of overlapping cubes between the collision model and the subject model; and
determining a depth weight of each cube in the set of overlapping cubes based on distances between the cube and corresponding surfaces of the models, and determining a collision degree between the collision model and the subject model based on the depth weight and the degree of overlap, wherein the degree of overlap is a number of cubes in the set of overlapping cubes.