基于惯性导航的扫地机器人系统设计

摘要：

针对扫地机器人行进中姿态控制难和无规划式清扫等问题,设计了一种以STM32F030R8T6微控制器为主控制器,以单轴陀螺仪GGPM01为姿态角检测传感器及以弓字形清扫方式为路径规划法的扫地机器人系统.因陀螺仪数据存在随机误差和噪声干扰,故采用卡尔曼滤波算法对陀螺仪和光电编码器数据进行融合,计算出机器人当前的偏航角最优估计值.再以最优偏航角和机器人速度为反馈量构成串级比例、积分、微分(PID)控制,实现机器人的直线行驶,最后采用弓字形算法实现路径规划.通过系统的仿真及软件测试,机器人以10.2～12.6 m/min的速度完成弓字形路径规划,最大角度偏移量为0.4°,验证了扫地机器人的功能特性及算法的有效性.

关键词：STM32、单轴陀螺仪、弓字形、卡尔曼滤波、串级比例、积分、微分(PID)

所属期刊栏目：41

分类号：TM966;TP273

在线出版日期：2020-04-24（万方平台首次上网日期，不代表论文的发表时间）

页数：共5页

页码：885-889