Factor Graphs for Robot Perception - Robotics Institute Carnegie Mellon University