Path Planning and Navigation