Three-dimensional Formation and Obstacle Avoidance Method of Underwater Robots

Abstract

The invention relates to a three-dimensional formation and obstacle avoidance method of an underwater robot, comprising: defining a geometric formation by using a virtual structure method, and constructing a mathematical model of a three-dimensional formation system of an underwater robot according to the reference trajectory of the formation center; , calculate the reference state vector of each underwater robot based on the Lyapunov stability principle; calculate the influence of a single obstacle on the motion of the underwater robot to correct the reference speed of each underwater robot; according to the zero-space strategy, consider the impact of all obstacles on the underwater robot According to the influence of robot motion, the reference state vector of each underwater robot in a multi-obstacle environment is obtained; each underwater robot uses a nonlinear model predictive controller to solve the formation control problem according to its own reference state vector, and obtains the optimal control input. The invention predicts and considers the influence of all obstacles on the movement of the underwater robot based on the modified zero-space model, and at the same time ensures the stable formation navigation and safe obstacle avoidance of the robots, and is suitable for complex environments.

Description

technical field [0001] The invention belongs to the technical field of navigation, guidance and control of underwater robots, and in particular relates to a three-dimensional formation and obstacle avoidance method for underwater robots based on a modified zero-space model predictive control. Background technique [0002] In recent years, with the gradual application of underwater robots in the fields of marine environment monitoring, submarine resource detection, search and rescue, domestic and foreign scholars have conducted a lot of research on how to improve the autonomous navigation and environmental adaptability of underwater robots. Among them, the formation control technology is the basic and key technology for underwater robots to cooperate to perform specific tasks. It requires controlling the composition of multiple robots and maintaining a certain geometric formation. Scholars at home and abroad have proposed a series of control structures for formation problems,...

AI Technical Summary

Problems solved by technology

Scholars at home and abroad have proposed a series of control structures for formation problems, mainly including the leader-wingman method, behavior-based methods, and virtual structure methods, which are applicable to different environments and have their own advantages and disadvantages: the principle of the leader-wingman method is simple, However, there are problems such as formation error accumulation and poor robustness; the behavior-based method has strong ability to adapt to the environment, but there are defects such as difficulty in system design; the formation accuracy of the virtual structure method is high, but the flexibility is poor

However, existing methods are often only suitable for avoiding simple obstacles, and cannot be applied to formation and obstacle avoidance tasks in 3D complex environments.

Images