UUV dynamic obstacle avoidance method based on speed obstruction method

A speed obstacle and dynamic obstacle avoidance technology, which is applied in non-electric variable control, height or depth control, vehicle position/route/height control, etc., can solve the problems of poor accuracy of moving obstacles, reduce the impact of collisions, and improve avoidance. The effect of touching safety and avoiding conservative problems

Active Publication Date: 2016-05-18
HARBIN ENG UNIV
View PDF6 Cites 30 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0004] The present invention solves the problem of poor accuracy of avoiding mo

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
  • UUV dynamic obstacle avoidance method based on speed obstruction method
  • UUV dynamic obstacle avoidance method based on speed obstruction method
  • UUV dynamic obstacle avoidance method based on speed obstruction method

Examples

Experimental program
Comparison scheme
Effect test

Example Embodiment

[0022] Specific implementation mode one, combination figure 1 , figure 2 with image 3 To explain this embodiment, the UUV dynamic obstacle avoidance method based on the speed obstacle method described in this embodiment, the specific steps of the method are:

[0023] Step 1: Convert the movement uncertainty of the obstacle into position uncertainty to obtain the obstacle O i Estimated lower limit of radius R ro And obstacle O i Upper limit estimate of the radius

[0024] Obtain obstacle O according to the uncertainty of obstacle movement i Estimated lower limit of radius R ro : R ro =R o +R r +δ p

[0025] Obstacle O i Upper limit estimate of the radius

[0026] δ p Is the estimated deviation of the obstacle radius, ΔR o Is the estimated upper limit of the uncertainty of obstacle movement, R safe Is the safety distance, R o Is the obstacle radius, R r Is the UUV radius;

[0027] Estimate the lower limit based on the obstacle radius R ro , Calculate the minimum safety angle Accord...

Example Embodiment

Specific embodiment:

[0059] UUV sails from the starting point (0, 0) to the end point (450, 450), starting course at 45°, and designing 3 moving obstacles that cross the UUV O 1 ,O 2 ,O 3 , Suppose the moving obstacle is set as a rectangle. Obstacle location and motion information are unknown, using forward-looking sonar as the collision avoidance sensing device. Use formula (1) to get the speed hazard of moving obstacles, use formula (3) to get the reachable speed space of moving obstacles, and use formula (13) to get the coefficients in the optimized objective function. Then, the speed obstacle method is used to find the point with the smallest value of the objective function as the next waypoint to gradually realize the UUV route planning. Simulation trajectory such as Figure 4 Shown.

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 provides a UUV dynamic obstacle avoidance method based on a speed obstruction method and relates to a UUV dynamic obstacle avoidance method which solves the problem that an existing UUV route planning method is poor in accuracy when avoiding moving obstacles. According to the method, movement uncertainty of obstacles is converted into position uncertainty; according to movement uncertainty of the obstacles, the minimum safety angle alpha 1 and the maximum safety angle alpha 2 are obtained; the comprehensive speed danger degree, caused by the obstacles, of a UUV is obtained, , speed space of UUV movement is determined according to UUV dynamics constraint rule, and according to position uncertainty of the obstacles and the largest action range of the obstacles, the minimum collision time of the UUV and all the obstacles is obtained; by means of the comprehensive speed danger degree of the UUV and the minimum collision time between the UUV and all the obstacles, an optimized target route function of the UUV is obtained; by means of the speed obstruction method, the minimum value point of the target function is found to serve as the next way point of UUV movement, and a UUV movement path is planned. The UUV dynamic obstacle avoidance method is suitable for UUV dynamic obstacle avoidance.

Description

technical field [0001] The invention relates to a UUV dynamic obstacle avoidance method. Background technique [0002] With the continuous increase of human demand for marine resources, the space for human activities has gradually expanded from near-shore and shallow seas to deeper seas. UUV technology has received more and more attention, especially in the military fields of various countries. important role. [0003] The route planning of UUV (Unmanned Underwater Vehicle) is an important guarantee for the efficient and safe completion of operational tasks. However, UUV may encounter dynamic obstacles during navigation, which requires UUV to respond quickly and effectively to moving obstacles. Many scholars at home and abroad have conducted in-depth research on the problem of dynamic obstacle avoidance, and proposed many effective planning methods, such as artificial potential field method (APF), vector field histogram method, dynamic window method (DWA) and behavior meth...

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
IPC IPC(8): G05D1/06
CPCG05D1/0692
Inventor 张伟王秀芳严浙平陈涛李娟滕延斌
Owner HARBIN ENG 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