The invention discloses a master-slave USV collaborative navigation method based on corner net condition adjustment, and belongs to the technical field of autonomous
underwater navigation, and the method comprises the following steps: using a strapdown
inertial navigation system to obtain a navigation state of a USV to be positioned at an initial moment, receiving a current position shared by other USV data in a USV formation by the USV to be positioned, converting the current position into a two-dimensional coordinate, and carrying out navigation on the two-dimensional coordinate; the USV to be positioned obtains the relative
distance measurement information # imgabs0 # and the relative
azimuth angle # imgabs1 # between the USV to be positioned and other USVs according to the equipped sensor, establishes a state equation and a measurement equation for describing the USV to be positioned, establishes a corner net condition adjustment
mathematical model, processes measurement vectors, obtains a measurement vector adjustment value and a variance matrix thereof, sets an observation
noise variance matrix, and obtains the measurement vector adjustment value of the USV to be positioned according to the measurement information # imgabs0 # and the relative
azimuth angle # imgabs1 # of the USV to be positioned. And measurement updating is carried out in combination with DVL
speed measurement information. By adopting the corner net condition adjustment-based master-slave USV collaborative navigation method disclosed by the invention, high-precision
estimation and collaborative correction of the navigation state of the USV to be positioned can be realized.