一种手持/背包式SLAM装置及定位方法制造方法及图纸

一种手持/背包式SLAM装置及定位方法，本发明专利技术分为手持部分和背包部分两部分，两部分可以通过螺栓和航空插头进行连接，利用所述的手持/背包SLAM设备进行数据采集、定位方法，步骤如下：S1.通过航空接口将手持部分与背包部分连接，将背包部分放入背包中，将屏幕通过绑带固定在身体上，启动设备。S2.安装ROS系统及上述传感器驱动。S3.开启串口的低延时模式，使所述组合导航的数据能够以200Hz高频率传入主机。S4.发布双目相机图像数据、IMU数据、激光点云数据、GNSS数据。S5.融合相机、激光雷达、GNSS、IMU的定位。本发明专利技术提出了与设备配套的高精度半紧耦合的视觉

【技术实现步骤摘要】
一种手持/背包式SLAM装置及定位方法


[0001]本专利技术属于SLAM装置领域，特别涉及一种手持/背包式SLAM装置及定位方法。

技术介绍

[0002]土地资源调查目前多以卫星遥感数据为主，外业实地调查为辅。但卫星遥感在村镇土地调查中存在局部信息精度差、难以获得三维立体数据的缺点。而SLAM(同步定位与地图构建)技术可以弥补这些缺点，实时的构建出精确的三维地图，并得到自身的位置。
[0003]目前，多传感器融合已成为了SLAM领域的一个主要发展趋势，单一的传感器已难以满足实时定位建图的需求。GNSS(全球导航卫星系统)可以提供精确的位置信息，但GNSS易受到遮挡，在村镇环境中，易受到树木、建筑的影响，精度出现大幅度下降。同时，GNSS
‑
RTK(实时动态载波相位差分技术)虽然精度高达厘米级，但他的频率较低，难以满足实时性的要求。GNSS与IMU(惯性测量单元)融合形成INS系统，可以输出高频率的位置信息，同时在遮挡环境下也具有了一定的定位能力。激光雷达可以满足快速实时建图的要求，但点云图像中缺乏纹理信息。视觉可以获取外部环境丰富的细节信息，但易受光照的影响，在村镇复杂环境下，存在图像计算量大、算法难以实现的问题。多传感器融合可以有效克服单一传感器的缺点，实现更好的定位建图效果。
[0004]在SLAM数据采集设备方面，国内已出现了许多的可穿戴产品，比较有代表性的有数字绿土推的出LiBackpack DGC50背包激光雷达扫描系统，它配备了水平和垂直两个方向的激光雷达传感器，并且支持选配高精度GNSS设备和全景相机，同时结合了SLAM技术，无论扫描环境中GNSS信息强度如何，均可获取到扫描范围内的高精度三维点云数据，因此适用于室内和室外多场景测量。另一个比较有代表性的产品是NavVis VLX可穿戴式室内移动绘图系统，它配备了Velodyne激光雷达传感器，可提供高质量3D测量数据捕获。NavVis VLX将Velodyne图像数据与SLAM技术相结合，可通过移动设备提供测量级点云。其紧凑的通用设计使该系统能够绘制小的、分散的和狭窄的空间，以及有着大量障碍和不平坦地形的环境。此外，它的顶部安装了四个2000万像素的摄像头，构成全景摄像，可以在每个方向上拍摄高分辨率的图像，且不会被操作者阻挡视野。
[0005]现有的可穿戴采集设备产品比较有代表性的有数字绿土推的出LiBackpack DGC50背包激光雷达扫描系统和NavVis VLX可穿戴式室内移动绘图系统。LiBackpack DGC50背包激光雷达扫描系统只能提供事后的GNSS
‑
RTK处理，其提供的定位算法中，并没有融合视觉的信息，激光点云和图像数据无法做到实时处理，只能通过配置后处理软件获得高精度的定位信息，没有手持部分，缺乏对手持场景的支持。NavVis VLX没有配备GNSS模块，无法通过卫星定位，搭载的SLAM算法同样没有融合视觉信息，也同样缺乏对手持场景的支持。且虽然目前，市面上已出现相关的集成产品，但大多数价格昂贵，缺乏手持终端，且无法充分利用各个传感器的数据。

技术实现思路

[0006]为了解决以上问题，提出一种手持/背包式SLAM装置及定位方法，，将双目相机，激光雷达，GNSS组合导航模块安装到手持部分中，将处理器，电源模块等安装到背包部分中，既可以手持采集数据，又可以将手持部分安装到背包上，在只背包状态下显示数据。同时，本专利技术搭载了高精度、高频率的组合导航设备，在遮挡不严重的环境下，可以将RTK定位数据与IMU数据融合，实现高达200Hz的厘米级位姿输出。同时，在遮挡较为严重的场景下，也可以通过视觉
‑
IMU
‑
激光
‑
INS半紧耦合的的定位算法实现高精度的定位输出。此外，由于融合了相机、激光雷达与IMU，在纹理较少或光照不好的环境中亦可以提供高精度定位。
[0007]为实现上述目的，本专利技术采取的技术方案是：
[0008]一种手持/背包式SLAM装置，分为手持部分和背包部分两部分，其特征在于：
[0009]所述手持设备部分包括激光雷达、GNSS柱状天线、组合导航设备和相机，手持设备部分头部的部分为圆柱体形状，圆柱体上方通过圆柱体边缘的钢柱连接一个倒的卡扣，所述卡扣固定激光雷达，所述手持设备部分尾部为长柄的形状，所述GNSS柱状天线通过磁吸的方式固定于手持部分的顶部，所述手持部分的圆柱体内部通过螺丝固定着组合导航设备、手持设备前部处固定着相机；
[0010]所述背包部分包括通讯模块的天线和屏幕，所述背包部分为长方体，手持部分上方有手持部分和背包部分的连接接口，手持设备部分尾部有插口，所述手持部分上方有航空插口与手持部分的插口处通过航空插口及数据线连接，所述通讯模块的天线通过磁吸的方式吸附于背包部分外壳上，所述背包部分的内部搭载了处理器，扩展板卡和电源模块，所述屏幕通过绑带连接于背包部分。
[0011]作为本专利技术进一步改进，所述激光雷达为32线激光雷达。
[0012]作为本专利技术进一步改进，所述相机为ZED相机。
[0013]作为本专利技术进一步改进，所述处理器为JETSON AGX XAVIER处理器。
[0014]作为本专利技术进一步改进，所述组合导航设备为Inertial Labs INS
‑
D组合导航设备。
[0015]本专利技术提供一种手持/背包式SLAM装置的定位方法，其特征在于：
[0016](1)通过组合导航设备输出的标志位判断组合导航的卫星定位是否处于RTK模式下，若是，则只通过组合导航输出200Hz的高频定位信息，若不是，则进行视觉
‑
IMU与激光
‑
INS松耦合的位姿估计；
[0017](2)激光
‑
INS紧融合的位姿估计；
[0018]1)对于32线激光雷达扫描得到的每一线数据，采用如下方法计算每个扫描点的曲率：
[0019][0020]其中P
k
为激光点在激光坐标系下的坐标；
[0021]2)对计算出来的点进行归类，曲率大的点归类为边缘点，曲率小的点归类为平面点，同时，进行地面点的剔除；
[0022]3)对于相邻第i帧激光雷达点云和第i+1帧激光雷达点云，添加点到线的约束d
ek
和点到面的约束d
pk
，k、u、v、w代表这些激光雷达点位于不同的线上；
[0023][0024][0025]设定一个滑窗，对于滑窗中的激光雷达帧，利用列文伯格
‑
马夸尔特算法优化以下残差：
[0026][0027]其中，优化变量为：
[0028][t
x
,t
y
,t
z
,θ
roll
,θ
pitch
,θ
yaw
](5)
[0029]得到了激光雷达坐标系下的相对位姿参数本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种手持/背包式SLAM装置，分为手持部分和背包部分两部分，其特征在于：所述手持设备部分包括激光雷达、GNSS柱状天线、组合导航设备和相机，手持设备部分头部的部分为圆柱体形状，圆柱体上方通过圆柱体边缘的钢柱连接一个倒的卡扣，所述卡扣固定激光雷达，所述手持设备部分尾部为长柄的形状，所述GNSS柱状天线通过磁吸的方式固定于手持部分的顶部，所述手持部分的圆柱体内部通过螺丝固定着组合导航设备、手持设备前部处固定着相机；所述背包部分包括通讯模块的天线和屏幕，所述背包部分为长方体，手持部分上方有手持部分和背包部分的连接接口，手持设备部分尾部有插口，所述手持部分上方有航空插口与手持部分的插口处通过航空插口及数据线连接，所述通讯模块的天线通过磁吸的方式吸附于背包部分外壳上，所述背包部分的内部搭载了处理器，扩展板卡和电源模块，所述屏幕通过绑带连接于背包部分。2.根据权利要求1所述的一种手持/背包式SLAM装置，其特征在于：所述激光雷达为32线激光雷达。3.根据权利要求1所述的一种手持/背包式SLAM装置，其特征在于：所述相机为ZED相机。4.根据权利要求1所述的一种手持/背包式SLAM装置，其特征在于：所述处理器为JETSON AGX XAVIER处理器。5.根据权利要求1所述的一种手持/背包式SLAM装置，其特征在于：所述组合导航设备为Inertial Labs INS
‑
D组合导航设备。6.根据权利要求1
‑
5任意一项所述手持/背包式SLAM装置的定位方法，其特征在于：(1)通过组合导航设备输出的标志位判断组合导航的卫星定位是否处于RTK模式下，若是，则只通过组合导航输出200Hz的高频定位信息，若不是，则进行视觉
‑
IMU与激光
‑
INS松耦合的位姿估计；(2)激光
‑
INS紧融合的位姿估计；1)对于32线激光雷达扫描得到的每一线数据，采用如下方法计算每个扫描点的曲率：其中P
k
为激光点在激光坐标系下的坐标；2)对计算出来的点进行归类，曲率大的点归类为边缘点，曲率小的点归类为平面点，同时，进行地面点的剔除；3)对于相邻第i帧激光雷达点云和第i+1帧激光雷达点云，添加点到线的约束d
ek
和点到面的约束d
pk
，k、u、v、w代表这些激光雷达点位于不同的线上；，k、u、v、w代表这些激光雷达点位于不同的线上；
设定一个滑窗，对于滑窗中的激光雷达帧，利用列文伯格
‑
马夸尔特算法优化以下残差：其中，优化变量为：[t
x
,t
y
,t
z
,θ
roll
,θ
pitch
,θ
yaw
](5)得到了激光雷达坐标系下的相对位姿参数；4)利用组合导航设备采集的GNSS定位数据、加速度、角速度数据以及两帧连续点云提取的特征信息来计算载体的相对变换；由于GNSS的数据以1Hz的远低于激光雷达10Hz的频率进行输出，对激光雷达的输出的位姿进行插值，得到连续轨迹，采用线性插值的方法，在τ时刻的姿态用以下公式计算出：对于τ
k
＜τ＜τ
k+1
，插值比率α＝(τ
‑
τ
k
)/(τ
k+1
...

【专利技术属性】
技术研发人员：王庆，杨锐，严超，谭镕轩，王怀虎，孙杨，王雪妍，
申请(专利权)人：东南大学，
类型：发明
国别省市：