偏移计算装置、偏移修正装置以及偏移计算方法与流程

文档序号:22113378发布日期:2020-09-04 15:18阅读:408来源:国知局
偏移计算装置、偏移修正装置以及偏移计算方法与流程

本发明涉及偏移计算装置、偏移修正装置以及偏移计算方法。



背景技术:

以往,在根据通过陀螺仪传感器检测出的角速度相关的传感器数据判定旋转状态的情况下,为了精度良好地判定旋转状态,提出除去传感器数据所包含的偏移的各种方法。例如,有求出无旋转状态下的传感器数据的平均值作为偏移值,并使用偏移值修正传感器数据的输出的方法。

例如,专利文献1所记载的失调漂移修正装置在装备了陀螺仪传感器的移动体,使用针对从陀螺仪传感器输出的角速度的大小的阈值判定移动体是否为旋转状态。然后,对陀螺仪传感器的输出与自适应滤波器的输出(估计偏移水平)之差(误差值)进行平均化,仅在判断为无旋转状态的情况下,使用平均化后的误差值更新估计偏移水平。

专利文献1:日本特开平7-324941号公报

然而,在安装了陀螺仪传感器的装置中,即使为无旋转状态,在步行时、行驶时等移动状态的情况下,也有向一方向产生振动的情况。

在图1示出在以无旋转状态处于移动状态的情况下从陀螺仪传感器输出的传感器数据的一个例子。图1(a1)以及图1(b1)是作为传感器数据的角速度的时间推移,图1(a2)以及图1(b2)是作为角速度的积分值的角度的时间推移。如图1(a1)所示,在传感器数据的振动没有偏差的情况下,如图1(a2)所示角度的推移恒定。另一方面,如图1(b1)所示,由于移动状态,而有传感器数据的振动的中心偏移的情况,在该情况下如图1(b2)所示角度的推移漂移。例如,若将安装了陀螺仪传感器的装置放入裤子口袋进行步行,则即使在直线上步行,也有陀螺仪传感器的传感器数据的振动产生偏差的情况。

无论在哪种情况下,都在无旋转状态下产生振动,所以在上述专利文献1中,例如有在短期间判定了移动体的旋转状态的情况下,尽管为无旋转状态但误判定为旋转状态,而不更新估计偏移水平这样的问题。



技术实现要素:

本发明是鉴于以上的点而完成的,目的在于即使是移动状态,也能够精度良好地计算偏移值。

本发明所涉及的偏移计算装置具备:判定部,其基于对与从角速度传感器输出的传感器数据对应的数值的时间序列数据导出的、相互不同的多个期间各自的移动平均值,来判定上述角速度传感器的感测对象的旋转状态;以及计算部,其基于通过上述判定部判定为上述感测对象为无旋转状态的期间所对应的上述传感器数据,计算上述传感器数据的偏移值。

本发明所涉及的偏移计算方法基于对与从角速度传感器输出的传感器数据对应的数值的时间序列数据导出的、相互不同的多个期间各自的移动平均值,来判定上述角速度传感器的感测对象的旋转状态,并基于与判定为上述感测对象为无旋转状态的期间对应的上述传感器数据计算上述传感器数据的偏移值。

根据本发明,即使为移动状态,也能够精度良好地计算偏移值。

附图说明

图1是表示在以无旋转状态处于移动状态的情况下从陀螺仪传感器输出的传感器数据的一个例子的图。

图2是表示各实施方式所涉及的偏移修正装置的构成的一个例子的框图。

图3是表示各实施方式所涉及的偏移计算装置的硬件构成的一个例子的框图。

图4是表示第一实施方式所涉及的偏移计算装置的功能的构成的一个例子的框图。

图5是表示第一实施方式所涉及的导出处理的一个例子的流程图。

图6是表示第一实施方式所涉及的第一以及第二旋转判定处理的一个例子的流程图。

图7是表示第一实施方式所涉及的导出处理及第一以及第二旋转判定处理的一个例子的图。

图8是表示第一实施方式所涉及的第三旋转判定处理的一个例子的流程图。

图9是表示第一实施方式所涉及的计算期间判定处理的一个例子的流程图。

图10是表示第一实施方式所涉及的方差值的时间推移的一个例子的图。

图11是表示第二实施方式所涉及的偏移计算装置的功能的构成的一个例子的功能框图。

图12是表示第二实施方式所涉及的面积计算处理的一个例子的流程图。

图13是表示第二实施方式所涉及的偏移计算处理的一个例子的流程图。

具体实施方式

以下,参照附图,对用于实施本发明的形态例进行详细说明。此外,在各附图中对相同或者对应的构成要素附加相同的参照附图标记。

首先,参照图2,对各实施方式所涉及的偏移修正装置70的功能构成进行说明。如图2所示,偏移修正装置70具备偏移计算装置10、陀螺仪传感器50以及修正部60。从陀螺仪传感器50输出的角速度值相关的传感器数据输入到偏移计算装置10以及修正部60。从偏移计算装置10输出的偏移值输入到修正部60。偏移修正装置70例如安装于智能手机以及平板计算机等移动终端装置。

陀螺仪传感器50检测感测对象的角速度,并输出表示检测到的角速度的大小的角速度值作为传感器数据。陀螺仪传感器50例如既可以是检测特定的单轴的角速度值的传感器,也可以检测多轴(双轴或者三轴)的各角速度值的传感器。在陀螺仪传感器50为检测单轴的角速度的传感器的情况下,输出该轴的角速度值作为传感器数据。另外,在为检测多轴的角速度的传感器的情况下,输出每一轴的角速度值作为传感器数据,该情况下,陀螺仪传感器50既可以利用单一设备检测各轴的角速度,也可以按照每一轴以不同的设备进行检测。

偏移计算装置10计算相当于重叠于从陀螺仪传感器50输出的传感器数据的偏移量的偏移值。

修正部60基于通过偏移计算装置10计算出的偏移值,修正从陀螺仪传感器50输出的传感器数据。此外,修正部60并不限定于与偏移计算装置10不同的设备,也可以由与偏移计算装置10相同的设备构成。

接下来,参照图3,对本实施方式所涉及的偏移计算装置10的硬件构成进行说明。如图3所示,偏移计算装置10包含cpu(centralprocessingunit:中央处理器)11、作为暂时存储区域的存储器12、输入输出端口13以及非易失性的存储部14。cpu11、存储器12、输入输出端口13以及存储部14与总线19连接。

通过hdd(harddiskdrive:硬盘驱动器)、ssd(solidstatedrive:固盘)、以及闪存等非易失性的存储介质实现存储部14。在作为存储介质的存储部14存储有判定处理程序15、计算处理程序16以及延迟处理程序17。cpu11从存储部14读出各程序之后展开在存储器12,并执行展开的各程序。

[第一实施方式]

参照图4,对本实施方式所涉及的偏移计算装置10的功能的构成进行说明。如图4所示,偏移计算装置10具备判定部20、计算部30以及延迟部40。cpu11通过执行判定处理程序15,作为判定部20发挥作用。另外,cpu11通过执行计算处理程序16,作为计算部30发挥作用。另外,cpu11通过执行延迟处理程序17,作为延迟部40发挥作用。此外,在图4也示出与偏移计算装置10一起使用的陀螺仪传感器50以及修正部60。

判定部20基于对与从陀螺仪传感器50输出的传感器数据对应的数值的时间序列数据导出的、相互不同的多个期间各自的移动平均值,判定偏移修正装置70的旋转状态。另外,判定部20具备导出部22、第一旋转判定部24、第二旋转判定部26以及第三旋转判定部28。

导出部22导出与从陀螺仪传感器50输出的传感器数据对应的数值的时间序列数据。具体而言,导出部22通过计算由从陀螺仪传感器50输出的传感器数据示出的角速度的移动平均值a,并进一步计算移动平均值a的移动平均来计算移动平均b。导出部22导出对移动平均值a与移动平均值b的差分c进行平方后的数值d的时间序列数据。

第一旋转判定部24对通过导出部22导出的数值d的时间序列数据导出第一期间的移动平均值,暂定判定安装了偏移修正装置70的设备(例如,智能手机以及平板计算机等移动终端装置,以下称为对象设备)的旋转状态,并输出暂定的第一旋转判定结果。第一期间是指在第一旋转判定部24导出移动平均值时使用的数值d的时间序列数据的数据区间的长度。

第二旋转判定部26对通过导出部22导出的数值d的时间序列数据导出作为比第一期间长的期间的第二期间的移动平均值,暂定判定对象设备的旋转状态,并输出暂定的第二旋转判定结果。第二期间是指在第二旋转判定部26导出移动平均值时使用的数值d的时间序列数据的数据区间的长度。

第三旋转判定部28基于第一旋转判定结果以及第二旋转判定结果的组合,最终地判定对象设备的旋转状态,并输出最终的第三旋转判定结果。第三旋转判定部28基于第一旋转判定结果以及第二旋转判定结果的组合,输出判定为对象设备为旋转状态、无旋转状态以及判定保留状态的哪个的结果作为第三旋转判定结果。

延迟部40使传感器数据延迟规定的延迟时间并输出。规定的延迟时间是指相当于在判定部20的各处理产生的延迟时间(即,从来自陀螺仪传感器50的传感器数据输入导出部22,到从第三旋转判定部28输出第三旋转判定结果为止的期间)的时间。即,延迟部40与在判定部20的各处理产生的延迟时间配合地使从陀螺仪传感器50输出的传感器数据延迟,从延迟部40输出的传感器数据与从判定部20输出的第三旋转判定结果的输出定时同步。

计算部30基于与通过判定部20判定为对象设备为无旋转状态的期间对应的传感器数据,计算传感器数据的偏移值。即,计算部30在第三旋转判定结果表示对象设备为无旋转状态的情况下,基于与判定为该无旋转状态的期间对应的传感器数据计算传感器数据的偏移值。

另外,计算部30在第三旋转判定结果表示对象设备连续规定期间为判定保留状态的情况下,估计为判定为该判定保留状态的期间为无旋转状态,并基于与判定为该判定保留状态的期间对应的传感器数据,事后计算传感器数据的偏移值。另外,计算部30在第三旋转判定结果从表示对象设备为判定保留状态的状态在规定期间内移至表示为无旋转状态的状态的情况下,估计为判定为该判定保留状态的期间为无旋转状态,并基于与判定为该判定保留状态的期间对应的传感器数据事后计算传感器数据的偏移值。另外,计算部30在第三旋转判定结果从表示对象设备为判定保留状态的状态在规定期间内移至表示为旋转状态的状态的情况下,估计为判定为该判定保留状态的期间为旋转状态,并事后决定不计算基于与判定为该判定保留状态的期间对应的传感器数据的偏移值。

计算部30使用从延迟部40输出的延迟的传感器数据,计算传感器数据的偏移值。即,计算部30基于从判定部20输出的对象设备的旋转状态的判定结果、和从延迟部40输出的延迟的传感器数据,计算传感器数据的偏移值。

接下来,对本实施方式所涉及的判定部20的作用进行说明。cpu11通过执行判定处理程序15,执行导出部22中的导出处理、第一旋转判定部24中的第一旋转判定处理、第二旋转判定部26中的第二旋转判定处理、以及第三旋转判定部28中的第三旋转判定处理。

首先,参照图5,对本实施方式所涉及的导出处理进行说明。例如在偏移计算装置10接收了从陀螺仪传感器50输出的传感器数据的情况下执行图5所示的导出处理。

在步骤s11,导出部22对从陀螺仪传感器50输出的传感器数据进行移动平均处理,导出移动平均值a。在步骤s12,导出部22进一步对移动平均值a进行移动平均处理导出移动平均值b。在步骤s13,导出部22导出移动平均值a与移动平均值b的差分c。在步骤s14,导出部22导出差分c的平方后的数值d。导出部22通过反复实施步骤s11~步骤s14的处理,导出数值d的时间序列数据。

接下来,参照图6,对本实施方式所涉及的第一旋转判定处理以及第二旋转判定处理进行说明。例如在导出部22中导出了数值d的时间序列数据之后执行图6所示的第一以及第二旋转判定处理。以下,对于图6中的移动平均值e,在第一旋转判定处理中记载为移动平均值e1,在第二旋转判定处理中记载为移动平均值e2。

首先,对第一旋转判定处理进行说明。在步骤s21,第一旋转判定部24对在导出部22中导出的数值d的时间序列数据进行第一期间的移动平均处理,导出移动平均值e1。

在步骤s22,第一旋转判定部24对移动平均值e1与阈值t进行比较。阈值t是预先设定的值。在移动平均值e1在阈值t以上的情况下(步骤s22是),第一旋转判定部24判定为对象设备有旋转状态的可能性,使暂定的第一旋转判定结果为true判定(步骤s23)。另一方面,在移动平均值e1比阈值t小的情况下(步骤s22否),第一旋转判定部24判定为对象设备有无旋转状态的可能性,使暂定的第一旋转判定结果为false判定(步骤s24)。

对于第二旋转判定处理来说,第二旋转判定部26进行与上述的第一旋转判定处理相同的处理,导出第二旋转判定结果,但在步骤s21中,进行比第一期间长的第二期间的移动平均处理,导出移动平均值e2。即,移动平均值e2的导出所使用的数据区间的长度比移动平均值e1的导出所使用的数据区间的长度长。此外,步骤s22中的阈值t与上述的第一旋转判定处理相同。

图7示出上述的导出处理及第一以及第二旋转判定处理的一个例子。图7所示的时间例如是从开始导出处理开始的时间。角速度是从陀螺仪传感器50输出的传感器数据的角速度值。此外,虽然在图7示出每一秒的角速度值,但陀螺仪传感器50的测定间隔并不限定于一秒,也可以是其以外的间隔。a是在导出处理的步骤s11由导出部22导出的移动平均值a,b是在导出处理的步骤s12由导出部22导出的移动平均值b,c是在导出处理的步骤s13由导出部22导出的差分c,d是在导出处理的步骤s14由导出部22导出的数值d。e1是在第一旋转判定处理的步骤s21由第一旋转判定部24导出的移动平均值e1,e2是在第二旋转判定处理的步骤s21由第二旋转判定部26导出的移动平均值e2。

首先,导出部22导出角速度的移动平均值a(步骤s11)。移动平均值a的导出所使用的数据区间的长度例如为5秒。移动平均值a的导出所使用的数据区间的长度越长旋转状态的判定的精度越提高,另一方面延迟也越大。

接下来,导出部22进一步对移动平均值a进行移动平均处理,导出移动平均值b(步骤s12)。为了使判定的精度提高,优选移动平均值b的导出所使用的数据区间的长度比移动平均值a的导出所使用的数据区间的长度长,例如为10秒。

接下来,导出部22导出移动平均值a与移动平均值b的差分c(步骤s13)。即,差分c是移动平均值a的偏差。接下来,导出部22导出差分c的平方亦即数值d(步骤s14)。

接下来,第一旋转判定部24以及第二旋转判定部26分别导出数值d的移动平均值e1以及e2(步骤s21)。即,移动平均值e1以及e2是移动平均值a的方差值。方差值有在对象设备为旋转状态的情况下较大,在无旋转状态的情况下较小的特征。为了使判定的精度提高,优选移动平均值e1的导出所使用的数据区间的长度比移动平均值b的导出所使用的数据区间的长度长,例如为20秒。另外,移动平均值e2的导出所使用的数据区间的长度例如为30秒。

图10示出在上述的第一以及第二旋转判定处理导出的移动平均值e1以及e2的时间推移的一个例子。在第一旋转判定处理中,在时刻0~t1、时刻t2~t3以及时刻t5~t7的期间,移动平均值e1比阈值t小(步骤s22否),所以第一旋转判定部24使第一旋转判定结果为false判定并输出(步骤s24)。另一方面,在时刻t1~t2、时刻t3~t5以及时刻t7~t9的期间,移动平均值e1在阈值t以上(步骤s22是),所以第一旋转判定部24使第一旋转判定结果为true判定并输出(步骤s23)。

移动平均值e1与移动平均值e2相比移动平均值的导出所使用的数据区间的长度较短,所以例如有时刻t1~t2以及时刻t7~t9间那样的基于暂时的振动变动较大,而第一旋转判定结果容易引起尽管为无旋转状态但进行true判定的误判定这一的课题。另一方面,例如有如时刻t3~t4以及时刻t5~t6那样,移动平均值e1的时间推移与移动平均值e2的时间推移相比延迟较少,而能够高速地进行旋转状态的判定这样的优点。

在第二旋转判定处理中,在时刻0~t4以及时刻t6以后的期间,移动平均值e2比阈值t小(步骤s22否),所以第二旋转判定部26使第二旋转判定结果为false判定并输出(步骤s24)。另一方面,在时刻t4~t6的期间,移动平均值e2在阈值t以上(步骤s22是),所以第二旋转判定部26使第二旋转判定结果为true判定并输出(步骤s23)。

移动平均值e2与移动平均值e1相比移动平均值的导出所使用的数据区间的长度较长,所以例如有如时刻t3~t4以及时刻t5~t6那样,移动平均值e2的时间推移与移动平均值e1的时间推移相比延迟较大,而第二旋转判定结果容易在旋转状态的判定产生延迟这样的课题。另一方面,在移动平均值e2的时间推移中,不产生例如在时刻t1~t2以及时刻t7~t9中在移动平均值e1的时间推移产生的暂时的振动,所以有第二旋转判定部26中的旋转状态的判定的精度比第一旋转判定部24中的旋转状态的判定的精度高这样的优点。

这样,在移动平均值的导出所使用的数据区间的长度相互不同的第一旋转判定结果和第二旋转判定结果中,具有不同的性质。因此,在第三旋转判定部28中,基于第一旋转判定结果以及第二旋转判定结果的组合,进行最终的旋转状态的判定,输出最终的第三旋转判定结果。由此,即使对象设备为移动状态,也能够精度良好地进行该设备的旋转状态的判定。

参照图8,对本实施方式所涉及的第三旋转判定处理进行说明。例如在导出了第一旋转判定结果以及第二旋转判定结果双方之后执行图8所示的第三旋转判定处理。

在步骤s31,第三旋转判定部28判定第一旋转判定结果以及第二旋转判定结果的组合。在步骤s31,第一旋转判定结果以及第二旋转判定结果双方为false判定的情况下,移至步骤s32。在步骤s32,第三旋转判定部28输出表示偏移修正装置70的旋转状态为无旋转状态的判定信号作为第三旋转判定结果。

在步骤s33,第三旋转判定部28再次判定第一旋转判定结果以及第二旋转判定结果的组合,并且在false判定的情况下(步骤s33是),返回到步骤s32。另一方面,在步骤s33,在第一旋转判定结果以及第二旋转判定结果的至少一方为true判定的情况下(步骤s33否),移至后述的步骤s34。

在步骤s31,第一旋转判定结果以及第二旋转判定结果的一方为true判定,另一方为false判定的情况下,第三旋转判定部28移至步骤s34。在步骤s34,第三旋转判定部28保留对象设备的旋转状态的判定,输出表示判定保留状态的判定信号作为第三旋转判定结果。

在步骤s35,第三旋转判定部28判定第二旋转判定结果是否为true判定。在第二旋转判定结果为true判定的情况下(步骤s35是),移至后述的步骤s37。另一方面,在第二旋转判定结果为false判定的情况下(步骤s35否),移至步骤s36。

在步骤s36,第三旋转判定部28判定第一旋转判定结果是否为false判定。在第一旋转判定结果为false判定的情况下(步骤s36是),移至步骤s32。另一方面,在第一旋转判定结果为true判定的情况下(步骤s36否),返回到步骤s34。

在步骤s31,第一旋转判定结果以及第二旋转判定结果双方为true判定的情况下,第三旋转判定部28移至步骤s37。在步骤s37,cpu11输出表示偏移修正装置70为旋转状态的判定信号作为第三旋转判定结果。

在步骤s38,第三旋转判定部28再次判定第一旋转判定结果以及第二旋转判定结果的组合,并且在为false判定的情况下(步骤s38是),移至步骤s32。另一方面,在步骤s38,第一旋转判定结果以及第二旋转判定结果的至少一方为true判定的情况下(步骤s38否),移至步骤s35。

接下来,对本实施方式所涉及的计算部30的作用进行说明。cpu11通过执行计算处理程序16,执行计算期间判定处理。

参照图9,对本实施方式所涉及的计算期间判定处理进行说明。例如在第三旋转判定部28中输出了第三旋转判定结果之后执行图9所示的计算期间判定处理。

在步骤s41,计算部30判定输出的第三旋转判定结果示出无旋转状态、判定保留状态以及旋转状态的哪个的情况。

在步骤s41,第三旋转判定结果示出无旋转状态的情况下,移至步骤s42。在步骤s42,计算部30对输出表示无旋转状态的判定信号作为第三旋转判定结果的期间亦即无旋转判定期间计算偏移值。

在步骤s41,第三旋转判定结果示出旋转状态的情况下,计算部30结束计算期间判定处理。即,对输出表示旋转状态的判定信号作为第三旋转判定结果的期间亦即旋转判定期间,不进行偏移值的计算。

在步骤s41,第三旋转判定结果示出判定保留状态的情况下,移至步骤s43。在步骤s43,计算部30判定是否从最初输出表示判定保留状态的判定信号作为第三旋转判定结果开始,在规定期间内,输出表示旋转状态的判定信号作为第三旋转判定结果。即,计算部30到经过规定期间为止对从第三旋转判定部28输出表示旋转状态以及无旋转状态的哪个的判定信号进行待机。规定期间是预先决定的期间。

在步骤s43,在规定期间内输出表示旋转状态的判定信号的情况下,计算部30结束计算期间判定处理。即,估计为输出表示判定保留状态的判定信号作为第三旋转判定结果的期间亦即判定保留期间也为旋转状态,而不进行基于与该判定保留期间对应的传感器数据的偏移值的计算。

另一方面,在步骤s43,在规定期间内输出表示无旋转状态的判定信号的情况下,计算部30移至步骤s44。在步骤s44,计算部30对判定保留期间以及无旋转判定期间的各个计算偏移值。即,估计为判定保留期间也为无旋转状态,并对判定保留期间以及无旋转判定期间的各个进行偏移值的计算。另外,在规定期间经过后也继续输出表示判定保留状态的判定信号的情况下,在步骤s44,也进行与输出表示无旋转状态的判定信号的情况相同的处理。

接下来,参照图10,对上述的第三旋转判定处理以及计算期间判定处理的一个例子进行说明。首先,例如,对移动平均值e1以及e2如时刻0~t1的期间那样推移的情况进行说明。在时刻0,第一旋转判定结果以及第二旋转判定结果双方为false判定(步骤s31f/f),所以第三旋转判定部28输出表示无旋转状态的判定信号(步骤s32)。其后,在时刻0~t1的期间,第一旋转判定结果以及第二旋转判定结果双方也为false判定(步骤s33是),所以第三旋转判定部28在时刻0~t1的期间连续输出表示无旋转状态的判定信号(步骤s32)。判定信号表示无旋转状态(步骤s41无旋转状态),所以计算部30基于与时刻0~t1的期间对应的传感器数据计算偏移值(步骤s42)。

接下来,例如,对移动平均值e1以及e2如时刻t1~t2的期间那样推移的情况进行说明。在时刻t1,第一旋转判定结果为true判定(步骤s33否),所以第三旋转判定部28输出表示判定保留状态的判定信号(步骤s34)。其后,在时刻t1~t2的期间,第二旋转判定结果为false判定(步骤s35否),第一旋转判定结果为true判定(步骤s36否),所以第三旋转判定部28在整个时刻t1~t2的期间连续输出表示判定保留状态的判定信号(步骤s34)。

在时刻t2,第一旋转判定结果为false判定(步骤s36是),所以第三旋转判定部28输出表示无旋转状态的判定信号(步骤s32)。由于从判定为判定保留状态的时刻t1开始在规定期间内输出了表示无旋转状态的判定信号(在步骤s43移至无旋转状态),所以计算部30估计为判定保留期间t1~t2为无旋转状态,并基于与时刻t1~t2对应的传感器数据计算偏移值(步骤s44)。

接下来,例如对移动平均值e1以及e2如时刻t3~t5的期间那样推移的情况进行说明。在时刻t3,第一旋转判定结果为true判定(步骤s33否),所以第三旋转判定部28输出表示判定保留状态的判定信号(步骤s34)。其后,在时刻t3~t4的期间,第二旋转判定结果为false判定(步骤s35否),且第一旋转判定结果为true判定(步骤s36否),所以第三旋转判定部28在整个时刻t3~t4的期间连续输出表示判定保留状态的判定信号(步骤s34)。

在时刻t4,第二旋转判定结果为true判定(步骤s35是),所以第三旋转判定部28输出表示旋转状态的判定信号(步骤s37)。从判定为判定保留状态的时刻t3开始在规定期间内输出了表示旋转状态的判定信号(在步骤s43移至旋转状态),所以计算部30估计为判定保留期间t3~t4为旋转状态,而不进行基于与时刻t3~t4的期间对应的传感器数据的偏移值的计算。

在其后,时刻t4~t5的期间中,第一旋转判定结果以及第二旋转判定结果双方也为true判定(步骤s38否)(步骤s35是),所以第三旋转判定部28在整个时刻t4~t5的期间连续输出表示旋转状态的判定信号(步骤s37)。因此,计算部30不进行基于与时刻t4~t5的期间对应的传感器数据的偏移值的计算(步骤s41旋转状态)。

接下来,例如对移动平均值e1以及e2如时刻t5~t6的期间那样推移的情况进行说明。在时刻t5,第一旋转判定结果为false判定,但第二旋转判定结果为true判定(步骤s38否)(步骤s35是),所以第三旋转判定部28继续输出表示旋转状态的判定信号(步骤s37)。因此,计算部30不进行基于与时刻t5~t6的期间对应的传感器数据的偏移值的计算(在步骤s41为旋转状态)。

接下来,例如对移动平均值e1以及e2如时刻t7~t9的期间那样推移的情况进行说明。在时刻t7,第一旋转判定结果为true判定(步骤s33否),所以第三旋转判定部28输出表示判定保留状态的判定信号(步骤s34)。其后,在时刻t7~t8的期间,第二旋转判定结果为false判定(步骤s35否),第一旋转判定结果为true判定(步骤s36否),所以第三旋转判定部28在整个时刻t7~时刻t8的期间连续输出表示判定保留状态的判定信号(步骤s34)。

在时刻t8,从时刻t7开始经过规定期间。在时刻t8~t9,第二旋转判定结果也为false判定(步骤s35否),第一旋转判定结果为true判定(步骤s36否),所以第三旋转判定部28在整个时刻t7~t9的期间连续输出表示判定保留状态的判定信号(步骤s34)。由于在从时刻t7开始经过规定期间之后也未移至旋转状态(步骤s43否),所以计算部30估计为判定保留期间t7~t9为无旋转状态,基于与时刻t7~t9的期间对应的传感器数据计算偏移值(步骤s44)。

这样,根据本实施方式所涉及的第三旋转判定处理以及计算期间判定处理,能够判断为在时刻t1~t2的期间仅第一旋转判定结果为true判定是基于暂时的振动的结果,能够估计为该期间为无旋转状态。另外,能够判断为在时刻t3~t4的期间仅第一旋转判定结果为true判定是基于第二旋转判定结果与第一旋转判定结果相比延迟的结果,能够估计为该期间为旋转状态。另外,能够判断在时刻t5~t6的期间仅第二旋转判定结果为true判定是基于第二旋转判定结果与第一旋转判定结果相比延迟,或者基于第一旋转判定结果暂时成为false判定的结果,能够估计为该期间为旋转状态。另外,能够判断为在时刻t7~t9的期间仅第一旋转判定结果为true判定是基于在移动状态产生的振动产生偏差等的结果,能够估计为该期间为无旋转状态。

即,计算部30能够对将对象设备估计为无旋转状态的期间计算偏移值。另外,能够在事后对判定保留期间判断旋转状态,并判定是否计算偏移值。

如以上说明的那样,根据本实施方式,判定部20基于对与从陀螺仪传感器50输出的传感器数据对应的数值的时间序列数据导出的、相互不同的多个期间各自的移动平均值,判定陀螺仪传感器50的感测对象的旋转状态,计算部30基于通过判定部20判定为对象设备是无旋转状态的期间所对应的传感器数据,计算传感器数据的偏移值。即,基于移动平均值的导出所使用的数据区间的长度相互不同的移动平均值判定旋转状态,所以能够精度良好地进行旋转状态的判定,其结果,即使对象设备为移动状态,也能够精度良好地计算偏移值。

另外,根据本实施方式,即使对象设备为移动状态,也能够仅基于从陀螺仪传感器50输出的传感器数据判定旋转状态。因此,即使没有用于检测是否为移动状态的其它的传感器(例如,加速度传感器以及地磁传感器),也能够计算偏移值。

此外,虽然在本实施方式中,基于第一旋转判定结果以及第二旋转判定结果的组合,判定旋转状态,但并不限定于此。例如,也可以通过进一步使用与移动平均值e1以及e2的导出所使用的数据区间的长度不同的长度的数据区间导出方差值,并与阈值t进行比较,来基于三个以上的暂定的旋转判定结果的组合判定最终的旋转状态。

另外,虽然在本实施方式中,基于移动平均值e1以及e2即传感器数据的方差值,判定旋转状态,但并不限定于此。例如,也可以代替方差值,而导出传感器数据的短时间的平均和长时间的平均,并基于其组合,判定旋转状态。

[第二实施方式]

根据上述的第一实施方式所涉及的偏移计算装置10,计算部30对与估计为对象设备为无旋转状态的期间对应的传感器数据进行移动平均处理,并输出移动平均值作为偏移值。该情况下,若在无旋转状态的传感器数据中产生的振动为图1(a1)那样的振动,则能够精度良好地检测偏移值。然而,在无旋转状态在传感器数据产生的振动如图1(b1)那样为偏移的振动的情况下,产生若将对传感器数据的移动平均值作为偏移值,则振动的偏差成为新的偏移这样的课题。因此,第二实施方式所涉及的偏移计算装置10进一步考虑上述的传感器数据的振动的偏差来计算偏移值。

参照图11,对本实施方式所涉及的偏移计算装置10的功能的构成进行说明。本实施方式的计算部30的功能的构成与第一实施方式不同。cpu11通过执行计算处理程序16,作为计算部30发挥作用。其它的功能的构成与第一实施方式相同,所以省略说明。

计算部30基于与根据传感器数据的规定时间内的时间推移示出的信号波形的波形部分的面积对应的数值,计算传感器数据的偏移值。

另外,计算部30具备计算期间判定部31、面积计算部32以及偏移计算部34。计算期间判定部31执行在第一实施方式说明的计算期间判定处理。面积计算部32计算根据传感器数据的规定时间内的时间推移示出的信号波形的正侧的波形部分的面积和负侧的波形部分的面积。偏移计算部34通过将正侧的波形部分的面积与负侧的波形部分的面积的差分除以与规定时间对应的数值,计算传感器数据的偏移值。即,偏移计算部34以根据通过修正部60修正的传感器数据的规定时间内的时间推移示出的信号波形的正侧的波形部分的面积以及负侧的波形部分的面积相同的方式,计算传感器数据的偏移值。

接下来,对本实施方式所涉及的计算部30的作用进行说明。cpu11通过执行计算处理程序16,执行计算期间判定部31中的计算期间判定处理、面积计算部32中的面积计算处理、以及偏移计算部34中的偏移计算处理。

首先,参照图12,对本实施方式所涉及的面积计算处理进行说明。例如在计算期间判定部31决定了计算偏移值的期间之后执行图12所示的面积计算处理。

在步骤s51,面积计算部32判定从延迟部40输出的传感器数据的角速度值是否在0以上。在传感器数据在0以上的情况下(步骤s51是),面积计算部32将角速度值作为正面积进行相加(步骤s52),并移至步骤s54。

另一方面,在步骤s51,在传感器数据的角速度值小于0的情况下(步骤s51否),面积计算部32将角速度值作为负面积并进行相加(步骤s53),并移至步骤s54。此外,负面积为了偏移计算处理中的计算,而以绝对值进行计算。

在步骤s54中,面积计算部32判定从最初进行步骤s51的判定开始是否经过了规定时间,在经过规定时间之前,反复步骤s51~s53。规定时间是为了计算偏移值而最低限度需要的累计数所对应的时间。

在经过了规定时间的情况下步骤s54是),移至步骤s55,面积计算部32输出正面积以及负面积。

此外,在计算面积的情况下,也可以不按照时间对角速度值进行积分。在利用偏移计算处理计算偏移值的情况下,按照时间对面积进行微分,所以为了计算的简单化,也可以累计角速度值。

接下来,参照图13,对本实施方式所涉及的偏移计算处理进行说明。例如在从面积计算部32输出了正面积或者负面积的情况下执行图13所示的偏移计算处理。

在步骤s61中,偏移计算部34计算正面积与负面积的差分,并将该差分除以在导出正面积以及负面积时实施的累计处理的累计数。进行该除法后的值为偏移值。即,偏移值是以根据通过修正部60修正的传感器数据的规定时间内的时间推移示出的信号波形的正面积与负面积均等的方式计算出的值。

这样计算出的偏移值是在陀螺仪传感器50具有的偏移进一步考虑振动的偏差计算出的偏移值,所以能够同时实施陀螺仪传感器50与振动的偏差双方的校准。

如以上所说明的那样,根据本实施方式,计算部30基于根据与估计为对象设备为无旋转状态的期间对应的传感器数据的规定时间内的时间推移示出的信号波形的波形部分的面积所对应的数值,计算传感器数据的偏移值。由此,即使在无旋转状态下的传感器数据产生有偏差的振动的移动状态下,也能够精度良好地计算偏移值。

此外,虽然在本实施方式中,作为用于计算偏移值的数值,使用传感器数据的面积所对应的数值,但并不限定于此。例如,也可以使用正侧的最大值与负侧的最小值的平均。

另外,虽然在上述各实施方式中,作为角速度传感器的一个例子使用了陀螺仪传感器50,但并不限定于此。例如,也可以使用从地磁传感器输出的传感器数据,判定感测对象的旋转状态,计算传感器数据的偏移值。

附图标记说明

10…偏移计算装置,11…cpu,12…存储器,13…输入输出端口,14…存储部,15…判定处理程序,16…计算处理程序,17…延迟处理程序,20…判定部,22…导出部,24…第一旋转判定部,26…第二旋转判定部,28…第三旋转判定部,30…计算部,31…计算期间判定部,32…面积计算部,34…偏移计算部,40…延迟部,50…陀螺仪传感器,60…修正部,70…偏移修正装置。

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