针对自主水下航行器控制需求建立了水下航行器在平面的运动学和动力学模型,具有内部耦合项和不确定性干扰的特征.在航行器驱动器数量少于自由度的情况下,提出了一种在二维平面内的航迹追踪控制器.控制器在预设路径输入的基础上,通过视线法确定航行器目标前向速度和转向角速度,然后通过反步法去逆向寻找确定合适的驱动器输入,使得航行器达到目标运动状态.该控制器在航迹进行有效追踪的基础上,针对航行器不同方向运动状态相互影响的情况进行处理,通过李雅普诺夫稳定性判据验证了控制系统的稳定.最终采用数值仿真对控制器有效性进行验证,并测试了控制器的良好性能.
自主水下航行器 视线法 反步法控制 路径追踪