1.一种阶段Aitken加速梯度下降法的水下应答器标定方法,该方法基于如下已知量:RTK输出的设备系下的三维位置信息Pi=[xi yi zi]T,其中,xi、yi、zi分别表示i时刻设备系下x,y,z三轴的坐标,上标T表示矩阵的转置;
USBL换能器记录声信号从载体传播至水下应答器的时间间隔τi;
USBL测得声线与水平方向的夹角θ;
其特征在于,该方法具体包括如下步骤:
步骤一、利用等效声速法建立系统方程和目标函数;
步骤二、异常值剔除:对每一个量测值定义一个参数,反应该量测值为正常值的概率,进而通过每个量测值对应的残差平方和与既定阈值比较来判断该量测值的偏离程度,从而对异常的量测值进行剔除;
步骤三、基于阶段Aitken加速的梯度下降法最优值求解;
步骤四、基于自适应方法的动态步长调整;
步骤一的具体方法如下:
USBL水下应答器标定方法为:将应答器放入水中,设其坐标为Pt=[xt yt zt]T,其中,xt、yt、zt分别表示应答器在导航坐标系下x,y,z三轴的待求坐标,载体围绕应答器做“田”字形运动,利用RTK记录各时刻载体位置Pi,则载体与应答器间的距离li为:同时载体与应答器的距离li由时间间隔τi与声速c表示:li=c·τi
由于声速会随水深度变化,因此实际声信号传播路线为一条弧线,则直线斜矩和实际声线间存在关系:其中,λ为实际弧形声线与所需直线斜矩的比例系数,为实际弧形声线;
则有效声速为:
其中,为有效声速;R为载体与应答器间的高度差;r为垂直高度值;θ(r)为随高度变化的声线与水平方向的夹角;c(r)为随深度变化的声速值;则观测方程为:其中为方便计算,将有效声速的倒数表示为δτi为时间残差,采用残差平方和构建目标函数其中,N为量测值个数;
步骤三具体包括如下子步骤:
首先针对步骤一中得到的目标函数计算梯度:则梯度向量为:
其中,与相同,为梯度向量,状态量沿着梯度向量方向更新迭代,直至满足既定精度为止;
待优化参数向量为则从i时刻到i+1时刻的更新阶段的公式为:其中,Si为i时刻的待优化参数向量,α(i)为i时刻更新的步长;下面进行阶段Aitken加速处理,对于i时刻的更新阶段,按照下列公式进行3次迭代计算:其中,代表i时刻的第j次迭代的待优化参数向量,j=1,2,3;3次迭代后得到则i时刻的最终参数向量优化值计算如下:其中,为i时刻的最终参数向量优化值;
设置迭代停止精度s0,s0具体数值由实验环境情况而定,当满足条件‖(J|i+1)-(J|i)‖≤s0时,迭代停止,此时就是最优解;其中J|i为i时刻目标函数。
2.根据权利要求1所述的阶段Aitken加速梯度下降法的水下应答器标定方法,其特征在于,步骤二的具体方法如下:首先将步骤一中的观测方程在初始估计值处进行泰勒展开,高阶小项忽略不计:其中,li0表示应答器坐标为初始估计值时应答器与载体间的斜矩,Δx,Δy,Δz分别为x,y,z方向上的位置误差;为的误差,则观测方程简化为:Z=HX+V
其中,Z为观测量;H为系统矩阵;X为状态量;V为观测噪声向量;
接下来定义残差与偏离指标:
W=H(HTH)-1HT
Φ=(I-W)Z
其中,W为投影矩阵;Φ为残差;I为单位矩阵;εi为第i个量测值的偏离指标,服从自由度为1的卡方分布;为Φ中第k个元素;wk为投影矩阵W的第k个对角线元素;接下来设置阈值,通过比较εi与阈值来检测异常量测值;
设置信度为85%,查询卡方分布表知此时分位数为2.072,则阈值为:其中,ε0为置信度为85%情况下的阈值;表示单位自由度的平均残差平方和,若εi>ε0则判定第i个测量值为异常值,进行剔除。
3.根据权利要求1所述的阶段Aitken加速梯度下降法的水下应答器标定方法,其特征在于,步骤四具体包括如下子步骤:将自适应方法引入梯度下降法中,实现迭代过程中步长的动态变化,扩宽系统可响应频带,其过程如下:α(i+1)=α(i)0+γ[α(i)-α(i+1)0]其中,α(i)0表示i时刻迭代的步长初值;α(i)为i时刻迭代最后采用的步长值,α(i+1)为i+1时刻迭代最后采用的步长值,α(i+1)0为i+1时刻迭代的步长初值;γ为固定经验值,满足0<γ<1。