Fixed shortest path delete bug
More informative error message on messed up topological sort
Added utility function for reading entire contents of file
removed unnecessary print statement on shortcut
Improved flexibility of AnyMotionPlanner
Fixed up some warnings
AnyCollisionGeometryQuery now updates mesh-mesh collision margins dynamically
Fixed include files on some platforms