Real-Time Simultaneous Localization and Mapping with LiDAR intensity