无缘定位程序

代码说明：

自己编的无源定位编码，多普勒原理应用FDOA  w为输入三行三列矩阵，为三个固定观察站的坐标。v为输入三行三列矩阵，为三个观察站的x方向，y方向，z方向的速度。！！！注意fdoa三个观察站必须有速度，不然就产生不了频差！！！I为一行两列矩阵，为收到的频差。f0为目标基站的频率，这里我随便设的数。c为光速r为地球半径此程序要求三元高次非线性方程组解，我选择用牛顿迭代法。