Weighted Plane Features For Simultaneous Localization And Mapping