A Robust Rgb-D Slam System For 3D Environment With Planar Surfaces