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

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 a specific formation, the existence of obstacles in the marine environment will bring collision risk and affect the movement of unmanned vehicles. 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 the 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 the 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 USVs 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. The simulation results show that the USV formation can track the corresponding formation transformation according to the distribution of obstacles, and the tracking errors of position, heading and speed are significantly reduced, and the output of longitudinal control force and turning control moment is smoother compared with the artificial potential field method.
    Conclusion The design method not only meets the need of formation change of USV target tracking formation in the environment of obstacles, but also realizes the stable formation change, ensuring the safety of multi-USV system and the integrity of tracking formation.

     

/

返回文章
返回