Sensor Fusion Localization and Navigation for Visually Impaired People