Added path finding. Glitchy in some cases