Added obstacle extension, got adjacency list formation working