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

• 作者: 张驰洲 熊根良 陈海初
• 来源期刊: 压电与声光
• 学科: 工学
• 关键词: STM32 单轴陀螺仪 弓字形 卡尔曼滤波 串级比例、积分、微分(PID)
• 年，卷（期）: 2019,（6）
• 页码范围: 885-889
• 页数: 5页
• 分类号: TM966|TP273
• 字数: 3671字
• 语种: 中文
• DOI: 10.11977/j.issn.1004-2474.2019.06.028

摘要

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

作者信息

序号	姓名	单位	发文数	被引次数	H指数	G指数
1	陈海初	南昌大学机电工程学院	32	126	6.0	10.0
2	熊根良	南昌大学机电工程学院	23	97	5.0	9.0
3	张驰洲	南昌大学机电工程学院	3	2	1.0	1.0