Bugfixes, working on path finding