c語言求兩點之間的距離
如果要考慮4個象限,考慮各種x3y3x4y4, 比較麻煩。
大致思路,計算b點到線L1的距離,計算c點到線L1的距離,
用ang3,ang4 與 ang 的相對位置判斷 l1 和 l2 應當相加還是相減得 總距離。
程序如下(沒考慮4個象限):
#include<stdio.h>
#include<stdlib.h>
#include<math.h>
void main()
{
double r1,r2;
double R=5.0, ang=1.05;
double Bx,By,P1x,P1y,P2x,P2y,l1,l2,L;
double x3=1,y3=3,x4=8,y4=10;
double ang3,ang4;
ang3 = atan(y3/x3);
ang4 = atan(y4/x4);
printf("input angle in deg: \n");
scanf("%lf",&ang);
ang = ang / 180.0 * 3.14159265;
Bx = R * cos(ang);
By = R * sin(ang);
r1 =( (x3*Bx)+(y3*By)) / (R*R);
P1x = r1 * Bx;
P1y = r1 * By;
l1 = sqrt( (x3-P1x)*(x3-P1x) + (y3-P1y)*(y3-P1y) );
r2 =( (x4*Bx)+(y4*By)) / (R*R);
P2x = r2 * Bx;
P2y = r2 * By;
l2 = sqrt( (x4-P2x)*(x4-P2x) + (y4-P2y)*(y4-P2y) );
if ( (ang3 >= ang) && (ang4 <= ang) ) L= fabs(l2 + l1);
else L = fabs(l2-l1);
printf("distance: %.2lf ",L);
}