[发明专利]四轮八驱机器人底盘里程计合成方法及系统

说明书

本发明公开了四轮八驱机器人底盘里程计合成方法及系统，属于机器人应用技术领域，本发明要解决的技术问题为机器人底盘由于模型复杂和舵机机械精度不高导致里程计数据误差大，采用的技术方案为：该方法是通过IMU方向角度变化数据融合轮速传感器的线速度数据，合成四轮八驱机器人底盘里程计数据；四轮八驱机器人底盘里程计数据包括两部分数据，分别为：前进速度，即线速度；转向速度，即角速度。该系统包括，IMU，用于获取方向角速度数据，进而获取转动角速度差值；轮速传感器，用于获取各个轮子的速度数据；融合模块，用于将方向角速度数据与轮速数据相融合，生成机器人底盘的里程计数据。

技术领域

本发明涉及机器人应用技术领域，具体地说是四轮八驱机器人底盘里程计合成方法及系统。

背景技术

随着机器人产业的不断发展，四轮八驱机器人底盘因其灵活的运动性以及复杂环境适应能力，被应用于越来越多的机器人产品中，从室外巡逻机器人到室内配送服务机器人，四轮八驱结构的底盘都能胜任。

对于机器人而言，建图、定位、导航是机器人的基本能力，建图质量的高低取决于激光雷达等传感器精度；同样，定位和导航精度也包括多方面因素，其中里程计信息是最关键因素，因为通过里程计数据积分可以计算出机器人运动的距离，从而为机器人位置推断提供依据。然而里程计包括线速度和角速度，数据往往由机器人底盘反馈，传统机器人底盘一般只通过测量轮子转动的圈数计算机器人运动的距离，通过两个轮子的差速或角度计算机器人运行的角速度，对于简单模型的机器人底盘(两轮差速模型底盘)而言不容易产生误差，计算出来的里程计数据是准确的。但是，对于四轮八驱机器人底盘，由于四个轮子都可以360度转动，所以增加了底盘模型的复杂程度，在转弯时，由于转向舵机机械精度问题，通过轮子转动角度和速度计算出来的角速度误差很大，从而导致合成的里程计数据误差也很大，最终导致定位和导航精度降低，对机器人造成安全隐患。

发明内容

本发明的技术任务是提供四轮八驱机器人底盘里程计合成方法及系统，来解决机器人底盘由于模型复杂和舵机机械精度不高导致里程计数据误差大的问题。

本发明的技术任务是按以下方式实现的，一种四轮八驱机器人底盘里程计合成方法，该方法是通过IMU(惯性测量单元)方向角度变化数据融合轮速传感器的线速度数据，合成四轮八驱机器人底盘里程计数据；四轮八驱机器人底盘里程计数据包括两部分数据，分别为：

前进速度，即线速度；

转向速度，即角速度。

作为优选，所述线速度是通过轮毂电机接口获取，四个轮子的线速度分别为v₁、v₂、v₃和v₄。

作为优选，所述角速度具体如下：

由IMU的两次角度值相减得到转动角速度差Δθ；

底盘角速度ω的计算公式如下：

更优地，根据轮子的线速度获取对应底盘线速度值，公式如下：

其中，a表示底盘的宽度；b表示底盘的长度；v_c1、v_c2、v_c3及v_c4分别表示四个轮子的线速度对应求取的底盘的线速度值。

更优地，对底盘的线速度值v_c1、v_c2、v_c3及v_c4求平均值，获取底盘的线速度v，公式如下：