基于双曲正切函数的多艇协同目标跟踪自适应队形变换策略与控制方法

Adaptive formation reconfiguration strategy and control method for cooperative target tracking of multi-USV based on Tanh function

  • 摘要: [目的]多无人艇系统以特定的队形进行协同目标跟踪作业时,海洋环境中障碍物的存在会影响跟踪编队的形成,可能导致跟踪任务的失败。针对上述问题,提出了一种基于双曲正切函数的自适应目标跟踪队形变换控制方法。[方法]首先,根据不同障碍物分布与碰撞检测结果设计了队形变换策略,并基于双曲正切函数结合队形变换临界距离与安全距离,设计了队形自适应变换律,以平缓队形变换过程;然后,考虑到跟踪过程无人艇跟踪编队的形成以及与目标运动的同步性,同时基于期望队形与目标速度建立分布式一致性偏差模型,并利用反步法设计了分布式运动学控制器,实现了对目标的稳定跟踪且提升了系统响应速度;同时基于超螺旋滑模法设计了动力学控制器,最后证明了闭环系统的稳定性。[结果]以4艘无人艇构成的系统为例,在不同场景下对所提出的算法进行了目标跟踪仿真实验验证。[结论]仿真结果表明,所设计的方法下的无人艇编队能够根据障碍物分布情况进行相应的队形变换跟踪,相较于仿射变换该方法能够实现更复杂的跟踪队形,且与人工势场法下的控制输出相比更为平滑,跟踪队形保持更好。

     

    Abstract: Objective When multiple unmanned vehicle systems conduct cooperative target tracking with specific formation, the existence of obstacles in marine environment will bring collision risk and affect the movement of unmanned vehicle. Although the traditional collision avoidance method can achieve collision avoidance, it is easy to disrupt the original tracking formation. At the same time, the traditional formation change method does not consider the influence of target state on the tracking formation, so it is difficult to adapt to the target tracking scene. To solve these problems, an adaptive target tracking formation transformation control method based on hyperbolic tangent (Tanh) function is proposed. Methods Firstly, the concept of collision detection is introduced according to the overlapping relationship between formation and obstacles, and then three formation transformation strategies are designed based on the collision detection results, namely, contraction, rotation and their combination transformation. Then, considering that the Tanh function can map the positive real part of the function to the range of 0 to 1, and its transformation curve is relatively smooth, the Tanh function is introduced and the critical distance and safe distance of formation transformation are combined to design the adaptive transformation law of formation. According to the different strategies and transformation degrees, this method can flexibly realize multiple tracking formations. The transformation law can smooth the formation transformation process. Then, considering the formation of the tracking formation and the synchronization with the target movement, the consistency deviation model is established based on the expected formation and target speed, and the distributed kinematics controller is designed by using the inverse step method, which realizes the stable tracking of the target and improves the response speed of the system. At the same time, the dynamic controller is designed based on the super twisting sliding mode method, and the stability of the closed-loop system is proved at last. Results Taking the system composed of four unmanned ships as an example, the proposed algorithm is verified by simulation experiments under the integrated scenarios of telescopic, rotating, telescopic and rotating combination and dense obstacles respectively. Conclusion The simulation results show that the USVs formation under the designed method can be tracked by corresponding formation transformation according to the distribution of obstacles. Compared with affine transformation, this method can achieve more complex tracking formation, and the control output is smoother than that under artificial potential field method, and the tracking formation is better maintained.

     

/

返回文章
返回