Factor Graphs For Robot Perception