SwRI developed a factor-graph-based algorithm to simultaneously localize and map the environment for automated vehicles. It intelligently combines sparse image features and landmark data with ...