A Robust Optimization Method for Underwater Vehicle Positioning Based on Switch Constraints

An underwater vehicle, robust optimization technology, applied in instrumentation, navigation, mapping and navigation, etc., can solve problems such as inability to achieve error closed-loop processing capability, map construction errors, etc., to eliminate adverse effects and reduce error rates. Effect

Active Publication Date: 2020-11-06
NORTHWESTERN POLYTECHNICAL UNIV
View PDF10 Cites 0 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0003] From the above analysis process, it can be seen that the traditional underwater vehicle navigation control technology system can guarantee its robustness in an ideal environment, but it cannot realize the processing ability of the error closed loop, so it is very easy to cause map construction errors

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • A Robust Optimization Method for Underwater Vehicle Positioning Based on Switch Constraints
  • A Robust Optimization Method for Underwater Vehicle Positioning Based on Switch Constraints
  • A Robust Optimization Method for Underwater Vehicle Positioning Based on Switch Constraints

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0037] Now in conjunction with embodiment, accompanying drawing, the present invention will be further described:

[0038] Firstly, the underwater environment is arranged. Lay out five marker points underwater and set any two of them as the same point.

[0039] Determine the initial position of the underwater vehicle (x, z) = (0, 0); the speed of the vehicle v = 1m / s, the accuracy of the internal odometer is Gaussian white noise with a variance of 1, with the preset attached figure 2 path sailing.

[0040] Step 1: Carry out map construction experiments underwater, and perform data fusion and build factor maps, as shown in the attached figure 1 As shown, and use the conditional probability distribution P(X|U) of the model to solve the SLAM pose graph problem. Where X represents the node pose and U represents the node constraint. Given a set of odometer ranging and closed-loop constraints u i , u ij ∈U, where u i Indicates any type of control input, with x i relevant, x...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention relates to an underwater vehicle positioning robust optimization method based on switch constraint. For the defect that a conventional underwater vehicle navigation control method cannotachieve robustness to an error closed loop, a navigation control method based on General Graph Optimization (g2o) and switch constraint is disclosed, a switch constraint back-end optimization methodis adopted, a node factor graph is adopted, and a method of eliminating an error closed loop generated in a map construction process is designed. The limitation that an existing underwater vehicle generates an error closed loop in the processes of synchronous positioning and map construction to cause errors of other constructed maps is solved, thus the vehicle processes the error closed loop in the map construction process and the error closed loop is weighted to be zero, and switch prior constraint is added to eliminate adverse effects brought by the error closed loop. The theory proves the robustness of the method, an experiment verifies the effectiveness of the method, and the method has a good effect in reducing an error rate of underwater vehicle map construction.

Description

technical field [0001] The invention belongs to the field of underwater vehicle navigation control and relates to a robust optimization method for underwater vehicle positioning based on switch constraints. Background technique [0002] Since the underwater vehicle does not have the support of the GPS signal, it needs to continuously form a closed loop through its own path to eliminate the odometer error and optimize the map construction and its own positioning. The traditional optimization method is to use the least squares optimization method, including the incremental smoothing and mapping method (iSAM) and the consistent attitude estimation method, that is, the underwater vehicle solves the problem by combining the visual tree method with the Bayesian probability framework. This problem, thereby reducing location recognition to a recursive Bayesian estimation problem, or detection of potential closed loops with stereo cameras, and filtering of false loop closures based o...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
Patent Type & Authority Patents(China)
IPC IPC(8): G05D1/08G01C21/20
CPCG01C21/203G05D1/0875
Inventor 张飞虎王璨程晨升
Owner NORTHWESTERN POLYTECHNICAL UNIV
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products