基于目标姿态角动态更新的自主稳定循迹系统设计OA北大核心CSTPCD

针对直线或者小曲率路径的长距离循迹问题,设计了一个自主稳定循迹系统。系统基于STM32单片机进行搭建,采用RTK-GNSS和更经济的IMU模块相结合作为传感器模块。在循迹行驶过程中,通过传感器模块实时获取车体的位姿信息,采用目标姿态角动态更新的PID控制算法控制舵机,不断逼近目标轨迹和方向,实现车体沿目标轨迹的自主循迹行驶。实验结果表明:该套自主循迹系统可有效实现自动行驶,在130米的长距离循迹行驶中最大横向偏差为6.60 cm,平均偏差为2.94 cm,稳定行驶后航向角偏差不超过1.5°,平均航向角偏差为0.384°,基本满足工程应用中高精度少摇摆的自主循迹需求。