1
|
|
|
<?php declare(strict_types=1); |
2
|
|
|
|
3
|
|
|
namespace Stratadox\Pathfinder\Graph\Builder; |
4
|
|
|
|
5
|
|
|
use function array_merge; |
6
|
|
|
use InvalidArgumentException; |
7
|
|
|
use Stratadox\Pathfinder\Environment; |
8
|
|
|
use Stratadox\Pathfinder\Graph\GeometricGraph; |
9
|
|
|
use Stratadox\Pathfinder\Graph\Location; |
10
|
|
|
use Stratadox\Pathfinder\Graph\Road; |
11
|
|
|
use Stratadox\Pathfinder\Graph\Roads; |
12
|
|
|
use Stratadox\Pathfinder\Metric; |
13
|
|
|
use Stratadox\Pathfinder\Position; |
14
|
|
|
|
15
|
|
|
final class GraphEnvironment |
16
|
|
|
{ |
17
|
|
|
private $metric; |
18
|
|
|
private $locations; |
19
|
|
|
|
20
|
|
|
private function __construct(?Metric $metric, Location ...$locations) |
21
|
|
|
{ |
22
|
|
|
$this->metric = $metric; |
23
|
|
|
$this->locations = $locations; |
24
|
|
|
} |
25
|
|
|
|
26
|
|
|
public static function create(): self |
27
|
|
|
{ |
28
|
|
|
return new self(null); |
29
|
|
|
} |
30
|
|
|
|
31
|
|
|
public function withLocation( |
32
|
|
|
string $label, |
33
|
|
|
Position $position, |
34
|
|
|
EdgeDefinition $edges |
35
|
|
|
): self { |
36
|
|
|
return new self($this->metric, ...array_merge( |
37
|
|
|
$this->locations, |
38
|
|
|
[Location::at($position, $label, $edges->gather())] |
39
|
|
|
)); |
40
|
|
|
} |
41
|
|
|
|
42
|
|
|
public function determineEdgeCostsAs(Metric $metric): self |
43
|
|
|
{ |
44
|
|
|
return new self($metric, ...$this->locations); |
45
|
|
|
} |
46
|
|
|
|
47
|
|
|
public function make(): Environment |
48
|
|
|
{ |
49
|
|
|
return GeometricGraph::with(...$this->actualLocations()); |
50
|
|
|
} |
51
|
|
|
|
52
|
|
|
private function actualLocations(): array |
53
|
|
|
{ |
54
|
|
|
if (null === $this->metric) { |
55
|
|
|
return $this->locations; |
56
|
|
|
} |
57
|
|
|
$actualLocations = []; |
58
|
|
|
foreach ($this->locations as $i => $location) { |
59
|
|
|
$newEdges = []; |
60
|
|
|
foreach ($location->edges() as $edge) { |
61
|
|
|
$newEdges[] = Road::towards($edge->target(), $this->newCost( |
62
|
|
|
$edge->cost(), |
63
|
|
|
$this->metric->distanceBetween( |
64
|
|
|
$location->position(), |
65
|
|
|
$this->positionOf($edge->target()) |
66
|
|
|
) |
67
|
|
|
)); |
68
|
|
|
} |
69
|
|
|
$actualLocations[] = Location::at( |
70
|
|
|
$location->position(), |
71
|
|
|
$location->label(), |
72
|
|
|
Roads::available(...$newEdges) |
73
|
|
|
); |
74
|
|
|
} |
75
|
|
|
return $actualLocations; |
76
|
|
|
} |
77
|
|
|
|
78
|
|
|
private function newCost(float $previousCost, float $distance): float |
79
|
|
|
{ |
80
|
|
|
return $previousCost - 1.0 + $distance; |
81
|
|
|
} |
82
|
|
|
|
83
|
|
|
private function positionOf(string $node): Position |
84
|
|
|
{ |
85
|
|
|
foreach ($this->locations as $location) { |
86
|
|
|
if ($node === $location->label()) { |
87
|
|
|
return $location->position(); |
88
|
|
|
} |
89
|
|
|
} |
90
|
|
|
throw new InvalidArgumentException("$node does not exist!"); |
91
|
|
|
} |
92
|
|
|
} |
93
|
|
|
|