基于通信基站的三维室内定位matlab

有程序和资料。16年华为杯数学建模C题。问题一，根据给定的10组LOS或NLOS传播环境下从手持终端到基站的TOA测量数据和所有基站的三维坐标，首先，根据每一组的终端与基站之间的TOA，计算出这三十个基站分别与各个终端之间的空间距离。对于每个终端，利用四点定位算法（在三维空间中，至少要采用四个基站才能实现坐标定位），根据所给的多个基站，采用分组定位，然后取均值的方法，可得出较精确的每个终端三维坐标。 问题二，根据题目中给定的10组TOA测量数据和所有基站的三维坐标（对应附录中编号为case011_input.txt到case020_input.txt的文件），首先使用问题一中的模型求解出终端坐标，再根据基站之间的距离进行基站的精简，再通过误差门限值等约束条件来保证精度，保证以尽可能少的基站数目，实现近似最优解的三维定位精度。 问题三，根据给定的5组对处于移动过程中的终端采集到的TOA数据（每组数据只记录一个终端的TOA，并且是这一个终端在运动轨迹中多个位置上的TOA数据）。首先计算出运动轨迹上每个点距离所有基站的距离，然后计算出所有轨迹点的二维坐标，然后通过最小二乘法对运动轨迹曲线进行拟合，计算出运动轨迹。

function XYZa=linear_solve（bs_xyzbs_numTOA）
m=length（TOA（:1））;%终端数目
n=bs_num;%基站数目
v=3e8;
C_mat_1=bs_xyz（2:end:）-repmat（bs_xyz（1:）n-11）;
C_mat_1=C_mat_1*2;C_mat_1（:3）=C_mat_1（:3）*50;
C_mat_2=TOA.^2*v^2;
C_mat_2=C_mat_2（:2:end）-repmat（C_mat_2（:1）1n-1）;
C_mat_2=C_mat_2‘;
bs_xyz（:3）=bs_xyz（:3）*50;
B=bs_xyz.^2;
B=sum（B2）;
B=B（2:end）-B（1）;%解算方程的自由项
XYZa=[];
for k=1:m
    mat=C_mat_2（:k）;
    C_mat=[C_mat_1mat];%解算方程的系数矩阵
    xyza=pinv（C_mat）*B;xyza（3）=xyza（3）/50/2;
    XYZa=[XYZaxyza];
end
end

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2018-08-30 21:01  程序\
     目录           0  2018-08-30 21:01  程序\1\
     文件      562722  2016-09-12 08:27  程序\1\case001_input.txt
     文件      818022  2016-09-12 08:27  程序\1\case002_input.txt
     文件     1107335  2016-09-12 08:27  程序\1\case003_input.txt
     文件     1430642  2016-09-12 08:28  程序\1\case004_input.txt
     文件      341429  2016-09-12 08:28  程序\1\case005_input.txt
     文件      562734  2016-09-12 08:28  程序\1\case006_input.txt
     文件      818026  2016-09-12 08:28  程序\1\case007_input.txt
     文件     1107330  2016-09-12 08:28  程序\1\case008_input.txt
     文件     1430638  2016-09-12 08:28  程序\1\case009_input.txt
     文件      341415  2016-09-12 08:28  程序\1\case010_input.txt
     文件         557  2018-08-23 18:51  程序\1\linear_solve.m
     文件      546106  2018-08-23 17:31  程序\1\output_case_001.txt
     文件      798006  2018-08-23 17:30  程序\1\output_case_002.txt
     文件     1085106  2018-08-23 17:30  程序\1\output_case_003.txt
     文件     1407406  2018-08-23 17:30  程序\1\output_case_004.txt
     文件      329406  2018-08-23 17:30  程序\1\output_case_005.txt
     文件      546106  2018-08-23 17:30  程序\1\output_case_006.txt
     文件      798006  2018-08-23 17:30  程序\1\output_case_007.txt
     文件     1085106  2018-08-23 17:30  程序\1\output_case_008.txt
     文件     1407406  2018-08-23 17:30  程序\1\output_case_009.txt
     文件      329406  2018-08-23 17:30  程序\1\output_case_010.txt
     文件       22426  2016-09-12 08:30  程序\1\sample_case001_ans.txt
     文件      562710  2016-09-12 08:30  程序\1\sample_case001_input.txt
     文件       24490  2016-09-12 08:30  程序\1\sample_case002_ans.txt
     文件      818025  2016-09-12 08:30  程序\1\sample_case002_input.txt
     文件       26610  2016-09-12 08:30  程序\1\sample_case003_ans.txt
     文件     1107338  2016-09-12 08:30  程序\1\sample_case003_input.txt
     文件       28695  2016-09-12 08:30  程序\1\sample_case004_ans.txt
     文件     1430633  2016-09-12 08:30  程序\1\sample_case004_input.txt
............此处省略56个文件信息