专利名称：补偿地磁传感器姿态误差的设备和方法
技术领域：
本发明涉及一种通过使用双轴地磁传感器和倾角仪所得到的地磁场的相关信息，补偿地磁传感器的姿态误差，由此而计算出精确的方位信息的测量设备和计算方法。
背景技术：
到目前为止，已经出现大量从事通过使用地磁传感器如磁通量闸门，来计算在自由空间移动中的交通工具或传感�？榈姆轿恍畔⒌姆椒ê蜕璞傅难芯�。然而，磁通量闸门因其昂贵的价格以及庞大的体积，仅应用在航海领域。
最近，小型并且低成本的地磁传感器�？橐丫玫椒⒄梗乇鸬兀孀臡EMS技术的发展，芯片型地磁传感器已经得到发展并应用到需要方位信息的各种驾驶领域。然而，在地磁传感器�？椴荒芩椒胖玫挠τ昧煊蛑校鐾ü卮糯衅魑薹ǖ玫骄返姆轿恍畔ⅰ�
地磁传感器一般是一种测量地磁场强度的设备，它仅在地磁场磁力线矢量平行于用于测量该磁力线矢量的传感器的测量轴矢量时，才能精确测量地磁场强度。在此情况下，在其中坐标轴彼此以右旋法则正交排列的双轴传感器被水平放置形成传感器�？橹螅纱衅髂？橹甘镜姆轿唤鞘褂昧酱衅鞯氖涑霰患扑恪�
然而，如果地磁传感器�？槊挥斜３炙剑蛭薹ň凡饬康卮懦∏慷龋耸钡姆轿恍畔⒅谢岚泻艽蟮奈蟛�。随后，需要根据姿态补偿误差，由于此原因，使用为测量姿态的三轴地磁传感器和倾角仪执行通过坐标变换的误差补偿。
随着小型化地磁传感器的发展，姿态误差补偿技术扩展到运动、多媒体、游戏机等应用领域上。
然而，由于传感器安装位置的问题，在使用双轴地磁传感器时，误差不能仅通过已发展的误差补偿技术得到补偿，因此计算出的方位角根据姿态的尺寸增加误差。
发明内容
本发明的目的在于至少解决前述的相关问题和/或弊端，并且至少提供下文所描述的优点。
本发明的另外一个目的在于提供通过补偿双轴地磁传感器姿态误差，来计算精确的方位信息的设备和方法。在双轴地磁传感器安放在需要方位信息的设备(例如，航海系统，游戏机，PDA，蜂窝电话等)中在情况下，根据本发明的该设备和方法使用双轴倾角仪计算姿态信息，然后根据该地磁传感器的姿态补偿误差以得到精确的方位信息。
为完成前述问题和/或本发明的其他特性，提供了计算方位角的设备，包括安放在需要方位信息的设备中以测量地磁场强度的双轴地磁传感器；提供姿态信息(例如旋转角和倾斜角)的双轴倾角仪；过滤传感器测量到的信号并将其转换为数字值的信号调节单元；通过地磁传感器和倾角仪所输出的测量地磁场强度，计算方位角的微处理器；显示计算出的方位信息的LCD�？椋淮湮⒋砥鞔淼母杏π藕乓约凹扑愠龅姆轿恍畔⒌拇型ㄐ沤涌凇�
本发明的另外一个方面在于提供计算方位角的方法，其包括步骤使用微处理器中的内部定时器设置数据输出周期；把传感器感应的模拟值转换为数字值；将转换后的感应数据保存在微处理器的寄存器中；使用倾角仪数据计算坐标变换矩阵；生成虚拟的Z轴地磁数据；基于使用三轴地磁数据(即双轴地磁传感器数据加上单轴虚拟传感器数据)以及坐标转换矩阵计算水平坐标系统计算地磁数据；使用算出的数据计算出方位角，并且如果由于内部定时器输出周期设置的原因中断定时器，通过串行通信把传感器数据和计算出的方位角数据传输到外部系统并在LCD模块显示传感器数据和计算出的方位数据。
得到的将地磁传感器数据转换到水平坐标系统的坐标转换矩阵的算法，其包括通过用比例因子(scale factor)与倾斜角数据相乘将存储在微处理器内部寄存器的倾角仪数据单元转换到SI单元，使用转换的倾角仪数据计算出姿态，使用计算出的姿态值计算坐标变换矩阵。
用于在使用双轴地磁传感器时生成虚拟Z轴地磁数据的算法，其包括当地磁传感器垂直指向地表的向下方向时设置地磁数据，使用计算出的姿态信息以及X轴和Y轴的地磁数据生成虚拟Z轴地磁数据。
本发明的前述目的以及其他优点通过对优选实施方案的详细描述中变得更为明显，其中附图如下图1是根据本发明的说明通过双轴地磁传感器产生的姿态补偿误差计算方位角的方法的示意图；图2是根据本发明的双轴地磁传感器和姿态误差补偿设备的结构示意图；图3是根据本发明的安装在双轴地磁传感器和姿态误差补偿设备中的微处理器操作的流程图；图4是根据本发明的使用倾角仪计算出的姿态试验结果的曲线图；图5是说明使用双轴地磁传感器和倾角仪计算出虚拟Z轴地磁数据的试验结果的曲线图；和图6是说明使用双轴地磁传感器和倾角仪计算出方位角的试验结果的曲线图。
具体实施例方式
现在，将参照附图，详细描述根据本发明优选实施例的计算方位角的设备和方法，在附图中相同的附图标记指代相同的部件。
图1是根据本发明的说明通过双轴地磁传感器产生的姿态补偿误差计算方位角的方法的示意图。该方法包括双轴地磁传感器101、倾角仪102、姿态(即坐标)变换矩阵103、虚拟Z轴地磁数据的生成104、地磁数据坐标的转换105和方位角的计算106。
地磁传感器101可以是磁通量闸门传感器或磁阻(MagnetoResistive，MR)，用于测量地磁场强度，且包括具有在传感器�？榍跋蚍较蛏系腦轴和在与X轴向右成90°方向上的Y轴的双轴传感器。
倾角仪102测量传感器101的相对于地表的倾斜角，加速计可以被用作倾角仪。在加速计仅测量静止重力加速度时，可以被用作倾角计，根据使用按正确角度放置的双轴或三轴�？榈淖颂ü饬坎煌矫娴募铀俣饶芄患扑阕颂畔�。在使用双轴加速计时，通过公式1a和1b测量加速度，并通过公式2a和2b计算姿态。
ax＝g·sin θ (1a)ay＝g·sinφ (1b)φ＝sin-1(ay/g) (2a)θ＝sin-1(ax/g) (2b)其中，ax和ay是X轴和Y轴加速计的输出值，g是重力加速度，φ和θ分别是旋转角和倾斜角。
坐标变换矩阵103用于将地磁传感器数据转换为水平坐标系统，并由使用倾角仪102的输出值计算出的姿态信息如下构成。
Cbh=cosθsinθsinφsinθcosφ0cosφ-sinφ-sinθcosθsinφcosθcosφ----(3)]]>虚拟Z轴地磁数据104对双轴地磁传感器的姿态误差补偿是必需的，使用地磁传感器的两个输出和前述计算出的姿态信息进行如下计算Zjg=Zh+Xjgsinθ-Yjgsinφcosθcosφcosθ---(4)]]>其中，Zh是当地磁传感器的测量轴指向地表垂直向下的方向时由设备首次测量的地磁场强度。
由地磁传感器数据到水平坐标系统的坐标变换105，如下实现XhYhZh=CbhXjgYjgZjg----(5)]]>其中，[XjgYjgZjg]T为地磁传感器数据。
通过使用转换为水平坐标系统的地磁数据坐标得出方位计算106，实现如下φ＝tan-1(Yh/Xh)(6)图2是说明为实现图1功能的双轴地磁传感器结构的接口结构的示意图。该接口包括双轴地磁传感器201、倾角计202、信号调节单元203、微处理器204、LCD�？�205和串行通信接口206。
信号调节单元203包括用于消除电源噪声和高频噪声的低通滤波器，把模拟传感器信号转换为数字值的模/数(A/D)转换()器。信号调节单元203必需在传感器信号输入微处理器204之前对其进行处理。
微处理器204包括用于存储从A/D转换器203输出的传感器信号的寄存器、用于补偿地磁传感器姿态误差和计算方位信息的ALU(算术逻辑部件)和FPU(浮点部件)、用于设定将传感器数据和计算出的方位信息传输到LCD�？楹屯馍璧氖涑鲋芷诘哪诓渴敝�。
LCD�？�205显示从微处理器204输出的方位信息，以便用户能识别出具有水平放置的地磁传感器�？樯璞傅姆轿唤�。
串行通信接口206用于传输从微处理器204输出到外设的传感器数据和方位信息，其可采用同步串行通信或者异步串行通信的类型。
图3是根据本发明的安装在双轴地磁传感器和姿态误差补偿设备中的微处理器操作的流程图。
首先，为了传输双轴地磁传感器201和倾角仪202的输出值与最终计算出的方位信息到外部系统，使用安装在微处理器204上的内部定时器设定数据输出周期(步骤301)。
为把地磁传感器201和倾角仪202的输出值转换为数字值，产生A/D转换控制信号(步骤302)，然后在内部寄存器存储转换后的传感器数据(步骤303)。
使用在存储的传感器数据中的倾角仪数据，通过公式2a和2b计算出传感器�？榈淖颂�(步骤304)。使用此计算出的姿态，通过公式3计算出坐标变换矩阵(步骤305)。
使用计算出的姿态和存储在内部寄存器的地磁传感器数据，通过公式4生成虚拟Z轴地磁数据(步骤306)。
使用计算出的坐标变换矩阵通过公式5将三轴地磁数据(即双轴地磁传感器数据+单轴计算出的虚拟Z轴地磁数据)转换为水平坐标系统内的地磁场范围的强度(步骤307)。使用此转换后的数据，通过公式6计算方位角(步骤308)。
通过在内部定时器内设定的数据输出周期检查是否生成中断(步骤309)。
如果检查出未生成定时器中断，当前步骤返回前面把传感器数据转换为数字值的步骤302，以重复执行步骤302。同时，如果检查出生成定时器中断(步骤309)，通过串行通信把前述计算出的方位信息和传感器数据传输到外部系统(步骤310)，并输出到LCD�？榻邢允�(步骤311)。然后，操作返回把传感器数据转化为数字值的步骤302，并且重复后面的步骤直到下一定时器中断生成。
图4是根据本发明使用倾角仪202通过公式2计算出的姿态试验结果的曲线图。
图5是说明通过公式4计算出的虚拟Z轴地磁数据的实验结果与三轴地磁传感器Z轴的比较图。图5中，虚线代表三轴地磁传感器Z轴，实线代表通过等式4计算出的虚拟Z轴地磁数据。可以看出，随着通过公式4计算出的随姿态改变而变化的Z轴地磁数据更为精确。
图6是说明使用生成的虚拟Z轴地磁数据通过等式5和等式6计算出的方位角的试验结果和双轴地磁传感器的输出结果以及姿态改变时计算出的坐标变换矩阵的示意图。虚线代表补偿前的方位角，可以看出方位角有很大的变化，实线代表补偿后的方位角，可以看出方位角仅在方位角的变化很小的误差范围内有改变。
根据本发明所述的通过地磁传感器姿态误差补偿来计算方位角的设备，使用双轴地磁传感器和双轴倾角仪向用户提供方位角信息以克服地磁传感器�？榈募际蹙窒蓿瞿？橛Ω檬褂孟钟械娜岬卮糯衅骱颓憬且恰�
本发明可以方便的应用在需要方位信息的领域。例如，当使用存储在PDA的电子地图需要确定用户的朝向时，可以识别用户当前的精确方位角并随之在PDA的LCD显示出相应地旋转的地图，以便用户能方便的决定他/她的朝向。
同样地，本发明通过游戏机的姿态附加游戏机旋转方向的信息而使三维游戏的实施更加容易，此外也可用于虚拟现实的数据输入设备中。
虽然本发明已经进行了详细的描述，但应该理解可以在不脱离所附的权利要求中涉及的范围而进行多种改变、替代和变更。
权利要求
1.一种计算方位角的设备，包括双轴地磁传感器，安装在需要方位信息的设备中，用于如果所述设备移动时，根据方位信息测量地磁场强度；倾角仪，用于测量诸如旋转和倾斜角等姿态；模数转换器，用于将传感器数据转换为数字值；微处理器，用于使用双轴地磁传感器和倾角仪的输出补偿姿态误差来计算方位信息；串行通信接口，用于传输由微处理器的处理数据；以及LCD�？椋糜谙允居晌⒋砥骷扑愠龅姆轿恍畔�。
2.一种用于补偿双轴地磁传感器姿态误差的设备，该设备在使用双轴倾角仪时，使用倾角仪的输出计算姿态，并通过补偿双轴地磁传感器的姿态误差来计算方位信息。
3.一种计算方位角的方法，包括第一步骤，使用安装在微处理器上的内部定时器设置数据输出周期；第二步骤，使用模数转换器将传感器所感应的模拟值转换为数字值；第三步骤，把转换后的传感器数据存储在微处理器的内部寄存器中；第四步骤，使用倾角仪数据计算出姿态并得出坐标变换矩阵；第五步骤，在使用双轴地磁传感器时生成虚拟Z轴地磁数据；第六步骤，使用三轴地磁数据和坐标变换矩阵来计算水平坐标系统上的地磁数据，其中，所述三轴地磁数据为双轴地磁传感器数据加单轴虚拟传感器数据；第七步骤，使用计算的数据计算方位角；以及第八步骤，如果由于内部定时器设定的输出周期而产生定时器中断，则通过串行通信把传感器数据和计算出的方位数据传输到外部系统，并在LCD模块上显示出传感器数据和计算出的方位数据。
4.根据权利要求3所述的方法，其中生成虚拟Z轴地磁数据的算法包括第一步骤，当地磁传感器的测量轴指向地表垂直向下的方向时，通过试验测量所测量的地磁场强度；第二步骤，使用倾角仪输出计算姿态；第三步骤，使用双轴地磁传感器测量在传感器�？閄轴和Y轴方向上的地磁场感应强度，其中，所述X轴方向为前向，所述Y轴方向为右向；以及第四步骤，使用传感器�？樗扑愕淖颂退岬卮糯衅鞯氖涑鲋瞪尚槟鈀轴地磁数据。
5.根据权利要求4所述的方法，其中水平坐标系统中计算地磁数据的算法包括第一步骤，使用通过倾角仪的输出计算的姿态来计算坐标变换矩阵；第二步骤，通过把生成的Z轴地磁数据和测量的X轴和Y轴地磁数据与计算出的坐标变换矩阵进行相乘来计算水平坐标系统的地磁数据。
6.根据权利要求5的方法，其中使用双轴地磁传感器计算方位信息的算法包括第一步骤，使用倾角仪计算姿态，并得出坐标变换矩阵；第二步骤，生成虚拟Z轴地磁数据；第三步骤，在水平坐标系统上生成地磁数据；以及第四步骤，使用水平坐标系统中地磁数据的X轴和Y轴数据计算方位角。
全文摘要
公开了一种在使用双轴地磁传感器计算方位信息时，根据姿态(旋转角与倾斜角)使用倾角仪补偿地磁传感器输出变化的设备和方法。使用倾角仪测量地磁传感器�？榈淖颂扑愠霭蚜⑻遄晗低匙晃阶晗低车淖瓯浠痪卣�。使用双轴地磁传感器的输出和计算出的姿态信息生成地磁传感器模块的当前姿态的Z轴方向的虚拟地磁数据。在将生成的Z轴地磁数据和测量X轴与Y轴地磁数据被转换到水平坐标系统后，认为计算出的方位角为地磁传感器�？榈姆轿唤恰�
文档编号G01C17/38GK1501050SQ0312554
公开日2004年6月2日 申请日期2003年8月4日 优先权日2002年8月6日
发明者崔相彦, 曹宇钟, 李宇钟, 朴赞国, 赵星闰 申请人:朴赞国, 三星电子株式会社
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
