The invention relates to the technical field of mechanical arm control, in particular to a
collision detection and
pose adjustment method and
system for picking in a mechanical arm box. The method comprises the following steps: firstly, projecting a three-dimensional
point cloud of a box body to a two-dimensional table-board coordinate
system, matching to obtain an initial relative
pose, performing iterative registration on the three-dimensional
point cloud of the box body and a three-dimensional template
point cloud according to an initial relative
pose relationship, and obtaining coordinates of inner and outer angular points of the box body; then, the three-dimensional point cloud of the box body is converted into a box body coordinate
system according to the coordinates of the inner and outer angular points of the box body, and a space
plane equation of each side wall of the box body is obtained; then, judging whether the
collision risk of the box body occurs or not by calculating the intersection point distance between the pose
ray of the sorting point and the side wall of the box body; if so, generating an execution vector; otherwise, pose point optimization is carried out, sorting task execution information is generated according to the pose point optimization, it is ensured that the mechanical arm does not collide with the side wall when grabbing in the box body, and the
operation safety and reliability are improved.