一种基于凸优化的高精度定位方法技术

本发明专利技术涉及一种水下目标定位问题中的基于凸优化的高精度定位方法。本发明专利技术包括设目标的待解算坐标为x＝[x0,y0,z0]T，目标首先测得到周围n个信标的距离ri和对应信标的坐标ai＝[xi,yi,zi]T，设到每个信标的测距误差为εi，服从高斯分布εi～N(0,σi2)，得到目标的测距方程等。通过将水下目标球面交汇定位方程的最小二乘结构进行形式变换并添加限制条件，将其转化为凸优化理论中的DC结构的形式，进而可以利用凸‑凹过程(CCP)的方法来求解，并针对直接CCP算法需要迭代初值在可行域内的缺点在原优化方程添加松弛变量和罚函数，扩大可行域，放宽对初值的限制。较线性最小二乘定位解算方法而言可以提高定位精度，实现高精度水下目标定位。

【技术实现步骤摘要】

本专利技术涉及一种水下目标定位问题中的基于凸优化的高精度定位方法。
技术介绍
水声定位技术够提供海底勘查设备如ROV和AUV等重要的定位、导航和通信支撑。通过在水面工作船只、水下移动平台以及作业海区上加装和布放声学定位设备，可实现对水下目标位置的实时监控、水面与水下平台的信息交互，是海洋科学考察、海洋资源勘探、海洋资源开发、深海空间站建设等工程的必备手段。到目前为止，水声定位技术可以分为基于测距的定位技术和不基于测距的定位技术两大类，而高精度定位技术都是通过测距方式实现的，待定位目标首先与周围信标进行通信，获得到至少四个参考信标的距离，结合已知的参考信标的位置，进行定位解算得到目标位置。在水下目标的定位解算方法中，最小二乘法具有高精度、低复杂度的优点，应用最为广泛。但是由于基于球面交汇的定位解算方程是非线性的，并且是严格非凸的，现有的方法很难得到定位问题直接最小二乘结构的全局最优解。目前常用的计算方法是通过距离方程两两相减消项去掉二次项，再利用线性最小二乘求解方法进行位置解算。但是由于这种方法消掉了二次项，定位解算结果并不是最优的。因此对于高精度水下定位技术而言有必要研究定位问题最小二乘结构的直接解算方法。
技术实现思路
本专利技术的目的在于针对水声定位技术定位问题中球面交汇定位方程的最小二乘结构的一般解算方式是通过定位方程两两相减消项的方式得到线性最小二乘结构实现的，去掉二次项造成定位精度下降的问题，提出了一种提高了球面交汇定位方程的定位解算精度的基于凸优化的高精度定位方法。本专利技术的目的是这样实现的：一种基于凸优化的高精度定位方法，包括如下步骤：(一)设目标的待解算坐标为x＝[x0,y0,z0]T，目标首先测得到周围n个信标的距离ri和对应信标的坐标ai＝[xi,yi,zi]T，设到每个信标的测距误差为εi，服从高斯分布εi～N(0,σi2)，得到目标的测距方程为：ri＝||x-ai||+εi,i＝1,2,...,n根据距离测量残差平方和最小的原则建立球面交汇定位问题的最小二乘结构：(二)步骤(一)求出的最小二乘结构展开，去掉常数项得：F(x)＝f(x)-g(x)其中(三)约束条件设置方面，由于目标的测距误差服从高斯分布，根据高斯分布的3σ准则，令δi＝3σi得到：||xk-ai||≤ri+δiri-δi≤||xk-ai||得到带约束条件的优化方程(四)对步骤(三)中得到的优化方程的目标函数和限制条件进行仿射近似，转化为可以利用凸优化求解的方程形式，形式如下：subjecttofi(x)-gi(x)≤0,i＝1,...,m,其中x∈Rn，并且fi:Rn→R,gi:Rn→R,(i＝0,...,m)都是凸函数；根据泰勒公式对定位方程中的非凸的gi(x)进行仿射近似；对目标函数进行仿射近似可得：对非凸的约束条件进行仿射近似可得：||x-ai||-ri-δi≤0从而得到关于定位问题可以利用凸优化求局部解的最优化方程：s.t:||x-ai||-ri-δi≤0(五)在限制条件中添加松弛变量扩大可行域，并结合在目标函数中添加罚函数的方法放宽对初始目标位置的限制；(5.1)对原方程添加松弛变量si和以及惩罚函数得到转化后的优化方程：subjectto:||x-ai||-ri-δi≤si(5.2)设定位置初值x0，迭代最大次数Kmax，初始惩罚因子τ0，惩罚因子增长系数μ＞0，设置迭代次数为k＝0；(5.3)利用凸优化工具包求解步骤一中添加松弛变量和罚函数的优化方程解出变量x*,s*,(5.4)更新惩罚因子τk+1＝μτk,k＝k+1；(5.5)如果迭代次数达到上限，终止迭代，将最终的x*作为最终结果，否则继续转到步骤(5.3)进行迭代。本专利技术的有益效果在于：通过将水下目标球面交汇定位方程的最小二乘结构进行形式变换并添加限制条件，将其转化为凸优化理论中的DC结构的形式，进而可以利用凸-凹过程(CCP)的方法来求解，并针对直接CCP算法需要迭代初值在可行域内的缺点在原优化方程添加松弛变量和罚函数，扩大可行域，放宽对初值的限制。较线性最小二乘定位解算方法而言可以提高定位精度，实现高精度水下目标定位。附图说明图1为本专利技术目标与通信范围内的信标通信示意图；图2为本专利技术添加松弛变量和罚函数后凸-凹过程求解定位方程的流程图；图3为本专利技术仿真添加松弛变量和罚函数的凸-凹过程定位误差与线性最小二乘定位误差的对比图；图4为本专利技术图3中200-300次仿真结果的局部放大图。图5为本专利技术图3中300-450次仿真结果的局部放大图。具体实施方式下面结合附图对本专利技术做进一步的说明。实现本专利技术的基本思想是，通过将球面交汇定位方程的最小二乘结构形式变换、添加限制条件，将其转化为凸优化问题中的DC(differenceofconvex)结构形式，再将目标函数和限制条件进行仿射近似，转化为可以用凸优化方法求解的非线性优化问题，可以利用凸优化理论中的凸-凹过程(CCP)方法求出变换后定位方程最小二乘结构的局部解。但是，凸-凹过程迭代求解方法具有要求迭代初始点必须是可行域内的点的缺点，通过在原有CCP方法上添加松弛变量和罚函数的罚凸-凹过程(PCCP)方法，可以放宽对初值的限制、提高算法的适用性。本专利技术的具体实施步骤如下：步骤一：测量到信标的距离、建立定位问题的最小二乘结构模型。假设目标的待解算坐标为x＝[x0,y0,z0]T，目标首先测得到周围n个信标的距离ri和对应信标的坐标ai＝[xi,yi,zi]T。设到每个信标的测距误差为εi(服从高斯分布εi～N(0,σi2))，则得到目标的测距方程为：ri＝||x-ai||+εi,i＝1,2,...,n(1)根据距离残差平方和最小的原则建立球面交汇定位问题的最小二乘结构：步骤二：对步骤一步求出的最小二乘结构进行变换。步骤一步求出的最小二乘结构展开，去掉常数项得：F(x)＝f(x)-g(x)(3)其中步骤三：添加限制条件。约束条件设置方面，由于目标的测距误差服从高斯分布，根据高斯分布的3σ准则，令δi＝3σi得到：得到带约束条件的优化方程步骤四：对步骤三中得到的优化方程的目标函数和限制条件进行仿射近似，转化为可以利用凸优化求解的方程形式。凸优化理论中有一类DC问题，其一般形式如下：其中x∈Rn，并且fi:Rn→R,gi:Rn→R,(i＝0,...,m)都是凸函数。可见步骤二中对定位问题最小二乘结构进行整理得到的带约束条件的优化方程符合DC问题的一般形式。由于DC(Differenceofconvexprogramming)问题中只有gi(x)是仿射函数的条件下，才是凸优化问题，才能利用凸优化方法求其局部解。所以首先要根据泰勒公式对定位方程中的非凸的gi(x)进行仿射近似。对目标函数进行仿射近似可得：对非凸的约束条件进行仿射近似可得：从而得到关于定位问题可以利用凸优化求局部解的最优化方程：步骤五：对步骤四中得到的优化方程添加惩罚函数和松弛变量，放宽凸优化求解转换之后优化方程凸优化求解迭代初始目标位的置限制。步骤四中将原定位问题的最小二乘结构经变换和仿射近似之后得到的最优化方程可以利用Yuille和Rangarajan在2003年提出的凸-凹过程(CCP)方法来求解，但是凸-凹过程求解仿射近似后的DC问题要求本文档来自技高网...

【技术保护点】
一种基于凸优化的高精度定位方法，其特征在于，包括如下步骤：(一)设目标的待解算坐标为x＝[x0,y0,z0]T，目标首先测得到周围n个信标的距离ri和对应信标的坐标ai＝[xi,yi,zi]T，设到每个信标的测距误差为εi，服从高斯分布得到目标的测距方程为：ri＝||x‑ai||+εi,i＝1,2,...,n根据距离测量残差平方和最小的原则建立球面交汇定位问题的最小二乘结构：minimizexF(x)=Σi=1n(ri-||x-ai||)2]]>(二)步骤(一)求出的最小二乘结构展开，去掉常数项得：F(x)＝f(x)‑g(x)其中(三)约束条件设置方面，由于目标的测距误差服从高斯分布，根据高斯分布的3σ准则，令δi＝3σi得到：||xk‑ai||≤ri+δiri‑δi≤||xk‑ai||得到带约束条件的优化方程minimizeF(x)=f(x)-g(x)subject to||x-ai||≤ri+δiri-δi≤||x-ai||;]]>(四)对步骤(三)中得到的优化方程的目标函数和限制条件进行仿射近似，转化为可以利用凸优化求解的方程形式，形式如下：minimizexf0(x)-g0(x)]]>subject to fi(x)‑gi(x)≤0,i＝1,...,m,其中x∈Rn，并且fi:Rn→R,gi:Rn→R,(i＝0,...,m)都是凸函数；根据泰勒公式对定位方程中的非凸的gi(x)进行仿射近似；对目标函数进行仿射近似可得：F^(x)=f(x)-g^(x,xk)=xTx-2xTvk]]>vk=1nΣi=1nai+1nΣi=1nri∂||xk-ai||;]]>对非凸的约束条件进行仿射近似可得：||x‑ai||‑ri‑δi≤0-||xk-ai||-∂||xk-ai||T(x-xk)+ri-δi≤0;]]>从而得到关于定位问题可以利用凸优化求局部解的最优化方程：minimizexF^(x)=xTx-2xTvk]]>s.t:||x‑ai||‑ri‑δi≤0-||xk-ai||-∂||xk-ai||T(x-xk)+ri-δi≤0;]]>(五)在限制条件中添加松弛变量扩大可行域，并结合在目标函数中添加罚函数的方法放宽对初始目标位置的限制；(5.1)对原方程添加松弛变量si和以及惩罚函数得到转化后的优化方程：minimizex,s,s^xTx-2xTvk+τkΣi=1n(si+s^i)]]>subject to:||x‑ai||‑ri‑δi≤si-||xk-ai||-∂||xk-ai||T(x-xk)+ri-δi≤s^i]]>si≥0,s^i≥0,i=1,2,...,n]]>(5.2)设定位置初值x0，迭代最大次数Kmax，初始惩罚因子τ0，惩罚因子增长系数μ＞0，设置迭代次数为k＝0；(5.3)利用凸优化工具包求解步骤一中添加松弛变量和罚函数的优化方程解出变量x*,s*,(5.4)更新惩罚因子τk+1＝μτk,k＝k+1；(5.5)如果迭代次数达到上限，终止迭代，将最终的x*作为最终结果，否则继续转到步骤(5.3)进行迭代。...

【技术特征摘要】
1.一种基于凸优化的高精度定位方法，其特征在于，包括如下步骤：(一)设目标的待解算坐标为x＝[x0,y0,z0]T，目标首先测得到周围n个信标的距离ri和对应信标的坐标ai＝[xi,yi,zi]T，设到每个信标的测距误差为εi，服从高斯分布得到目标的测距方程为：ri＝||x-ai||+εi,i＝1,2,...,n根据距离测量残差平方和最小的原则建立球面交汇定位问题的最小二乘结构：minimizexF(x)=Σi=1n(ri-||x-ai||)2]]>(二)步骤(一)求出的最小二乘结构展开，去掉常数项得：F(x)＝f(x)-g(x)其中(三)约束条件设置方面，由于目标的测距误差服从高斯分布，根据高斯分布的3σ准则，令δi＝3σi得到：||xk-ai||≤ri+δiri-δi≤||xk-ai||得到带约束条件的优化方程minimizeF(x)=f(x)-g(x)subjectto||x-ai||≤ri+δiri-δi≤||x-ai||;]]>(四)对步骤(三)中得到的优化方程的目标函数和限制条件进行仿射近似，转化为可以利用凸优化求解的方程形式，形式如下：minimizexf0(x)-g0(x)]]>subjecttofi(x)-gi(x)≤0,i＝1,...,m,其中x∈Rn，并且fi:Rn→R,gi:Rn→R,(i＝0,...,m)都是凸函数；根据泰勒公式对定位方程中的非凸的gi(x)进行仿射近似；对目标函数进行仿射近似可得：F^(x)=f(x)-g^(x,xk)=xTx-2xTvk]]>vk=1nΣi=1nai+1...

【专利技术属性】
技术研发人员：张居成，史春昊，钱洪宝，孙大军，郑翠娥，史铭，王永恒，韩云峰，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江;23