それだけだと常に障害物の角を通ることになるから必ずしも最短距離にならなくない?
適当に何もないところにも点足さないといけない気が