联系方式:[email protected]
MPU9250包括三轴加速度计、三轴陀螺仪和三轴磁力计。因为加速度/磁力计具有高频噪声(需要低通滤波),将加速度/磁力计的信号看成是音频信号,它们的信号会有很多“毛刺“,也就是说它们的瞬时值不够精确,解算出来的姿态会震荡,但长期来看姿态方向是对的。而陀螺仪具有低频噪声(需要高通滤波),即每个时刻的得到的角速度是比较精确的,使用积分就能得到旋转角度(姿态),但是积分会累积误差,因此积分到后面姿态就不对了,也就是漂移现象。 加速度/磁力计和陀螺仪在频域上的特性互补,可以融合这三种传感器的数据,提高精度和系统的动态特性。
下图表示的是把传感器翻转90°一段时间后又翻转回来时,加速度/磁力计、陀螺仪以及融合传感信号,所求得的姿态信息:
然而对于原始的MPU9250来说,在进行姿态融合前需要对传感器进行校正等“预处理”。
如上图所示,要对MPU9250进行姿态融合/滤波,大体需要三个步骤:1、校正,2、坐标转换,3、滤波。其中前两步需要离线执行。下面详解这三个步骤。
按正常的情况来说,加速度传感器在静止状态(即只受重力作用),重力在各个姿态下,在三维空间中,向量顶点会落在一个球面上。但在IMU中,x,y,z轴的度量单位很大可能不相同,假设各轴之间相互直,各姿态重力点会落在一个椭球面上,椭球的中心也不一定在原点,这其实就是加速度的偏移量。
在磁力计上,由于测量磁场强度,在环境不变的情况下,传感器每个姿态感受磁场强度是相同的,所以不需要静止状态,磁力计测量的x,y,z轴值,在没有偏差且传感器内部x,y,z轴相互垂直的情况下,在三维空间中组成一个圆球面。但是磁力计存在Hard Iron Distortion和Soft Iron Distortion,使得x,y,z轴度量单位不相同,各轴也并非相互垂直,椭球球心也并非[0,0,0]坐标。
总的来说加速度/磁力计校正,需要求出椭球的球心(偏移量)、椭球轴长(各轴单位长度;其实磁力计不需要求,后面会解释。),即椭球拟合。
加速度计校正
磁力计校正
陀螺仪校正
陀螺仪不存在椭球的问题,因此可以直接从离线数据中找到静止状态下的数据,对数据求均值即可得到偏移量。
磁力计的基坐标系和加速度的基坐标系(我们以加速度的基坐标系作为世界坐标系)并不一定是一样的,比如加速度的基坐标系x轴指向东,磁力计的指向北。因此,需要将磁力计坐标系转换到加速度计坐标系,才能通过加速度/磁力计解算出正确的姿态。
假设加速度计测量到的重力加速度向量是 ug ,磁力计测量到的磁通量是 vm ,首先要将 vm 从椭球上投射到正球上,投射方程为 rm=Avm 。 rm 是投射后的向量, A 为
其次求出 rm 转换到加速度计坐标系的旋转矩阵 R ,得到
磁通量在世界坐标系下的x轴分量为0,重力加速度方向固定不变和z轴一致,通过向量点乘可以求出归一化后磁通量在世界坐标系下z轴的分量,再用模长公式求出y轴的分量。最后得到磁通量在世界坐标系下的向量 wm ,用于滤波时的校正。
在使用各种滤波方法(如高低通滤波,EKF,Mahony)做姿态融合时,可以基于欧拉角、方向余弦和四元数等方法。欧拉角在求解姿态时存在奇点(万向节锁),不能用于全姿态解算;方向余弦可用于全姿态解算但计算量大,不能满足实时性要求;四元数,计算量小,无奇点,满足实时解算。
所以这里使用的是基于四元数姿态融合,滤波方法包括高低通滤波、EKF、Mahony滤波。下面简单介绍这三种算法的大致思想:
高低通滤波
两个方程说明问题
Quaternion 是姿态融合后的四元数, gyroSensorQ 是陀螺仪测量到的角速度所代表的瞬时四元数, Quaternion(t)^ 是使用陀螺仪推算 t 时刻的估计姿态,
EKF
广义卡尔曼滤波,主要有两步:估算、校正。(公式和推导不详述)。
Mahony滤波
主要是使用了PI控制器思想(未深入,理解有偏差欢迎指出)。同样也分两步:估算、校正。
加速度计椭球拟合
上图更像一个球,但球心明显偏离
磁力计椭球拟合
同样球心明显偏离 [0,0,0] 。
四元数姿态估计
下图中第一到第四行分别是四元数4个值在使用各种方法估计姿态时的变化情况,第五行是角速度的变化情况。
可以看到,除了Gyro估计的姿态,其他三种滤波算法估算的姿态基本一样。
Matlab实验视频:
height="500" width="800" src="http://player.youku.com/embed/XMjgxOTUzMDE0NA==">
前面两个图是加速度计和磁力计的椭球拟合;后一个图是各姿态融合算法对比,可以看到陀螺仪估算的姿态随时间累积误差变大,加速度/磁力计估算的姿态有明显的抖动(高频噪声),其他三种姿态融合算法效果差别不大。
计算时间 Mahony < 高低通 < EKF
手机端姿态融合
属于实验室张欣博士师兄的成果,非本人的工作。
height="500" width="800" src="http://player.youku.com/embed/XMjUxMDM5Mjk0MA==">
蓝牙传输的数据为100Hz
计算所用的时间 : Mahony < 高低通 < EKF
致谢:以上工作由张欣师兄指导完成,感谢师兄!
文章浏览阅读2.5w次,点赞6次,收藏50次。官方解释是,docker 容器是机器上的沙盒进程,它与主机上的所有其他进程隔离。所以容器只是操作系统中被隔离开来的一个进程,所谓的容器化,其实也只是对操作系统进行欺骗的一种语法糖。_docker菜鸟教程
文章浏览阅读5.7k次,点赞3次,收藏14次。该如何避免的,今天小编给大家推荐两个下载Windows系统官方软件的资源网站,可以杜绝软件捆绑等行为。该站提供了丰富的Windows官方技术资源,比较重要的有MSDN技术资源文档库、官方工具和资源、应用程序、开发人员工具(Visual Studio 、SQLServer等等)、系统镜像、设计人员工具等。总的来说,这两个都是非常优秀的Windows系统镜像资源站,提供了丰富的Windows系统镜像资源,并且保证了资源的纯净和安全性,有需要的朋友可以去了解一下。这个非常实用的资源网站的创建者是国内的一个网友。_msdn我告诉你
文章浏览阅读1.2k次。vue2封装对话框el-dialog组件_
文章浏览阅读4.7k次,点赞5次,收藏6次。MFC 文本框换行 标签: it mfc 文本框1.将Multiline属性设置为True2.换行是使用"\r\n" (宽字符串为L"\r\n")3.如果需要编辑并且按Enter键换行,还要将 Want Return 设置为 True4.如果需要垂直滚动条的话将Vertical Scroll属性设置为True,需要水平滚动条的话将Horizontal Scroll属性设_c++ mfc同一框内输入二行怎么换行
文章浏览阅读832次。检查Linux是否是否开启所需端口,默认为6379,若未打开,将其开启:以root用户执行iptables -I INPUT -p tcp --dport 6379 -j ACCEPT如果还是未能解决,修改redis.conf,修改主机地址:bind 192.168.85.**;然后使用该配置文件,重新启动Redis服务./redis-server redis.conf..._redis-server doesn't support auth command or ismisconfigured. try
文章浏览阅读4.9k次。济大数电实验报告_数据选择器及其应用
文章浏览阅读236次。1研究内容消费在生产中占据十分重要的地位,是生产的最终目的和动力,是保持省内经济稳定快速发展的核心要素。预测河南省社会消费品零售总额,是进行宏观经济调控和消费体制改变创新的基础,是河南省内人民对美好的全面和谐社会的追求的要求,保持河南省经济稳定和可持续发展具有重要意义。本文建立灰色预测模型,利用MATLAB软件,预测出2019年~2023年河南省社会消费品零售总额预测值分别为21881...._灰色预测模型用什么软件
文章浏览阅读1.2k次。12.4-在Qt中使用Log4Qt输出Log文件,看这一篇就足够了一、为啥要使用第三方Log库,而不用平台自带的Log库二、Log4j系列库的功能介绍与基本概念三、Log4Qt库的基本介绍四、将Log4qt组装成为一个单独模块五、使用配置文件的方式配置Log4Qt六、使用代码的方式配置Log4Qt七、在Qt工程中引入Log4Qt库模块的方法八、获取示例中的源代码一、为啥要使用第三方Log库,而不用平台自带的Log库首先要说明的是,在平时开发和调试中开发平台自带的“打印输出”已经足够了。但_log4qt
文章浏览阅读786次。全局观思维模型,一个教我们由点到线,由线到面,再由面到体,不断的放大格局去思考问题的思维模型。_计算机中对于全局观的
文章浏览阅读330次。一、CountDownLatch介绍CountDownLatch采用减法计算;是一个同步辅助工具类和CyclicBarrier类功能类似,允许一个或多个线程等待,直到在其他线程中执行的一组操作完成。二、CountDownLatch俩种应用场景: 场景一:所有线程在等待开始信号(startSignal.await()),主流程发出开始信号通知,既执行startSignal.countDown()方法后;所有线程才开始执行;每个线程执行完发出做完信号,既执行do..._countdownluach于cyclicbarrier的用法
文章浏览阅读508次。Prometheus 算是一个全能型选手,原生支持容器监控,当然监控传统应用也不是吃干饭的,所以就是容器和非容器他都支持,所有的监控系统都具备这个流程,_-自动化监控系统prometheus&grafana实战
文章浏览阅读4.7k次。输入关键字,可以通过键盘的搜索按钮完成搜索功能。_react search