位置计算方法以及位置计算装置制造方法及图纸

本发明专利技术涉及位置计算方法以及位置计算装置。在位置计算装置中，惯性导航运算部进行使用IMU的检测值的惯性导航运算来计算该装置的位置、速度以及姿势角，卡尔曼滤波器部进行利用由惯性导航运算部得到的运算结果的卡尔曼滤波处理，推算地计算该装置的位置、速度、姿势角等。此外，KF初始参数设定部根据与上次使用时的环境之差，设定作为卡尔曼滤波处理中使用的误差指标值的误差协方差矩阵P的初始值。

【技术实现步骤摘要】

本专利技术涉及一种使用位置计算用的传感器的检测结果的位置计算装置等。
技术介绍
—种使用加速度传感器、陀螺仪传感器这样的各种传感器的检测结果，自律性地计算移动体的位置、速度、姿势角等的惯性导航运算被广泛利用。在传感器的输出值中，包括了以零点偏差为代表的偏差(误差)，由于该偏差，在惯性导航运算结果中有可能产生大的误差。因此，在惯性导航运算的开始之前，需要进行计算(推算)传感器的偏差的校准(例如，参照专利文献1)。在传感器的偏差中，除了在传感器的输出为零时的零点偏差之外，还包括在接入电源时产生的接通偏差、由电源变动、温度变动等外部原因引起的随机的漂移。因此，在严格地消除偏差的情况下，每当接入电源而开始使用时，需要进行校准。校准需要几秒?几十秒左右的时间。此外，在校准中，一般由用户使传感器以规定的姿势进行规定的动作(例如，停止、旋转等)。因此，当在日常使用的装置中实施校准的情况下，对用户造成负担。此外，即使进行了校准，也几乎不可能完全地计算传感器检测值中包括的偏差并去除，在惯性导航运算结果中，尽管微小但仍可能包括误差。现有技术文献专利文献专利文献1:日本特开2012-8096号公报
技术实现思路
本专利技术是鉴于上述情形而完成的，其目的在于，提出一种即使不需要频繁的校准，也在一定程度上维持测量精度的新方法。用于解决上述课题的第一专利技术涉及一种位置计算方法，包括:执行第一位置计算处理，在该第一位置计算处理中，使用位置计算用的规定传感器的检测结果，来推算、更新该传感器的检测值的误差指标值，同时计算当前位置；存储在计算所述第一位置计算处理时的环境信息；以及执行第二位置计算处理，在该第二位置计算处理中，根据新进行位置计算时的环境信息与存储的所述环境信息之差，来设定在新进行位置计算时的初始的误差指标值，使用所述传感器的检测结果，来进行该误差指标值的推算、更新以及当前位置的计笪并ο此外，作为其他专利技术，也可以构成位置计算装置，该位置计算装置具备:位置计算用的规定传感器；位置计算部，其推算、更新所述传感器的检测值的误差指标值，同时计算当前位置；以及设定部，其将所述位置计算部的上次计算时的环境信息存储到存储部，根据基于所述位置计算部的新的计算时的环境信息与该存储部中存储的环境信息之差，来设定该新的计算时的初始的误差指标值。根据该第一专利技术等，能够根据新的位置计算时的环境信息与上次计算时的环境信息之差，来设定传感器的检测值的初始的误差指标值。传感器的检测结果受环境影响。因此，通过根据从上次计算时起的环境变化来设定误差指标值，能够降低检测值的误差。因此，即使不执行校准，也能够将测量精度维持在一定程度上。作为第二专利技术，根据第一专利技术的位置计算方法，也可以构成为:所述第一位置计算处理以及所述第二位置计算处理是使用采用基于所述误差指标值的误差协方差矩阵的卡尔曼滤波器来计算位置的处理。根据该第二专利技术，作为位置计算处理，使用采用基于误差指标值的误差协方差矩阵的卡尔曼滤波器来计算当前位置。作为第三专利技术，根据第一或者第二专利技术的位置计算方法，也可以构成为:设定所述误差指标值包括:在进行新位置计算时的环境信息与存储的所述环境信息之差不满足规定的容许差条件、并且不进行所述传感器的校准的情况下，将新进行位置计算时的初始的误差指标值设定为表示规定的最大误差的误差指标值。根据该第三专利技术，在环境信息之差不满足规定的容许差条件、并且不进行传感器的校准的情况下，能够将新进行位置计算时的初始的误差指标值设定为表示规定的最大误差的误差指标值。作为第四专利技术，根据第三专利技术的位置计算方法，也可以构成为:执行所述第二位置计算处理包括:在将初始的误差指标值设为表示所述最大误差的误差指标值的情况下，将所述传感器的偏差误差设为零而进行位置计算。根据该第四专利技术，在将初始的误差指标值设为表示最大误差的误差指标值的情况下，将传感器的偏差误差设为零而进行位置计算。作为第五专利技术，根据第一至第四专利技术中的任一个专利技术的位置计算方法，也可以构成为:所述环境信息包括所述传感器的环境温度的信息，设定所述误差指标值包括:根据新进行位置计算时的环境温度与存储的所述环境温度之差，将所述误差指标值设定为可变。根据该第五专利技术，环境信息包括传感器的环境温度的信息，根据与上次计算时的环境温度之差来将误差指标值设定为可变。例如，环境温度的差越大，则越能够将误差指标值设定为表示误差大的值。作为第六专利技术，根据第一至?第五专利技术中的任一个专利技术的位置计算方法，也可以构成为:所述存储包括存储所述第一位置计算处理的计算日期时间，设定所述误差指标值包括:根据新进行位置计算时的日期时间与存储的所述计算日期时间之差，将所述误差指标值设定为可变。根据该第六专利技术，环境信息包括计算日期时间，根据与上次计算时的计算日期时间之差，将误差指标值设定为可变。例如，计算日期时间之差越大，则越能够将误差指标值设定为表示误差大的值。【附图说明】图1是位置计算装置的构成例。图2是位置计算装置的功能构成图。图3是位置计算处理的流程图。符号说明10、用户20位置计算装置110、操作部120、显示部130、声音输出部140、通信部150、时钟部200、处理部210、惯性导航运算部220、卡尔曼滤波器部230、KF初始参数设定部240、偏差设定部300、存储部310、位置计算程序320、传感器数据330、上次使用时数据40、传感器部30、頂U (惯性测量单元)31、加速度传感器32、陀螺仪传感器42、温度传感器50、定位单元。【具体实施方式】图1是本实施方式中的位置计算装置20的构成例。该位置计算装置20例如是在跑步时安装于用户10的腰部来利用的便携型的电子设备。在位置计算装置20中，设置了操作开关21、显示器22、扬声器23等，并且内置了 IMU(Inertial Measurement Unit，惯性测量单元)30、以及安装有CPU (Central Processing Unit,中央处理单元)、存储器的控制装置(未图示)。頂U30是具有加速度传感器以及陀螺仪传感器的惯性传感器单元。加速度传感器检测作为与该传感器对应起来的三维正交坐标系(x，y，z)的传感器坐标系(局部坐标系)中的加速度。陀螺仪传感器检测作为与该传感器对应起来的三维正交坐标系(x，y，z)的传感器坐标系中的角速度。此外，设为在加速度传感器的传感器坐标系与陀螺仪传感器的传感器坐标系之间使坐标轴相同来进行说明，但在不同的情况下，能够通过进行坐标变换矩阵运算，来将一方的坐标系变换成另一方的坐标系。关于坐标变换矩阵运算，能够应用公知的方法。位置计算装置20能够进行使用頂U30的检测值的惯性导航运算，计算该装置的位置、速度、姿势等。但是，由于頂U30的各传感器(加速度传感器，陀螺仪传感器)的输出值中包括的偏差，在惯性导航运算结果中有可能产生大的误差。因此，需要预先计算(推算)MU30的各传感器的偏差，考虑所计算出的偏差来进行惯性导航运算。作为以往的偏差的计算方法，例如在紧接着接入电源之后开始使用该装置时，进行计算(推算)并校正MU30的各传感器的偏差的校准。在本实施方式中，基于与上次使用时的环境的差异，来判断是否需要校准，在判断为需要的情况下，进行校准，在判断为不需要的情况下，直接使用在上次本文档来自技高网...

【技术保护点】
一种位置计算方法，包括：执行第一位置计算处理，在该第一位置计算处理中，使用传感器的检测值推算、更新该传感器的检测值的误差指标值，并计算第一时间点的位置；存储所述第一位置计算处理的计算时的环境信息；以及执行第二位置计算处理，在该第二位置计算处理中，根据比所述第一时间点晚的第二时间点的环境信息与存储的所述第一时间点的所述环境信息之差设定进行所述第二时间点的位置计算时的初始的误差指标值，使用所述传感器的检测结果进行该误差指标值的推算、更新，并计算第二时间点的位置。

【技术特征摘要】
...

【专利技术属性】
技术研发人员：佐藤彰展，
申请(专利权)人：精工爱普生株式会社，
类型：发明
国别省市：日本;JP