Modern Robotics, Chapter 10.2.3: Graphs and Trees