摘要
本发明公开一种基于反射标识物的二维激光全局定位算法,包括:Step1:利用二维激光雷达进行局部扫描,并将所有反射物的中心点组成点集;Step2:随机抽取并组合点集中的不同点对,求任一点对的笛卡尔距离;Step3:将该点对的笛卡尔距离与全局地图中所有点对的笛卡尔距离进行匹配并求出该点对的两个初始位姿;Step4:根据初始位姿计算点集中其他点的相对全局坐标,并在全局地图中确定其对应的匹配点,再通过该匹配点反推出二维激光雷达的对应位置,将所有匹配点反推出的二维激光雷达对应位置进行均值化处理;Step5:重复Step2‑Step4,并对所有的均值化处理结果进行评分排序以确定二维激光雷达的全局定位。
技术关键词
二维激光雷达
定位算法
笛卡尔
全局地图
移动激光雷达
坐标
延长线
激光点
矩阵
连线
误差
圆心
系统为您推荐了相关专利信息
飞行器
角度测量误差
耦合误差
估计误差
定位算法
超高频传感器
聚类算法
对象
数据分析模块
定位校准
陪护机器人
多任务
生命体征数据
多模态注意力
情感分析模型
协同控制方法
空间定位算法
设备姿态信息
波束相位
重构智能