Navigating safely in complex marine environments is a challenge for submarines because proper path planning underwater is difficult. This paper decomposes the submarine path planning problem into global path planning and local dynamic obstacle avoidance. Firstly, an artificial potential field ant colony algorithm (APF-ACO) based on an improved artificial potential field algorithm and improved ant colony algorithm is proposed to solve the problem of submarine underwater global path planning. Compared with the Optimized ACO algorithm proposed based on a similar background, the APF-ACO algorithm has a faster convergence speed and better path planning results. Using an inflection point optimization algorithm greatly reduces the number and length of inflection points in the path. Using the Clothoid curve fitting algorithm to optimize the path results, a smoother and more stable path result is obtained. In addition, this paper uses a three-dimensional dynamic obstacle avoidance algorithm based on the velocity obstacle method. The experimental results show that the algorithm can help submarines to identify threatening dynamic obstacles and avoid collisions effectively. Finally, we experimented with the algorithm in the submarine underwater semi-physical simulation system, and the experimental results verified the effectiveness of the algorithm.
To address the challenge of monitoring BeiDou RDSS signals under low signal-to-noise ratio (SNR) and high-dynamic conditions, this paper introduces a hierarchical joint processing algorithm combining PMF-FFT and PMF-FRFT. The method counters the energy dispersion issue in conventional FFT-based techniques by employing a two-stage “coarse–fine” strategy. A computationally efficient PMF-FFT performs a rapid coarse search, followed by an intelligent trigger, based on a correlation peak morphology, that initiates a localized PMF-FRFT fine search for high-dynamic signals, to precisely estimate the code phase, center frequency, and Doppler rate. Experimental results demonstrated that the algorithm’s acquisition performance was comparable to a global PMF-FRFT search and superior to the conventional PMF-FFT, achieving a 4.91% correlation peak improvement at −10 dB SNR and a gain of nearly 30% in extreme conditions (−20 dB SNR, 1000 Hz offset). Crucially, its average processing time (∼0.088 s) was on the same order of magnitude as PMF-FFT (∼0.0568 s) and significantly faster than global PMF-FRFT (∼0.3317 s). The proposed algorithm effectively balances detection performance with computational efficiency, offering a viable solution for the real-time monitoring of high-dynamic DSSS signals.