点至直线的距离和垂足点计算

//点到直线的垂足点
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)
{ //平面坐标中
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);
}
//计算两经纬度点的距离,单位米
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公式计算球面两点间的距离。
//经纬度转换成弧度
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
//点到直线的距离
public static double getDistanceByPointToLine_笛卡尔坐标(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;
}
---------------------

原文地址:https://www.cnblogs.com/ly570/p/10970802.html

时间: 2024-09-30 22:43:28

点至直线的距离和垂足点计算的相关文章

求解点关于直线的距离、垂足、对称点公式

下面通过两种直线方程的形式,求解点关于直线的距离.垂足.对称点公式. 问题描述1: 已知点的坐标(x0,y0),直线的方程为Ax+By+C = 0: 求点到直线上的距离d.点在直线上的垂足(x, y).点关于直线的对称点(x’, y’). 解决方法: (1)距离: d = ( Ax0 + By0 + C ) / sqrt ( A*A + B*B ); 这个“距离”有符号,表示点在直线的上方或者下方,取绝对值表示欧式距离. (2)垂足: 求解两个方程: (a) Ax + By + C = 0; (

点到直线方程的距离、垂足、对称点

问题描述1: 已知点的坐标(x0,y0),直线的方程为Ax+By+C = 0:求点到直线上的距离d.点在直线上的垂足(x, y).点关于直线的对称点(x’, y‘). 解决方法: (1)距离: d = ( Ax0 + By0 + C ) / sqrt ( A*A + B*B ); 这个“距离”有符号,表示点在直线的上方或者下方,取绝对值表示欧式距离. (2)垂足: 求解两个方程:(a).Ax + By + C = 0;(b).(y - y0) / (x - x0) = B / A; 解得,x =

已知直线上的两点 A(x1, y1), B(x2, y2) 和另外一点 C(x0, y0),求C点到直线的距离。

数学知识太差,一点点积累,高手勿喷. 1. 先求出AB向量 a = ( x2-x1, y2-y1 ) 2. 求AB向量的单位方向向量 b = √((x2-x1)^2 + (y2-y1)^2)) a1 = ( (x2-x1)/b, (y2-y1)/b ) 3.求出CA的法向向量(或CB的法向向量) c = ( y0-y1, -(x0-x1) ) 4. 距离 = AC法向向量与BC向量的单位方向向量的数量积 距离d = a1 * c = ( (x2-x1)(y0-y1) - (y2-y1)(x0-x

求点到直线的最短距离及垂足

一.根据两点求直线方程 已知直线上两点为:(x1,x2),(y1,y2); 设方程为:Ax+By+C=0; 1. 求斜率:k=(y2-y1)/(x2-x1): 2. 直线方程为: y-y1=k(x-x1): 换算得:kx-y+y1-kx1=0,即: A=k B=-1 C=y1-kx1=y1-(y2-y1)/(x2-x1)*x1 二.求距离和垂足公式 1. 点(x0,y0)到直线的距离公式为: d=abs(Ax0+By0+C)/sqrt(A*A+B*B); 2. 设垂足为p,则: p.x=(B*B

POJ1584 判断多边形是否为凸多边形,并判断点到直线的距离

求点到直线的距离: double dis(point p1,point p2){   if(fabs(p1.x-p2.x)<exp)//相等的  {    return fabs(p2.x-pegx);    }  else     {   double k=(p2.y-p1.y)/(p2.x-p1.x);   double b=p2.y-k*p2.x;   return fabs(k*pegx-pegy+b)/sqrt(k*k+1);//返回的是距离的   }}判断多边形是否为凸多边形 if

使用向量的方法计算点到直线的距离

使用向量的方法效率更高,更简单. 首先要了解什么是向量,什么是向量的模 主要用到了解析几何里的几个公式 a * b = | a | * | b | * cos(x),其中x为向量a,b的夹角 | a | * 单位向量 = a,单位向量为模为1的向量 向量的加减法 ,如下图所示 向量的加法 向量的减法 问题的原型如下图所示,红色的点为鼠标位置,蓝色的点(x0,y0),(x1,y1)为线段的端点,求红色的点到直线的距离 可以将点到线的距离转换为直角三角形的问题,如下图所示: 我们定义鼠标所在点为M,

HDU1174(空间点到直线的距离,用叉积)

爆头 Time Limit: 2000/1000 MS (Java/Others)    Memory Limit: 65536/32768 K (Java/Others)Total Submission(s): 2002    Accepted Submission(s): 868 Problem Description gameboy是一个CS高手,他最喜欢的就是扮演警察,手持M4爆土匪的头.也许这里有人没玩过CS,有必要介绍一下“爆头”这个术语:所谓爆头,就是子弹直接命中对方的头部,以秒杀

【ShaderToy】基础篇之谈谈点、线的绘制

写在前面 写前面一篇的时候,发现还是不够基础.因此打算增加几篇基础篇,从点线面开始,希望可以更好理解. 其实用Pixel Shader的过程很像在纸上绘画的过程.屏幕上的每一个像素对应了纸上的一个方格,如果你愿意,你甚至可以一个个判断像素的位置,从而画出任何你想画的图像,也的确有爱好者这么做过.但往往,我们需要的是一个动态的效果,这个效果往往依赖于数学公式的约束.我们可以说是,用数学去绘画.我们用数学去约束,哪些点应该用什么颜色去绘制. 这篇,我们从基本的点和线开始,看一下如何在Pixel Sh

计算几何--二维几何基础练习

内容参考书籍——<算法竞赛入门经典训练指南> 例题1 题目链接:https://uva.onlinejudge.org/index.php?option=com_onlinejudge&Itemid=8&page=show_problem&problem=2119 莫利定理(Morley's theorem),也称为莫雷角三分线定理.将三角形的三个内角三等分,靠近某边的两条三分角线相交得到一个交点,则这样的三个交点可以构成一个正三角形.这个三角形常被称作莫利正三角形.