在水平调平时采用双位置进行单陀螺或者双陀螺进行寻北包括寻北原理word和matlab代码可用于估计MEMS陀螺的零偏并估计出航向角。 代码已通过实测数据验证。来聊点实际的工程问题吧最近在折腾MEMS陀螺的航向校准发现这玩意儿零偏真是让人头疼。传统单位置寻北总感觉差点意思直到试了双位置法才算是摸到门道。今天咱们直接上干货说说怎么用两套姿势让陀螺自己招供零偏值。先说说基本原理。地球自转角速度的水平分量就像个老司机带着陀螺输出里藏着航向角的秘密。但零偏这个捣蛋鬼总在搅局这时候就需要让陀螺在两个不同方位角上各躺平一次。比如先正北转90度到正东把两次测量数据联立方程组零偏自然就藏不住了。实测数据验证过的Matlab代码在此关键部分节选function [bias, heading] dual_position_calibration(gyro_data1, gyro_data2) % 两次测量数据均值处理 omega1 mean(gyro_data1(:,3)); % Z轴角速度 omega2 mean(gyro_data_data2(:,3)); % 地球自转角速率水平分量 omega_ie 15.04; % 度/小时 latitude 39.9; % 北京纬度 % 构造观测方程 A [sind(latitude) 1; cosd(latitude) 1]; b [omega1; omega2] * 3600; % 转为度/小时 % 最小二乘求解 x A\b; % 提取零偏和航向 bias x(2); % 度/小时 heading_rad atan2(x(1), omega_ie*cosd(latitude)); heading rad2deg(heading_rad); end这段代码的核心在于观测矩阵的构造。A矩阵的第一列对应地球自转分量在不同方位时的投影第二列的1专门用来捕获零偏。注意第12行的单位转换实测发现MEMS陀螺原始输出通常是度/秒这里统一转为度/小时更符合工程习惯。在水平调平时采用双位置进行单陀螺或者双陀螺进行寻北包括寻北原理word和matlab代码可用于估计MEMS陀螺的零偏并估计出航向角。 代码已通过实测数据验证。有个坑得提醒latitude参数别随便填有次偷懒用了默认的40度结果在深圳做实验时航向误差直接飙到5度开外。后来改成GPS实时获取纬度值误差立马缩到1度以内。验证环节发现双位置法对陀螺安装误差的容忍度比想象中高。某次实验平台倾斜了2度航向估计结果居然只飘了0.3度。推测是因为水平姿态的旋转轴基本保持不变倾斜带来的影响被两次测量平均掉了。不过也别高兴太早实测中遇到的最大挑战是环境振动。有组数据在楼宇空调外机旁边采集陀螺输出方差直接翻倍。后来加了个滑动平均滤波代码里第4行的mean函数就是这么来的。当然数据量大时换成递推平均会更省内存。最后说说扩展应用这个框架稍作修改就能玩出花双陀螺版本把A矩阵扩展到4行两个陀螺各自的双位置数据堆叠动态补偿在振动环境中加入加速度计数据辅助判断静止时段温度校准把bias结果与温度传感器数据关联建模说到底MEMS器件的性能提升不能光靠硬件这种巧用先验信息的算法补偿才是工程师的杀手锏。下次再遇到陀螺零偏作妖不妨试试这个双位置大法说不定有惊喜呢