CN113092819B - 足部加速度计动态零速校准方法及系统 - Google Patents

足部加速度计动态零速校准方法及系统 Download PDF

Info

Publication number
CN113092819B
CN113092819B CN202110401906.4A CN202110401906A CN113092819B CN 113092819 B CN113092819 B CN 113092819B CN 202110401906 A CN202110401906 A CN 202110401906A CN 113092819 B CN113092819 B CN 113092819B
Authority
CN
China
Prior art keywords
zero
interval
speed
accelerometer
foot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110401906.4A
Other languages
English (en)
Other versions
CN113092819A (zh
Inventor
蒋博
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Star Network Application Co Ltd
Original Assignee
Dongfanghong Satellite Mobile Communication Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Dongfanghong Satellite Mobile Communication Co Ltd filed Critical Dongfanghong Satellite Mobile Communication Co Ltd
Priority to CN202110401906.4A priority Critical patent/CN113092819B/zh
Publication of CN113092819A publication Critical patent/CN113092819A/zh
Application granted granted Critical
Publication of CN113092819B publication Critical patent/CN113092819B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P21/00Testing or calibrating of apparatus or devices covered by the preceding groups
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Abstract

本发明提出了一种足部加速度计动态零速校准方法及系统。该方法为:采集足部加速度计的加速度、时间原始数据信息,采集足底压力计的压力、时间原始数据信息;对加速度计与压力计所采集的信息进行数据提取处理,得到当前运动区间内加速度计的零速区间与压力计的零速区间,将加速度计测得的零速区间与压力计测得的零速区间的合集区间作为对应运动区间的零速区间,该运动区间的剩余区间为动态区间;S3,分别计算当前运动区间内零速区间、动态区间的零速偏移量,对该运动区间内的零速区间、动态区间的足部加速度计输出的加速度进行校准。该方法提高了人员运动时的加速度测量精度,可用于对人员行走过程中的足部加速度计零速偏移校准。

Description

足部加速度计动态零速校准方法及系统
技术领域
本发明涉及惯性导航器件校准领域,具体涉及一种足部加速度计动态零速校准方法及系统。
背景技术
目前,随着微机电系统MEMS传感器的微型化发展,使得MEMS陀螺仪、加速度计、压力计等组成的惯性定位系统进一步缩小,从而基于惯性传感器的人员定位技术得到了进一步发展,惯性定位技术日益受到重视。MEMS加速度计的零速偏移误差一直存在,而安装误差校准只能对静止放置的加速度计进行校准,而当人员配戴定位终端进行测试或者实验时,需要在动态的情况下去校准零速信息。
发明内容
为了克服上述现有技术中存在的缺陷,本发明的目的是提供一种足部加速度计动态零速校准方法及系统。
为了实现本发明的上述目的,本发明提供了一种足部加速度计动态零速校准方法,包括以下步骤:
S1,在足部设置加速度计以及压力计,采集足部加速度计的加速度、时间原始数据信息,采集足底压力计的压力、时间原始数据信息,所述加速度计与压力计的时间信息同步;
S2,对加速度计与压力计所采集的信息进行数据提取处理,然后根据处理后的信息对人员行走时当前运动区间的足部零速信息进行检测,得到当前运动区间内加速度计的零速区间与压力计的零速区间,将加速度计测得的零速区间与压力计测得的零速区间的合集区间作为对应运动区间的零速区间,该运动区间的剩余区间为动态区间;
S3,分别计算当前运动区间内零速区间、动态区间的零速偏移量;
采用零速区间零速偏移量对该运动区间内的零速区间的足部加速度计输出的加速度进行校准;采用动态区间零速偏移量对该运动区间内的动态区间的足部加速度计输出的加速度进行校准;完成足部加速度计动态零速校准。
本方法引入非惯性器件-压力计来辅助校准惯性器件的动态零速信息,减少了零速区间内的异常突跳点,提高了加速度计的零偏稳定性。该方法提高了人员运动时的加速度测量精度,可用于对人员行走过程中的足部加速度计零速偏移校准。
本申请还提出了一种足部加速度计动态零速校准系统,包括设置于足部的加速度计和压力计,所述加速度计和压力计的信息输出端分别连接至控制单元信息输入端,所述控制单元按上述的足部加速度计动态零速校准方法对足部加速度计进行动态零速校准。该足部加速度计动态零速校准系统可以有效提高加速度计的零速稳定性与测量速度精度。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1是该足部加速度计动态零速校准方法的流程示意图;
图2是零速区间检测结果示意图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。
在本发明的描述中,除非另有规定和限定,需要说明的是,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是机械连接或电连接,也可以是两个元件内部的连通,可以是直接相连,也可以通过中间媒介间接相连,对于本领域的普通技术人员而言,可以根据具体情况理解上述术语的具体含义。
如图1所示,本发明提供了一种足部加速度计动态零速校准方法,包括以下步骤:
S1,在足部设置加速度计以及压力计,采集足部加速度计的加速度、时间原始数据信息,采集足底压力计的压力、时间原始数据信息,所述加速度计与压力计的时间信息同步。
具体设置时,本实施例中,加速度计设置于足部前端,压力计设置于足底与鞋垫之间。
S2,对加速度计与压力计所采集的信息进行数据提取处理,然后根据处理后的信息对人员行走时当前运动区间的足部零速信息进行检测,得到当前运动区间内加速度计的零速区间与压力计的零速区间,将加速度计测得的零速区间与压力计测得的零速区间的合集区间作为对应运动区间的零速区间,该运动区间的剩余区间为动态区间。
对加速度计与压力计所采集的信息进行数据提取处理时,本实施例优选但不限于把加速度计与压力计作为贝叶斯估计算法的2个数据源,在一次测量结果为y时,加速度值与压力值分别发生的概率为p(acceli|y)与p(forcei|y),对一段时间内加速度计输出的加速度值(accel1,accel2,...,acceln)与压力计输出的数据(force1,force2,...,forcen)分别利用贝叶斯估计算法得到最佳估计值ai与fi,ai与fi计算公式为:
Figure BDA0003020700050000041
Figure BDA0003020700050000042
本实施例中,当前运动区间内加速度计测得的零速区间判断方法为:
采集足部加速度计x轴的原始数据,计算加速度计的零速区间指标值
Figure BDA0003020700050000043
其中,
Figure BDA0003020700050000044
表示x轴加速度最大零速阈值,
Figure BDA0003020700050000045
表示x轴加速度最小零速阈值,ax为加速度计x轴输出的加速度;当Za(i)=1时,则当前时间点处于零速区间;当加速度计的零速区间指标值Za(i)=0时,则当前时间点不处于零速区间,i指第i个采样点。
当前运动区间内压力计测得的零速区间判断方法为:
计算压力计的零速区间指标值
Figure BDA0003020700050000046
其中
Figure BDA0003020700050000047
表示压力电阻最大零速阈值,
Figure BDA0003020700050000048
表示压力电阻最小零速阈值,ri表示检测到压力变化时输出的电阻值;当Zr(i)=1时,则当前时间点处于零速区间;当加速度计的零速区间指标值Zr(i)=0时,则当前时间点不处于零速区间。
因此,足部零速区间Z(i)=Za(i)∪Zr(i),如图2所示。
这里一个运动区间可根据具体需要进行设定,可以是行走一步即为一个运动区间,可以是运动一段时间为一个运动区间,可以是运动一段距离为一个运动区间等。
S3,分别计算当前运动区间内零速区间、动态区间的零速偏移量;
采用零速区间零速偏移量对该运动区间内的零速区间的足部加速度计输出的加速度进行校准;采用动态区间零速偏移量对该运动区间内的动态区间的足部加速度计输出的加速度进行校准;完成足部加速度计动态零速校准。
零速更新后的加速度值的计算方法如下:
在静止状态下,加速度计x轴的输出ax会发生零位偏移,其中最大偏移值可达为0.01m/s^2,为了减小偏移,首先通过平滑滤波处理,计算出加速度零速差值。
因此,本实施例中,
Figure BDA0003020700050000051
Figure BDA0003020700050000052
对一段时间内的加速度值作平滑滤波处理,得到零速区间零速偏移量,即
Figure BDA0003020700050000053
N1<i≤N2
Figure BDA0003020700050000058
Figure BDA0003020700050000055
N2<i<N3
因此,在当前运动区间内,校准后的加速度值的计算方法如下:
校准后的实时加速度值
Figure BDA0003020700050000056
其中
Figure BDA0003020700050000057
为足部加速度计x轴实时输出值,
Figure BDA0003020700050000061
其中,N1指当前运动区间内零速区间的起点数据序号,N2指当前运动区间内零速区间的终点数据序号,也是当前运动区间内动态区间的起点数据的序号,N3指当前运动区间内动态区间的终点数据的序号,i指第i个采样点,r指平滑滤波的滑动区间长度。
这里将下一个时间段的运动加速度初始值减去零偏差值,就得到了动态校准之后的加速度值。以此类推,就可以实现对整个动态行走过程的动态零位校准,提高加速度计的测量精度,为后面步数检测、步长估算奠定基础。
为了确保准确性,该方法还包括步骤S4,将零速校准后的加速度值输入校准程序中,分析动态零速偏移标准偏差,若偏差小于额定要求偏差值,则验证通过,动态零速校准结束;若偏差大于额定要求偏差值,则验证不通过,返回步骤S1分析修改校准模型,继续完善零偏校准方法。
本申请还提出了一种足部加速度计动态零速校准系统的实施例,该系统包括设置于足部的加速度计和压力计,所述加速度计和压力计的信息输出端分别连接至控制单元信息输入端,所述控制单元按上述的足部加速度计动态零速校准方法对足部加速度计进行动态零速校准。该系统可以有效提高加速度计的零速稳定性与测量速度精度。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。

Claims (4)

1.一种足部加速度计动态零速校准方法,其特征在于,包括以下步骤:
S1,在足部设置加速度计以及压力计,采集足部加速度计的加速度、时间原始数据信息,采集足底压力计的压力、时间原始数据信息,所述加速度计与压力计的时间信息同步;
S2,对加速度计与压力计所采集的信息进行数据提取处理,然后根据处理后的信息对人员行走时当前运动区间的足部零速信息进行检测,得到当前运动区间内加速度计的零速区间与压力计的零速区间,将加速度计测得的零速区间与压力计测得的零速区间的合集区间作为对应运动区间的零速区间,该运动区间的剩余区间为动态区间;
S3,分别计算当前运动区间内零速区间、动态区间的零速偏移量;
采用零速区间零速偏移量对该运动区间内的零速区间的足部加速度计输出的加速度进行校准;采用动态区间零速偏移量对该运动区间内的动态区间的足部加速度计输出的加速度进行校准;完成足部加速度计动态零速校准;
校准后的加速度值的计算方法如下:
校准后的实时加速度值
Figure FDA0003829164170000011
其中
Figure FDA0003829164170000012
为足部加速度计x轴实时输出值,
Figure FDA0003829164170000013
为零速差值,
Figure FDA0003829164170000014
其中,N1指当前运动区间内零速区间的起点数据序号,N2指当前运动区间内零速区间的终点数据序号,也是动态区间的起点数据的序号,N3指当前运动区间内动态区间的终点数据的序号,i指第i个采样点,r指平滑滤波的滑动区间长度。
2.根据权利要求1所述的足部加速度计动态零速校准方法,其特征在于,还包括步骤S4,将零速校准后的加速度输入校准程序中,分析动态零速偏移标准偏差,若偏差小于额定要求偏差值,则验证通过,动态零速校准结束;若偏差大于额定要求偏差值,则验证不通过,返回步骤S1调整加速度计以及压力计的设置位置,重新完善零偏校准。
3.根据权利要求1所述的足部加速度计动态零速校准方法,其特征在于,所述步骤S2中,
当前运动区间内加速度计测得的零速区间判断方法为:
采集足部加速度计x轴的原始数据,计算加速度计的零速区间指标值
Figure FDA0003829164170000021
其中,
Figure FDA0003829164170000022
表示x轴加速度最大零速阈值,
Figure FDA0003829164170000023
表示x轴加速度最小零速阈值,ax为加速度计x轴输出的加速度;当Za(i)=1时,则当前时间点处于零速区间;当加速度计的零速区间指标值Za(i)=0时,则当前时间点不处于零速区间,i指第i个采样点;
当前运动区间内压力计测得的零速区间判断方法为:
计算压力计的零速区间指标值
Figure FDA0003829164170000024
其中
Figure FDA0003829164170000025
表示压力电阻最大零速阈值,
Figure FDA0003829164170000026
表示压力电阻最小零速阈值,ri表示检测到压力变化时输出的电阻值;当Zr(i)=1时,则当前时间点处于零速区间;当加速度计的零速区间指标值Zr(i)=0时,则当前时间点不处于零速区间。
4.一种足部加速度计动态零速校准系统,其特征在于,包括设置于足部的加速度计和压力计,所述加速度计和压力计的信息输出端分别连接至控制单元信息输入端,所述控制单元按权利要求1-3任一项所述的足部加速度计动态零速校准方法对足部加速度计进行动态零速校准。
CN202110401906.4A 2021-04-14 2021-04-14 足部加速度计动态零速校准方法及系统 Active CN113092819B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110401906.4A CN113092819B (zh) 2021-04-14 2021-04-14 足部加速度计动态零速校准方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110401906.4A CN113092819B (zh) 2021-04-14 2021-04-14 足部加速度计动态零速校准方法及系统

Publications (2)

Publication Number Publication Date
CN113092819A CN113092819A (zh) 2021-07-09
CN113092819B true CN113092819B (zh) 2022-11-18

Family

ID=76677460

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110401906.4A Active CN113092819B (zh) 2021-04-14 2021-04-14 足部加速度计动态零速校准方法及系统

Country Status (1)

Country Link
CN (1) CN113092819B (zh)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4026159A (en) * 1976-02-23 1977-05-31 United Technologies Corporation Fluidic angular rate sensor null error compensation
CN105547291A (zh) * 2015-12-31 2016-05-04 长沙格致电子科技有限公司 室内人员自主定位系统的自适应静止检测方法
CN106908060A (zh) * 2017-02-15 2017-06-30 东南大学 一种基于mems惯性传感器的高精度室内定位方法
CN111721288A (zh) * 2020-06-19 2020-09-29 哈尔滨工业大学 一种mems器件零偏修正方法、装置及存储介质

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100643304B1 (ko) * 2005-02-15 2006-11-10 삼성전자주식회사 관성 센서 보정 장치 및 방법, 그리고, 상기 방법을 기록한기록 매체
CN103644910A (zh) * 2013-11-22 2014-03-19 哈尔滨工程大学 基于分段rts平滑算法的个人自主导航系统定位方法
CN106017461B (zh) * 2016-05-19 2018-11-06 北京理工大学 基于人体/环境约束的行人导航系统三维空间定位方法
CN106482733B (zh) * 2016-09-23 2019-10-01 南昌大学 行人导航中基于足底压力检测的零速修正方法
CN109115207B (zh) * 2017-06-23 2021-06-04 北京方位捷讯科技有限公司 行人步行轨迹检测方法、装置及系统
CN107543544A (zh) * 2017-09-11 2018-01-05 中南民族大学 行人惯性导航中的零速度检测系统
CN108186021B (zh) * 2017-12-22 2021-02-19 北京中科汇成科技有限公司 一种基于多模态信息融合的步态零速检测方法及系统
CN108362282B (zh) * 2018-01-29 2020-10-27 哈尔滨工程大学 一种基于自适应零速区间调整的惯性行人定位方法
CN108680184B (zh) * 2018-04-19 2021-09-07 东南大学 一种基于广义似然比统计曲线几何变换的零速检测方法
CN109646009B (zh) * 2018-11-15 2021-11-26 北京中科汇成科技有限公司 基于便携式步态分析系统的步态时空参数的计算方法
CN109489694A (zh) * 2019-01-02 2019-03-19 中国船舶重工集团公司第七0七研究所 一种压敏传感器辅助的单兵导航系统零速检测方法
CN109827577B (zh) * 2019-03-26 2020-11-20 电子科技大学 基于运动状态检测的高精度惯性导航定位算法
CN110455316B (zh) * 2019-08-27 2021-08-06 哈尔滨工业大学 一种自适应零速区间检测方法
CN110702104B (zh) * 2019-09-27 2023-09-26 同济大学 一种基于车辆零速检测的惯性导航误差修正方法
CN110672095A (zh) * 2019-10-17 2020-01-10 北京首贝科技发展有限公司 一种基于微惯导的行人室内自主定位算法
CN112099468A (zh) * 2020-08-12 2020-12-18 东方红卫星移动通信有限公司 一种基于粒子群的整车控制策略测试用例自动生成方法
CN112362057B (zh) * 2020-10-26 2023-05-02 中国人民解放军海军航空大学 基于零速修正与姿态自观测的惯性行人导航算法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4026159A (en) * 1976-02-23 1977-05-31 United Technologies Corporation Fluidic angular rate sensor null error compensation
CN105547291A (zh) * 2015-12-31 2016-05-04 长沙格致电子科技有限公司 室内人员自主定位系统的自适应静止检测方法
CN106908060A (zh) * 2017-02-15 2017-06-30 东南大学 一种基于mems惯性传感器的高精度室内定位方法
CN111721288A (zh) * 2020-06-19 2020-09-29 哈尔滨工业大学 一种mems器件零偏修正方法、装置及存储介质

Also Published As

Publication number Publication date
CN113092819A (zh) 2021-07-09

Similar Documents

Publication Publication Date Title
US7822563B2 (en) Method and device for calculating magnitude of wheel-generated cornering force
CN103913171A (zh) 基于加速度计和陀螺仪的载体转速与转角补偿测量方法
CN106153069B (zh) 自主导航系统中的姿态修正装置和方法
CN104613965B (zh) 一种基于双向滤波平滑技术的步进式行人导航方法
JP2017067723A (ja) 計測装置、計測システム、計測方法、及びプログラム
CN108030497B (zh) 一种基于imu惯性传感器的步态分析装置及其方法
KR101348817B1 (ko) 인공신경망을 이용한 오류 계측값 추정 방법 및 시스템
CN110455284B (zh) 一种基于mems-imu的行人运动模式识别方法及装置
CN113092819B (zh) 足部加速度计动态零速校准方法及系统
CN114469073B (zh) 基于可穿戴传感器的步态分析与异常检测方法
WO2023108315A1 (zh) 基于步可穿戴传感器的步态分析与异常检测方法
CN111351628B (zh) 一种高超声速风洞连续变攻角试验数据处理方法
CN109758703B (zh) 一种用于消防火场气压高度传感器的误差修正系统及方法
CN110410057B (zh) 抽油机井光杆悬点死点的检测方法及系统
KR101372406B1 (ko) 회전축 분석 장치
JP2002131077A (ja) 移動体の停止判定方法及び停止判定装置ならびに停止判定プログラムを記録した記憶媒体
CN111337050B (zh) 一种基于多条件融合的零速判断条件及计步方法
CN113445992A (zh) 抽油机运动位移的处理方法和装置
CN112985390B (zh) 一种基于磁强计辅助的步态检测方法
CN114427870B (zh) 一种离心机速率精度自标定自补偿方法
CN115046548A (zh) 一种多条件约束的零速区间检测方法
CN110065864A (zh) 一种利用手机测量电梯运行数据的方法
JP5815866B2 (ja) ヨーレートセンサユニットの出力信号の評価方法、及び、ヨーレートセンサユニット
CN110231031A (zh) 一种姿态角确定方法、装置及系统
KR102424438B1 (ko) 센서 어레이의 동적 변위 탐지에 기초하는 구조물 상태 진단 방법

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: 401120 39-1, Building 1, No. 64, Middle Huangshan Avenue, Yubei District, Chongqing

Patentee after: China Star Network Application Co.,Ltd.

Address before: 618 Liangjiang Avenue, Longxing Town, Yubei District, Chongqing

Patentee before: Dongfanghong Satellite Mobile Communication Co.,Ltd.