1. 程式人生 > >求內切圓的圓心和半徑(已知三個點的座標)

求內切圓的圓心和半徑(已知三個點的座標)

/******
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