通过TDOA和AOA两种定位方法联合,对三维环境下的待测点进行定位,模拟若干基站(已知点)对飞行器(未知点)定位,只有一个m文件,方便学习和调试。订阅专栏后可获得完整代码 参考文献:《多无人机协同定位与跟踪航迹规划方法研究》 文章目录 运行结果 完整代码 程序说明 关键数学公式 1. 三维AOA观测模型 2. 三维TDOA观测模型 3. 雅可比矩阵构造 运行结果 定位结果示意图: 误差示意图: 完整代码 以下代码粘贴到MATLAB的空脚本后,可直接运行,并获得上述结果: %% 三维AOA-TDOA联合定位仿真 % 作者:matlabfilter clc; clear; close all; %% 参数设置 num_drones = 3;