一种基于STM32的自动巡航机器人控制算法

摘要

采用自制两轮巡航机器人为实验平台，使用微重力传感器对机器人做姿态检测，以STM32103VE做主控MCU并对ITG3205三轴陀螺仪和ADXL345三轴加速度计进行数据采集，使用卡尔曼滤波算法对数据进行融合得到最接近真实姿态的位置信息，通过平衡控制算法调节巡航机器人的平衡姿态，通过GPS获取导航信息。实现自动无人巡航和载人巡航控制。通过试验验证了该控制算法的可行性。