一种用于3D激光雷达惯性SLAM系统的动态滑动窗口优化方法

    公开(公告)号:CN119437244A

    公开(公告)日:2025-02-14

    申请号:CN202411625213.3

    申请日:2024-11-14

    Abstract: 一种用于3D激光雷达惯性SLAM系统的动态滑动窗口优化方法,涉及SLAM技术领域,旨在改善现有激光惯性SLAM系统在机器人复杂运动状态下位姿估计的精度。本发明根据位移差和旋转差选取关键帧,并进一步将关键帧划分为强关键帧和弱关键帧,在窗口滑动时,设计了强弱关键帧的多滑入多滑出的动态优化策略,并结合窗口是否满足优化条件的双标准,赋予SLAM系统根据机器人不同运动状态动态调整窗口大小的能力。此外,本发明设计了滑窗内关键帧优化和滑窗内局部普通帧优化的两次优化方案,关键帧优化后能为普通帧优化提供较精确的优化基准,普通帧优化后能为下一次关键帧的优化提供了更可靠的边缘化先验信息,从而提高SLAM系统在机器人复杂运动状态下位姿估计的精度。

    一种动态环境下联合多目标跟踪的物体SLAM方法

    公开(公告)号:CN117036408B

    公开(公告)日:2024-03-29

    申请号:CN202311054988.5

    申请日:2023-08-22

    Abstract: 本发明公开了一种动态环境下联合多目标跟踪的物体SLAM方法,完成在动态环境中对动态与静态对象的定位与建图任务。首先,为精确获得物体的运动区域,通过短时密集连接(STDC)网络进行语义分割得到运动物体掩膜,依据运动物体掩膜对特征点进行区分得到静态特征点与动态特征点。同时,将图像输入到单目3D目标检测(SMOKE)网络进行三维目标检测,并将检测结果输入到数据关联模块进行多目标跟踪。利用动静态特征点与数据关联后的目标位姿共同估计相机与动静态物体位姿。最后,依据动静态特征点、相机与动静态物体位姿进行跟踪优化,提升定位与建图精度。本方法与传统SLAM方法相比,有效提升了SLAM系统的鲁棒性,建立的地图语义明确、可解释性好。

    一种用于3D激光雷达视觉惯性SLAM系统的双滑动窗口优化方法

    公开(公告)号:CN119722480A

    公开(公告)日:2025-03-28

    申请号:CN202411776074.4

    申请日:2024-12-05

    Abstract: 本发明提出了一种用于3D激光雷达视觉惯性SLAM系统的双滑动窗口优化方法,通过多源异构传感器信息融合下的双滑动窗口优化的结构设计,旨在提升SLAM系统适应复杂环境的鲁棒性,及在复杂环境下的定位精度。本发明为SLAM系统设计了双滑动窗口优化结构,视觉滑窗能够快速地估计机器人的位姿,用于实时地位姿跟踪;当视觉滑窗位姿估计失败时,使用激光雷达滑窗修正漂移的位姿或恢复丢失的轨迹。视觉滑窗和激光雷达滑窗分别独立选取关键帧,两种滑窗分别独立进行优化;视觉滑窗估计出的机器人位姿参与到激光雷达滑窗优化中,两种滑窗即独立又联合,充分发挥两者的优势,保证SLAM系统的鲁棒性,即使在光线强烈变化等极端场景下,仍能保证系统稳定运行。

    一种考虑方向入口线和辅助标记点的停车位检测方法

    公开(公告)号:CN117152716B

    公开(公告)日:2024-04-02

    申请号:CN202311174928.7

    申请日:2023-09-13

    Abstract: 本发明提出一种考虑方向入口线和辅助标记点的停车位检测方法,旨在通过图注意力机制将方向入口线和辅助标记点相结合以提高停车位检测的鲁棒性和简易性。首先选择合适的数据集制作训练样本和测试样本;其次,将训练样本输入到卷积网络中提取深度特征,将深度特征输入到方向入口线检测器和辅助标记点检测器,综合考虑两者的结果,获取每个标记点的坐标以及相对坐标特征,经过双线性插值、特征融合获取每个标记点的融合特征;然后通过图注意力机制获取包含所有标记点信息的注意力加权特征;最后将重要标记点的注意力加权特征拼接输入到停车位鉴别网络,判断其能否形成合理的停车位。本发明可以使模型快速、鲁棒地检测出各种类型的停车位。

    一种考虑地图复杂度的无人车路径规划方法

    公开(公告)号:CN117168483A

    公开(公告)日:2023-12-05

    申请号:CN202311127747.9

    申请日:2023-09-01

    Abstract: 本发明涉及一种考虑地图复杂度的无人车路径规划方法,旨在解决传统方法在路径搜索中存在搜索效率低、节点冗余以及目标点附近碎片化路径过多等问题。本方法包括:在栅格地图中进行随机撒点,获取全地图有效节点的个数,计算地图复杂度;在以最近节点为圆心的一定范围内进行随机撒点,得到区域复杂度,通过区域复杂度选择节点产生方式,解决传统方法在搜索中易陷入僵化的问题,提高搜索效率;引入目标距离和目标迭代次数,进行新节点与目标节点的无碰撞检测和距离判断,减少了节点的数量和碎片化路径;最后对路径进行逆向寻优和B样条曲线拟合,使得路径平滑。仿真结果表明,本发明在障碍物较多的情况下表现良好,且路径平滑。

    一种动态环境下联合多目标跟踪的物体SLAM方法

    公开(公告)号:CN117036408A

    公开(公告)日:2023-11-10

    申请号:CN202311054988.5

    申请日:2023-08-22

    Abstract: 本发明公开了一种动态环境下联合多目标跟踪的物体SLAM方法,完成在动态环境中对动态与静态对象的定位与建图任务。首先,为精确获得物体的运动区域,通过短时密集连接(STDC)网络进行语义分割得到运动物体掩膜,依据运动物体掩膜对特征点进行区分得到静态特征点与动态特征点。同时,将图像输入到单目3D目标检测(SMOKE)网络进行三维目标检测,并将检测结果输入到数据关联模块进行多目标跟踪。利用动静态特征点与数据关联后的目标位姿共同估计相机与动静态物体位姿。最后,依据动静态特征点、相机与动静态物体位姿进行跟踪优化,提升定位与建图精度。本方法与传统SLAM方法相比,有效提升了SLAM系统的鲁棒性,建立的地图语义明确、可解释性好。

    一种考虑地图复杂度的无人车路径规划方法

    公开(公告)号:CN117168483B

    公开(公告)日:2024-05-14

    申请号:CN202311127747.9

    申请日:2023-09-01

    Abstract: 本发明涉及一种考虑地图复杂度的无人车路径规划方法,旨在解决传统方法在路径搜索中存在搜索效率低、节点冗余以及目标点附近碎片化路径过多等问题。本方法包括:在栅格地图中进行随机撒点,获取全地图有效节点的个数,计算地图复杂度;在以最近节点为圆心的一定范围内进行随机撒点,得到区域复杂度,通过区域复杂度选择节点产生方式,解决传统方法在搜索中易陷入僵化的问题,提高搜索效率;引入目标距离和目标迭代次数,进行新节点与目标节点的无碰撞检测和距离判断,减少了节点的数量和碎片化路径;最后对路径进行逆向寻优和B样条曲线拟合,使得路径平滑。仿真结果表明,本发明在障碍物较多的情况下表现良好,且路径平滑。

    一种适用于低线束3D激光雷达的动态障碍物去除方法

    公开(公告)号:CN116879870A

    公开(公告)日:2023-10-13

    申请号:CN202310678823.9

    申请日:2023-06-08

    Abstract: 针对移动机器人在室外环境中,因行人、车辆等动态物体的存在,导致激光SLAM生成的地图中存在动态物体的轨迹残影,影响后续的定位及路径规划等问题,本发明提出了一种适用于低线束3D激光雷达的动态障碍物去除方法。该方法包括以下步骤:首先对激光雷达采集到的三维点云数据进行预处理;然后进行地面分割,并将非地面点云地图投影为深度图,通过视点可见法对比与查询帧之间可见性来去除轨迹残影;考虑到点云具有距离越远越稀疏的特性,根据距离信息来自适应调节深度图的分辨率,并通过不断减小分辨率来恢复被误删的静态点。经实验证明,该方法可以在低线束的3D激光雷达上高效地去除动态障碍物,保留完整的静态地图,减小动态障碍物对SLAM系统的影响。

Patent Agency Ranking