Method for avoiding moving obstacle in UUV navigation process based on virtual puffing
A movement obstacle and obstacle technology, applied in the field of movement obstacle avoidance, can solve the problem of difficulty in accurately predicting the movement state of random movement obstacle
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
specific Embodiment approach 1
[0030] Specific embodiment one: a method for avoiding motion obstacles in a UUV sailing process based on virtual puffing comprises the following steps:
[0031] The guidance direction refers to the direction of the vector formed by the line from the current position of the UUV to the next non-motion obstacle waypoint. The so-called non-movement obstacle waypoint means that the waypoint is not formed by relying on the movement obstacle, but is the vertex of the static environment information in the environment, such as the vertex of the static target (p 2 ), necessary points, recycling points, etc. When the UUV runs to figure 1 At the position shown, when the No. 1 motion obstacle is encountered, the UUV triggers the dynamic programming algorithm to form a new avoidance route, point p 1 is the waypoint formed by the UUV to avoid the No. 1 movement obstacle and relies on the movement obstacle, and the point p 2 is the static target puffed vertex. So according to the definit...
specific Embodiment approach 2
[0038] Specific embodiment 2: The difference between this embodiment and specific embodiment 1 is that in the first step, according to the headAngle, it is determined that the UUV and the movement disorder are sailing in the same direction or the UUV and the movement disorder are sailing in the same direction as:
[0039] like figure 2 As shown, when When , the UUV and the motion obstacle are facing each other; if image 3 As shown, when When , the UUV and the motion obstacle sail in the same direction.
specific Embodiment approach 3
[0040] Specific implementation mode three: the difference between this implementation mode and specific implementation mode one or two is that: in the step two, avoiding movement disorders is specifically:
[0041] Step 21: When the UUV detects a movement obstacle and sails in the opposite direction, the movement obstacle is circularly expanded, and the area radius after expansion is R, R>obs_r+safe_d, and the obs_r is the radius of the movement obstacle (during the modeling process, according to The maximum width of the obstacle will make the obstacle a circular model), safe_d is the expansion distance;
[0042] Step 22: According to the circular expansion of the movement obstacle in step 21, a rectangular virtual obstacle with a length of L and a width of 2R is generated along the forward direction of the movement obstacle, such as Figure 4 Shown; The relationship between the length of the rectangular virtual barrier and the straight-line distance M from the UUV to the cent...
PUM
Abstract
Description
Claims
Application Information
- R&D Engineer
- R&D Manager
- IP Professional
- Industry Leading Data Capabilities
- Powerful AI technology
- Patent DNA Extraction
Browse by: Latest US Patents, China's latest patents, Technical Efficacy Thesaurus, Application Domain, Technology Topic, Popular Technical Reports.
© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap|About US| Contact US: help@patsnap.com