ICode9

精准搜索请尝试: 精确搜索
首页 > 其他分享> 文章详细

匿名mahony互补滤波代码详解

2021-06-08 17:56:20  阅读:266  来源: 互联网

标签:载体 16 滤波 加速度 匿名 详解 ADC 传感器 mahony


下面是我对匿名源码修改整理后得到的代码,去掉了冗余便于讲解,此外给出了一些优化建议。
一、函数调用
在这里插入图片描述

二、Drv_Icm20602_Read()
在这里插入图片描述
读取16位ADC采样值

三、imu_origDataPrepare()
在这里插入图片描述
因为传感器安装角度和载体坐标系可能不一致,因此需要一个基础的坐标转换,最终得到x前、y右、z下的载体坐标系。

在这里插入图片描述
因为加速度计对高频抖动敏感,因此需要一个低通滤波器。陀螺仪加一个低通滤波无伤大雅。

在这里插入图片描述
当传感器不在载体中心时,载体旋转时传感器会有一个向心加速度,该加速度会被传感器测量出来,因此要去掉。

在这里插入图片描述
将16位ADC转换为物理单位值,对于该例程为±16g的加速度,

标签:载体,16,滤波,加速度,匿名,详解,ADC,传感器,mahony
来源: https://blog.51cto.com/u_15262460/2883189

本站声明: 1. iCode9 技术分享网(下文简称本站)提供的所有内容,仅供技术学习、探讨和分享;
2. 关于本站的所有留言、评论、转载及引用,纯属内容发起人的个人观点,与本站观点和立场无关;
3. 关于本站的所有言论和文字,纯属内容发起人的个人观点,与本站观点和立场无关;
4. 本站文章均是网友提供,不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属;如您发现该文章侵犯了您的权益,可联系我们第一时间进行删除;
5. 本站为非盈利性的个人网站,所有内容不会用来进行牟利,也不会利用任何形式的广告来间接获益,纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。

专注分享技术,共同学习,共同进步。侵权联系[81616952@qq.com]

Copyright (C)ICode9.com, All Rights Reserved.

ICode9版权所有