1.一种基于SLAM技术的船舶进出港三维场景重建与展示系统,其特征在于,包括港口三维地图与船舶三维模型构建模块、船舶进出港时位置和姿态的动态更新模块和船舶进出港三维展示平台,所述船舶进出港时位置和姿态的动态更新模块通过无线通信方式连接所述船舶进出港三维展示平台;
所述港口三维地图与船舶三维模型构建模块用于获取多传感器采集到的激光雷达点云数据和IMU姿态数据,根据所述激光雷达点云数据和所述IMU姿态数据基于SLAM算法构建港口三维点云地图和船舶三维模型,并离线保存后存储至所述船舶进出港三维展示平台;
所述船舶进出港时位置和姿态的动态更新模块用于获取船舶GPS数据和船舶IMU数据,并通过无线通信方式发送至所述船舶进出港三维展示平台;
所述船舶进出港三维展示平台用于加载显示所述港口三维地图与船舶三维模型构建模块发送的所述港口三维点云地图和船舶三维模型,接收所述舶进出港时位置和姿态的动态更新模块发送的所述船舶GPS数据和所述船舶IMU数据更新船舶的位置和姿态,以及控制港口和船舶对应信息的显示。
2.根据权利要求1所述的系统,其特征在于,根据所述激光雷达点云数据和所述IMU姿态数据基于SLAM算法构建港口三维地图和船舶三维模型,包括:使用IMU姿态数据对所述激光雷达点云数据进行去畸变处理后,对处理后的激光雷达点云数据进行配准,配准后采用迭代最近点方法进行位姿估计、地图和船舶模型构建,最后采用因子图优化,以紧耦合方式融合配准后的激光雷达和IMU测量值,进行三维点云地图和船舶三维模型的生成与保存,依据港口实际经纬度信息对所述三维点云地图赋予实际地理坐标信息。
3.根据权利要求2所述的系统,其特征在于,所述对处理后的激光雷达点云数据进行配准,包括:
设定在t时刻获取的点云Pt,Pi是t时刻的点云Pt中的一个点,将所述点云Pt投影到预设的距离图像中,确定投影图像的水平方向分辨率和竖直分辨率;
将所述点云Pt投影到所述预设的距离图像上后,每个三维空间的点变为二维空间的像素点,获取点Pi对应的像素点到激光雷达传感器的欧氏距离Ri,依据Ri和竖直维度的特性标记出地面点和非地面点;
点云分割之后采用广度优先搜索对点云进行聚类处理,将距离图像分割为多个聚类,同一个聚类的点被标记上唯一的标识,点数少于预设数量点的聚类被作为噪声去除,只保留原始的地面点和相对较大的静态物体;
依据激光雷达每帧点云中每个点的曲率确定角点和平面特征,再依据确定的特征信息进行相邻关键帧之间点云配准。
4.根据权利要求2所述的系统,其特征在于,所述使用IMU姿态数据对所述激光雷达点云数据进行去畸变处理之前,包括:采用imu_utils开源代码对IMU内参进行标定,标定参数包括陀螺仪和加速度计各自的零偏、标度因数和安装误差;
在船舶上安装激光雷达和9轴IMU传感器,安装时将两个传感器固定在一个基座上,坐标系统一朝向,将基座安装在船头或者船尾;
使用Lidar_IMU_calib方法对激光雷达和IMU之间进行外参标定,将各自传感器的坐标系统一到同一个世界坐标系下;
采集船舶围绕港口航行的激光雷达和IMU数据,采用Ubuntu系统下ROS数据包录制功能使得采集数据过程中激光雷达数据和IMU数据时间同步。
5.根据权利要求1所述的系统,其特征在于,所述SLAM算法具体为开源算法LIO-SAM。
6.根据权利要求1所述的系统,其特征在于,所述无线通信方式具体为基于UDP通信协议的SOCKET网络通信方式。
7.根据权利要求1所述的系统,其特征在于,所述船舶GPS数据具体为船舶经纬度数据,船舶IMU数据具体为船舶与真北方向的夹角信息,所述获取船舶GPS数据和船舶IMU数据包括:所述船舶经纬度数据通过船舶上所搭载GPS传感器获取,所述船舶与真北方向的夹角通过在船舶上装载的9轴IMU的磁力计获取。
8.根据权利要求1所述的系统,其特征在于,所述船舶进出港三维展示平台包括ROS节点管理模块、RVIZ显示设置模块以及显示模块,所述ROS节点管理模块和所述RVIZ显示设置模块均连接所述显示模块,所述显示模块包括三维地图显示窗口、港口和船舶必要信息显示窗口以及人机交互按钮控制窗口,所述ROS节点管理模块用于处理平台所使用的ROS终端和线程,所述RVIZ显示设置模块用于对所述港口三维地图显示参数进行设置。