UWB定位/RSSI定位 三边测量法trilateration C语言代码详解

在之前学习的过程中我发现对于三边定位C代码的详细解释比较少,很多代码里的计算过程看完都是一脸蒙圈。
为了方便大家快速理解,不浪费时间,这篇文章里我简单解析一下目前最常用的三边定位法代码。

头文件

#ifndef __MY_LOCATION_H
#define __MY_LOCATION_H
	static int AX,BX,CX,DX,AY,BY,CY,DY;
	void MY_location_Init(int X1, int Y1, int X2, int Y2, int X3, int Y3,int X4,int Y4);
	double* trilateration(double x1, double y1, double d1, double x2, double y2, double d2, double x3, double y3, double d3);
	double* coordinate(double d1, double d2, double d3, double d4);
	int P(int x, int n);

#endif

头文件没什么可说的,定义了基本参数,也定义了需要使用的几个函数的类型。

.C

#include"MY_Location.h"

int  P(int x, int n)
{
   
	int  val = 1;
	while (n--)
		val *=
  • 10
    点赞
  • 65
    收藏
    觉得还不错? 一键收藏
  • 3
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 3
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值