一种基于ORB-SLAM2和单目深度相机的三维稠密建图方法

    公开(公告)号:CN116337038A

    公开(公告)日:2023-06-27

    申请号:CN202310215111.3

    申请日:2023-03-08

    Abstract: 本发明提供一种基于ORB‑SLAM2和单目深度相机的三维稠密建图方法,包括:根据ORB‑SLAM2对相机进行状态估计,得到单目深度相机的位置以及相关姿态信息,同时读取单目深度相机的单目深度图像,并对二者进行话题发布;将深度相机的位置姿态、单目深度图像以及单目彩色图像作为输入,采用基于后验概率的方法利用深度图像转化形成的点云信息,构建三维稠密地图;以三维稠密地图的栅格作为根节点进行递归扩展,构造八叉树地图;对于空闲的障碍物栅格,采用欧氏距离算法,计算空闲栅格距离最近障碍物栅格的距离,进一步构造带符号的欧氏距离地图,最终使用英伟达的边缘智能开发板和显示器对其进行显示。

    一种基于能量最优的无人车轨迹规划方法

    公开(公告)号:CN116295485A

    公开(公告)日:2023-06-23

    申请号:CN202310192583.1

    申请日:2023-03-02

    Abstract: 本发明提供一种基于能量最优的无人车轨迹规划方法,包括:基于点云信息更新无人车中周边的复杂无规则障碍物信息,依据每次反馈的点云信息计算栅格的后验概率,实时构造占据栅格地图;根据传感器构造的地形与环境信息,采用基于车辆运动学的A*算法进行避开障碍物的路径点的搜索;采用路径回溯方法得到一系列较为稠密的路径点,采用不过控制点的均匀B样条曲线进行曲线拟合;构建欧氏距离地图进一步构造关于最小能耗、行驶速度、行驶加速度以及避障避碰距离的无约束优化问题,采用开源的求解库进行求解进而得到一条能耗最优、满足动力学可行性以及可以以避开障碍物的最优轨迹;对最优轨迹进行时间重分配,使轨迹点对应的速度和加速度值不超过阈值。

Patent Agency Ranking