用于在定位平面中定位机器人的方法
Abstract:
本发明涉一种用于在与具有x和y两个轴的二维参考相关联的定位平面中定位机器人的方法,所述方法包括以下步骤:通过测距来确定(200)机器人的坐标x1和y1的估计以及机器人的取向Θ1的估计;通过使用虚拟罗盘来确定(202)机器人的取向的估计Θ2;通过使参考全景的部分与查询全景的部分相关来确定(204)机器人的取向的估计Θ3;通过使用迭代最近点技术来确定(206)机器人位置的估计x4、y4;确定前述估计的标准偏差σ_x1、σ_x2、σ_θ1、σ_θ2、σ_θ3、σ_x4、σ_y4;使用所述标准偏差来确定(220)每种可用的估计的概率分布G(x1)、G(y1)、G(Θ1)、G(Θ2)、G(Θ3)、G(x4)和G(y4);确定(221)三个全局分布GLOB(x)、GLOB(y)和GLOB(Θ)并且通过将最大似然应用于全局分布来确定定位平面中的机器人的坐标的全局估计xg、yg以及机器人的取向的全局估计Θg。
Patent Agency Ranking
0/0