Manipulator artificial potential field space path planning method combined with spherical tree model

Abstract

The invention discloses a manipulator artificial potential field space path planning method combined with a spherical tree model. The manipulator artificial potential field space path planning methodcombined with spherical tree model comprises the following steps of (1) constructing a sphere octree bounding box of a barrier; (2) trimming a hollow sphere, and after clipping the hollow sphere, obtaining a model with a rough shape of the barrier; (3) trimming a redundant sphere, and after trimming the redundant sphere, obtaining a model capable of accurately reflecting the shape of the model; (4) building an artificial potential field model, and calculating the attractive force of a target point, and the repulsive force and the resultant force of the barrier suffered by a robot; (5) judgingwhether the robot is trapped in a local minimum value or a vibration area or not, and if yes, building a virtual target point, and calculating the attractive force of the virtual target point, and therepulsive force and the resultant force of the barrier suffered by a current point; (6) carrying out iterative computation, computing to obtain an optimal solution, and planning an appropriate obstacle avoidance path; and (7) smoothing a track.

Description

technical field [0001] The present invention relates to a robot automatic obstacle avoidance method, in particular to a manipulator artificial potential field space path planning method combined with a ball tree model, and relates to industrial robots and service robots widely used in the fields of industrial production, logistics transportation, etc. . Background technique [0002] Path planning is a very critical technology in robotics. Industrial robots and service robots can quickly and accurately locate the target point during operation. Path planning is required to plan the most suitable operating path, avoid obstacles, and increase robot The safety of operation improves the operating efficiency of the robot. The environment is unknown and changing; this requires dynamic path planning technology, and static path planning can no longer meet the requirements. [0003] Dynamic path planning for industrial robots and service robots requires efficient collision detection ...

AI Technical Summary

Problems solved by technology

[0007] The present invention aims at the redundant space problem of the spherical envelope model of the obstacle, and describes the obstacle by constructing a spherical tree model; uses the improved artificial potential field method model to solve the problem that the repulsion of the target point is not zero; aims at the artificial potential field method in three-dimensional space The problem of local minima and repeated oscillations in the path exists in the system. By temporarily constructing a virtual target point to jump out of the minimum point and local oscillation area, the manipulator can reach the target point smoothly.

Images