鱼雷状小型无人艇路径跟踪控制系统研制

为了提高无人艇在水域作业时的航向跟踪精度,自主设计了一款鱼雷状小型无人艇路径跟踪控制系统。该系统由岸基控制系统和艇载控制系统组成,具有自主巡航和手动控制2种工作模式。岸基控制系统通过数传电台与艇载控制系统进行信息交互,显示传回的状态信息并下达控制指令,在自主航行模式下完成BD09与WGS84的坐标系转换、期望航向角计算和目标点更新;艇载控制系统采用STM32F429作为控制芯片,完成数据采集和运动控制,在自主巡航模式下提供位置和航向数据,通过路径跟踪控制器输出的舵机PWM信号调整航向。实验表明设计的路径跟踪控制系统运行稳定,精度较高。