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

Adaptive formation transformation strategy and control for multi-USV cooperative target tracking based on the Tanh function

  • 摘要:
    目的 针对多无人艇系统在目标跟踪过程中的障碍物避碰与队形变换问题,提出一种基于双曲正切函数的自适应目标跟踪队形变换控制方法。
    方法 首先,根据不同障碍物分布与碰撞检测结果设计队形变换策略,并基于双曲正切函数结合队形变换临界距离与安全距离设计队形自适应变换律,以平缓队形变换过程;然后,基于期望队形与目标速度建立分布式一致性偏差模型,并利用反步法设计分布式运动学控制器,实现对目标的稳定跟踪且提升系统响应速度;同时,基于超螺旋滑模法设计动力学控制器,实现在模型不确定与存在环境扰动条件下对期望速度的稳定跟踪;最后,证明多艇协同目标跟踪系统在设计方法下各误差信号均收敛。以4艘无人艇构成的目标跟踪系统为例,在不同场景下对所提出的算法进行对比仿真实验。
    结果 仿真结果表明,无人艇编队能够根据障碍物分布情况进行相应的队形变换跟踪,且与人工势场法相比,一致性跟踪偏差最值均显著降低,纵向控制力与转艏控制力矩输出更为平缓。
    结论 该方法可满足无人艇跟踪编队在障碍物环境下进行队形变换的需求,同时还能够实现队形的平稳变换,保证多艇系统的安全性与跟踪队形的完整性。

     

    Abstract:
    Objective In cooperative target tracking missions involving multiple unmanned surface vehicles, maintaining a prescribed formation is often challenged by the presence of obstacles in the marine environment, which increases the risk of collision and disrupts vehicle motion. Traditional collision avoidance methods can prevent collision avoidance but tend to disrupt the original tracking formation. Meanwhile, conventional formation transformation methods typically neglect the influence of the target state on the tracking formation, limiting their adaptability in dynamic tracking scenarios. To address these problems, this study proposes an adaptive formation transformation and control method for target tracking based on the hyperbolic tangent (Tanh) function.
    Methods  First, collision detection is formulated based on the overlap between formation and obstacles, and then three formation transformation strategies are designed based on the collision detection results, namely, contraction, rotation and a combined transformation. Then, considering that the Tanh function can map the positive real values to the range of 0 to 1 with a smooth transformation curve, it is introduced to integrate the critical distance and safe distance in order to define an adaptive formation transformation law. According to different strategies and transformation degrees, this method enables flexible realization of multiple tracking formations, while smoothing the formation transformation process. Then, to ensure coordinated tracking and synchronization with the target’s motion, a consistency deviation model is established based on the expected formation and target velocity. A distributed kinematics controller is designed using the inverse step method, which enables stable target tracking and enhances the system’s response speed. In addition, a dynamic controller based on the super-twisting sliding mode method is implemented, and the stability of the closed-loop system is rigorously verified.
    Results  Taking a system of four USVs as an example, the proposed algorithm is validated through simulation experiments under the integrated scenarios involving telescopic, rotational, combined telescopic-rotational, and dense obstacle conditions. The results show that the USV formation can adaptively track the desired formation transformations according to the obstacle distribution. The proposed approach significantly reduces tracking errors in position, heading and speed, while producing smoother outputs for both longitudinal control forces and turning control moments compared with the artificial potential field method.
    Conclusion The proposed design method not only meets the requirements for formation transformation in USV cooperative target tracking under obstacle-rich environments, but also realizes the stable formation transformation, ensuring the safety of multi-USV system and the integrity of tracking formation.

     

/

返回文章
返回