Faster alternative method for finding obstacle in path. Almost as fast as original one, but with correct path.