|
1
|
|
|
<?php |
|
2
|
|
|
|
|
3
|
|
|
declare(strict_types=1); |
|
4
|
|
|
|
|
5
|
|
|
namespace Location\Utility; |
|
6
|
|
|
|
|
7
|
|
|
use Location\Coordinate; |
|
8
|
|
|
use Location\Distance\DistanceInterface; |
|
9
|
|
|
use Location\Line; |
|
10
|
|
|
|
|
11
|
|
|
class PointToLineDistance |
|
12
|
|
|
{ |
|
13
|
|
|
/** |
|
14
|
|
|
* @var DistanceInterface |
|
15
|
|
|
*/ |
|
16
|
|
|
private $distanceCalculator; |
|
17
|
|
|
|
|
18
|
|
|
/** |
|
19
|
|
|
* PointToLineDistance constructor. |
|
20
|
|
|
* @param DistanceInterface $distanceCalculator |
|
21
|
|
|
*/ |
|
22
|
|
|
public function __construct(DistanceInterface $distanceCalculator) |
|
23
|
|
|
{ |
|
24
|
|
|
$this->distanceCalculator = $distanceCalculator; |
|
25
|
|
|
} |
|
26
|
|
|
|
|
27
|
|
|
/** |
|
28
|
|
|
* @param Coordinate $point |
|
29
|
|
|
* @param Line $line |
|
30
|
|
|
* |
|
31
|
|
|
* @return float |
|
32
|
|
|
*/ |
|
33
|
|
|
public function getDistance(Coordinate $point, Line $line): float |
|
34
|
|
|
{ |
|
35
|
|
|
if ($line->getPoint1()->hasSameLocation($line->getPoint2())) { |
|
36
|
|
|
return $this->distanceCalculator->getDistance($point, $line->getPoint1()); |
|
37
|
|
|
} |
|
38
|
|
|
|
|
39
|
|
|
$pLat = deg2rad($point->getLat()); |
|
40
|
|
|
$pLng = deg2rad($point->getLng()); |
|
41
|
|
|
|
|
42
|
|
|
$l1Lat = deg2rad($line->getPoint1()->getLat()); |
|
43
|
|
|
$l1Lng = deg2rad($line->getPoint1()->getLng()); |
|
44
|
|
|
$l2Lat = deg2rad($line->getPoint2()->getLat()); |
|
45
|
|
|
$l2Lng = deg2rad($line->getPoint2()->getLng()); |
|
46
|
|
|
|
|
47
|
|
|
$deltal2l1Lat = $l2Lat - $l1Lat; |
|
48
|
|
|
$deltal2l1Lng = $l2Lng - $l1Lng; |
|
49
|
|
|
|
|
50
|
|
|
$u = (($pLat - $l1Lat) * $deltal2l1Lat + ($pLng - $l1Lng) * $deltal2l1Lng) / ($deltal2l1Lat ** 2 + $deltal2l1Lng ** 2); |
|
51
|
|
|
|
|
52
|
|
|
if ($u <= 0) { |
|
53
|
|
|
return $this->distanceCalculator->getDistance($point, $line->getPoint1()); |
|
54
|
|
|
} |
|
55
|
|
|
|
|
56
|
|
|
if ($u >= 1) { |
|
57
|
|
|
return $this->distanceCalculator->getDistance($point, $line->getPoint2()); |
|
58
|
|
|
} |
|
59
|
|
|
|
|
60
|
|
|
$tmpPoint1 = new Coordinate( |
|
61
|
|
|
$point->getLat() - $line->getPoint1()->getLat(), |
|
62
|
|
|
$point->getLng() - $line->getPoint1()->getLng() |
|
63
|
|
|
); |
|
64
|
|
|
$tmpPoint2 = new Coordinate( |
|
65
|
|
|
$u * ($line->getPoint2()->getLat() - $line->getPoint1()->getLat()), |
|
66
|
|
|
$u * ($line->getPoint2()->getLng() - $line->getPoint1()->getLng()) |
|
67
|
|
|
); |
|
68
|
|
|
|
|
69
|
|
|
return $this->distanceCalculator->getDistance($tmpPoint1, $tmpPoint2); |
|
70
|
|
|
} |
|
71
|
|
|
} |
|
72
|
|
|
|
mjaschen /
phpgeo
