點(diǎn)至直線的距離和垂足點(diǎn)計(jì)算

//點(diǎn)到直線的垂足點(diǎn)
public static Coordinate getFootPoint(Coordinate point, Coordinate pnt1, Coordinate pnt2)
{
double A=pnt2.y-pnt1.y; //y2-y1
double B=pnt1.x-pnt2.x; //x1-x2;
double C=pnt2.x*pnt1.y-pnt1.x*pnt2.y; //x2*y1-x1*y2
if (A * A + B * B < 1e-13) {
return pnt1; //pnt1與pnt2重疊
}
else if (Math.abs(A * point.x + B * point.y + C) < 1e-13) {
return point; //point在直線上(pnt1_pnt2)
}
else {
double x = (B * B * point.x - A * B * point.y - A * C) / (A * A + B * B);
double y = (-A * B * point.x + A * A * point.y - B * C) / (A * A + B * B);
Coordinate fpoint = new Coordinate();
fpoint.x = x;
fpoint.y = y;
return fpoint;
}
}
public static double getDistancePoineToLine_planeCoord(Coordinate point, Coordinate pnt1, Coordinate pnt2)
{ //平面坐標(biāo)中
double A=pnt2.y-pnt1.y; //y2-y1
double B=pnt1.x-pnt2.x; //x1-x2;
double C=pnt2.x*pnt1.y-pnt1.x*pnt2.y; //x2*y1-x1*y2
if (A * A + B * B < 1e-13) { //pnt1與pnt2重疊
double dx = point.x - pnt1.x;
double dy = point.y - pnt1.y;
return Math.sqrt(dx * dx + dy * dy);
}
else if (Math.abs(A * point.x + B * point.y + C) < 1e-13) {
return 0; //point在直線上(pnt1_pnt2)
}
else {
double distance = Math.abs(A * point.x + B * point.y + C) / Math.sqrt(A * A + B * B);
return distance;
}
}
public static double getDistance_wgs84(Coordinate p1, Coordinate p2)
{
return getDistance_wgs84(p1.x,p1.y,p2.x,p2.y);
}
//計(jì)算兩經(jīng)緯度點(diǎn)的距離，單位米
public static double getDistance_wgs84(double p1_x,double p1_y, double p2_x,double p2_y)
{
double lat1=p1_x;
double lon1=p1_y;
double lat2=p2_x;
double lon2=p2_y;
//
double earch_radius=6371008.8; // 地球半徑 平均值 米
//用haversine公式計(jì)算球面兩點(diǎn)間的距離。
//經(jīng)緯度轉(zhuǎn)換成弧度
double h_lat1=lat1*Math.PI/180.0;
double h_lon1=lon1*Math.PI/180.0;
double h_lat2=lat2*Math.PI/180.0;
double h_lon2=lon2*Math.PI/180.0;
//差值
double vlon=Math.abs(h_lon1-h_lon2);
double vlat=Math.abs(h_lat1-h_lat2);
//
double h=HaverSin(vlat)+Math.cos(h_lat1)*Math.cos(h_lat2)*HaverSin(vlon);
//
double d=2*earch_radius*Math.asin(Math.sqrt(h));
//
return d;
}
public static double HaverSin(double theta)
{
double v=Math.sin(theta/2);
return v*v;
};
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
//點(diǎn)到直線的距離
public static double getDistanceByPointToLine_笛卡爾坐標(biāo)(Coordinate point, Coordinate pnt1, Coordinate pnt2)
{
double dis = 0;
if (pnt1.x == pnt2.x)
{
if (pnt1.y == pnt2.y)
{
double dx = point.x - pnt1.x;
double dy = point.y - pnt1.y;
dis = Math.sqrt(dx * dx + dy * dy);
}
else
dis = Math.abs(point.x - pnt1.x);
}
else
{
double lineK = (pnt2.y - pnt1.y) / (pnt2.x - pnt1.x);
double lineC = (pnt2.x * pnt1.y - pnt1.x * pnt2.y) / (pnt2.x - pnt1.x);
dis = Math.abs(lineK * point.x - point.y + lineC) / (Math.sqrt(lineK * lineK + 1));
}
//
return dis;
}
---------------------

總結(jié)

以上是生活随笔為你收集整理的点至直线的距离和垂足点计算的全部內(nèi)容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網(wǎng)站內(nèi)容還不錯(cuò)，歡迎將生活随笔推薦給好友。