Code for the hierarchical pathing project