三边测量法定位算法Cfree代码

导读 代码该代码是需要输入四个基站坐标和四个基站到未知点的距离的, 如果需要改成三个 直接引用 trilateration(AX, AY, d1, BX, BY, d...

代码该代码是需要输入四个基站坐标和四个基站到未知点的距离的, 如果需要改成三个 直接引用 trilateration(AX, AY, d1, BX, BY, d2, CX, CY, d3);即可。4个基站只是在三个基站的基础上来解析的,多了一步对4种不同的三个基站的定位位置数据平均化。.h文件代码:#ifndef __MY_LOCATION_H#define __MY_LOCATION_Hx09static int AX,BX,CX,DX,AY,BY,CY,DY;x09void MY_locatio