求內切圓的圓心和半徑(已知三個點的座標)
阿新 • • 發佈:2019-02-07
/******
m0 n0 m1 n1 m2 n2 為三角形的三個點的座標值 m為橫座標 n為縱座標
px 內切圓的圓心的橫座標
py 內切圓的圓心的縱座標
pr 內切圓的半徑
***/
int NeiQieYuan(int m0, int n0, int m1, int n1, int m2, int n2, float *px, float *py, float *pr)
{
int dax = 0;
int day = 0;
int dbx = 0;
int dby = 0;
float absA = 0.0f;
float absB = 0.0f;
float temp = 0;
dax = m0 - m1;
day = n0 - n1;
dbx = m2 - m1;
dby = n2 - n1;
temp = dax * dax + day * day * 1.0f;
absA = sqrtf(temp);
temp = dbx * dbx + dby * dby * 1.0f;
absB = sqrtf(temp);
// (absB * day - absA * dby)(y - n1) = (absA * dbx - absB * dax)(x - m1)
// 第一個角平分線方程
// a(y - n1) = b(x - m1)
// 方程1
float a = 0.0f;
float b = 0.0f;
a = (absB * day - absA * dby);
b = (absA * dbx - absB * dax);
dax = m0 - m2;
day = n0 - n2;
dbx = m1 - m2;
dby = n1 - n2;
temp = dax * dax + day * day * 1.0f;
absA = sqrtf(temp);
temp = dbx * dbx + dby * dby * 1.0f ;
absB = sqrtf(temp);
float c = 0.0f;
float d = 0.0f;
c = (absB * day - absA * dby);
d = (absA * dbx - absB * dax);
// 第二個角平分線方程
// c(y - n2) = d(x - m2)
float PointX = 0.0f;
float PointY = 0.0f;
if(a != 0)
{
PointX = (c * b * m1 + n2 * a * c - n1 * a * c - a * d * m2) / (c * b - a * d);
PointY = b * (PointX - m1) / a + n1;
}else
{
PointX = m1;
PointY = d * (m1 - m2) / c + n2;
}
// dax * (y - n2) = day * (x - m2)
// 點到直線的方程 (-day)(y - PointY) = (dax)(x - PointX)
// 計算點到直線的距離
float intersectionX = 0.0f;
float intersectionY = 0.0f;
if(dax != 0)
{
intersectionX = (day * day * m2 - day * dax * n2 + day * dax * PointY + dax * dax * PointX) / (dax * dax + day * day);
intersectionY = day * (intersectionX - m2) / dax + n2;
}else
{
intersectionX = m2;
intersectionY = dax * (intersectionX - PointX) / (-day) + PointY;
}
*px = PointX;
*py = PointY;
float temp1 = (intersectionX - PointX) * (intersectionX - PointX) + (intersectionY - PointY) * (intersectionY - PointY);
*pr = sqrtf((intersectionX - PointX) * (intersectionX - PointX) + (intersectionY - PointY) * (intersectionY - PointY));
return 0;
}
- 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
- 74
- 75
- 76
- 77
- 78
- 79
- 80
- 81
- 82
- 83
- 84
- 85
- 86
- 87
- 88
- 89
- 90
- 91
- 92
- 93
- 94
- 95
- 96
- 97
- 98
- 99
- 100
- 101
- 102
- 103
- 104
- 105
- 106
- 107
- 108
- 109
- 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
- 74
- 75
- 76
- 77
- 78
- 79
- 80
- 81
- 82
- 83
- 84
- 85
- 86
- 87
- 88
- 89
- 90
- 91
- 92
- 93
- 94
- 95
- 96
- 97
- 98
- 99
- 100
- 101
- 102
- 103
- 104
- 105
- 106
- 107
- 108
- 109