1.一种基于信号到达时间差的多基地声纳的定位方法,其特征在于包括以下步骤:步骤一:建立一个平面坐标系或空间坐标系作为参考坐标系;设定参考坐标系中存在1个未知坐标的目标及N个接收机和M个发射机;将目标在参考坐标系中的坐标位置的真实值记为uo,将第j个接收机在参考坐标系中的坐标位置的真实值记为 将第i个发射机在参考坐标系中的坐标位置的真实值记为 将水下环境中信号的真实传播速度记为co,将第j个接收机在参考坐标系中的原本名义部署的标称坐标位置记为sj,将第i个发射机在参考坐标系中的原本名义部署的标称坐标位置记为ti,将水下环境中信号的标准传播速度记为其中,N≥1,M≥1,N+M≥4,1≤j≤N,1≤i≤M,Δsj表示第j个接收机的位置误差,Δti表示第i个发射机的位置误差,Δsj和Δti均服从零均值、方差为 的高斯分布,20≤σz≤200米,Δc表示信号的传播速度误差,Δc服从零均值、方差为 的高斯分布,2≤σc≤20米/秒;
步骤二:发射机发射的信号分别经过直接路径和经过目标反射的间接路径两条路径后,被接收机先后接收;然后利用信号到达时间差来进行椭圆拟合,得到测量模型,描述为:接着将sj和ti代入测量模型中,并考虑假设信号的真实传播速度是一个已知分布的随机变量和信号的真实传播速度是完全未知这两种情况,对应得到信号的真实传播速度已知分布的情况下的测量模型和信号的真实传播速度完全未知的情况下的测量模型,将信号的真实传播速度已知分布的情况下的测量模型描述为:将信号的真实传播速度完全未知的情况下的测量模型描述为: 其中, 表示第i个发射机发射的信号经过目标反射的间接路径后被第j个接收机接收所经历时间与第i个发射机发射的信号经过直接路径后被第j个接收机接收所经历时间的真实时间差,符号“|| ||”为求欧氏距离,“s.t.”表示“受约束于……”,τi,j表示第i个发射机发射的信号经过目标反射的间接路径后被第j个接收机接收所经历时间与第i个发射机发射的信号经过直接路径后被第j个接收机接收所经历时间的测量时间差,εi,j和 均为引入的中间变量,Δτi,j服从零均值、方
差为 的高斯分布,0.02≤στ≤0.2秒, 均为引入的中间变量,“T”表示向量或矩阵的转置,信号的真
实传播速度已知分布的情况下的测量模型和信号的真实传播速度完全未知的情况下的测量模型均为高度非线性模型;
步骤三:将信号的真实传播速度已知分布的情况下的测量模型中的||uo-sj||-||ti-sj||移到等式左侧,然后对等式两边平方并展开,再省略展开式中的二次方项,得到信号的真实传播速度已知分布的情况下的线性关系方程,描述为:;同
样,将信号的真实传播速度完全未知的情况下的测量模型中的||uo-sj||-||ti-sj||移到等式左侧,然后对等式两边平方并展开,再省略展开式中的二次方项,得到信号的真实传播速度完全未知的情况下的线性关系方程,描述为:接着将信号的真实传播速
度已知分布的情况下的线性关系方程整理成矩阵形式,得到信号的真实传播速度已知分布的情况下的矩阵形式:Bε=b-Ayo;同样,将信号的真实传播速度完全未知的情况下的线性关系方程整理成矩阵形式,得到信号的真实传播速度完全未知的情况下的矩阵形式:其中,B表示引入的中间矩阵,
IM表示维数为M×M的单位矩阵,符号
表示克罗内克积,diag([||uo-s1||,||uo-s2||,...,||uo-sN||])表示将向量[||uo-s1||,||uo-s2||,...,||uo-sN||]中的每个元素依次作为对角元素的对角矩阵,s1表示第1个接收机在参考坐标系中的原本名义部署的标称坐标位置,s2表示第2个接收机在参考坐标系中的原本名义部署的标称坐标位置,sN表示第N个接收机在参考坐标系中的原本名义部署的标称坐标位置,ε=[ε1,1,ε1,2,...,ε1,N,ε2,1,...,εM,N]T,ε1,1,ε1,2,...,ε1,N,ε2,1,...,εM,N均根据 计算得到,b为引入的中间向量,b=[b1,1,b1,2,...,b1,N,b2,1,...,bi,j,...,bM,N]T,b1,1,b1,2,...,b1,N,b2,1,...,bi,j,...,bM,N均为b中的元素, A为引入的中间矩阵,A=[A1,A2,...,Ai,...,AM]T,A1,A2,...,Ai,...,AM为A中的元素,
0i-1表示维数为1×(i-1)且元素全为0的列向量,0M-i表示维数为1×(M-i)且元素全为0的列向量,τi,1表示第i个发射机发射的信号经过目标反射的间接路径后被第1个接收机接收所经历时间与第i个发射机发射的信号经过直接路径后被第1个接收机接收所经历时间的测量时间差,τi,2表示第i个发射机发射的信号经过目标反射的间接路径后被第2个接收机接收所经历时间与第i个发射机发射的信号经过直接路径后被第2个接收机接收所经历时间的测量时间差,τi,N表示第i个发射机发射的信号经过目标反射的间接路径后被第N个接收机接收所经历时间与第i个发射机发射的信号经过直接路径后被第N个接收机接收所经历时间的测量时间差,yo为由未知变量构成的向量,yo=[uoT,||uo-t1||,||uo-t2||,...,||uo-tM||]T,t1表示第1个发射机在参考坐标系中的原本名义部署的标称坐标位置,t2表示第2个发射机在参考坐标系中的原本名义部署的标称坐标位置,tM表示第M个发射机在参考坐标系中的原本名义部署的标称坐标位置,均根据
计算得到,为引入的中间向量,
均为 中的元素,
为引入的中间矩阵,
为 中的元素,
0M-1表示维
数为1×(M-1)且元素全为0的列向量,α为在信号的真实传播速度完全未知的情况下为避免出现数值问题而引入的缩放比例常数,α∈[100,1000], 为由未知变量构成的向量,o
表示c
等比例缩小α倍后的值;
步骤四:将信号的真实传播速度已知分布的情况下的矩阵形式转化为信号的真实传播速度已知分布的情况下的加权最小二乘问题,描述为: 同样,将信号的真实传播速度完全未知的情况下的矩阵形式转化为信号的真实传播速度完全未知的情况下的加权最小二乘问题,描述为: 然后通过添置约束条件将信号的真实传播速度已知分布的情况下的加权最小二乘问题转化为信号的真实传播速度已知分布的情况下的非凸约束优化问题,描述为:同样,通过添置约束条件将信号的真实传播速度完全未知的情况下的加权最小二乘问题转化为信号的真实传播速度完全未知的情况下的非凸约束优化问题,描述为: 其中,Q和 均为引入的中间矩阵,Q的初始值为IMN,的初始值为IMN,IMN表示维数为MN×MN的单位矩阵,y为与yo对应由待优化变量组成的向量,y=[uT,||u-t1||,||u-t2||,...,||u-tM||]T,为与 对应由待优化变量组成的向量,
u表示uo对应的待优
化变量,表示 对应的待优化变量,y(2+i)表示y中的第2+i个元素,y(1:2)表示由y中的第
1个元素和第2个元素构成的列向量, 表示 中的第4个元素, 表示 中的第3个元素, 表示 中的第4+i个元素, 表示由 中的第1个元素和第2个元素构成的列向量, 表示 中的第4+M+i个元素;
步骤五:令Y=yyT,将信号的真实传播速度已知分布的情况下的非凸约束优化问题转换成相应的等价问题,描述为: 令
将信号的真实传播速度完全未知的情况下的非凸约束优化问题转换成相应的等价问题,描述为: 其中,Y和 均为引入的
中间矩阵,tr{}表示求矩阵的迹,rank()表示求矩阵的秩,F和 均为引入的中间矩阵,Y(2+i,2+i)表示Y中的第2+i行第2+i列的元素,Y(1:2,1:2)表示由Y中的第1行至第2行中第1列至第2列的所有元素构成的矩阵,表示 中的第4+i行第4+i列的元素, 表示由 中的第1行至第2行中第1列至第2列的所有元素构成的矩阵, 表示 中的第3行第4+i列的元素,表示 中的第4行第4+i列的元素, 表示 中的第3行第4+M+i列的元素, 表示 中的第3行第3列的元素;
步骤六:采用半正定松弛技术将信号的真实传播速度已知分布的情况下的非凸约束优化问题相应的等价问题松弛为易处理的凸问题,将信号的真实传播速度已知分布的情况下的易处理的凸问题描述为: 同样,采
用半正定松弛技术将信号的真实传播速度完全未知的情况下的非凸约束优化问题相应的等价问题松弛为易处理的凸问题,将信号的真实传播速度完全未知的情况下的易处理的凸问题描述为:
步骤七:通过在信号的真实传播速度已知分布的情况下的易处理的凸问题中添加额外的约束来加紧问题,得到信号的真实传播速度已知分布的情况下的加紧后的凸问题,描述为: 通过在信号的真实传播速度完全
未知的情况下的易处理的凸问题中添加额外的约束来加紧问题,得到信号的真实传播速度完全未知的情况下的加紧后的凸问题,描述为:其中,Y(2+i,2+j)表示Y中的
第2+i行第2+j列的元素,Y(1:2,2+j)表示由Y中的第1行至第2行中第2+j列的所有元素构成的矩阵,y(2+j)表示y中的第2+j个元素, 表示 中的第2+i行第2+j列的元素,表示由 中的第1行至第2行中第2+j列的所有元素构成的矩阵, 表示中的第2+j个元素, 表示 中的第4+i行第3列的元素, 表示由 中的第1行至第2行中第3列的所有元素构成的矩阵, 表示 中的第4+M+i行第3列的元素, 表示 中的第4+i行第4+j列的元素, 表示由 中的第1行至第2行中第4+j列的所有元素构成的矩阵, 表示 中的第4+j个元素, 表示 中的第4+i行第4+M+j列的元素, 表示由 中的第1行至第2行中第4+M+j列的所有元素构成的矩阵, 表示 中的第4+M+j个元素;
步骤八:求解信号的真实传播速度已知分布的情况下的加紧后的凸问题,得到y的最优解,记为y*;同样,求解信号的真实传播速度完全未知的情况下的加紧后的凸问题,得到 的最优解,记为步骤九:根据y*得到信号的真实传播速度已知分布的情况下uo的初步估计值,记为u1*,u1*=y*(1:2);并根据 得到信号的真实传播速度完全未知的情况下uo和 的初步估计值,对应记为u2*和 其中,y*(1:2)表示y*中的第1个元素和第2个元素构成的向量, 表示 中的第1个元素和第2个元素构成的向量, 表示 中的第
3个元素;
步骤十:将u1*代入 中来更新Q的值,将u2*和 代入 中来更新 的值;然后在Q和 的值更新后重复执行步骤四至步骤八;再根据重复执行得到的y*获得信号的真实传播速度已知分布的情况下uo的最终估计值,记为u*1,final,u*1,final=y*(1:2);并根据重复执行得到的 获得信号的真实o *传播速度完全未知的情况下u的最终估计值,记为u 2,final, 其中,Qτ、Dz、Dt、Ds为引入的中间矩阵, IMN表示维数为MN×MN的单位矩阵,Dz=[Dt,Ds],Dt=Diag{Dt,1,Dt,2,...,Dt,i,...,Dt,M},Dt=Diag{Dt,1,Dt,2,...,Dt,i,...,Dt,M}表示由Dt,1,Dt,2,...,Dt,i,...,Dt,M作为对角块构成块对角矩阵Dt,均根据
计算得到,
表示由
作为对角块构成块对角矩阵Ds,i,
均根据 计算得到, I2(M+N)表示维数为2(M+N)×2(M+N)的单位矩阵,τ=[τ1,1,τ1,2,...,τ1,N,τ2,1,...,τM,N]T,τ1,1表示第1个发射机发射的信号经过目标反射的间接路径后被第1个接收机接收所经历时间与第1个发射机发射的信号经过直接路径后被第1个接收机接收所经历时间的测量时间差,τ1,2表示第1个发射机发射的信号经过目标反射的间接路径后被第2个接收机接收所经历时间与第1个发射机发射的信号经过直接路径后被第2个接收机接收所经历时间的测量时间差,τ1,N表示第1个发射机发射的信号经过目标反射的间接路径后被第N个接收机接收所经历时间与第1个发射机发射的信号经过直接路径后被第N个接收机接收所经历时间的测量时间差,τ2,1表示第2个发射机发射的信号经过目标反射的间接路径后被第1个接收机接收所经历时间与第2个发射机发射的信号经过直接路径后被第1个接收机接收所经历时间的测量时间差,τM,N表示第M个发射机发射的信号经过目标反射的间接路径后被第N个接收机接收所经历时间与第M个发射机发射的信号经过直接路径后被第N个接收机接收所经历时间的测量时间差。