三點定位的演算法

2021-09-02 08:29:48 字數 2437 閱讀 9180

三點定位,

已知a,b,c三個頂點的x,y座標

和三個點都z座標的距離,la,lb,lc

求z點的座標

原理就是圍繞a,b,c 三個點畫圓,三個圓焦點的部分就是所求

但是,由於三個點的距離可能不准,不一定會有結果,

所以是三個圓環的焦點,環的寬度開始為0,沒有取到則加1

執行gcc -lm test.c

test.c**如下

#include "stdio.h"

#include "stdlib.h"

#include

//座標

double ax,ay,bx,by,cx,cy,zx,zy;

//距離

double la,lb,lc;

double cx1,cy1,cx2,cy2,cx3,cy3,cx4,cy4;

int main(void)

printf("input b coordinate:\n");

scanf("%lf%lf",&bx,&by);

if((bx > 1000)||(bx > 1000))

printf("input c coordinate:\n");

scanf("%lf%lf",&cx,&cy);

if((cx > 1000)||(cx > 1000))

printf("input distance from a to z:\n");

scanf("%lf",&la);

if(la > 1000)

printf("input distance from b to z:\n");

scanf("%lf",&lb);

if(lb > 1000)

printf("input distance from c to z:\n");

scanf("%lf",&lc);

if(lc > 1000)

printf("\n");

printf("a(%lf,%lf)\n",ax,ay);

printf("b(%lf,%lf)\n",bx,by);

printf("c(%lf,%lf)\n",cx,cy);

printf("az = %lf\n",la);

printf("bz = %lf\n",lb);

printf("cz = %lf\n",lc);

//input:

for(zx = ax -la;zx <= ax + la;zx++) }

if(!okflag)err++;

} while (okflag == 0);

i++;

err = 0;

okflag = 0;

} printf("query...\n");

i = 0;

for(zx = bx -lb;zx <= bx + lb;zx++) }

if(!okflag)err++;

} while (okflag == 0);

i++;

err = 0;

okflag = 0;

} printf("query...\n");

getchar();

i = 0;

for(zx = cx -lc;zx <= cx + lc;zx++) }

if(!okflag)err++;

} while (okflag == 0);

i++;

err = 0;

okflag = 0;

} printf("query a b c over!\n");

printf("press enter to continue!\n");

//必須加不然執行出錯,但不會停止

getchar();

do

} }

}

if(abrequery < loopnum)aberr++;

}while(abrequery < loopnum);

acerr =0;

//找ac 交點

do

} }

} if(acrequery < loopnum)acerr++;

}while(acrequery < loopnum);

//找交點的交點

for(i = 0;i < abrequery;i++) }

} if(requery1 == 0)

if(loopnum == 10)

}while(requery1 ==0);

printf("finish!\n");

getchar();

return 0;

}

C 學習筆記 三點定位演算法

自己寫的,可能還有很多不足,看著 不對的求提出,我改 先上 然後解釋我的想法 1 namespace threepointorientation210 static point threepointorientation point a,point b,point c,int lenaz,int l...

三點定位 企業展廳設計怎麼定位,從這三點入手

企業展廳是一項系統工程,涉及環節比較複雜比較多。要在綜合考慮空間面積大小 造型和所處位置等客觀因素上對整個展廳進行設計布局。力求展廳落地呈現出效果最大化。要做到這樣,企業展廳設計怎麼精準定位,重慶數位化展廳設計公司曼斯特科技給大家甩乾貨 從這三點入手。1 突出企業的時代感和特色感 企業展廳是展示企業...

三點定位法原理及實現 藍芽定位

實現 最近在做藍芽室內定位,藍芽定位用到的乙個非常經典的演算法就是三點定位法。三點定位法,顧名思義首先有三個圓點,同時我們也知道這三個圓的半徑,最終求得三圓的交點,達到定位效果。如圖 我們的目的是求得o點,利用畢達哥拉斯定理我們可以快速求得o點座標。不過事與願違,現實情況並不總是如人意,而是這樣 甚...