[发明专利]一种三轮全向移动机器人车轮滑动定量估计方法

权利要求书

1.一种基于编码器与激光雷达的三轮全向移动机器人车轮滑动定量估计方法，其具体技术方案为：

输入：M₀,M₁,其中M₀表示前一时刻的激光雷达测量，M₁表示当前时刻的激光雷达测量，表示编码器测量的第一个轮子转动位移，表示编码器测量的第二个轮子转动位移，表示编码器测量的第三个轮子转动位移；

输出：S₁,S₂,S₃，其中S₁表示一个轮子滑动位移，S₂表示第二个轮子滑动位移，S₃表示第三个轮子滑动位移；

步骤1：根据利用 式(1)计算表示根据编码器测量以及机器人运动学模型计算出的机器人相对于前一时刻坐标系的位置，表示根据编码器测量以及机器人运动学模型计算出的机器人相对于前一时刻坐标系的方位；

其中，

其中，表示前一时刻机器人的方位，R表示车轮半径，L₁表示机器人几何中心到第一个和第二个车轮的距离，L₂表示机器人几何中心到第三个车轮的距离，δ表示机器人几何中心到第一个轮子的线段与机器人坐标系X轴的夹角；

步骤2：计算H₀,T₀；H₀和T₀分别表示机器人相对于前一时刻坐标系的旋转矩阵和平移向量的初始估计；

步骤3：根据H₀,T₀,M₀,M₁，利用迭代最近点方法计算机器人相对于前一时刻坐标系的旋转矩阵H和平移向量T，

(H,T,d)＝ICP(H₀,T₀,M₀,M₁,σ) (4)

其中，ICP代表迭代最近点方法，σ为匹配距离阈值，d为匹配精度；

步骤4：根据H,T由式(5)，式(6)和式(7)获得表示机器人当前位置相对于前一时刻坐标系的坐标，表示机器人当前时刻相对于前一时刻坐标系的方位；

其中，H_2,1表示H的第二行第一列的元素，T_1,1表示的T第一行第一列元素，T_2,1表示T的第二行第一列的元素；

步骤5：根据计算表示第一个轮子实际的转动位移，表示第二个轮子实际的转动位移，表示第三个轮子实际的转动位移；

步骤6：计算车轮滑动

。