Fixed minor path finding bugs