一种基于Kalman滤波的双轮机器人姿态控制算法

采用自制的双轮式结构机器人作为试验平台,以ADXL345三轴加速度计和ITG3200三轴陀螺仪微重力MEMS微机械电子技术的传感器作为机器人的角度传感器,通过建立离散卡尔曼滤波器数学模型对两种传感器的数据进行滤波融合,使其得到更稳定更准确更接近真实值的角度值,使用STM32F103VE获取动态的角度信息,通过变参数自整定平衡控制算法的调节使机器人保持平衡,实验结果验证了该方法的可行性,对特殊环境自动无人巡航机器人和载人巡航机器人控制有很大的研究价值。