本发明专利技术公开了一种基于DOP值分析声学定位系统多应答器最优布阵方法。本发明专利技术属于声学定位系统多应答器布阵方法技术领域，具体涉及一种适用于多应答器声学定位系统的应答器空间几何最优布阵方法。本方法建立了一种从空间几何角度定量分析多应答器布局优劣的思路方法；该理论可直接用于应答器阵的布放和应答器位置的标校。并以三应答器为例，对空间几何最优布局思路进行详细分析，利用本方法定量的分析得到了平面圆形区域内三应答器阵的最优布局方案。
【技术实现步骤摘要】
本专利技术属于声学定位系统多应答器布阵方法
，具体涉及一种适用于多应答器声学定位系统的应答器空间几何最优布阵方法。
技术介绍
对于声学定位系统而言，当有三个应答器甚至更多应答器能够使用时，应答器的空间几何阵型布置以及应答器和基阵间的相对几何位置关系都和定位精度有一定的关系。尤其对于以球面交汇为定位原理的声学定位系统，多应答器空间几何最优布阵方案设计对提高整体精度有重要意义。随着声学定位技术在水下导航领域的发展和应用，国内外研制了包括长基线、短基线和超短基线在内的多种声学定位系统典型产品，声学定位系统研制单位专注于开发出高性能(传感器误差小)的产品，但仍缺少一种能够定量分析多应答器空间几何布局优劣的方法，未能在传感器误差一定的情况下，通过多应答器的阵型优化来减小声学定位系统系统误差的方法。因此，亟需研制一种适用于多应答器声学定位系统的应答器空间几何最优布阵方法，从而能够定量分析多应答器空间几何布局优劣，
技术实现思路
本专利技术要解决的技术问题是提供一种声学定位系统多应答器空间几何最优布阵方法，从空间几何角度定量的分析多应答器布局的优劣，进而得到一种多应答器阵型布放的最优化设计，一定程度上减小声学定位系统系统误差。为了实现这一目的，本专利技术采取的技术方案是：一种基于DOP值分析声学定位系统多应答器最优布阵方法，包括以下步骤：(1)利用超短基线定位系统USBL输出的方位角α和高度角β，建立DOP观测矩阵A：其中，αi和βi分别表示第i个应答器的方位角和高度角，i＝1～n，n＝3；不考虑USBL测量的时间差，建立3应答器的位置误差最小二乘解：其中Δρ为观测噪声向量，其方差为σ2；简化后的位置误差方差为：(2)建立3应答器DOP观测方程的权系数矩阵Q：(3)根据式0定义多应答器USBL定位的三种DOP值的计算公式如下：水平几何精度因子(HorizontalDilutionofPrecision，HDOP)：垂直几何精度因子(VerticalDilutionofPrecision，VDOP)：三维几何精度因子(PositionalDilutionofPrecision，PDOP)：(4)确定平面圆形区域内三应答器的相对位置关系(4.1)确定平面圆形区域内观测矩阵中高度角和方位角半径为R的平面圆形区域内，观测矩阵中高度角β1,β2,β3均设定为0，设三个应答器相对于基阵的方位角依次为α1,α2,α3；DOP值观测矩阵为：权系数矩阵为：其中：(4.2)分析平面圆形区域内水平几何精度因子HDOP值，将0中非零部分取出，构成平面内简化HDOP权系数矩阵QH：其中：则HDOP为最优布局需要设定A＝Amax，α1+α2+α3＝360°，得到当三个方位角相差均为120°时，可获得半径为R的平面圆形区域内的最优布局，从而确定三个应答器分别在边长为的等边三角形三个顶点上；结合0和0确定，位于同一水平面上的三个应答器的方位角依次为：α,α+120°,α+240°，在保证三个应答器两两之间方位角差值为120°的情况下，α为任一角度，HDOP值不会受到影响；(5)确定圆形区域内半径和深度关系的最优解在步骤(4)平面圆形区域内最优布阵方案的前提下，求解USBL绝对定位三维几何精度因子最优点；取半径为R的圆的内切等边三角形的三个顶点为应答器的布放位置，三个方位角依次为α1＝0°,α2＝120°,α3＝240°，从数学几何关系计算确定，最优解在圆的轴向上，其到各平面圆形区域内个应答器的高度h都相等；令高度角β1＝β2＝β3＝β；其中，DOP值观测矩阵为：权系数矩阵为：平面定位精度因子为：垂直几何精度因子为：三维定位精度因子为：最优布局需要设定PDOP值最小，化简上式：可得当且仅当即时，PDOP值取得最小值，此时为确定圆形区域内半径和深度关系的最优解。进一步的，如上所述的一种基于DOP值分析声学定位系统多应答器最优布阵方法，应答器数量多于3个时，取n＞3，采用步骤(1)～(5)的方法求解最优布阵。本专利技术的有益效果在于，建立了一种从空间几何角度定量分析多应答器布局优劣的思路方法；该理论可直接用于应答器阵的布放和应答器位置的标校。并以三应答器为例，对空间几何最优布局思路进行详细分析，利用本方法定量的分析得到了平面圆形区域内三应答器阵的最优布局方案。此外，该方法还有助于提高应答器的绝对位置标定精度。具体实施方式下面结合具体实施例对本专利技术一种基于DOP值分析声学定位系统多应答器最优布阵方法进行详细说明。该方法包括以下步骤：(1)利用超短基线定位系统USBL输出的方位角α和高度角β，建立DOP观测矩阵A：其中，αi和βi分别表示第i个应答器的方位角和高度角，i＝1～n，n＝3；不考虑USBL测量的时间差，建立3应答器的位置误差最小二乘解：其中Δρ为观测噪声向量，其方差为σ2；简化后的位置误差方差为：(2)建立3应答器DOP观测方程的权系数矩阵Q：(3)根据式0定义多应答器USBL定位的三种DOP值的计算公式如下：水平几何精度因子(HorizontalDilutionofPrecision，HDOP)：垂直几何精度因子(VerticalDilutionofPrecision，VDOP)：三维几何精度因子(PositionalDilutionofPrecision，PDOP)：(4)确定平面圆形区域内三应答器的相对位置关系(4.1)确定平面圆形区域内观测矩阵中高度角和方位角半径为R的平面圆形区域内，观测矩阵中高度角β1,β2,β3均设定为0，设三个应答器相对于基阵的方位角依次为α1,α2,α3；DOP值观测矩阵为：权系数矩阵为：其中：(4.2)分析平面圆形区域内水平几何精度因子HDOP值，将0中非零部分取出，构成平面内简化HDOP权系数矩阵QH：其中：则HDOP为最优布局需要设定A＝Amax，α1+α2+α3＝360°，得到当三个方位角相差均为120°时，可获得半径为R的平面圆形区域内的最优布局，从而确定三个应答器分别在边长为的等边三角形三个顶点上；结合0和0确定，位于同一水平面上的三个应答器的方位角依次为：α,α+120°,α+240°，在保证三个应答器两两之间方位角差值为120°的情况下，α为任一角度，HDOP值不会受到影响；(5)确定圆形区域内半径和深度关系的最优解，在步骤(4)平面圆形区域内最优布阵方案的前提下，求解USBL绝对定位三维几何精度因子最优点；即分析基阵位置精度最优解所在的位置，有助于提高各应答器的绝对位置标定精度。在平面圆形区域内最优布阵方案的前提下，求解USBL绝对定位三维几何精度因子最优点。这个最优点的分析可以对USBL应答器的布放使用以及标定提供理论基础，比如应答器初始位置的高精度校准，或者在固定半径为R的圆形区域内应答器应该布放多深(h)才能获得相对较小的PDOP值。取半径为R的圆的内切等边三角形的三个顶点为应答器的布放位置，三个方位角依次为α1＝0°,α2＝120°,α3＝240°，从数学几何关系计算确定，最优解在圆的轴向上，其到各平面圆形区域内个应答器的高度h都相等；令高度角β1＝β2＝β3＝β；其中，DOP值观测矩阵为：权系数矩阵为：平面定位精度因子为：垂直几何精度因子为：三维定位精度因子为：最优本文档来自技高网...
【技术保护点】
一种基于DOP值分析声学定位系统多应答器最优布阵方法，其特征在于，包括以下步骤：(1)利用超短基线定位系统USBL输出的方位角α和高度角β，建立DOP观测矩阵A：A=cos(β1)sin(α1)cos(β1)cos(α1)sin(β1)cos(β2)sin(α2)cos(β2)cos(α2)sin(β2)·········cos(βn)sin(αn)cos(βn)cos(αn)sin(βn)---(1)]]>其中，αi和βi分别表示第i个应答器的方位角和高度角，i＝1～n，n＝3；不考虑USBL测量的时间差，建立3应答器的位置误差最小二乘解：Δx^=A-1ΔρΔx^=(ATA)-1ATΔρ---(2)]]>其中Δρ为观测噪声向量，其方差为σ2；简化后的位置误差方差为：E[Δx^Δx^T]=σ2·(ATA)-1---(3)]]>(2)建立3应答器DOP观测方程的权系数矩阵Q：Q=(ATA)-1=Q11Q12Q13Q21Q22Q23Q31Q32Q33---(4)]]>(3)根据式(4)定义多应答器USBL定位的三种DOP值的计算公式如下：水平几何精度因子HDOP：HDOP=Q11+Q22---(5)]]>垂直几何精度因子VDOP：VDOP=Q33---(6)]]>三维几何精度因子PDOP：PDOP=HDOP2+VDOP2=Q11+Q22+Q33---(7)]]>(4)确定平面圆形区域内三应答器的相对位置关系(4.1)确定平面圆形区域内观测矩阵中高度角和方位角半径为R的平面圆形区域内，观测矩阵中高度角β1,β2,β3均设定为0，设三个应答器相对于基阵的方位角依次为α1,α2,α3；DOP值观测矩阵为：A=cos(β1)sin(α1)cos(β1)cos(α1)sin(β1)cos(β2)sin(α2)cos(β2)cos(α2)sin(β2)cos(β3)sin(α3)cos(β3)cos(α3)sin(β3)=sinα1cosα10sinα2cosα20sinα3cosα30---(8)]]>权系数矩阵为：Q=(ATA)-1=(sinα1sinα2sinα3cosα1cosα2cosα3000sinα1cosα10sinα2cosα20sinα3cosα30)-1=Σi=13sin2αiΣi=13sinαicosαi0Σi=13sinαicosαiΣi=13cos2αi0000-1---(9)]]>其中：Σi=13sin2αi=sin2α1+sin2α2+sin2α3,Σi=13cos2αi=cos2α1+cos2α2+cos2α3]]>Σi=13sinαicosαi=sinα1cosα1+sinα2cosα2+sinα3cosα3]]>(4.2)分析平面圆形区域内水平几何精度因子HDOP值，将(9)中非零部分取出，构成平面内简化HDOP权系数矩阵QH：QH=Σi=13sin2αiΣi=13sinαicosαiΣi=13sinαicosαiΣi=13cos2αi-1=Σi=13sin2αiA-Σi=13sinαicosαiA-Σi=13sinαi...
【技术特征摘要】
1.一种基于DOP值分析声学定位系统多应答器最优布阵方法，其特征在于，包括以下步骤：(1)利用超短基线定位系统USBL输出的方位角α和高度角β，建立DOP观测矩阵A：A=cos(β1)sin(α1)cos(β1)cos(α1)sin(β1)cos(β2)sin(α2)cos(β2)cos(α2)sin(β2)·········cos(βn)sin(αn)cos(βn)cos(αn)sin(βn)---(1)]]>其中，αi和βi分别表示第i个应答器的方位角和高度角，i＝1～n，n＝3；不考虑USBL测量的时间差，建立3应答器的位置误差最小二乘解：Δx^=A-1ΔρΔx^=(ATA)-1ATΔρ---(2)]]>其中Δρ为观测噪声向量，其方差为σ2；简化后的位置误差方差为：E[Δx^Δx^T]=σ2·(ATA)-1---(3)]]>(2)建立3应答器DOP观测方程的权系数矩阵Q：Q=(ATA)-1=Q11Q12Q13Q21Q22Q23Q31Q32Q33---(4)]]>(3)根据式(4)定义多应答器USBL定位的三种DOP值的计算公式如下：水平几何精度因子HDOP：HDOP=Q11+Q22---(5)]]>垂直几何精度因子VDOP：VDOP=Q33---(6)]]>三维几何精度因子PDOP：PDOP=HDOP2+VDOP2=Q11+Q22+Q33---(7)]]>(4)确定平面圆形区域内三应答器的相对位置关系(4.1)确定平面圆形区域内观测矩阵中高度角和方位角半径为R的平面圆形区域内，观测矩阵中高度角β1,β2,β3均设定为0，设三个应答器相对于基阵的方位角依次为α1,α2,α3；DOP值观测矩阵为：A=cos(β1)sin(α1)cos(β1)cos(α1)sin(β1)cos(β2)sin(α2)cos(β2)cos(α2)sin(β2)cos(β3)sin(α3)cos(β3)cos(α3)sin(β3)=sinα1cosα10sinα2cosα20sinα3cosα30---(8)]]>权系数矩阵为：Q=(ATA)-1=(sinα1sinα2sinα3cosα1cosα2cosα3000sinα1cosα10sinα2cosα20sinα3cosα30)-1=Σi=13sin2αiΣi=13sinαicosαi0Σi=13sinαicosαiΣi=13cos2αi0000-1---(9)]]>其中：Σi=13sin2αi=sin2α1+sin2α2+sin2α3,Σi=13cos2αi=cos2α1+cos2α2+cos2α3]]>Σi=13sinαicosαi=sinα1cosα1+sinα2cosα2+sinα3cosα3]]>(4.2)分析平面圆形区域内水平几何精度因子HDOP值，将(9)中非零部分取出，构成平面内简化HDOP权系数矩阵QH：QH=Σi=13sin2αiΣi=13sinαicosαiΣi=13sinαicosαiΣi=13cos2αi-1=...
【专利技术属性】
技术研发人员：张亚文，马小艳，郭玉胜，邓继权，胡恒佳，艾瀛涛，
申请(专利权)人：北京自动化控制设备研究所，
类型：发明
国别省市：北京;11
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。