一种基于数据筛选的双反光板激光定位与导航方法技术

本发明专利技术公开了一种基于数据筛选的双反光板激光定位与导航方法，与传统技术中的几何三角定位不同，本发明专利技术深入挖掘并充分利用了反射光的复数域信息，打破了传统意义上三块反光板的技术瓶颈，其运行条件为同时检测到两块反光板的数据即可，大大提高了激光导航技术的适用性；虽然本发明专利技术最低要求为检测到两块反光板，但实际应用时可能会同时检测到多个反光板，通过设计数据融合处理，能够最大化利用反光板的信息，从而进一步提高精度。

A laser positioning and navigation method for dual reflector based on data filtering

The invention discloses a dual reflector laser positioning and navigation method based on data filtering, geometric triangulation and traditional technology is different, the invention fully excavate and use the complex domain information of the reflected light, breaking the technical bottle neck of traditional three pieces of the reflecting plate, the operating conditions for simultaneous detection two a reflector data can be greatly improved, the applicability of laser navigation technology; although the minimum requirements for detecting two reflectors, but the actual application may also detect multi reflector processing through the design of data fusion, to maximize the use of reflective plate information, so as to further improve precision.

【技术实现步骤摘要】
一种基于数据筛选的双反光板激光定位与导航方法
本专利技术属于智能仓储物流领域，具体涉及一种基于数据筛选的双反光板激光定位与导航方法。
技术介绍
基于激光传感器的定位与导航技术是工业AGV、智能机器人等领域的关键性技术，相比传统有轨导航方式，该技术具有定位精度高、灵活多变等优点，适用于复杂、高动态的工业场景中。国内外现有基于反光板的激光定位技术，均采用了几何三角定位原理，每时每刻必须要求同时检测到三块反光板才可实现定位。这一数量要求实际上在复杂工业场景中很难满足，极大地制约了激光定位与导航技术的实用性。
技术实现思路
为了解决上述问题，本专利技术提供一种新型激光定位与导航方法，通过提取和利用激光测距信息中的复数域信息，将三块反光板的最低要求降低为两块，有效解决了反光板最低数量的技术瓶颈，大大提高了激光导航技术的适用性。本专利技术的目的是通过以下技术方案来实现的：一种基于数据筛选的双反光板激光定位与导航方法，该方法包括：(1)在工业环境中布置反光板，预设反光板世界坐标，生成反光板坐标列表；(2)安装在移动平台上的激光传感器向周围呈辐射状发射激光，并接收反射激光；(3)筛选来源于反光板的有效光束：预设强度阈值σ，通过检测反射激光强度I，并与σf(d)相比较，判定激光照射物是反光板还是普通环境物体，其中f(d)与距离d负相关；(4)确定当前时刻照射到的反光板数量及其相对激光传感器的相对坐标：根据反射光束角度的连续性，判断是否为同一块反光板，或者，根据反射光束角度和距离的连续性，判断是否为同一块反光板；根据属于同一反光板的反射光束得到该反光板相对于激光传感器的相对坐标，并存入反光板列表；(5)初始化反光板列表，得到至少两个反光板的世界坐标：人工确定初始位置对应的反光板列表中至少两个反光板的世界坐标；或者，激光传感器在初始位置获取至少三个反光板返回的角度和距离，计算两两反光板之间的距离，与根据反光板坐标列表生成的反光板距离信息相匹配，得到至少两个反光板的世界坐标；(6)在动态过程中计算期望反光板列表：根据上一时刻对当前时刻激光传感器位置和角度的预测，估计激光传感器与所有反光板之间的相对距离和角度，并存入期望反光板列表；(7)在动态过程中反光板列表的匹配：计算当前时刻反光板列表与期望反光板列表中同一个反光板对应的距离之差和角度之差，当距离之差和角度之差均满足预设阈值时，匹配成功；(8)基于双反光板数据的激光传感器位姿计算：利用激光传感器测量数据的复频域信息，在匹配成功的反光板中任选两块：第l个和第k个，并计算：zk＝Xk+i*Ykzl＝Xl+i*Yl其中，下标l和k分别代表第l和第k个反光板；α和ρ分别代表在激光传感器相对自身的极坐标系下，反光板的角度和距离；X和Y分别为反光板在X和Y轴的分量；z为反光板在世界坐标系下的复数坐标；zk,l为根据第l和第k个反光板计算得到的激光传感器世界坐标，θk是根据第k块反光板的数据计算得到的激光传感器在世界坐标系下的角度；进一步地，所述步骤(6)中，直接采用上一时刻激光传感器的位置和角度作为当前时刻的预测，或者采用滤波算法进行预测。进一步地，所述步骤(8)之后，还包括多块优化的步骤：如果激光传感器检测到三个及以上的反光板数据，可以根据多组数据中任意两组计算得到的位姿进行数据融合，得到最终的移动平台及激光传感器在世界坐标系下的位置及角度。本专利技术的有益效果如下：与传统技术中的几何三角定位不同，本专利技术深入挖掘并充分利用了反射光的复数域信息，打破了传统意义上三块反光板的技术瓶颈，其运行条件为同时检测到两块反光板的数据即可，大大提高了激光导航技术的适用性；虽然本专利技术最低要求为检测到两块反光板，但实际应用时可能会同时检测到多个反光板，通过设计数据融合处理，能够最大化利用反光板的信息，从而进一步提高精度。本专利技术的具体性能为：定位误差<1cm，角度误差<0.5°，定位频率>35Hz。附图说明图1为本专利技术的硬件结构示意图；图2为移动平台运动学模型示意图；图3为本专利技术方法整体流程图。具体实施方式下面结合附图，通过实施例对本专利技术作进一步地说明。本专利技术提供的一种基于数据筛选的双反光板激光定位与导航方法，该方法包括：(1)在工业环境中布置反光板，预设反光板世界坐标，生成反光板坐标列表；(2)安装在移动平台上的激光传感器向周围呈辐射状发射激光，并接收反射激光(激光传感器安装在AGV、工业车辆等移动平台上)；(3)筛选来源于反光板的有效光束：预设强度阈值σ，通过检测反射激光强度I，并与σf(d)相比较，判定激光照射物是反光板还是普通环境物体，其中f(d)与距离d负相关，优选地，可设置f(d)＝1/d；一种可能的实现方式如下：对于所有接收到的反射光束，如果第step个激光束的激光强度intensity(step)大于预设强度阈值intensity_threshold/激光测量的距离distance(step)，则将(step,intensity(step),distance(step))写入激光强点的数据列表data中；对应的伪代码如下：forstep＝1:number_laserifintensity(step)>intensity_threshold/distance(step)将(step,intensity(step),distance(step))写入data表中endifendfor(4)确定当前时刻照射到的反光板数量及其相对激光传感器的相对坐标：根据反射光束角度的连续性，判断是否为同一块反光板，或者，根据反射光束角度和距离的连续性，判断是否为同一块反光板；根据属于同一反光板的反射光束得到该反光板相对于激光传感器的相对坐标(方法为：平均、取最强光，加权平均，任取)，并存入反光板列表；根据反射光束角度和距离的连续性，判断是否为同一块反光板，一种可能的实现方式如下：对于data表中所有的反光强点：如果第i个反光强点的序号step(i)等于第i-1个反光强点的序号step(i-1)+1，并且第i和i-1的激光强点测得的距离之差distance(step(i))-distance(step(i-1))小于预设的距离阈值distance_threshold，那么光束step(i)和step(i-1)照射到的是同一块反光板，则将(step(i),α,ρ)赋值到上一个landmark结构体中；否则照射到的是一块新的反光板，开始一个新的landmark结构体；计算：α＝(step(i)-1)·resolution+α；ρ＝distance(step(i))将(step(i),α,ρ)写入新的landmark结构体中；最终得到由landmark结构体组成的所照射到的反光板列表measure_landmark_list；对应的伪代码如下：fori＝1:number_dataifstep(i)＝step(i-1)+1&&distance(step(i))-distance(step(i-1))<distance_thresholdthen光束step(i)和step(i-1)照射到的是同一块反光板elseα＝(step(i)-1)·resolution+α；ρ＝distanc本文档来自技高网...

【技术保护点】
一种基于数据筛选的双反光板激光定位与导航方法，其特征在于，该方法包括：(1)在工业环境中布置反光板，预设反光板世界坐标，生成反光板坐标列表；(2)安装在移动平台上的激光传感器向周围呈辐射状发射激光，并接收反射激光；(3)筛选来源于反光板的有效光束：预设强度阈值σ，通过检测反射激光强度I，并与σf(d)相比较，判定激光照射物是反光板还是普通环境物体，其中f(d)与距离d负相关；(4)确定当前时刻照射到的反光板数量及其相对激光传感器的相对坐标：根据反射光束角度的连续性，判断是否为同一块反光板，或者，根据反射光束角度和距离的连续性，判断是否为同一块反光板；根据属于同一反光板的反射光束得到该反光板相对于激光传感器的相对坐标，并存入反光板列表；(5)初始化反光板列表，得到至少两个反光板的世界坐标：人工确定初始位置对应的反光板列表中至少两个反光板的世界坐标；或者，激光传感器在初始位置获取至少三个反光板返回的角度和距离，计算两两反光板之间的距离，与根据反光板坐标列表生成的反光板距离信息相匹配，得到至少两个反光板的世界坐标；(6)在动态过程中计算期望反光板列表：根据上一时刻对当前时刻激光传感器位置和角度的预测，估计激光传感器与所有反光板之间的相对距离和角度，并存入期望反光板列表；(7)在动态过程中反光板列表的匹配：计算当前时刻反光板列表与期望反光板列表中同一个反光板对应的距离之差和角度之差，当距离之差和角度之差均满足预设阈值时，匹配成功；(8)基于双反光板数据的激光传感器位姿计算：利用激光传感器测量数据的复频域信息，在匹配成功的反光板中任选两块：第l个和第k个，并计算：...

【技术特征摘要】
1.一种基于数据筛选的双反光板激光定位与导航方法，其特征在于，该方法包括：(1)在工业环境中布置反光板，预设反光板世界坐标，生成反光板坐标列表；(2)安装在移动平台上的激光传感器向周围呈辐射状发射激光，并接收反射激光；(3)筛选来源于反光板的有效光束：预设强度阈值σ，通过检测反射激光强度I，并与σf(d)相比较，判定激光照射物是反光板还是普通环境物体，其中f(d)与距离d负相关；(4)确定当前时刻照射到的反光板数量及其相对激光传感器的相对坐标：根据反射光束角度的连续性，判断是否为同一块反光板，或者，根据反射光束角度和距离的连续性，判断是否为同一块反光板；根据属于同一反光板的反射光束得到该反光板相对于激光传感器的相对坐标，并存入反光板列表；(5)初始化反光板列表，得到至少两个反光板的世界坐标：人工确定初始位置对应的反光板列表中至少两个反光板的世界坐标；或者，激光传感器在初始位置获取至少三个反光板返回的角度和距离，计算两两反光板之间的距离，与根据反光板坐标列表生成的反光板距离信息相匹配，得到至少两个反光板的世界坐标；(6)在动态过程中计算期望反光板列表：根据上一时刻对当前时刻激光传感器位置和角度的预测，估计激光传感器与所有反光板之间的相对距离和角度，并存入期望反光板列表；(7)在动态...

【专利技术属性】
技术研发人员：林志赟，邢浩，金智，
申请(专利权)人：浙江科钛机器人股份有限公司，
类型：发明
国别省市：浙江,33