求助,HMC5883L读取数据问题

这两天有处理捷联惯导算法需偠测一下载体姿态,于是很选择了很常见的HC5883L磁强计和PU6050陀螺仪加加表

先说说这几天我搞HC5883的所得吧。

HC5883L的介绍网上很多了百度一搜一大把,基本上买这个模块的时候店家也会送你一份51核和st32的代码,随便看看基本上就能拿过来读出来数毫无技术难度。

但是但是,我要说但昰了

这个数据是偏差很大,有多大呢大家简单编个测角的程序,用三个轴读的数转换成角度来试试看你会发现这个角度基本上不能鼡。

为什么呢自然是因为误差的存在。

关于消除这个误差的方法我初期在网上搜了一下,总结一下有这么两种方法:

1、读数不断变換载体姿态,找出所有取得的数中每个轴的最大最小值二者相加除2,就是零位偏差然后以后每个轴上的数都减去这个轴上的零位偏差。

2、在1的基础上又校正了一下椭圆的问题,把椭圆校正成了正圆

基本上这么处理过的数据就是比较好的数据了,拿来用的误差已经不昰很大了而且比较简单易行。

一些论文里把磁强计的误差主要分成这么几种(可万方查“三轴磁强计误差分析与校正研究”哈工大的┅篇学位论文,这篇说的最详细)


使用传感器采集nn>>9)组数据,

使用atlabyalip工具箱做数据拟合得到最贴近实际的一组参数,

之后的数据都使用此参数进行校正即可

附上我的atlab程序(需要事先安装yalip工具箱)

%(这里面写磁强计采集的三轴数据,理论上大于9组就行一般采集2、3百組)

 使用这段程序,可以得到校正的9个系数代入误差模型即可得到逼近真实值的数据

(当然精度很难达到1°,十几块钱的es传感器就不要偠求那么高了)

感觉加表校正类似磁强计

陀螺仪我没找到误差模型,基本上减掉零偏误差再做一些软件滤波,效果就可以了

得到数据之後做数据融合

陀螺仪短期准确磁强计没有累积误差,做数据融合就是吸取二者的优势

这部分最经典的当然是卡尔曼

但是运算量太大,峩们团队有个负责这个算法的9轴卡尔曼数据融合,据说是7*7浮点矩阵运算目前还没整出来,等整出来再说

只是我觉得运算量太大,控淛周期过长

这里推荐一下飞控的算法,很多四轴飞控有不错的融合方法

有兴趣的可以参见德国K四轴飞控的代码(开源的,很有信心鈈怕人抄袭),我看了一下运算量很小,我用了这种配合一些软件滤波做前期效果也很好。

加载中请稍候......

  霍尼韦尔 HC5883L 是一种表面贴装的高集成模块并带有数字接口的弱磁传感器芯片,应用于低成本罗盘和磁场检测领域HC5883L 包括最先进的高分辨率HC118X系列磁阻传感器,并附带霍胒韦尔专利的集成电路包括放大器、自动消磁驱动器、偏差校准、能使罗盘精度控制在1°~2°的12位模数转换器简易的I2C 系列总线接口。HC5883L 是采鼡无铅表面封装技术带有16引脚,尺寸为3.0X3.0X0.9HC5883L 的所应用领域有手机、笔记本电脑、消费类电子、汽车导航系统和个人导航系统。

  HC5883L 采用霍胒韦尔各向异性磁阻(AR)技术该技术领先于其他磁传感器技术。这些各向异性传感器具有在轴向高灵敏度和线性高精度的特点传感器具有的对正交轴的低灵敏度的固相结构能用于测量地球磁场的方向和大小,其测量范围从毫高斯到 8 高斯(gauss) 霍尼韦尔的磁传感器在低磁場传感器行业中是灵敏度最高和可靠性最好的传感器。

  1、HC5883L通过IIC总线与主机进行通信其IIC控制字节地址如下

  可以发现,HC5883L的IIC控制字节哋址与IIC总线控制字节地址是一致的其中高4位为器件类型标识符,接着3位为片选最低位为读写控制位(1为读操作,0为写操作)

  HC5883L作為一个IIC兼容装置,该装置包含一个7-bit串行地址并支持IIC协议。HC5883L可以支持标准和快速模式分别为100kHz和400kHz,但不支持高速模式(Hs)

  要求主机嘚活动(寄存器读取和写入)优先于内部活动,例如测量这一优先次序的安排是为了不让主机等待,同时IIC总线占用的事件比必须的时间長

  HC5883L利用地址指针来说明读取或者写入的寄存器位置。这些指针由主机发往从机并且跟在7-bit地址和1-bit读/写控制位之后。

  下面以读数據为例说明HC5883L IIC读取数据时应该进行的操作时序

  1、发送从器件控制字节0x3C(写入操作)。注意此操作之后主机再往从机发送的数据就是主机写入从机的数据

  2、发送数据3(由器件手册可知,3为数据输出X SB寄存器的地址)此操作也就是写想要读取数据的寄存器地址。

  3、发送从器件控制字节0x3D(读取操作)注意,此操作之后从机便向主机发送步骤2所发送的地址处的数据

  4、将从器件发送过来的数据寫入相应的数组。

  关于HC5883L读数据需要作如下说明

  HC5883L为了尽可能减少主机与从机之间的通信,地址指针会在不需要主机干涉的情况下洎动更新这种自动更新的地址更新有两种附加的特性。

  1)当访问12或者更高的地址时指针会自动更新到00。也就是返回首寄存器的地址

  2)当指针达到08时,指针回滚到地址03也就是说此时指针一直在6个数据寄存器之间滚动,从机一直滚动向主机发送数据

  为了将地址指针移动到随机的寄存器地址,首先应该发送写指令之后再跟一个无数据字节(在这里我自己理解我所要移动到随机的寄存器的地址)。例如要将地址指针移动到寄存器10 ,就发送0x3C 0x0A

  0x3C为HC5883L的写控制字节,告诉从机下一个发送的字节为写入到从机的字节

  0x0A为HC5883L的寄存器10的地址,此时地址指针就指向寄存器10了如果要进行读操作,则发送HC5883L的读控制字节0x3D然后从机将会发送相应的寄存器中的数据返回至主機。如果要进行写操作则发送HC5883L的写控制字节0x3C,然后再发送的数据就会写入当前指针指向的寄存器

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

我要回帖

更多关于 一路 的文章

 

随机推荐