Graph Bug Fixed

- Fixed the existing bug where graph gets self-disconnected
- Was able to deal with 4 aligned obstacles