We present a simultaneous localization and mapping algorithm for a mobile robot in 3D. It allows to construct a map of the environment without artifacts caused by dynamic objects such as trees or people. Experimental results confirm the effectiveness of the algorithm in real world scenarios. We also compare the developed algorithm with previously realized analogs.