π-LSAM: LiDAR Smoothing and Mapping With Planes