Robot distributed cooperative obstacle avoidance method based on independent virtual center point

Abstract

The present invention relates to a robot distributed cooperative obstacle avoidance method based on an independent virtual central point. The method comprises the following steps: step 1: using an extended Kalman filter to fuse an inertial measurement unit with odometer data to obtain current pose information of the robot; step 2: through network communication, sharing the speed and position information between the robots, and calculating the virtual center point of each robot, wherein the virtual center point moves with the movement of the robot; step 3: according to the current position, thetarget point position and the virtual center point position of each robot, obtaining the target vector and the repulsion vector of the robot; step 4: defining a switching signal to determine whetherthe movement mode of the robot is an obstacle avoidance mode or an obstacle-free mode; and step 5: using the vector differential method to obtain the desired speed and the desired angle of the robot,and according to the control law, obtaining the real-time speed and the angular velocity of the robot to guide the movement of the robot. According to the obstacle avoidance method provided by the present invention, the robot rotates around the virtual center point and perpendicular to the direction of the repulsion vector; and the obstacle-free mode means that the robot always moves toward the target vector, so that the robot is guided to orderly avoid obstacles.

Description

technical field

[0001] The invention relates to the field of autonomous navigation of industrial mobile robots, and relates to a decentralized collaborative obstacle avoidance method for robots based on an independent virtual center point. Background technique

[0002] With the rapid development of the field of artificial intelligence, intelligent robots have played an increasingly important role in human production and life. Because of the unique functions possessed by intelligent robots, they have been endowed with many different applications and achieved relatively excellent results. For example: in the field of military security, monitor dangerous elements and maintain regional security; in the field of exploration, adapt to various environments, collect various environmental parameters, and reduce personnel losses; in the field of medical care, assist medical personnel to treat diseases. With the continuous development and innovation of robot technology, sometimes a si...

Images