Visual Mapping And Pose Estimation For Self-Driving Cars