pierrepault / probabilistic_robotics C++ 1.3K 388 solution of exercises of the book "probabilistic robotics" probabilistic-robotics bayesian-inference kalman-filter slam