Truss rod trajectory planning based on cubic B-spline curve and Dynamic Window Algorithm

In order to solve the problems such as the current low level of automation in the fishing of Antarctic krills (Euphausia superba) in China, and the error in determining the fishing depth by manually observing the fish detector image, we proposed a dynamic truss trajectory planning method based on the metadata of Antarctic krill sonar equipment. First, we analyzed the data sent back by the underwater acoustic instrument EK80 scientific echo sounder, obtained the target intensity of krills at different depths, and used statistical methods to determine the krills resources at this depth, so as to get the densest depth (Y) of krills corresponding to each horizontal distance (X). Then we used cubic B-spline curve and Dynamic Window Algorithm to carry out the global path planning and local path planning. The planned route passed through the densest depth of these krills. The results show that the total length of the planned path was 1 054 m, and the total time was 614 s. The maximum deviation distance tracked by the Dynamic Window Algorithm was only 3.3 m, which was less than the expected maximum deviation distance of 5 m. The proposed method can: 1) Avoid the impact of artificial judgment of resource depth on the fishing volume effectively, and improve the fishing efficiency. 2) Realize the automatic planning of the truss forward route with the best fishing efficiency.