发明名称 基于巨磁阻传感器的地磁方位角测量系统、测量方法及正交补偿方法
摘要 本发明公开一种基于巨磁阻传感器的地磁方位角测量系统、测量方法及正交补偿方法,从而实现对地磁方位角的全方位测量,减小由于三轴传感器非正交及零位偏差引起的测量误差。该测量系统,由地三轴磁测量模块、三轴姿态测量模块、温度测量模块、微处理器及上位机组成。本发明涉及到智能传感器技术、数字信号处理等技术领域。本发明针对巨磁阻传感器进行方位角测量时,由于数学模型导致方位角测量的多值问题,提出了一种以三轴加速度传感器为基础的智能卦限判别法,从而实现基于巨磁阻传感器的全方位角测量。同时,针对巨磁阻传感器三轴非正交及零位偏差导致的测量误差,提出了一种在微处理器内部完成的三轴正交及零位补偿方法,进而提高测量系统的测量精度。另外本发明还具有开发成本低、硬件电路简单等特点。
申请公布号 CN102313543B 申请公布日期 2013.07.17
申请号 CN201110192080.1 申请日期 2011.07.11
申请人 上海大学 发明人 付敬奇;郑学理
分类号 G01C17/30(2006.01)I;G01C17/38(2006.01)I 主分类号 G01C17/30(2006.01)I
代理机构 上海上大专利事务所(普通合伙) 31205 代理人 何文欣
主权项 1.一种基于巨磁阻传感器的地磁方位角测量方法,采用的测量系统的结构为:由电源模块(1)、地磁测量模块(2)、姿态测量模块(3)、温度测量模块(4)、微处理器(5)和上位机(6)组成,其特征在于,所述电源模块(1)为系统提供3.3V稳定电源;所述地磁测量模块(2)包括X轴、Y轴和Z轴巨磁阻传感器及对应每轴上的信号处理电路;所述姿态测量模块(3)包括相互正交的X、Y、Z三轴加速度传感器;所述地磁测量模块(2)连接至微处理器(5)A/D采样口;所述姿态测量模块(3)和温度测量模块(4)分别连接至微处理器(5)的数字IO口;所述微处理器(5)经RS232口连接至上位机(6);所述电源模块(1)采用电压转换芯片1117;所述地磁测量模块(2)采用三轴巨磁阻传感器AAH002-02连接RC低通滤波电路及仪用运放INA118;所述姿态测量模块(3)采用三轴加速度传感器ADXL345;所述温度测量模块(4)采用温度传感器DSB18B20;所述微处理器(5)采用微处理器MSP430F149,对地磁信息、俯仰信息和温度信息进行预处理后,通过上位机(6)处理后得到地磁方位角进行测量,其特征在于该方法的具体操作步骤如下:(1)系统初始化;(2)数据采集,采集地磁测量模块中地磁场在X、Y、Z三轴上的磁场分量<img file="2011101920801100001DEST_PATH_IMAGE001.GIF" wi="112" he="25" />,姿态测量模块中X、Y、Z三轴上的加速度分量Ax 、Ay、Az及温度测量模块中的温度数据;(3)利用姿态数据运算出单值唯一的俯仰角<img file="2011101920801100001DEST_PATH_IMAGE002.GIF" wi="14" he="19" />和横滚角<img file="2011101920801100001DEST_PATH_IMAGE003.GIF" wi="14" he="20" />,并结合地磁数据<img file="522793DEST_PATH_IMAGE001.GIF" wi="112" he="25" />,通过式<img file="2011101920801100001DEST_PATH_IMAGE004.GIF" wi="361" he="46" />进行地磁方位角<img file="DEST_PATH_IMAGE005.GIF" wi="27" he="23" />的全方位计算;(4)输出地磁方位角<img file="564567DEST_PATH_IMAGE005.GIF" wi="27" he="23" />;所述步骤(3)中,方位角<img file="344304DEST_PATH_IMAGE005.GIF" wi="27" he="23" />需要进行全方位判定,具体步骤如下:<img file="2011101920801100001DEST_PATH_IMAGE006.GIF" wi="21" he="42" />微处理器(5)将三轴加速度传感器测得的加速度分量Ax 、Ay带入等式<img file="DEST_PATH_IMAGE007.GIF" wi="210" he="26" />计算俯仰角<img file="422070DEST_PATH_IMAGE002.GIF" wi="14" he="19" />和横滚角<img file="174125DEST_PATH_IMAGE003.GIF" wi="14" he="20" />;<img file="DEST_PATH_IMAGE008.GIF" wi="21" he="42" />微处理器(5)通过对Ax、Ay、Az大于0、小于0、等于0、等于g、等于-g这5种情况进行组合判别,最终实现对俯仰角<img file="183538DEST_PATH_IMAGE002.GIF" wi="14" he="19" />和横滚角<img file="450572DEST_PATH_IMAGE003.GIF" wi="14" he="20" />全方位判定;具体步骤如下:当<img file="668077DEST_PATH_IMAGE002.GIF" wi="461" he="26" />;当<img file="3243DEST_PATH_IMAGE004.GIF" wi="461" he="26" />;当<img file="669848DEST_PATH_IMAGE006.GIF" wi="461" he="26" />;当<img file="748662DEST_PATH_IMAGE008.GIF" wi="461" he="26" />;当<img file="246640DEST_PATH_IMAGE010.GIF" wi="401" he="25" />;当<img file="955970DEST_PATH_IMAGE012.GIF" wi="405" he="25" />;当<img file="906608DEST_PATH_IMAGE014.GIF" wi="414" he="25" />;当<img file="726797DEST_PATH_IMAGE016.GIF" wi="392" he="25" />;当<img file="79281DEST_PATH_IMAGE018.GIF" wi="441" he="26" />;当<img file="21829DEST_PATH_IMAGE020.GIF" wi="417" he="26" />;当<img file="397446DEST_PATH_IMAGE022.GIF" wi="406" he="26" />;当<img file="818063DEST_PATH_IMAGE024.GIF" wi="360" he="25" />;<img file="DEST_PATH_IMAGE009.GIF" wi="21" he="42" />定义水平地磁分量为<img file="DEST_PATH_IMAGE010.GIF" wi="74" he="24" />,根据姿态矩阵及步骤<img file="587155DEST_PATH_IMAGE008.GIF" wi="21" he="42" />中得出的俯仰角<img file="944449DEST_PATH_IMAGE002.GIF" wi="14" he="19" />和横滚角<img file="937813DEST_PATH_IMAGE003.GIF" wi="14" he="20" />,解出<img file="692142DEST_PATH_IMAGE010.GIF" wi="74" he="24" />;令<img file="DEST_PATH_IMAGE011.GIF" wi="225" he="52" />通过下面的判别实现方位角<img file="366837DEST_PATH_IMAGE005.GIF" wi="27" he="23" />的全方位判定;<img file="DEST_PATH_IMAGE012.GIF" wi="274" he="25" /><img file="DEST_PATH_IMAGE013.GIF" wi="312" he="26" /><img file="DEST_PATH_IMAGE014.GIF" wi="320" he="26" /><img file="DEST_PATH_IMAGE015.GIF" wi="321" he="26" />;所述地磁测量模块(2)中巨磁阻传感器三轴非正交及存在零位偏差的三轴正交及零位补偿方法为:定义巨磁阻传感器三个轴向上实际坐标ox3y3z3及理想坐标OX3Y3Z3输出的磁场量分别为<img file="DEST_PATH_IMAGE016.GIF" wi="104" he="25" />和<img file="14856DEST_PATH_IMAGE001.GIF" wi="112" he="25" />;oy3与其在面OY3Z3上投影的夹角为<img file="DEST_PATH_IMAGE017.GIF" wi="20" he="24" />,其投影与OY3的夹角为<img file="DEST_PATH_IMAGE018.GIF" wi="21" he="24" />;oz3与其在面OX3Z3上投影的夹角为<img file="DEST_PATH_IMAGE019.GIF" wi="21" he="25" />,其投影与OZ3的夹角为<img file="DEST_PATH_IMAGE020.GIF" wi="21" he="24" />;令巨磁阻传感器三轴上的零位误差分别为<img file="DEST_PATH_IMAGE021.GIF" wi="79" he="25" />;定义<img file="DEST_PATH_IMAGE022.GIF" wi="78" he="25" />可分别为实际及理想输出的磁场值及零偏值的向量形式,可得:<img file="DEST_PATH_IMAGE023.GIF" wi="108" he="25" /><img file="DEST_PATH_IMAGE024.GIF" wi="394" he="25" /><img file="DEST_PATH_IMAGE025.GIF" wi="397" he="25" />其中,令<img file="DEST_PATH_IMAGE026.GIF" wi="329" he="76" />则有<img file="DEST_PATH_IMAGE027.GIF" wi="94" he="25" />,所以可以计算出三轴正交及零位补偿模型<img file="DEST_PATH_IMAGE028.GIF" wi="118" he="26" />,其具体步骤如下: (1)在标定台上经多次标定后,计算出补偿矩阵<img file="DEST_PATH_IMAGE029.GIF" wi="54" he="22" />;(2)将模型<img file="821532DEST_PATH_IMAGE028.GIF" wi="118" he="26" />计算写入微处理器中;(3)每次测量数据<img file="63157DEST_PATH_IMAGE016.GIF" wi="104" he="25" />,在微处理器中经模型<img file="338281DEST_PATH_IMAGE028.GIF" wi="118" he="26" />处理后输出理想地磁数据<img file="168702DEST_PATH_IMAGE001.GIF" wi="112" he="25" />。
地址 200444 上海市宝山区上大路99号
您可能感兴趣的专利