发帖

[问答]

如何在得到四元数之后进行卡尔曼滤波？

12973

问答对人有帮助，内容完整，我也想知道答案 0 用卡尔曼滤波处理四元数，以前用过单变量的卡尔曼滤波，但是这一次需要处理四个变量，有些不太清楚了，有做过的坛友指教一下原理和公式~~下面是我四元数的后半部分程序： // integrate quaternion rate and normalise q0 = q0 + (-q1gx - q2gy - q3gz)halfT; q1 = q1 + (q0gx + q2gz - q3gy)halfT; q2 = q2 + (q0gy - q1gz + q3gx)halfT; q3 = q3 + (q0gz + q1gy - q2gx)halfT; // normalise quaternion norm = invSqrt(q0q0 + q1q1 + q2q2 + q3q3); q0 = q0 * norm; q1 = q1 * norm; q2 = q2 * norm; q3 = q3 * norm; 复制代码这是单变量的卡尔曼滤波器： float KalmanGain;// 卡尔曼增益 float EstimateCovariance;//估计协方差 float MeasureCovariance;//测量协方差 float EstimateValue;//估计值 void KalmanFilterInit(void) { EstimateValue = 0; EstimateCovariance = 1; MeasureCovariance = 2; } float KalmanFilter(float Measure) { //计算卡尔曼增益 KalmanGain=EstimateCovariancesqrt(1/(EstimateCovarianceEstimateCovariance+MeasureCovarianceMeasureCovariance)); //计算本次滤波估计值 EstimateValue=EstimateValue+KalmanGain (Measure-EstimateValue); //更新估计协方差 EstimateCovariance=sqrt(1-KalmanGain) * EstimateCovariance; //更新测量方差 MeasureCovariance=sqrt(1-KalmanGain) * MeasureCovariance; //返回估计值 return EstimateValue; } 复制代码 1
2015-5-22 15:12:20　　评论淘帖0 邀请回答您可以邀请以下用户，快速回答问题 × richthoffen 该类别下有 182 个回答。邀请回答 7vyydyfwef 该类别下有 57 个回答。邀请回答我是卖报的小男孩该类别下有 32 个回答，其中被选为最佳答案 1 次。邀请回答 chenbingjy 该类别下有 31 个回答。邀请回答谦谦三君子该类别下有 27 个回答。邀请回答短短该类别下有 25 个回答。邀请回答 dingyang598 该类别下有 22 个回答，其中被选为最佳答案 1 次。邀请回答 nvuuweew 该类别下有 22 个回答。邀请回答 YY599566 该类别下有 22 个回答。邀请回答 h1654155957.9572 该类别下有 19 个回答。邀请回答 hapyy 该类别下有 19 个回答。邀请回答 60user16 该类别下有 19 个回答。邀请回答 HEHELA 该类别下有 18 个回答。邀请回答 DerSohn 该类别下有 18 个回答。邀请回答 huhu12 该类别下有 18 个回答。邀请回答 csz9981 该类别下有 15 个回答。邀请回答陈军该类别下有 15 个回答。邀请回答 dull20112011 该类别下有 15 个回答。邀请回答天地直方该类别下有 15 个回答。邀请回答罕井雅直该类别下有 14 个回答。邀请回答举报从未拥有相关推荐 • 请问四轴解算的卡尔曼滤波、互补滤波、四元数都是什么？ 3239 • 请问姿态解算用什么方法处理更好？ 2819 • 想学习labview的卡尔曼滤波，手上有陀螺仪跟MyRio 4710 • 卡尔曼滤波可以用于四轴的姿态数据处理吗？ 441 • 关于卡尔曼滤波的问题。（八百里加急般的急） 5566 • mikrokopter的滤波算法和卡尔曼滤波算法哪个更好？ 5474 • 卡尔曼滤波算法 3817 • 卡尔曼滤波 3037 • 请问卡尔曼滤波有什么用？ 2185 • 什么是卡尔曼滤波？具有哪些参数？ 1729 4个回答

答案对人有帮助，有参考价值 0 首先，你要把单变量要都变成矩阵。

2015-5-22 16:02:11 评论举报爱与友人

答案对人有帮助，有参考价值 0 我觉得要是单变量卡尔曼用起来的话，先把加速度做卡尔曼（我现在用的是20次滑动平均），在传入四元素里面融合，应该会有不少的提升。

2015-5-22 16:29:20 评论举报人走了

答案对人有帮助，有参考价值 0 人走了发表于 2015-5-22 16:29 我觉得要是单变量卡尔曼用起来的话，先把加速度做卡尔曼（我现在用的是20次滑动平均），在传入四元素里面融合，应该会有不少的提升。不要把卡尔曼和普通滤波混淆了。你对加速度做的只是个平均滤波，那可算不上卡尔曼。

2015-5-22 16:30:09 评论举报从未拥有

答案对人有帮助，有参考价值 0 从未拥有发表于 2015-5-22 16:30 不要把卡尔曼和普通滤波混淆了。你对加速度做的只是个平均滤波，那可算不上卡尔曼。是的，我说的是代替。单变量卡尔曼只能滤波不能融合。

2015-5-22 16:31:13 评论举报人走了

撰写答案

你正在撰写答案

如果你是对答案或其他答案精选点评或询问，请使用“评论”功能。

声明：本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人，不代表电子发烧友网立场。文章及其配图仅供工程师学习之用，如有内容图片侵权或者其他问题，请联系本站作侵删。侵权投诉

我要提问

精选推荐

STM32F405驱动DS1302时钟模块，输出时间错乱该怎么排查？

2797 浏览 2 评论
stm32f405rgt6驱动DS1302ZN出现时间错乱问题

2403 浏览 1 评论
stm32用fsmc读取ad7606采集数据，数据不变，只有开发版复位才更新数据

2276 浏览 0 评论
请问串口重映射后会修改GPIO的配置吗？

2388 浏览 1 评论
STM32 驱动 INA226 测量电流电压功率

1637 浏览 1 评论

快速回复 返回顶部 返回列表

关注微信公众号

电子发烧友网

电子发烧友论坛

社区合作: 刘勇; 联系电话：15994832713; 邮箱地址：liuyong@huaqiu.com

社区管理: elecfans短短; 微信：elecfans_666; 邮箱：users@huaqiu.com

返回 STM32/STM8技术论坛

回复

关闭

站长推荐 /9

快速回复 返回顶部 返回列表

- 厂商专区: 飞凌嵌入式

瑞萨单片机论坛

米尔电子

Aigtek安泰电子

斯丹麦德电子

芯佰微电子

其利天下技术小组

道生物联技术社区

视美泰

FCom富士晶振

大大通

合众恒跃

进迭时空

RT-Thread论坛

EASY-EAI灵眸科技

- 技术社区: 张飞电子技术社区

KaihongOS技术社区

FPGA开发者技术社区

RISC-V MCU技术社区

HarmonyOS技术社区

- OpenHarmony开源社区: OpenHarmony开源社区

- 嵌入式论坛: ARM技术论坛

STM32/STM8技术论坛

嵌入式技术论坛

单片机/MCU论坛

RISC-V技术论坛

瑞芯微Rockchip开发者社区

FPGA|CPLD|ASIC论坛

DSP论坛

- 电路图及DIY: 电路设计论坛

DIY及创意

电子元器件论坛

专家问答

- 电源技术论坛: 电源技术论坛

无线充电技术

- 综合技术与应用: 机器人论坛

USB论坛

电机控制

模拟技术

音视频技术

综合技术交流

上位机软件（C/Python/Java等）

- 无线通信论坛: WIFI技术

蓝牙技术

天线|RF射频|微波|雷达技术

- EDA设计论坛: PCB设计论坛

DigiPCBA论坛

Protel|AD|DXP论坛

PADS技术论坛

Allegro论坛

multisim论坛

proteus论坛|仿真论坛

KiCad EDA 中文论坛

DFM|可制造性设计论坛

- 测试测量论坛: LabVIEW论坛

Matlab论坛

测试测量技术

传感技术

- 招聘/交友/外包/交易/杂谈: 项目外包

供需及二手交易

工程师杂谈|交友

招聘|求职|工程师职场

- 官方社区: 发烧友官方/活动

华秋商城

华秋电路

+ 元器件搜索引擎: 元器件搜索引擎

time

recommend

hot

post

—
—
—

版
块
导
航