Implemented bidirectional A*