申请/专利权人：南京理工大学

申请日：2021-03-12

公开（公告）日：2024-04-12

公开（公告）号：CN113091768B

主分类号：G01C25/00

分类号：G01C25/00;G06N3/044;G06N3/049;G06N3/084

优先权：

专利状态码：有效-授权

法律状态：2024.04.12#授权;2024.03.26#著录事项变更;2021.07.27#实质审查的生效;2021.07.09#公开

摘要：本发明公开了一种MIMU整体动态智能标定补偿方法。该方法为：通过工装将MEMS‑IMU固定在测试设备上，采集保存IMU以及测试设备的输出；基于DeepAR递归神经网络建立误差补偿模型，确定神经网络输入输出结构、隐含层数目以及神经元数目；将采集到惯性测量单元实测数据作为神经网络的输入，测试设备的数据与惯性测量单元的实际输出的差值分别作为神经网络模型的输出，建立训练集与测试集，利用训练集对神经网络模型进行训练；利用训练完成的神经网络模型结合测试集输入得到模型的输出数据，将输出数据与测试集输出数据进行对比，评价模型性能并对模型参数进行调整优化，进而得到最终的补偿模型。本发明标定精度高，适应性强。

主权项：1.一种MIMU整体动态智能标定补偿方法，其特征在于，包括以下步骤：步骤1、采集数据阶段，通过工装将MEMS-IMU固定在测试设备上，测试设备为转台、离心机，采集保存IMU的输出以及测试设备的输出；步骤2、基于DeepAR递归神经网络建立MEMS-IMU误差补偿模型，确定神经网络输入输出结构、隐含层数目以及神经元数目；步骤3、将在步骤1采集到惯性测量单元实测数据作为神经网络的输入，测试设备的数据与惯性测量单元的实际输出的差值分别作为神经网络模型的输出，建立训练集与测试集，利用训练集对神经网络模型进行训练；步骤4、利用训练完成的DeepAR递归神经网络模型结合测试集输入得到模型的输出数据，将输出数据与测试集输出数据进行对比，评价模型性能并对模型参数进行调整优化，进而得到最终的补偿模型；步骤1所述的采集数据阶段，通过工装将MEMS-IMU固定在测试设备上，测试设备为转台、离心机，采集保存IMU的输出以及测试设备的输出，具体如下：将惯导固定在三轴温箱转台上先分别测试单轴的MIMU的角速率输出，控制三轴转台每个轴的角速率在-400°s-400°s之间均匀变化，变化速率为1°s，通过分别对单轴采集数据能够学习到单轴的标定补偿模型；进而将三轴设置不同的角加速度从而获得三轴不同角速度的误差耦合数据；转动形式设定为依次从逆时针转动，逐渐减为零，再逐渐顺时针加速转动；对三轴施加不同的角加速度从而实现对各轴在不同的角速度下的耦合误差进行采集；控制温箱的温度设定为从最高温度到常温再到最低温度循环往复，同时保持上述的转动形式，采集4小时的数据；为了激励惯导加速度计的高阶误差项，通过工装将惯导安装在离心机上，将输入轴安装在离心机工作半径的正方向，测试向心加速度从0g-10g变化，变化速度为10ming，重新将输入轴安装在离心机工作半径的负方向，测试向心加速度从0g-10g变化，变化速度为10ming；改变惯导在离心机夹具的安装方位，分别对三轴加速度计进行激励，通过上述数据能够对加速度计的高阶误差模型进行学习；最后，将惯导固定在角振动台上对惯导分别施加幅值为0.5°，1°，3°并且振动频率从0.5HZ到100HZ的角振动，振动频率每分钟增加0.5HZ，改变惯导在夹具上的安装方位分别测试不同轴向的角振动输出并采集数据；上述实验将MEMS-IMU实际输出与测试设备的理想输出一同保存，数据均采集两组分为训练集与测试集；步骤2所述基于DeepAR递归神经网络建立MEMS-IMU误差补偿模型，确定神经网络输入输出结构、隐含层数目以及神经元数目，具体如下：建立基于DeepAR递归神经网络的MEMS-IMU误差补偿模型，该模型的输入为三轴角速度信息、三轴加速度信息、温度信息，输出为三轴角速度误差、三轴加速度误差，模型具体结构如下：需要计算得到的目标值的分布为似然函数的乘积形式，如下： 上式即为利用隐含层输出hi,t参数化的自回归循环神经网络模型；概率pzi,t∣θhi,t服从设定的分布，这个分布的参数由隐含层输出的函数确定；其中为似然函数，为以t0时刻之前的输出以及从1到T时刻的协变量序列为先验信息求得的第i个序列的时刻T的输出；为从1到t0-1时刻的输出序列，xi,1:T为从1到T时刻的协变量序列，t为当前时刻，t0为预测起始时刻，T为协变量的当前时刻，zi,t为t时刻的第i序列的输出，zi,1:t-1表示1到当前时刻的第i输出序列，p表示条件概率；的形式根据选择的数据分布形式决定，在下面数据分布部分给出了不同分布形式下的函数形式；hi,t为隐含层输出；表示神经网络参数，包括权值矩阵、阈值矩阵；记zi,t-1为t-1时刻的时间序列i的目标值即为惯性测量单元的测量误差，xi,t为t时刻时间序列i的预测协变量即为同时刻与目标值耦合的其他惯性测量单元的测量信息，hi,t为t-1时刻时间序列i的隐含层网络输出， 其中h表示由LSTM神经元构成的多层递归神经网络实现的函数，且LSTM神经元由参数化；hi,t-1为t-2时刻的隐含层输出，zi,t-1为t-1时刻的第i序列的输出，xi,t为t时刻的第i序列的协变量；其中LSTM神经元的内部结构由遗忘门、输入门、输出门以及仿射变换神经元构成，其中三个门函数的输出值在0-1之间，表示对信息的控制程度；其中前向传播的流程，首先是计算遗忘门ft，遗忘门能够决定记忆信息流Ct-1中的内容保留的程度，遗忘门通过以下公式计算：ft＝σWf·[ht-1,xt]+bf其中ht-1为t-1时刻的隐含状态，xt为t时刻输入，Wf遗忘为权值矩阵，bf为遗忘阈值向量，σ为激活函数；其次，通过计算输入门控制信息注入记忆信息流，输入门的计算公式为： it＝σWi·[ht-1,xt]+bi 其中，it为t时刻的输入门的值，为t时刻的输入门的控制值，e为自然指数，Wi为输入们权值矩阵，WC为控制门权值矩阵，bC为控制门阈值向量，bi为输入门阈值向量，xt为t时刻传递的状态，tanh为激活函数： 最终，t时刻的记忆信息流通过输入门与遗忘门传递的信息求和得到，即为 其中Ct表示t时刻的记忆信息流，Ct-1为t-1时刻的记忆信息流；上式等式右侧第一项表述了通过遗忘门留下的信息，第二项表述了新输入记忆信息流的信息；得到当前时刻信息流的值后，计算当前时刻的输出，此时需要考虑输出门的计算，输出门决定了输出信息的量：ot＝σWo[ht-1,xt]+boht＝ot*tanhCt其中ot表示输出门的数值，Wo为输出门权值矩阵，bo为输出门阈值矩阵，ht表示传递给下一时刻的当前的系统隐含状态，上式表述了通过输出门ot控制信息流Ct的输出量；此时，即完成一个时刻的LSTM神经元的前向传播，反向传播通过依据时间的反向传播算法获得，其中使用了链式法则，通过求导与梯度下降法实现最优化；概率pzi,t∣θhi,t为一个固定的概率分布，参数利用下式得到， 其中θi,t为似然函数的参数其形式取决于似然函数，hi,t为DeepAR神经网络t时刻隐含层输出，为神经网络的连接参数；DeepAR神经网络的目标是得到一个目标值的条件分布， 其中t0代表着目标值未知的起始时刻，预测协变量xi,1:T为全时刻已知的惯性测量单元输出；条件区间的观测信息通过初始状态转移到预测区间中；在该模型中的预测区间与条件区间都选择同样的结构作为编解码模型，同时，编码器与解码器共享权重，因此由式计算，初始状态hi,0和zi,0设置为零；下一步，给定模型参数即能够通过之前已知的数据得到样本的分布首先通过式计算hi,t-1,t＝1,...,t0-1；其次为了计算样本预测其中对于t0时刻，令和得到当前时刻的预测目标值的步骤为：利用上时刻的预测目标值上时刻的预测协变量xi,t-1和上时刻的隐含层输出hi,t-1计算当前时刻的隐含层输出hi,t，再输入似然函数pzi,t-1∣θi,t-1即得到当前时刻预测目标值DeepAR神经网络模型中的似然函数根据惯性测量单元的噪声特性确定，在这里选择高斯似然函数作为概率分布模型；高斯似然函数通过均值与方差两个参数来描述为θ＝μ,σ，其中均值是作为神经网络的仿射层的输出，标准差通过仿射变换以及softplus激活函数计算输出，目的是为了保证标准差大于零； 其中pG代表似然函数，z表示输出数据，μ表示均值，σ表示标准差，π表示圆周率的数值，exp表示e指数，μ表示在高斯分布的数据分布下的预测均值计算函数，表示DeepAR神经网络输出预测均值的权值矩阵的转置，bμ表示DeepAR神经网络输出的预测均值的阈值向量，σ表示在高斯分布的数据分布下的预测标准差计算函数，表示DeepAR神经网络输出预测标准差的权值矩阵的转置，bσ表示DeepAR神经网络输出的预测标准差的阈值向量；上述均值与方差是分别通过了一个仿射变换，不同的是方差通过的仿射变换利用了softplus为激活函数，仿射变换中的权值矩阵与阈值矩阵同样是最优化算法寻优的参数；设置该神经网络的隐含层为四层，每层的神经元数目为50；步骤3所述将在步骤1采集到惯性测量单元实测数据作为神经网络的输入，测试设备的数据与惯性测量单元的实际输出的差值分别作为神经网络模型的输出，建立训练集与测试集，利用训练集对神经网络模型进行训练，具体如下：将微惯性测量单元的实际输出数据作为神经网络的输入，具体为惯性测量单元的三轴加速度序列Ax,Ay,Az，三轴角速度序列ωx,ωy,ωz，以及所在环境的温度序列T；其次DeepAR神经网络的输出定义为误差序列即利用转台采集到的真实加速度数值减去微惯性测量单元量测得到的数值得到的序列；将三轴加速度误差序列ΔAx,ΔAy,ΔAz与三轴角速度误差序列Δωx,Δωy,Δωz作为神经网络的输出；根据上述的输入输出定义，利用步骤2采集到的两组数据，分别建立神经网络的训练集与测试集；训练超参数预设值为训练步数1000步，学习率0.0005，使用随机梯度下降优化器，目标精度为0.001；下面进入训练步骤：首先给定数据集{Zi,1:T}i＝1,...,N和预测协变量xi,1:T，给定模型参数RNN中h·和θ·的参数通过最大化下面的似然函数得到 其中表示总体的似然函数值，p表示条件概率；θhi,t表示神经网络预测的似然函数参数，包括均值、标准差；选择随机梯度下降方法对上述函数进行优化；其次，在进行训练之前还需要进行数据预处理，针对实际数据，将输入数据序列分别除以缩放因子，该缩放因子由下式计算： 其中vi表示第i序列的缩放因子，t0为预测起始时刻，zi,t为当前时刻的第i序列输出值；同时，将预测协变量标准化为均值为零、方差为1的标准正态分布；步骤4所述利用训练完成的DeepAR递归神经网络模型结合测试集输入得到模型的输出数据，将输出数据与测试集输出数据进行对比，评价模型性能并对模型参数进行调整优化，进而得到最终的补偿模型，具体如下：利用步骤3训练完成的DeepAR神经网络，将微惯性测量单元的实际输出与温度值输入神经网络，再通过将神经网络输出与微惯性测量单元实际输出相加即得到标定补偿后的测量输出；利用步骤3所构建的测试集对DeepAR模型进行测试，根据测试精度，调整深度神经网络的超参数并重新训练神经网络，超参数为训练步数、学习率。

全文数据：

权利要求：

百度查询： 南京理工大学 一种MIMU整体动态智能标定补偿方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD