重力传感器的校准方法与流程

文档序号:17208420发布日期:2019-03-27 10:35阅读:3062来源:国知局
重力传感器的校准方法与流程

本发明涉及一种校准方法,且特别涉及一种重力传感器的校准方法。



背景技术:

随着信息科技的发达,电子装置的功能不断的增加,而电子装置内所需要的感测元件也不断增加。由于重力传感器可以判断电子装置的移动及转动,在众多应用中,重力传感器已是不可或缺的感测元件。然而,重力传感器安装于电子装置时,重力传感器的z轴与电子装置的z轴可能会有误差,造成感测结果不正确。因此,如何消除重力传感器的z轴与电子装置的z轴之间的误差则是设计电子装置的一个重要课题。



技术实现要素:

本发明提供一种重力传感器的校准方法,可使校准后的重力坐标确实表示电子装置的转动状态及/或位移状态。

本发明的重力传感器的校准方法,包括下列步骤。取得重力传感器所提供的初始重力坐标,其中初始重力坐标为装载重力传感器的电子装置平放于测试平台时所测得。基于z轴旋转初始重力坐标第一角度,使初始重力坐标于x轴及y轴的其中之一的分量为0,以取得平面坐标。基于分量为0的x轴或y轴旋转平面坐标第二角度,以使平面坐标于x轴及y轴的其中另一的分量为0。存储第一角度以及第二角度,以供重力传感器感测重力坐标时,依据第一角度及第二角度进行校准,以取得校准后重力坐标。

基于上述,本发明实施例的重力传感器的校准方法,会先算出重力传感器的坐标轴与电子装置的坐标轴之间的角度差,并且通过上述角度差旋转重力传感器的重力坐标,以取得校准后的重力坐标。由此,校准后的重力坐标可确实表示电子装置的转动状态及/或位移状态。

为让本发明的上述特征和优点能更明显易懂,下文特举实施例,并配合附图作详细说明如下。

附图说明

图1为依据本发明一实施例的电子装置的系统示意图;

图2a为依据本发明一实施例的初始重力坐标的校准示意图;

图2b为依据本发明一实施例重力坐标的校准示意图;

图3a为依据本发明另一实施例的初始重力坐标的校准示意图;

图3b为依据本发明另一实施例重力坐标的校准示意图;

图4为依据本发明一实施例的重力传感器的校准方法的流程图。

具体实施方式

图1为依据本发明一实施例的电子装置的系统示意图。请参照图1,在本实施例中,电子装置100包括重力传感器110、驱动电路120、存储器130及承载平台140,其中承载平台140可以是背板、电路板或电子装置100的壳体,但本发明实施例不以此为限。

重力传感器110安装于承载平台140,以提供重力坐标gxyz,其中重力坐标gxyz可用来计算电子装置100的转动状态及/或位移状态。在理想状态下,重力传感器110在水平且静止的平面上所感测的重力坐标gxyz仅会具有z轴分量(即,地心引力)。然而,重力传感器110与承载平台140可能无法完美结合,重力传感器110的坐标轴与电子装置100的坐标轴之间会有误差,而产生除了z轴外的分量。此时,驱动电路120会接收重力坐标gxyz,并且在初始化期间,驱动电路120会计算重力传感器110的坐标轴与电子装置100的坐标轴之间的角度差。

接着,驱动电路120将重力传感器110的坐标轴与电子装置100的坐标轴之间的角度差存储于存储器130,接着依据重力传感器110的坐标轴与电子装置100的坐标轴之间的角度差校准重力坐标gxyz,以提供校准后的重力坐标agxyz。

依据上述,校准后的重力坐标agxyz已消除重力传感器110的坐标轴与电子装置100的坐标轴之间的误差,因此校准后的重力坐标agxyz可确实表示电子装置100的转动状态及/或位移状态。也就是说,当重力传感器110置于水平且静止的平面上,校准后的重力坐标agxyz仅剩下z轴的分量,x轴以及y轴的分量为零。

图2a为依据本发明一实施例的初始重力坐标的校准示意图。请参照图1及图2a,在本实施例中,在初始化期间,驱动电路120会取得重力传感器110提供的一组初始重力坐标ogxyz,其中初始重力坐标ogxyz为装置重力传感器110的电子装置100平放于测试平台(未示出)所测得。优选地,测试平台为水平且静止的一平面。接着,在取得一组的重力坐标ogxyz之后,驱动电路120会基于z轴旋转初始重力坐标ogxyz第一角度θ11至yz平面,以取得平面坐标mgyz,亦即x轴的分量为0。

进一步来说,基于z轴旋转初始重力坐标ogxyz的第一旋转矩阵满足下列方程式

其中,θ11为第一角度,gx、gy及gz分别为初始重力坐标ogxyz在x轴、y轴以及z轴上的三个分量,gy'及gz'分别为平面坐标mgyz的两个分量。并且,基于为第一角度θ11来运行的第一旋转矩阵(1)会存储于存储器130中。

然后,驱动电路120会基于x轴将平面坐标mgyz旋转第二角度θ12至z轴,而取得z轴的分量为1(亦即1g)而x轴及y轴的分量为0的校准后初始重力坐标aogxyz。进一步来说,基于x轴旋转平面坐标mgyz的第二旋转矩阵满足下列方程式

其中,θ12为第二角度,gz”为z轴上的分量且值为1g。并且,基于为第二角度θ12来运行的第二旋转矩阵(2)会存储于存储器130中。

图2b为依据本发明一实施例一操作期间重力坐标的校准示意图。其中,操作期间指的是电子装置100处于一使用或一操作状态。请参照图1、图2a及图2b,在本实施例中,在操作期间,重力传感器110会感测重力坐标pg1xyz,并且驱动电路120会按序利用第一旋转矩阵(1)及第二旋转矩阵(2)校准重力坐标pg1xyz。进一步来说,在取得重力坐标pg1xyz后,会先利用第一角度θ11进行旋转,以取得中间重力坐标mg1xyz。接着,再利用第二角度θ12进行旋转,以取得校准后重力坐标apg1xyz。也就是说,校准后重力坐标apg1xyz可由旋转重力坐标pg1xyz与第一旋转矩阵(1)及第二旋转矩阵(2)进行矩阵相乘所得出,其运算方法可参照下列方程式

其中,pg1x、pg1y及pg1z分别为重力坐标pg1xyz在x轴、y轴以及z轴上的三个分量,ag1x、ag1y及pg1z分别为校准后重力坐标apg1xyz在x轴、y轴以及z轴上的三个分量。

依据上述,在电子装置100平放于水平且静止的平面时,重力传感器110的重力坐标gxyz上仅有z轴存有为1g的分量gz,因此在初始化期间驱动电路120可依据初始重力坐标ogxyz计算出重力传感器110的坐标轴与电子装置100的坐标轴之间的第一角度θ11及第二角度θ12,进而导入第一旋转矩阵(1)及第二旋转矩阵(2)。接着,同样利用第一旋转矩阵(1)及第二旋转矩阵(2)对重力坐标pg1xyz进行矩阵相乘而取得校准后重力坐标apg1xyz。因此,存在于重力传感器110的坐标轴与电子装置100的坐标轴之间的误差,可通过第一旋转矩阵(1)及第二旋转矩阵(2)来消除。

图3a为依据本发明另一实施例的初始重力坐标的校准示意图。请参照图1及图3a,在本实施例中,在初始化期间,驱动电路120会取得重力传感器110提供的一组初始重力坐标ogxyz,其中装置重力传感器110的电子装置100平放于测试平台(未示出,为水平且静止的平面)。接着,在测得一组的重力坐标ogxyz之后,驱动电路120会基于z轴旋转初始重力坐标ogxyz第一角度θ21至xz平面,以取得平面坐标mgxz,亦即y轴的分量为0。

进一步来说,基于z轴旋转初始重力坐标ogxyz的第一旋转矩阵满足下列方程式

其中,θ21为第一角度,gx、gy及gz分别为初始重力坐标ogxyz在x轴、y轴以及z轴上的三个分量,gx'及gz'分别为平面坐标mgxz的两个分量。并且,基于为第一角度θ21来运行的第一旋转矩阵(3)会存储于存储器130中。

然后,驱动电路120会基于y轴将平面坐标mgxz旋转第二角度θ22至z轴,而取得z轴的分量为1(亦即1g)而x轴及y轴的分量为0的校准后初始重力坐标aogxyz。进一步来说,基于y轴旋转平面坐标mgyz的第二旋转矩阵满足下列方程式

其中,θ22为第二角度,gz”为z轴上的分量且值为1g。并且,基于为第二角度θ22来运行的第二旋转矩阵(4)会存储于存储器130中。

图3b为依据本发明另一实施例一操作期间重力坐标的校准示意图。其中,操作期间指的是电子装置100处于一使用或一操作状态。请参照图1、图3a及图3b,在本实施例中,在操作期间,重力传感器110会感测重力坐标pg2xyz,并且驱动电路120会按序利用第一角度θ21及第二角度θ22校准重力坐标pg2xyz。进一步来说,在取得重力坐标pg2xyz后,会先利用第一角度θ21进行旋转,以取得中间重力坐标mg2xyz。接着,再利用第二角度θ22进行旋转,以取得校准后重力坐标apg2xyz,其运算方法可参照下列方程式

其中,pg2x、pg2y及pg2z分别为重力坐标pg2xyz在x轴、y轴以及z轴上的三个分量,ag2x、ag2y及pg2z分别为校准后重力坐标apg2xyz在x轴、y轴以及z轴上的三个分量。

依据上述,在电子装置100平放于水平且静止的平面时,重力传感器110的重力坐标gxyz上仅有z轴存有为1g的分量gz,因此在初始化期间驱动电路120可依据初始重力坐标ogxyz计算出重力传感器110的坐标轴与电子装置100的坐标轴之间的第一角度θ21及第二角度θ22,进而导入第一旋转矩阵(3)及第二旋转矩阵(4)。接着,同样利用第一旋转矩阵(3)及第二旋转矩阵(4)对重力坐标pg2xyz进行矩阵相乘而取得校准后重力坐标apg2xyz。因此,存在于重力传感器110的坐标轴与电子装置100的坐标轴之间的误差,可通过坐标的旋转来消除。

图4为依据本发明一实施例的重力传感器的校准方法的流程图。请参照图4,在本实施例中,重力传感器的校准方法包括下列步骤。在步骤s410中,在初始化期间,取得重力传感器提供的初始重力坐标,其中初始重力坐标为装载重力传感器的电子装置平放于测试平台所测得。在步骤s420中,基于z轴旋转初始重力坐标第一角度,使初始重力坐标于x轴及y轴的其中之一的分量为0,以取得平面坐标。在步骤s430中,存储第一角度。在步骤s440中,基于分量为0的x轴或y轴旋转平面坐标第二角度,以使平面坐标于x轴及y轴的其中另一的分量为0。在步骤s450中,存储第二角度。在步骤s460中,以供重力传感器感测重力坐标时依据第一角度及第二角度进行校准,以取得校准后重力坐标。其中,步骤s410、s420、s430、s440、s450及s460的顺序为用以说明,本发明实施例不以此为限。并且,步骤s410、s420、s430、s440、s450及s460的细节可参照图1、图2a、图2b、图3a及图3b所示实施例,在此则不再赘述。

综上所述,本发明实施例的重力传感器的校准方法,会先算出重力传感器的坐标轴与电子装置的坐标轴之间的角度差,并且通过上述角度差旋转重力传感器的重力坐标,以取得校准到后的重力坐标。因此,校准后的重力坐标可确实表示电子装置的转动状态及/或位移状态。

虽然本发明已以实施例公开如上,然其并非用以限定本发明,任何所属技术领域中技术人员,在不脱离本发明的构思和范围内,当可作些许的变动与润饰,故本发明的保护范围当视权利要求所界定者为准。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1