专利汇可以提供一种多MEMS传感器组合测姿方法专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种多MEMS 传感器 组合测姿方法,步骤是:1)在载体 坐标系 的三个轴上,将四组MEMS传感器两两对 角 安装在载体坐标系的各轴上, 相位 差为180°;2)采集四组MEMS传感器的测量数据与四元数估计数据的向量积作为 传感器系统 误差参数;3)将传感器系统误差参数作为模糊 控制器 和PI控制器的输入参数,将控制器的输出参数作为互补 滤波器 的输入参数,以修正 陀螺仪 的 角速度 输出;4)根据修正后的陀螺仪角速度数据,通过四元数微分方程解算出 姿态 角数据。本发明方法仿真结果表明,提出的方法较传统姿态解算具有更好的 精度 以及鲁棒性。,下面是一种多MEMS传感器组合测姿方法专利的具体信息内容。
1.一种多MEMS传感器组合测姿方法,其特征在于,包括以下步骤:
(1)在载体坐标系的三个轴上,将四组MEMS传感器两两对角安装在载体坐标系的各轴上,相位差为180°;
(2)采集四组MEMS传感器的测量数据与四元数估计数据的向量积作为传感器系统误差参数;
(3)将传感器系统误差参数作为模糊控制器和PI控制器的输入参数,将控制器的输出参数作为互补滤波器的输入参数,以修正陀螺仪的角速度输出;
(4)根据修正后的陀螺仪角速度数据,通过四元数微分方程解算出姿态角数据。
2.根据权利要求1所述的一种多MEMS传感器组合测姿方法,其特征在于,所述步骤(1)的具体过程为:
首先采用十二组MEMS传感器均匀分布在载体坐标系的各轴上,即每一轴上应用四组MEMS传感器,将四组MEMS传感器两两对角安装,为了方便计算将四组MEMS传感器分为a,b组每一组由两组传感器对角安装,设置俯仰角为θ,横滚角为γ以及航向角为 载体坐标系为n系,参考坐标系为s系,xsyszs为参考坐标系北东地方向,初始载体和参考坐标系的三轴相重合,参考坐标系经过旋转后与载体坐标系的关系为:载体坐标系等于方向余弦矩阵与参考坐标系的乘积,欧拉角是一个坐标系到另一个坐标系的变换,可以通过不同坐标轴的3次连续转动来实现,用欧拉角的形式可以表示方向余弦矩阵
3.根据权利要求1所述的一种多MEMS传感器组合测姿方法,其特征在于,所述步骤(2)的具体过程为:
先计算a组MEMS传感器所测得的数据和参考坐标系下加速度和磁场强度数据通过坐标变换矩阵,得到俯仰角θ1,横滚角γ1以及航向角 b组和a组的方法一样,同理求得b组的俯仰角θ2,横滚角γ2以及航向角 利用均值法得到整个系统的俯仰角θ,横滚角γ以及航向角 由于欧拉角存在奇点问题,所以将解算出欧拉角初始数据表示为四元数的初始值,即可得四元数矩阵 四元数用q0,q1,q2,q3表示成一个具有4个参数的复数形式,q0为其实部,q1,q2,q3为其虚部,利用向量积法算出俯仰角和横滚角的误差eθγ以及航向角误差eθγ为四元数矩阵 第三列数据与加速度传感器测量数据做向量积, 为四元数矩阵 与地理坐标系下的地磁测量向量的乘积再与磁力计输出数据的单位向量的乘积,得到每组传感器的系统误差 求得第一组至第四组传感器的系统误差e。
4.根据权利要求1所述的一种多MEMS传感器组合测姿方法,其特征在于,所述步骤(3)中,所述的将四组MEMS传感器系统误差e分别作为两组模糊控制器和两组PI控制器的输入参数,将两组模糊控制器和两组PI控制器的输出参数u作为互补滤波器的输入参数,以修正陀螺仪的角速度输出。
5.根据权利要求1所述的一种多MEMS传感器组合测姿方法,其特征在于,所述步骤(4)的具体过程为:
通过两组模糊控制器与两组PI控制器调节,互补滤波修正后得到的角速度 采用四阶龙格库塔算法得到四元数微分方程的解,进行归一化处理后,即单位化,得到新的四元数矩阵 进而转换成姿态角,四元数转化姿态角俯仰角θ=-arcsin2(q1q3-q0q2),横滚角航向角
6.根据权利要求1所述的一种多MEMS传感器组合测姿方法,其特征在于,在所述步骤(3)中,所述的利用互补滤波原理修正陀螺仪漂移误差的具体方法包括以下步骤:
(3-1)将两组模糊控制器都是选用二维模糊控制器,其的输入误差A,误差变化率B以及输出C论域为[-6,6],[-6,6],[-3,3];模糊集均为{NB,NM,NS,ZO,PS,PM,PB},模糊推理语句选用“If A and B then C”蕴含关系为A∧B→C;根据关系矩阵R得出输出量,关系矩阵R为A和B向量积的列转置与C合成;选用三角形隶属函数trimf(x,[a,b,c]);选择Mamdani模糊系统进行推理;反模糊化选用面积重心法centroid,两组PI控制器相应参数设置为P为2,I为
0.02;
(3-2)将模糊控制器构造好以及PI控制器相应参数设置好后,将四组MEMS传感器的系统误差分别作为两组模糊控制器和两组PI控制器的输入量,即将第一组传感器和第二组传
1 2
感器的系统误差e和e 作为两组模糊控制器的输入量,第三组传感器和第四组传感器的系统误差e3和e4作为两组PI控制器的输入量;
(3-3)将两组模糊控制器和两组PI控制器的输出参数u1,u2,u3,u4,作为互补滤波的输入参数,得到四组修正后的角速度 通过均值法得到载体的角速度
标题 | 发布/更新时间 | 阅读量 |
---|---|---|
一种双发油动变桨距多旋翼飞行器的飞行控制方法 | 2020-05-12 | 840 |
性能退化产品可靠度置信区间估计数值仿真方法 | 2020-05-12 | 535 |
一种电连接器加速退化试验方案优化方法 | 2020-05-12 | 9 |
一种基于行为的室内定位和地标语义标识的方法 | 2020-05-14 | 204 |
一种基于轨道交通车辆轮对寿命统计学模型的镟修方法 | 2020-05-14 | 521 |
一种行人导航定位中的自适应零速修正方法 | 2020-05-08 | 167 |
毫米波雷达成像与模式识别 | 2020-05-14 | 843 |
基于OpenStreetMap的高空间分辨率遥感影像迁移学习分类方法 | 2020-05-15 | 984 |
一种基于高光谱成像技术的烟草非烟物质分类方法 | 2020-05-16 | 644 |
融合卡尔曼和小波的MEMS陀螺仪自适应抗野值去噪方法 | 2020-05-11 | 948 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。