A method for constructing amphibious vehicle environments and planning paths that considers ocean currents and land information
By constructing a composite map of ocean currents and seabed information, the problem of existing technologies failing to effectively consider dynamic ocean currents and seabed soil characteristics is solved, enabling amphibious vehicles to plan routes in complex underwater environments and ensuring the feasibility and optimality of the routes.
Patent Information
- Application Number
- CN202611130726.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-07-28
- Publication Date
- 2026-11-10
AI Technical Summary
Existing underwater path planning methods fail to effectively consider dynamic ocean currents and seabed soil characteristics, resulting in inaccurate path planning and insufficient safety, which affects the autonomous navigation and mission execution of amphibious vehicles.
Construct a composite map that integrates ocean currents and seabed information, and generate the optimal path through raster map planning, topography and ocean current environment construction, path planning, path height limitation and collision detection.
It enables amphibious vehicle path planning in complex underwater environments, ensuring the feasibility and optimality of the path, and avoiding path deviations and vehicle entrapment accidents caused by dynamic ocean currents and seabed soil characteristics.
Smart Images

Figure CN123065459A_ABST
Abstract
Description
Technical Field
[0001] This invention belongs to the field of amphibious vehicle environment construction and path planning technology, specifically relating to an amphibious vehicle environment construction and path planning method that takes into account ocean currents and ground information. Background Technology
[0002] With the development of amphibious vehicle technology, unmanned amphibious vehicles are now being used for underwater exploration and rescue. Compared with land or air environments, the underwater environment is highly complex and dynamic, posing serious challenges to the autonomous navigation and path planning of amphibious vehicles.
[0003] Currently, traditional underwater path planning methods are mostly based on static environment models, primarily considering static obstacles (such as reefs and shipwrecks) and constant water depth to plan the geometrically shortest or safest path. However, these methods have significant limitations. First, they generally ignore the influence of dynamic ocean currents. Ocean currents, as a continuous natural force, change in speed and direction over time and space. Ignoring the dynamic characteristics of ocean currents can lead to significant deviations from the planned path during actual navigation, and may even result in mission failure.
[0004] Secondly, existing methods often lack effective integration of seabed soil information. Amphibious vehicles, unlike underwater vehicles, require real-time contact with the seabed soil. The type of seabed soil in different areas (such as soft silt, hard sand, or clay) has a decisive impact on their mobility. Entering areas of extremely poor load-bearing capacity, vehicles are highly susceptible to getting stuck, resulting in a "stuck vehicle" accident and loss of maneuverability. Traditional route planning treats the seabed only as a uniform two-dimensional plane, failing to identify and avoid such geologically risky areas, seriously threatening mission safety.
[0005] In summary, existing technologies fail to simultaneously consider two key environmental factors: dynamic ocean currents and seabed soil characteristics. Therefore, there is an urgent need to develop a novel underwater path planning method that can integrate predicted ocean current data with seabed sediment information to comprehensively plan a feasible path for amphibious vehicles in complex spatiotemporal environments. Summary of the Invention
[0006] (a) Technical problems to be solved The technical problem to be solved by this invention is: how to solve the environmental construction problem in underwater path planning for amphibious tracked vehicles.
[0007] (II) Technical Solution To address the aforementioned technical problems, this invention provides a method for constructing and planning the environment and path for amphibious vehicles that considers ocean currents and land information, such as... Figure 1 As shown, the amphibious vehicle environment construction and path planning method includes the following steps: Step S1: Grid map planning; Step S2: Terrain Environment Construction; Step S3: Ocean current environment construction; Step S4: Create a composite topographic-ocean current map; Step S5: Path planning; Step S6: Limit the path height; Step S7: Determine if a collision has occurred; Step S8: Determine if the path is optimal.
[0008] In step S1, grid map planning is performed as follows: Based on the scope of the target sea area, plan the map size and initialize a three-dimensional spatial raster map. The map structure size is represented as length × width × height. Plan a sea area raster map with a certain length, width, and water depth for amphibious vehicle underwater path planning. That is, plan a water area space with a raster map length of 200 meters, a width of 200 meters, and a water depth of 15 meters, i.e., a 200×200×15 sea area for amphibious vehicle underwater path planning.
[0009] In step S2, the terrain environment is constructed as follows: Digital seabed topography data is loaded based on the geological characteristics of the target sea area. This data includes information on seabed bearing capacity, seabed topography, and obstacle distribution, such as... Figure 4 As shown.
[0010] In step S3, the ocean current environment is constructed: Digital dynamic ocean current information is loaded based on the hydrographic information of the target sea area. The data includes information on the distribution, location, velocity, intensity, core radius, and depth of influence of ocean eddies.
[0011] In step S4, a topographic-ocean current composite map is formed: The topographic and ocean current environments are overlaid and mapped onto the 200m × 200m × 15m sea area raster map from step S1, as shown below. Figure 6 As shown.
[0012] In step S5, path planning is performed as follows: Based on the topographic-ocean current composite map, underwater path global planning is performed using path planning algorithms (path planning methods such as A-Star, RRT, and PSO intelligent algorithms can all be used). Set the starting and ending points of the amphibious vehicle's mission according to actual needs, and set (1, 1) as the starting point and (200, 200) as the ending point in the terrain-ocean current composite map.
[0013] In step S6, the path height is limited: The PSO (Particle Swarm Optimization) algorithm is applied for underwater path planning of amphibious vehicles. According to the requirements of path planning, a series of control points are generated between the starting point and the ending point. In this embodiment, the number of control points is set to 10. The terrain interpolation function forces the control point to remain at a safe height, ensuring that the amphibious vehicle's path remains in close contact with the terrain and does not collide with the seabed. The safe height is consistent with the vehicle's center of gravity height. If the vehicle's center of gravity height cannot be accurately obtained, it is simplified to half of the vehicle's height.
[0014] In step S7, it is determined whether a collision has occurred: Check if the currently planned path collides with an obstacle. If no collision is found, proceed to the next step; if a collision is found, replan the path. Among them, step S8: Determine whether the path is optimal: The shortest path from the starting point to the ending point is selected as the criterion for determining the optimal path. After the particle swarm optimization algorithm loop ends, the amphibious vehicle selects the optimal path to execute. Figure 7 As shown.
[0015] Among them, such as Figure 2 As shown, the terrain environment construction in step S2 specifically includes the following steps S21-S23: Step S21: Obtain seabed topography data: The seabed topography data obtained in advance (such as multibeam bathymetry data) is mapped into a two-dimensional matrix, where the row vectors of the matrix are mapped to the length of the target sea area, the column vectors are mapped to the width of the target sea area, and the values in the matrix are mapped to the topographic height at that location. Step S22: Seabed data normalization processing: To avoid instability in numerical calculations due to excessively large or small topographic slope characteristic values, the two-dimensional matrix of seabed topography is normalized: In the formula: The current value of the matrix; It is the minimum value in the matrix; The maximum value in the matrix; Based on matrix normalization, a terrain mapping function is established using cubic spline interpolation. Combined with the elevation restoration coefficient, a continuous real seabed elevation model is generated. If the seabed terrain feature points collected in advance are sparse, the terrain resolution is increased through interpolation algorithm to ensure that the accuracy meets the path planning algorithm. Step S23: Generate terrain mapping model: Based on matrix normalization, a terrain mapping function is established using cubic spline interpolation. Combined with the elevation restoration coefficient, a continuous real seabed elevation model is generated and mapped onto a 200m × 200m × 15m sea area raster map. If the seabed topographic feature points collected in advance are sparse, the topographic resolution can be increased by interpolation algorithm to ensure that the ground accuracy meets the path planning algorithm. Step S24: Set obstacle information: Based on pre-detected seabed topographic obstacle information and suspected non-communication areas, obstacles are designated as such. These obstacles are not limited to any particular shape; in this embodiment, a sphere is used to represent them. Figure 5 As shown.
[0016] Among them, such as Figure 3 As shown, the ocean current environment construction in step S3 specifically includes the following steps S31-S34: Step S31: Initialize surface current velocity in the sea area: The surface current velocity is initialized based on the wave level in open water. The surface current velocity is expressed as: In the formula: This refers to the surface current velocity at the sea surface. v The wind speed for the target sea area can be found in the day's weather forecast. Step S32: Calculation of laminar flow velocity on the seabed: The laminar current velocity at the location of the amphibious vehicle on the seabed, calculated based on the surface current velocity, is expressed as: In the formula: The velocity of ocean currents on the seabed; z In this embodiment, the water depth is... z =15 meters; h The characteristic depth for ocean current attenuation is 15-30 meters. Step S33: Seabed eddy velocity assessment: The eddy current velocity at the seabed location of the amphibious vehicle is assessed based on the intensity, radial distance, and diffusion time of the eddy current in open sea areas, and is expressed as: In the formula: The tangential velocity of the eddy current; The intensity of the vortex is 0.1~1 m / s; r It is the radial distance from the center of the vortex; It is the kinematic viscosity of the fluid, with a value of 1e-6 m² / s; t It is the diffusion time; The radial distance from the vortex center is expressed as: In the formula: The coordinates of the vortex center are set according to the nautical information. The coordinates are for the amphibious vehicle; the vortex is a two-dimensional vortex, uniformly distributed along the depth. Step S34: Ocean current environment mapping: Based on the calculation of seabed laminar velocity and the evaluation of seabed eddy velocity, it is expressed as follows: In the formula: Position of a two-dimensional matrix ocean current speed, Position of a two-dimensional matrix Laminar velocity; Position of a two-dimensional matrix The eddy current velocity at each point is calculated; the laminar velocity and eddy current velocity at each point in the two-dimensional matrix are linearly superimposed and mapped onto a 200m × 200m × 15m sea area raster map.
[0017] (III) Beneficial Effects Compared with existing technologies, this invention provides an amphibious vehicle environment construction and path planning method that considers ocean currents and land information to solve the environmental construction problem in underwater path planning for amphibious tracked vehicles. It involves underwater ocean current environment, seabed soil environment, and topographic slope information to realize path planning for amphibious vehicles in complex spatiotemporal changing environments.
[0018] Specifically, this method constructs a composite map integrating ocean currents and seabed topography information to achieve underwater path planning for amphibious vehicles. The method first initializes a 3D raster map and then loads seabed topography data (including bearing capacity, terrain, and obstacle information) and dynamic ocean current data (including eddy distribution and current velocity information) separately, overlaying them into a composite environmental model. Based on this, a path planning algorithm (such as PSO) is used to generate control points from the starting point to the ending point, and terrain interpolation ensures that the path maintains a safe height relative to the seabed. Collision detection is performed during the planning process, and the shortest path is selected as the optimal path output, thereby ensuring the feasibility and path optimization of amphibious vehicles in complex underwater environments. Attached Figure Description
[0019] Figure 1 A flowchart illustrating the amphibious vehicle environment construction and path planning method that takes into account ocean currents and land information, provided in this embodiment of the invention. Figure 2 A flowchart illustrating the ground-obstacle environment construction process provided in this embodiment of the invention; Figure 3 A flowchart for constructing an ocean current environment provided in an embodiment of the present invention; Figure 4 A schematic diagram of the ground environment provided for an embodiment of the present invention; Figure 5 A schematic diagram of the ground-obstacle environment provided in an embodiment of the present invention; Figure 6 This is a schematic diagram of the ground-obstacle-flow field environment provided in an embodiment of the present invention; Figure 7 This is a schematic diagram of an underwater path planning method for amphibious vehicles that takes into account ocean currents and land information, provided in an embodiment of the present invention. Detailed Implementation
[0020] To make the objectives, contents, and advantages of the present invention clearer, the specific embodiments of the present invention will be described in further detail below with reference to the accompanying drawings and examples.
[0021] To address the aforementioned technical problems, this invention provides a method for constructing and planning the environment and path for amphibious vehicles that considers ocean currents and land information, such as... Figure 1 As shown, the amphibious vehicle environment construction and path planning method includes the following steps: Step S1: Grid map planning; Step S2: Terrain Environment Construction; Step S3: Ocean current environment construction; Step S4: Create a composite topographic-ocean current map; Step S5: Path planning; Step S6: Limit the path height; Step S7: Determine if a collision has occurred; Step S8: Determine if the path is optimal.
[0022] In step S1, grid map planning is performed as follows: Based on the scope of the target sea area, plan the map size and initialize a three-dimensional spatial raster map. The map structure size is represented as length × width × height. Plan a sea area raster map with a certain length, width, and water depth for amphibious vehicle underwater path planning. That is, plan a water area space with a raster map length of 200 meters, a width of 200 meters, and a water depth of 15 meters, i.e., a 200×200×15 sea area for amphibious vehicle underwater path planning.
[0023] In step S2, the terrain environment is constructed as follows: Digital seabed topography data is loaded based on the geological characteristics of the target sea area. This data includes information on seabed bearing capacity, seabed topography, and obstacle distribution, such as... Figure 4 As shown.
[0024] In step S3, the ocean current environment is constructed: Digital dynamic ocean current information is loaded based on the hydrographic information of the target sea area. The data includes information on the distribution, location, velocity, intensity, core radius, and depth of influence of ocean eddies.
[0025] In step S4, a topographic-ocean current composite map is formed: The topographic and ocean current environments are overlaid and mapped onto the 200m × 200m × 15m sea area raster map from step S1, as shown below. Figure 6 As shown.
[0026] In step S5, path planning is performed as follows: Based on the topographic-ocean current composite map, underwater path global planning is performed using path planning algorithms (path planning methods such as A-Star, RRT, and PSO intelligent algorithms can all be used). Set the starting and ending points of the amphibious vehicle's mission according to actual needs, and set (1, 1) as the starting point and (200, 200) as the ending point in the terrain-ocean current composite map.
[0027] In step S6, the path height is limited: The PSO (Particle Swarm Optimization) algorithm is applied for underwater path planning of amphibious vehicles. According to the requirements of path planning, a series of control points are generated between the starting point and the ending point. In this embodiment, the number of control points is set to 10. The terrain interpolation function forces the control point to remain at a safe height, ensuring that the amphibious vehicle's path remains in close contact with the terrain and does not collide with the seabed. The safe height is consistent with the vehicle's center of gravity height. If the vehicle's center of gravity height cannot be accurately obtained, it is simplified to half of the vehicle's height.
[0028] In step S7, it is determined whether a collision has occurred: Check if the currently planned path collides with an obstacle. If no collision is found, proceed to the next step; if a collision is found, replan the path. Among them, step S8: Determine whether the path is optimal: The shortest path from the starting point to the ending point is selected as the criterion for determining the optimal path. After the particle swarm optimization algorithm loop ends, the amphibious vehicle selects the optimal path to execute. Figure 7 As shown.
[0029] Among them, such as Figure 2 As shown, the terrain environment construction in step S2 specifically includes the following steps S21-S23: Step S21: Obtain seabed topography data: The seabed topography data obtained in advance (such as multibeam bathymetry data) is mapped into a two-dimensional matrix, where the row vectors of the matrix are mapped to the length of the target sea area, the column vectors are mapped to the width of the target sea area, and the values in the matrix are mapped to the topographic height at that location. Step S22: Seabed data normalization processing: To avoid instability in numerical calculations due to excessively large or small topographic slope characteristic values, the two-dimensional matrix of seabed topography is normalized: In the formula: The current value of the matrix; It is the minimum value in the matrix; The maximum value in the matrix; Based on matrix normalization, a terrain mapping function is established using cubic spline interpolation. Combined with the elevation restoration coefficient, a continuous real seabed elevation model is generated. If the seabed terrain feature points collected in advance are sparse, the terrain resolution is increased through interpolation algorithm to ensure that the accuracy meets the path planning algorithm. Step S23: Generate terrain mapping model: Based on matrix normalization, a terrain mapping function is established using cubic spline interpolation. Combined with the elevation restoration coefficient, a continuous real seabed elevation model is generated and mapped onto a 200m × 200m × 15m sea area raster map. If the seabed topographic feature points collected in advance are sparse, the topographic resolution can be increased by interpolation algorithm to ensure that the ground accuracy meets the path planning algorithm. Step S24: Set obstacle information: Based on pre-detected seabed topographic obstacle information and suspected non-communication areas, obstacles are designated as such. These obstacles are not limited to any particular shape; in this embodiment, a sphere is used to represent them. Figure 5 As shown.
[0030] Among them, such as Figure 3 As shown, the ocean current environment construction in step S3 specifically includes the following steps S31-S34: Step S31: Initialize surface current velocity in the sea area: The surface current velocity is initialized based on the wave level in open water. The surface current velocity is expressed as: In the formula: This refers to the surface current velocity at the sea surface. v The wind speed for the target sea area can be found in the day's weather forecast. Step S32: Calculation of laminar flow velocity on the seabed: The laminar current velocity at the location of the amphibious vehicle on the seabed, calculated based on the surface current velocity, is expressed as: In the formula: The velocity of ocean currents on the seabed; z In this embodiment, the water depth is... z =15 meters; h The characteristic depth for ocean current attenuation is 15-30 meters. Step S33: Seabed eddy velocity assessment: The eddy current velocity at the seabed location of the amphibious vehicle is assessed based on the intensity, radial distance, and diffusion time of the eddy current in open sea areas, and is expressed as: In the formula: The tangential velocity of the eddy current; The intensity of the vortex is 0.1~1 m / s; r It is the radial distance from the center of the vortex; It is the kinematic viscosity of the fluid, with a value of 1e-6 m² / s; t It is the diffusion time; The radial distance from the vortex center is expressed as: In the formula: The coordinates of the vortex center are set according to the nautical information. The coordinates are for the amphibious vehicle; the vortex is a two-dimensional vortex, uniformly distributed along the depth. Step S34: Ocean current environment mapping: Based on the calculation of seabed laminar velocity and the evaluation of seabed eddy velocity, it is expressed as follows: In the formula: Position of a two-dimensional matrix ocean current speed, Position of a two-dimensional matrix Laminar velocity; Position of a two-dimensional matrix The eddy current velocity at each point is calculated; the laminar velocity and eddy current velocity at each point in the two-dimensional matrix are linearly superimposed and mapped onto a 200m × 200m × 15m sea area raster map.
[0031] The above description is only a preferred embodiment of the present invention. It should be noted that for those skilled in the art, several improvements and modifications can be made without departing from the technical principles of the present invention, and these improvements and modifications should also be considered within the scope of protection of the present invention.
Claims
1. A method for constructing an amphibious vehicle environment and planning a path, considering ocean currents and land information, characterized in that, The amphibious vehicle environment construction and path planning method includes the following steps: Step S1: Grid map planning; Step S2: Terrain Environment Construction; Step S3: Ocean current environment construction; Step S4: Create a composite topographic-ocean current map; Step S5: Path planning; Step S6: Limit the path height; Step S7: Determine if a collision has occurred; Step S8: Determine if the path is optimal.
2. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 1, characterized in that, In step S1, grid map planning is performed. Based on the scope of the target sea area, plan the map size, initialize a three-dimensional spatial raster map, and represent the map structure size as length × width × height. Plan a sea area raster map with a certain length, width and water depth for underwater path planning of amphibious vehicles.
3. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 2, characterized in that, In step S2, the terrain environment is constructed: Digital seabed topographic data is loaded based on the geological characteristics of the target sea area. The data includes information on seabed bearing capacity, seabed topography, and obstacle distribution.
4. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 3, characterized in that, In step S3, the ocean current environment is constructed: Digital dynamic ocean current information is loaded based on the hydrographic information of the target sea area. The data includes information on the distribution, location, velocity, intensity, core radius, and depth of influence of ocean eddies.
5. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 4, characterized in that, In step S4, a topographic-ocean current composite map is generated: The topographic environment and ocean current environment are overlaid and mapped onto the marine area raster map of step S1.
6. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 5, characterized in that, In step S5, path planning is performed. Based on a topographic-ocean current composite map, a path planning algorithm is applied to perform global underwater path planning. The starting and ending points of the missions performed by the amphibious vehicles are set according to actual needs.
7. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 6, characterized in that, In step S6, the path height is limited: The PSO (Particle Swarm Optimization) algorithm is applied for underwater path planning of amphibious vehicles. Based on the requirements of path planning, a series of control points are generated between the starting point and the ending point. The terrain interpolation function forces the control point to remain at a safe height, ensuring that the amphibious vehicle's path remains in close contact with the terrain and does not collide with the seabed. The safe height is consistent with the vehicle's center of gravity height. If the vehicle's center of gravity height cannot be accurately obtained, it is simplified to half of the vehicle's height.
8. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 7, characterized in that, In step S7, it is determined whether a collision has occurred: Check if the currently planned path collides with an obstacle. If no collision is found, proceed to the next step; if a collision is found, replan the path. Among them, step S8: Determine whether the path is optimal: The shortest path planned from the starting point to the ending point is selected as the criterion for determining the optimal path. After the particle swarm algorithm loop ends, the amphibious vehicle selects the optimal path to execute.
9. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 8, characterized in that, The terrain environment construction in step S2 specifically includes the following steps S21-S23: Step S21: Obtain seabed topography data: The seabed topography data obtained in advance is mapped into a two-dimensional matrix, where the row vectors of the matrix are mapped to the length of the target sea area, the column vectors are mapped to the width of the target sea area, and the values in the matrix are mapped to the topographic height at that location. Step S22: Submarine data normalization processing: To avoid instability in numerical calculations due to excessively large or small topographic slope characteristic values, the two-dimensional matrix of seabed topography is normalized: In the formula: The current value of the matrix; It is the minimum value in the matrix; The maximum value in the matrix; Based on matrix normalization, a terrain mapping function is established using cubic spline interpolation. Combined with the elevation restoration coefficient, a continuous real seabed elevation model is generated. If the seabed terrain feature points collected in advance are sparse, the terrain resolution is increased through interpolation algorithm to ensure that the accuracy meets the path planning algorithm. Step S23: Generate terrain mapping model: Based on matrix normalization, a terrain mapping function is established using cubic spline interpolation. Combined with the elevation restoration coefficient, a continuous real seabed elevation model is generated and mapped onto a marine area raster map. If the seabed topographic feature points collected in advance are sparse, the topographic resolution can be increased by interpolation algorithm to ensure that the ground accuracy meets the path planning algorithm. Step S24: Set obstacle information: Based on the pre-detected seabed topographical obstacles and suspected non-communication areas, obstacles were set up.
10. The amphibious vehicle environment construction and path planning method considering ocean currents and land information as described in claim 9, characterized in that, The ocean current environment construction in step S3 specifically includes the following steps S31-S34: Step S31: Initialize surface current velocity in the sea area: The surface current velocity is initialized based on the wave level in open water. The surface current velocity is expressed as: In the formula: This refers to the surface current velocity at the sea surface. v The wind speed for the target sea area can be found in the day's weather forecast. Step S32: Calculation of laminar flow velocity on the seabed: The laminar current velocity at the location of the amphibious vehicle on the seabed, calculated based on the surface current velocity, is expressed as: In the formula: The velocity of ocean currents on the seabed; z Seawater depth; h This represents the characteristic depth of ocean current attenuation. Step S33: Seabed eddy velocity assessment: The eddy current velocity at the seabed location of the amphibious vehicle is assessed based on the intensity, radial distance, and diffusion time of the eddy current in open sea areas, and is expressed as: In the formula: The tangential velocity of the eddy current; The intensity of the vortex; r It is the radial distance from the center of the vortex; It is the kinematic viscosity coefficient of the fluid; t It is the diffusion time; The radial distance from the vortex center is expressed as: In the formula: The coordinates of the vortex center are set according to the nautical information. The coordinates are for the amphibious vehicle; the vortex is a two-dimensional vortex, uniformly distributed along the depth. Step S34: Ocean current environment mapping: Based on the calculation of seabed laminar velocity and the evaluation of seabed eddy velocity, it is expressed as follows: In the formula: Position of a two-dimensional matrix The speed of the ocean current, Position of a two-dimensional matrix laminar velocity; Position of a two-dimensional matrix The eddy current velocity at each point is calculated; the laminar velocity and eddy current velocity at each point in the two-dimensional matrix are linearly superimposed and mapped onto a raster map of the sea area.
