用C/C++实现输入IQ数据，计算时差（IQ数据互相关），完成TDOA定位（Chan算法）

文末贴源码链接

需求：已知接收机IQ数据，根据IQ数据做互相关，求信号时差，最终通过TDOA（Chan算法）定位发射机坐标。输入输出坐标均为经纬度坐标，而在TDOA计算中，需要笛卡尔坐标系坐标，涉及坐标转换问题。

头文件：一共包含4个算法

/***************************************************************
TDOA算法1：
****************************************************************/

//场强超过阈值记录时间戳
struct INPUT
{
	double jcdwz[2];//经纬度
	double time;//时间戳
	double* cq;//场强数组
	int cqLen;//场强数组的长度
	int deviceId;//设备ID，只能是1,2,3,4

	double threshold;//阈值
	double delay[4] = { 0,0,0,0 };//四个接收站同步延迟，无延迟则全部输入0，单位：纳秒
}input;

//场强超过阈值记录时间戳,直到记录了4台设备开始TDOA计算
//输出
//int flag;//0表示没有计算，1表示可以读取TDOA结果
//double max;//最大场强值
//double llOutput[2];//TDOA定位结果
void Fun_TDOA(INPUT input, int* flag, int* max, double* llOutput);


/***************************************************************
TDOA算法2：反向求时间差，为算法1提供仿真数据
****************************************************************/

//仿真输入结构体，针对Fun_TDOA的仿真
struct INPUT_Simulation
{
	double BS[2];//接收站经度、纬度，单位：度、度
	double S[2];//发射站的经度、纬度
}input_simulation;
//北京位于东经115.7°—117.4°,北纬39.4°—41.6°
//        经度   纬度      Fun_TDOA_Simulation计算结果 
//发射站：116.25 39.54     
//接收站1：116   39        274949
//接收站2：117   40        356044
//接收站3：116   40        240672
//接收站4：117   39        380055
double Fun_TDOA_Simulation(INPUT