[发明专利]基于激光传感器的多移动机器人位姿测定方法

摘要

本发明涉及一种基于激光传感器的多移动机器人位姿测定方法。本方法利用激光传感器扫描区域内的以一定形状（本说明书以典型形状矩形为例）为标识的移动机器人，将测量数据通过接口传输到计算机，计算机通过数据处理算法进行数据处理，提取属于机器人的形状特征，同时结合机器人前一时刻的位姿，实时计算出机器人当前位姿。本发明能迅速、准确地识别确定多个机器人位置和姿态，分别给机器人或者上位控制系统提供位姿信息，实现多移动机器人轨迹跟踪和精确定位。

主权项

1.一种基于激光传感器的多移动机器人位姿测定方法，其特征在于操作步骤为：a.使用激光传感器进行区域扫描，得到N个离散的数据点，以矩形为机器人扫描特征，通过方程：及计算算得机器人在全局坐标系下的参数，其中：是第个点在以激光传感器为原点的极坐标系中的坐标；是第个点在以激光坐标系为原点的平面坐标系中的坐标；是第个点在全局坐标系中的坐标，是激光传感器在全局坐标系中的坐标参数；b.根据步骤a的处理数据，对移动机器人进行矩形特征识别，提取出机器人矩形特征的两条边；c.根据步骤b提取的机器人特征，按照扫描到机器人矩形特征的一条边还是两条边两种情况来分别计算出机器人特征边的中点，进而计算出机器人的中心位置坐标；d.对步骤b的特征线段进行线性拟合后，得出倾斜角，通过实时跟踪及比对记录数据，计算出机器人的当前角度参数。