基于生物激励模型的UUV虚拟速度控制方法

摘要

基于生物激励模型的UUV虚拟速度控制方法，涉及一种UUV速度的控制方法。为了解决UUV速度的控制不稳定的问题。包括：获得虚拟速度；将当前的位置误差输入至生物激励模型进行平滑连续处理，获得新的位置误差，根据所述新的位置误差对虚拟速度进行处理，获得平滑连续的虚拟速度；将虚拟速度、海流速度与UUV当前实际航速相减后获得速度误差作为PID速度控制器的输入，PID速度控制器将输出作用在UUV模型上，得到UUV下一步的实际位置，根据得到实际位置对UUV进行控制；将UUV的实际位置与UUV运动规划输出的期望位置相比较，得到的位置误差项作为下一步生物激励模型的位置误差输入。本发明用于UUV在近水面或浅海区域航行时控制航速。