买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

龙图腾网获悉东南大学申请的专利一种手持/背包式SLAM装置及定位方法获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN116027351B 。

龙图腾网通过国家知识产权局官网在2026-04-17发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202310006695.3，技术领域涉及：G01S17/89；该发明授权一种手持/背包式SLAM装置及定位方法是由王庆;杨锐;严超;谭镕轩;王怀虎;孙杨;王雪妍设计研发完成，并于2023-01-04向国家知识产权局提交的专利申请。

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

本发明授权一种手持/背包式SLAM装置及定位方法在权利要求书中公布了：1.一种手持背包式SLAM装置的定位方法，所述装置分为手持部分和背包部分两部分： 所述手持部分包括激光雷达、GNSS柱状天线、组合导航设备和相机，手持设备部分头部的部分为圆柱体形状，圆柱体上方通过圆柱体边缘的钢柱连接一个倒的卡扣，所述卡扣固定激光雷达，所述手持设备部分尾部为长柄的形状，所述GNSS柱状天线通过磁吸的方式固定于手持部分的顶部，所述手持部分的圆柱体内部通过螺丝固定着组合导航设备、手持设备前部处固定着相机； 所述背包部分包括通讯模块的天线和屏幕，所述背包部分为长方体，手持部分上方有手持部分和背包部分的连接接口，手持设备部分尾部有插口，所述手持部分上方有航空插口与手持部分的插口处通过航空插口及数据线连接，所述通讯模块的天线通过磁吸的方式吸附于背包部分外壳上，所述背包部分的内部搭载了处理器，扩展板卡和电源模块，所述屏幕通过绑带连接于背包部分； 所述定位方法具体如下，其特征在于： 1通过组合导航设备输出的标志位判断组合导航的卫星定位是否处于RTK模式下，若是，则只通过组合导航输出200Hz的高频定位信息，若不是，则进行视觉-IMU与激光-INS松耦合的位姿估计； 2激光-INS紧融合的位姿估计； 1对于32线激光雷达扫描得到的每一线数据，采用如下方法计算每个扫描点的曲率： ; 其中为激光点在激光坐标系下的坐标； 2对计算出来的点进行归类，曲率大的点归类为边缘点，曲率小的点归类为平面点，同时，进行地面点的剔除； 3对于相邻第i帧激光雷达点云和第i+1帧激光雷达点云，添加点到线的约束和点到面的约束，k、u、v、w代表这些激光雷达点位于不同的线上； ; 设定一个滑窗，对于滑窗中的激光雷达帧，利用列文伯格-马夸尔特算法优化以下残差： ; 其中，优化变量为： ; 得到了激光雷达坐标系下的相对位姿参数； 4利用组合导航设备采集的GNSS定位数据、加速度、角速度数据以及两帧连续点云提取的特征信息来计算载体的相对变换； 由于GNSS的数据以1Hz的远低于激光雷达10Hz的频率进行输出，对激光雷达的输出的位姿进行插值，得到连续轨迹，采用线性插值的方法，在时刻的姿态用以下公式计算出：对于，插值比率，则 ; 其中，，； 利用组合导航设备输出的加速度，角速度数据，对轨迹添加约束，对于轨迹的位移进行二次求导，利用激光与组合导航设备之间的外参得到轨迹在IMU帧下的加速度，同理，对轨迹的姿态进行一次求导得到角速度，得到以下约束方程： ; 其中，和为组合导航设备输出的加速度和角速度，为轨迹的位移，为对轨迹姿态求导得到的角速度； 每运动的时间或距离大于设定的阀值th时，添加GPS约束，由于GPS高程不准，只使用GPS数据的经度和纬度数据，将其转换到当地坐标系L下； ; 求解以下最小二乘问题来优化连续激光雷达轨迹： ; 3视觉-IMU紧耦合的位姿估计； 1使用光流法对采集到的视觉信息进行特征点追踪； 2建立一个滑动窗口，对滑动窗口中的视觉数据和IMU数据添加视觉约束和IMU约束，进行位姿的优化； 3优化的变量为： ; 其中，是第k个相机帧时刻IMU的状态，包含该时刻IMU位置、速度、姿态和随机游走噪声，是第l帧特征点的深度； 4视觉约束为：将相机第i帧中的特征点，投影到第j帧，构建残差如下： ; 其中，与是第i帧图像的特征点在归一化平面上的坐标，、、为第j帧图像的特征点在相机坐标系下的坐标； IMU约束如下：对于相机的第k帧和第k+1帧对应的IMU的第和帧，约束如下 ; 其中，是预积分的测量值； 4视觉-IMU与激光-INS松耦合的位姿估计； 在以地球坐标系为导航坐标系时，分别以姿态、速度、位置以及陀螺漂移和加速度计的随机游走误差作为状态变量: ; 建立系统状态和量测方程如下： ; 其中，为松组合时的状态方程系数矩阵，它与视觉-IMU子系统有关，为松组合时的状态方程系统噪声；为组合时的外部量测值，由INS-激光子系统得到，为松组合时的量测方程系数矩阵；为松组合时的量测噪声； 最后，利用Kalman滤波求解得到载体的位姿； 5每隔t时间重新判断，若卫星定位重新进入RTK定位模式，则对过去的位置信息进行校正并用组合导航设备输出的位姿重新确定位置。

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人东南大学，其通讯地址为：210096 江苏省南京市玄武区四牌楼2号；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。

以上内容由龙图腾AI智能生成。