一种适用于非结构化动态环境下的同时定位与建图方法，首先，基于惯性元件测量得到的姿态角对激光雷达点云数据去除运动畸变，再对无运动畸变的激光点云数据与惯性元件输出的姿态进行融合，通过几何特征对激光点云分割，得到较准确的船舱环境感知结果；其次，针对需要获取处于船舱内高动态环境下推耙机的实时位姿的情况，提出一种基于语义特征点匹配的激光里程计来估计推耙机在船舱内的位姿。基于多传感器融合得到的感知结果，利用其语义信息进行提取特征点，再采用点到点、点到线两种匹配方式实时估计推耙机的位姿；最后，为了降低点云地图内存占用率，设计了一种基于最近邻搜索的动态环境下地图更新方法，利用该方法降低算法的空间复杂度。