Added and tested bi-directional search, which works with/without A*