Probabilistic Robotics Lecture on Robot Motion Planning (University of Freigburg) Click Here! Georgia Tech Smoothing and Mapping library -GTSAM- Click Here!