Added a* path finding algorithm