CN103884337B - 多姿态步距校正定位系统与方法 - Google Patents

多姿态步距校正定位系统与方法 Download PDF

Info

Publication number
CN103884337B
CN103884337B CN201310137189.4A CN201310137189A CN103884337B CN 103884337 B CN103884337 B CN 103884337B CN 201310137189 A CN201310137189 A CN 201310137189A CN 103884337 B CN103884337 B CN 103884337B
Authority
CN
China
Prior art keywords
step pitch
pose
correction
money
signal
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
CN201310137189.4A
Other languages
English (en)
Other versions
CN103884337A (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.)
Industrial Technology Research Institute ITRI
Original Assignee
Industrial Technology Research Institute ITRI
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 Industrial Technology Research Institute ITRI filed Critical Industrial Technology Research Institute ITRI
Publication of CN103884337A publication Critical patent/CN103884337A/zh
Application granted granted Critical
Publication of CN103884337B publication Critical patent/CN103884337B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C22/00Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
    • G01C22/006Pedometers
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183Compensation of inertial measurements, e.g. for temperature effects
    • G01C21/188Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation

Abstract

本发明公开了一种多姿态步距校正定位系统,适用于一移动装置,包括:至少一惯性感测元件,以感测该移动装置的至少一感测信号;一信号前处理单元,连接该感测元件,以处理该感测信号;一多姿态判断单元,接收并判断该经处理过的感测信号而决定出至少一姿态;一计步决策单元,依据该经处理过的感测信号,以计算出一步数及一步频;一图资特征校正单元,接收该步数、该步频与该姿态,以判断一步距是否符合一条件;一计步阈值调整单元,当该图资特征校正单元判断该步距为不符合该条件时,该计步阈值调整单元调整一计步阈值;以及一步距回归单元,当该图资特征校正单元判断该步距为符合该条件时,该步距回归单元根据该步频与该步距,更新该姿态的一步距回归曲线。

Description

多姿态步距校正定位系统与方法
技术领域
本发明是有关适用于移动装置的一种多姿态步距校正定位系统与方法。
背景技术
近年来消费型电子产品,如移动装置(mobile device,包含智能型手机、平板计算机等)均配备有各类型的感测元件,以提供用户更佳的应用功能与全新的体验,加上行动定位技术在近几年的发展,尤其是各种技术的混合研究和应用,使得个人导航、社群网络分享和LBS(Location-based Service)定位信息服务,已成为智能型手机和平板计算机应用的新焦点,并给人们带来极大的便利。然而,消费者若要通过移动装置在室内得到实时、正确且多样性的导航定位服务时,如何以智能型手机和平板计算机及其所配备的感测元件达成如此需求,则将是一关键。
传统惯性感测元件(Inertial Measurement Unit,IMU)定位系统是配合运动感知器,例如加速度计、陀螺仪及磁力计等,以估测出行进距离及方向,然而,若以智能型手机或平板计算机等移动装置作为定位系统的装置,用户将会有各种不同的手持或摆放该移动装置的姿态,在不同姿态下,感测元件所侦测到用户的步态信号也将有所不同。另外,由于惯性导航是根据位移与航向进行位置推算,因而将随着距离变大,其误差也不断累积,另外在不同使用者使用时,也存在了误差的问题。
发明内容
本发明的一实施例提供一种多姿态步距校正定位系统,适用于移动装置,包括:至少一惯性感测元件,以感测该移动装置的至少一感测信号;信号前处理单元,连接该感测元件,以处理该感测信号;多姿态判断单元,接收并判断经处理过的感测信号而决定出至少一姿态;计步决策单元,依据所述经处理过的感测信号,以计算出步数及步频;图资特征校正单元,接收该步数、该步频与该姿态,以判断步距是否符合条件;计步阈值调整单元,当该图资特征校正单元判断该步距为不符合该条件时,该计步阈值调整单元调整计步阈值;以及步距回归单元,当该图资特征校正单元判断该步距为符合该条件时,该步距回归单元根据该步频与该步距,更新该姿态的步距回归曲线。
本发明的另一实施例提供一种多姿态步距校正定位方法,适用于移动装置,包括以下步骤:依据至少一感测信号,并对该感测信号进行前处理;依据处理过的感测信号,进行姿态判断,以决定该装置的姿态;依据所述处理过的感测信号,进行计步演算,以计算出步数与步频;依据该步数、该步频与该姿态,进行步距计算,并判断该步距是否符合条件;当该步距符合时,则依据该步距与该步频,更新姿态步距回归方程式;当该步距不符合时,则调整计步阈值,并重新进行该计步演算。
附图说明
图1为本发明的多姿态步距校正定位系统架构示意图。
图2为使用本发明多姿态步距校正定位方法的流程图。
图3为本发明多姿态判断单元的姿态模式判断方法的流程示意图。
图4为本发明计步决策单元的计步演算实施例的流程示意图。
图5(A)~(C)为调整计步阈值的一范例。
图6为本发明的实时动态步距校正方法的流程图。
图7为本发明以图资特征及利用转弯信号校正室内定位的流程图。
图8为图7的以图资特征及利用转弯信号校正室内定位的一实施例。
图9为本发明以图资特征及利用多路径校正室内定位的流程图。
图10为图9的以图资特征及利用多路径校正室内定位的一实施例。
【主要元件符号说明】
110 惯性感测元件
111 加速度计
112 陀螺仪
113 磁力计
120 信号前处理单元
130 多姿态判断单元
140 计步决策单元
150 图资特征校正单元
160 计步阈值调整单元
170 步距回归单元
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,以下结合具体实施例,并参照附图,对本发明进一步详细说明。
图1为本发明的多姿态步距校正定位系统架构示意图。如图1所示,本实施例的多姿态步距校正定位系统是应用于一移动装置上(mobile device),例如包含智能型手机、平板计算机、电子书、个人数字助理(PDA)、电子卷标(Tag)等,亦可与其它伺服装置配合,包含至少一惯性感测元件110、一信号前处理单元120、一多姿态判断单元130、一计步决策单元140、一图资特征校正单元150、一计步阈值调整单元160、以及一步距回归单元170;其中,该惯性感测元件110,例如是一加速度计111、一陀螺仪112或一磁力计113,是用来感测使用者所手持或摆放该移动装置的姿态与运动信号,即是指该移动装置于任何时刻下所发出的惯性信号;该信号前处理单元120连接于该惯性感测元件110,以处理该惯性感测元件110所感测的信号;该多姿态判断单元130将经过该信号前处理单元120所处理过的感测信号进行判断,以决定使用者所手持或摆放该移动装置的姿态为何;该计步决策单元140进行该用户步数的估算,并将步数、步频与姿态等信息通过信号传递给该图资特征校正单元150;该图资特征校正单元150接收该步数、步频与姿态等信息,并判断步距是否合理,所谓合理与否是指该步距是否落入使用者正常步幅距离之内;当该图资特征校正单元150判断步距结果为不合理或范围之外时,该计步阈值调整单元160进行调整计步阈值;该步距回归单元170连接于该图资特征校正单元150,当该图资特征校正单元150判断步距结果为合理时,该步距回归单元170根据该步频与步距的关系,以更新该姿态的步距回归曲线。本发明所指的移动装置若与一伺服装置(图中未示出)配合实施时,上述的图资特征校正单元150、计步阈值调整单元160与步距回归单元170,或除惯性感测元件110以外的所有单元归并于该伺服装置内实施,另外为了能够沟通二装置,二装置中更各增加一信号接收与传送单元(图中未示出),此信号接收与传送单元可以有线或无线方式来实现。
本实施例中,信号前处理单元120对所接收到的感测信号的处理包含信号校正、同步、滤波(如移动平均滤波与一阶无限脉冲响应滤波(Infinite Impulse ResponseFilter)等),上述处理可相互搭配使用,或其中之一项,及坐标转换(如尤拉角与四元数等)等,以将惯性感测元件110所感测的各种信号,从用户的身体坐标转到地球坐标,以利于后续处理,多姿态判断单元130再进行判断以决定使用者所手持或摆放该移动装置的姿态为何,因为用户在使用移动装置时,将因为不同的手持或摆放的姿态,例如:手持该移动装置于胸前行走、手持该移动装置并前后摆动行走、将该移动装置系于腰部、上衣或裤子口袋、手提包或背包内行走、将该移动装置置于鞋子上、或绑置在身体躯干、四肢等可固定的部位行走。然而,以上各姿态不同或混合时,都会有不同的加速度型态(pattern),因此必须通过多姿态判断单元130进行型态模式的估测,以进行不同计步模式切换与计算。
多姿态判断可由磁力计的感测值判断使用者所手持或摆放该行动装置的姿态为何。例如,当行动装置水平置于手提包里时,测量到一组三轴磁力值m,合力大小为|m|,将mx、my(x,y轴磁力值)做atan求得水平航向角a1,已知台湾地区对磁北极的倾角为a2,经由a1、a2可得到一坐标转换用的旋转矩阵T,因此T*m=[0,|m|,0],若当行动装置垂直置于胸前口袋时,上述条件将不成立,即可从磁力计的感测值中判断行动装置是置于手提包内或者胸前口袋的姿态。
多姿态判断亦可包含由加速度计、陀螺仪或磁力计的值或其中之一所计算出的翻滚、俯仰或偏摆来判断使用者所手持或摆放该行动装置的姿态为何。例如,经由实际行走的实验数据分析,在不同手持或摆放该移动装置的行走模式下,会有显著的翻滚(roll)与俯仰(pitch)的差异,若在手持移动装置于胸前行走时,由于用户会观看屏幕来得知目前定位的位置,故较会能维持一平稳状态,因此翻滚的变化幅度较小;但是,当用户将装置握在手中前后摆动行走或将装置挂在腰间手机套内行走,则翻滚势必会呈现近似90度(或-90度)变化。另外在手持装置前后摆动行走时,用户会将移动装置以画弧形的前后摆动,所以俯仰会约在+20与-20度间来回震荡,因此通过判断翻滚及俯仰等的加速度变化,即可辨识使用者如何使用或摆放移动装置的型态。
若当使用者以新的手持或摆放的姿态行走时,经一段时间的翻滚、俯仰或偏摆(yaw)后,将会呈现稳定且重复出现的型态,且异于先前型态,多姿态判断单元130能自动新增该姿态的辨识型态,及将该新型态新增于多姿态判断单元之内。
图2为本发明的多姿态步距校正定位的方法流程图。如图2所示,步骤201,接收至少一感测信号,例如加速度计的三轴加速度值、陀螺仪的角加速度值与磁力计对地磁的变化量等,但不受限于此三种,单一感测元件在本发明中已可基本实施,并对感测信号进行前处理,例如但不受限于,包含信号校正、同步、滤波(如移动平均滤波与一阶无限脉冲响应滤波等),上述处理可相互搭配使用,或其中之一项,及坐标转换(如尤拉角与四元数等)等;其中该感测信号包含陀螺仪与磁力计的翻滚、俯仰与偏摆,以及加速度的Z轴(地球坐标中垂直于水平面的轴)的振幅值。步骤202,进行初始化,例如包含设定Z轴阈值与合理步距的初始值,所谓合理步距是指约0.5~0.9公尺,此范围可自行设定但不受限。步骤203,根据初始化后的感测信号,进行多姿态判断以决定使用者是以何种姿态持用或摆放移动装置;其中,该多姿态判断包含手持装置于胸前行走模式、将装置挂在腰间行走模式、将装置握于手中前后摆动行走模式等可能的型态。步骤204,亦根据初始化后的感测信号进行计步演算,以完成对步数与步频的估算。步骤205,取得图资特征信息,由室内摆设、走道与转角的图资及感测信号,可得知行走的距离等;然后执行步骤206,以判断步骤204中所计算出的步距是否合理;当步距合理时,则进行步骤207,将步距与步频等信息代入以更新姿态步距回归方程式;当步距不合理时,则执行步骤208,进行动态调整计步阈值,并重新执行步骤204的计步演算。
图3为本发明的多姿态判断单元130的姿态模式判断方法的流程示意图。步骤301,接收经过该信号前处理单元120处理的感测信号。步骤302,决定该感测信号的翻滚值是否大于一翻滚预定值,例如45度等;当该感测信号的翻滚值小于45度时,则判断姿态模式为手持装置于胸前行走模式,如步骤303所示;反之,则执行步骤304再决定该感测信号的俯仰值是否大于一俯仰预定值,例如20度;当该感测信号的俯仰值小于20度时,则判断姿态模式为将装置挂在腰间行走模式,如步骤305所示;反之,则判断姿态模式为将装置握于手中前后摆动行走模式,如步骤306所示。
在本实施例中,翻滚预定值设为45度是因为当用户将移动装置握在手中前后摆动行走,或将装置挂在腰间手机套内行走时,翻滚势必会呈现近似90度(或-90度)。因此,取其一半的数值作为该翻滚预定值,此为举例说明但不受限。同理,俯仰预定值设为20度是因为当使用者以画弧形的前后摆动模式手持装置行走,俯仰会在约+20与-20度间来回震荡。当然,以上翻滚预定值与俯仰预定值可由使用者设为其它数值。
图4为本发明的该计步决策单元140的计步演算实施例的流程示意图,以Z轴加速度为例。步骤401,记录加速度计的读值,并以波形方式记录之;在步骤402中,设定加速度波形的一阈值,该阈值是用来判断加速度波形是否足够明显以符合计步的条件。步骤403,找出该加速度波形的最大值(波峰)及最小值(波谷)。在步骤404中,若波峰及波谷皆超过所设定的阈值,则该加速度波形明显具有计步的特性,略去波峰或波谷未超过该阈值的波形。在步骤405中,若该加速度波形顺序依序为零点、波峰、零点、波谷及回到零点,则视为完整一步的波形,并列入计数。
由此,该计步决策单元140可将步数算出,在行走距离已知的情况下,得以计算出使用者的步频。接着,将所计算的步数与步频,以及多姿态判断单元130判断所得的姿态,传递至该图资特征校正单元140,通过判断步距是否合理来判断该步数与步频是否也合理;当该图资特征校正单元150判断步距结果为不合理时,该计步阈值调整单元则须进行调整计步阈值。
在上述的计步流程中,通过决定计步阈值来判断加速度Z轴值的波形是否可被估算成一步;当阈值设定过大时,容易遗失太轻的步伐计算;反之,当阈值设定过小时,容易将手部晃动误计算成一步。由于步态的轻重、快慢皆因人而异,因此需适时动态调整计步阈值,以得到准确的计步步数。另外,可通过图资特征校正信息提供已知的距离,推估合理的步距(例如,一般人正常步伐的步距约0.5~0.9公尺),若计步过少(即步距过大),需调低阈值;反之,若计步过多(即步距过小),则须调高阈值。
图5为计步阈值调整的一范例。当使用者在6.5公尺的距离真正行走10步时,而Z轴阈值设为0.6与-0.6,经由计步流程可正确估算出10个步伐,平均每一步为0.65公尺,属于合理的估算,如图5A所示。然而,如图5B所示,当使用者步态较轻时,相对之下加速度Z轴的振福也会比较小,此时若以Z轴阈值0.6与-0.6来估算步伐个数,仅能找出4步,每一步距离为1.625公尺,不符合正常人行走的常理,因此须将Z轴阈值调小,例如,当阈值减小为0.35与-0.35时,即可正确估算出10步。另一方面,如图5C所示,用户在手持移动装置下,很有可能会有手晃或不经意摆动的情况出现,造成误计算成一步。若使用者一样在6.5公尺距离真正行走10步,但发生手部晃动等情况时,若Z轴阈值设为0.35与-0.35,能找出14步,每一步距离为0.462公尺,步距过小不符合常理,须将Z轴阈值调大,当阈值增加为0.6与-0.6时,即可正确估算出10步。如此通过动态调整Z轴的阈值,能随个人步态的轻重、快慢,可适时动态调整计步阈值,以得到准确的计步步数。
步距估测算法主要考虑行人在平稳的行走方式下,步伐长度将因每个人的基本体态而有着不同的行走步长,如:身高、体重、年龄、步频及行走速率等。不同的步伐长度将直接影响行人室内定位的准确度,现有技术常以身高、体重、腿长及年龄当成建立步距回归映像模型的输入变量。然而,用户须输入个人基本数据参数当作是步距回归映像模型的影响变量。并且,仍须进一步收集其它相关信息以建立大型数据库,才能使步距估测更加强健与准确,避免造成步距估算错误。有鉴于此,本发明提出一实时动态步距校正方法以有效提高定位步距估算的准确度。
一般行人的行走频率与行走步距有关,行走频率越快,步距也会越大;反之,行走频率越慢,步距越小。可依步频与步距的关系以建立一步距回归映像模型,然而传统的作法缺点是所有人使用同一个步距回归方程式,容易造成步距估算产生误差。计算流程如下所示:
步距(Stride Length,SL)=距离(L)/步数 (1)
平均步间(Average Step Interval,SI)=∑Δt/步数 (2)
其中Δt为每一步的行走时间
步频(Step Frequency,SF)=1/平均步间 (3)
图6为本发明的实时动态步距校正方法的流程图。如图6所示,在步骤601中,由室内图资的信息可得知每一通道、走廊的距离,通过用户连续二个转弯信息,可得知期间通过通道的总行走距离(L)。其中,总行走距离(L)亦可由全球定位系统(Global PositioningSystem;GPS)、红外线(Infrared)、超音波(Ultrasound)、射频辨识(Radio FrequencyIdentification)、超宽带(Ultra Wideband)、可见光通信(Visible LightCommunication)、蓝芽(Bluetooth)、Zigbee、影像定位、WiFi与惯性感测元件等定位相关技术取得。在步骤602中,期间由惯性感测元件记录行经该信道的总行走步数与时间,可求得每一步的步距(SL)与步频(SF),并滤除不合理的步距与步频(例如,过大或过小)。在步骤603中,当使用者在室内陆续获得不同步距与步频时,分别将步距与步频代入步距回归分析,可求得SL与SF的关系(直线):
SLi=α×SFi+β (4)
其中,SLi与SFi为第i步的步距与步频;
α为SL与SF关系直线的斜率;
β为一常数。
上述的实时动态步距校正方法的优点为,不同使用者在不同的手持或摆放移动装置的姿态、各步距与步频的对应关系、步距回归映像模型下,能有专属的实时校正步距与修正回归方程式,而且使用者不需要输入任何步距回归映像模型的参数,更符合人性化需求。其中,该步距回归演算可包含线性回归与非线性回归方法。
举例来说,经由室内图资信息,用户可得到总行走距离,通过惯性感测元件能估算用户的步数与步频,即可求得在不同行走速度下的步频与步距关系。例如,当用户为手持装置于胸前行走模式,行走速度为正常速度、慢速与快速。由三种不同行走速度下的步频与步距关系,可求得手持装置于胸前行走模式的步距回归曲线或直线。同样地,当用户将装置挂于腰间行走、或拿在手中前后摆动行走时,亦可获得相对的步距回归曲线或直线。
使用者在室内空间中长时间的移动,会随着行走距离变大其定位误差也会不断累积,本发明可通过图资特征校正、惯性感测元件室内定位,来校正用户的定位位置。图7为本发明利用图资特征与惯性感测元件所感测到的转弯信号于室内定位的流程图。步骤701,由惯性感测元件110的感测信号来计算步数与步距;步骤702,判断是否侦测到转弯信号,当陀螺仪或磁力计未侦测到转弯信号时(直行情况),则进行步骤705,在图资上更新人员的位置;否则,进行步骤703,记录侦测到转弯信号后的步数与步距,以及步骤704,在转弯的节点上加上已记录的步数与步距,最后执行步骤705,在图资上更新人员的位置。
图8为图7中以图资特征与转弯信号校正室内定位的一实施例。其中附图标记1是图资显示人员目前的位置,附图标记2表示此时陀螺仪与磁力计侦测到有转弯信号发生的位置,但图资上未显示该人员在附图标记2的节点上,而附图标记3是图资将人员先送至转弯的节点上,随后加上所记录转弯后的步数与步距,再由图资更正人员到当前的位置,即附图标记3处。
图9为本发明以图资特征及利用多追踪路径校正室内定位的流程图。步骤901,由惯性感测元件110来计算步数与步距;步骤902,判断是否侦测到转弯信号,当陀螺仪或磁力计侦未测到转弯信号时(直行情况),则进行步骤908,在图资上更新人员的位置;否则进行步骤903,以该转弯节点为第一追踪路径,离该转弯节点最近的另一转弯节点为第二追踪路径。在步骤904中,记录转弯后的步数与步距。步骤905,判断第一追踪路径的转弯节点上是否可转弯,即判断其转弯特征;若是,则执行步骤907在转弯节点上加上转弯后的步数与步距,并执行步骤908,在图资上更新人员的位置;否则,先执行步骤906,舍弃第一追踪路径,以第二路径的转弯节点为主,再执行步骤907在转弯节点上加上转弯后的步数与步距,并执行步骤908,在图资上更新人员的位置。
图10为图9中以图资特征及利用多路径校正室内定位的一实施例。如图10所示,由图8当前人员的所在位置(附图标记3),若附图标记1为此时陀螺仪与磁力计侦测到向下转弯的信号,且可以继续行走,然而第一追踪路径依据图资特征,并无通路可向下转弯行走,但第二追踪路径则有。故标识第一追踪路径为错误路径,第二追踪路径如附图标记2所示才是正确路径,记录转弯信号与转弯后的步数与步距,图资先将人员送至第二追踪路径转弯的节点上(如图8的附图标记3所示),随后将所记录的步数与步距立即加上,即可经由图资修正人员当前的位置。
本发明的多姿态步距校正定位系统亦可采用主从式(server/client)架构实现,如前述。例如,可将该惯性感测元件110、信号前处理单元120、多姿态判断单元130以及计步决策单元140设置于一终端移动装置上,而将该图资特征校正单元150、计步阈值调整单元160以及步距回归单元170设置于一伺服装置上,并在移动装置与伺服装置分别设置一信号接收与传送单元(图中未示出)以进行信号接收与传输。当计步决策单元140完成步数估算后,将步数、步频与姿态等信息,通过移动装置的信号接收与传送单元传递给伺服装置;另一方面,若移动装置的信号接收与传送单元收到更改计步阈值的信息,则计步决策单元140会重新计步,再重新将步数、步频与姿态等信息通过信号接收与传送单元传递给伺服装置,重复上述流程。相对地,在伺服装置部分,信号接收与传送单元接收到移动装置由信号接收与传送单元所传来的步数、步频与姿态等信息,由图资特征校正单元150判断步距是否合理,若不合理则由计步阈值调整单元160修改阈值,再通过信号接收与传送单元回传给移动装置;若步距合理,则将该步频与步距关系代入该步距回归单元170以更新该姿态的步距回归曲线。
以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (56)

1.一种多姿态步距校正定位系统,其特征在于,包括:
至少一惯性感测元件,以感测移动装置的至少一感测信号;以及
多姿态判断单元,接收并判断该感测信号而决定出该移动装置的至少一姿态;
图资特征校正单元,接收步数、步频与该姿态,以判断步距是否符合条件;
计步阈值调整单元,当该图资特征校正单元判断该步距为不符合该条件时,该计步阈值调整单元调整计步阈值;
步距回归单元,当该图资特征校正单元判断该步距为符合该条件时,该步距回归单元根据该步频与该步距,更新该姿态的步距回归曲线。
2.如权利要求1所述的多姿态步距校正定位系统,其中该感测信号用于该多姿态判断包含磁力计的感测值。
3.如权利要求1所述的多姿态步距校正定位系统,其中再包括信号前处理单元,连接该惯性感测元件,以处理该感测信号。
4.如权利要求3所述的多姿态步距校正定位系统,其中经处理后用于该多姿态判断的感测信号更包含加速度计、陀螺仪及磁力计三者其中之一的翻滚、俯仰或偏摆。
5.如权利要求1所述的多姿态步距校正定位系统,其中再包括计步决策单元,依据经处理过的感测信号,以计算出步数。
6.如权利要求5所述的多姿态步距校正定位系统,其中该计步决策单元,再依据该经处理过的感测信号,计算每一步的步频。
7.如权利要求1所述的多姿态步距校正定位系统,其中该惯性感测元件是加速度计以及陀螺仪或磁力计的其中之一。
8.如权利要求1所述的多姿态步距校正定位系统,其中调整该计步阈值是依据该感测信号于一方向的振幅值而决定。
9.如权利要求1所述的多姿态步距校正定位系统,其中调整该计步阈值是依据若该步距大于该条件时,则调低该计步阈值;若该步距小于该条件时,则调高该计步阈值。
10.如权利要求1所述的多姿态步距校正定位系统,其中该步距回归曲线是由步距回归演算而得到的。
11.如权利要求10所述的多姿态步距校正定位系统,其中该步距回归演算是线性回归方法、非线性回归方法的其中之一。
12.如权利要求1所述的多姿态步距校正定位系统,其中该图资特征校正单元,更包括转弯信号图资校正与多追踪路径图资校正。
13.如权利要求12所述的多姿态步距校正定位系统,其中该转弯信号图资校正是依据经处理过的感测信号中的两个连续转弯信号,与行走距离而决定的。
14.如权利要求13所述的多姿态步距校正定位系统,其中行走距离是由全球定位系统(Global Positioning System;GPS)、红外线(Infrared)、超音波(Ultrasound)、射频辨识(Radio FrequencyIdentification)、超宽带(Ultra Wideband)、可见光通讯(VisibleLightCommunication)、蓝芽(Bluetooth)、Zigbee、影像定位、WiFi或惯性感测元件的其中之一取得的。
15.如权利要求12所述的多姿态步距校正定位系统,其中该多追踪路径图资校正是由判断路径的转弯特征而决定的。
16.一种多姿态步距校正定位系统,适用于移动装置与伺服装置,其中该移动装置包含:
至少一惯性感测元件,以感测该移动装置的至少一感测信号;
多姿态判断单元,接收并判断该感测信号而决定出该移动装置的至少一姿态;
其中该伺服装置包含:
信号接收与传送单元,以接收步数、步频与姿态;以及
图资特征校正单元,接收该步数、该步频与该姿态,以判断步距是否符合条件;
计步阈值调整单元,当该图资特征校正单元判断该步距为不符合该条件时,该计步阈值调整单元调整计步阈值,并由该信号接收与传送单元传出;以及
步距回归单元,当该图资特征校正单元判断该步距为符合该条件时,该步距回归单元根据该步频与该步距,更新该姿态的步距回归曲线。
17.如权利要求16所述的多姿态步距校正定位系统,其中该感测信号用于该多姿态判断包含磁力计的感测值。
18.如权利要求16所述的多姿态步距校正定位系统,其中该移动装置更包括信号前处理单元,连接该惯性感测元件,以处理该感测信号。
19.如权利要求18所述的多姿态步距校正定位系统,其中经处理后用于该多姿态判断的感测信号更包含加速度计、陀螺仪及磁力计三者其中之一的翻滚、俯仰或偏摆。
20.如权利要求16所述的多姿态步距校正定位系统,其中该移动装置更包括:
计步决策单元,依据经处理过的感测信号,计算出步数及每一步的步频;
信号接收与传送单元,以传送该步数、该步频与该姿态,并接收更改信息。
21.如权利要求16所述的多姿态步距校正定位系统,其中该惯性感测元件是加速度计以及陀螺仪或磁力计的其中之一。
22.如权利要求16所述的多姿态步距校正定位系统,其中调整该计步阈值是依据该感测信号于一方向的振幅值而决定。
23.如权利要求16所述的多姿态步距校正定位系统,其中调整该计步阈值是依据若该步距大于该条件时,则调低该计步阈值;若该步距小于该条件时,则调高该计步阈值。
24.如权利要求16所述的多姿态步距校正定位系统,其中该步距回归曲线是由步距回归演算而得。
25.如权利要求24所述的多姿态步距校正定位系统,其中该步距回归演算是线性回归方法、非线性回归方法的其中之一。
26.如权利要求16项所述的多姿态步距校正定位系统,其中该图资特征校正单元,更包括转弯信号图资校正与多追踪路径图资校正。
27.如权利要求26所述的多姿态步距校正定位系统,其中该转弯信号图资校正是依据经处理过的感测信号中的两个连续转弯信号,与行走距离而决定的。
28.如权利要求27所述的多姿态步距校正定位系统,其中行走距离是由全球定位系统(Global Positioning System;GPS)、红外线(Infrared)、超音波(Ultrasound)、射频辨识(Radio Frequency Identification)、超宽带(Ultra Wideband)、可见光通讯(VisibleLight Communication)、蓝芽(Bluetooth)、Zigbee、影像定位、WiFi或惯性感测元件的其中之一取得的。
29.如权利要求26所述的多姿态步距校正定位系统,其中该多追踪路径图资校正是由判断路径的转弯特征而决定的。
30.一种多姿态步距校正定位方法,其特征在于,包括以下步骤:
感测移动装置的至少一感测信号;
依据该感测信号,进行姿态判断,以决定姿态;
依据处理过的感测信号,进行计步演算,以计算出步数;
依据经处理过的感测信号,计算每一步的步频;
依据步数、步频与该姿态,进行步距计算,并判断该步距是否符合条件;当该步距符合时,则依据该步距与该步频,更新步距回归曲线;当该步距不符合时,则调整计步阈值,并重新进行计步演算。
31.如权利要求30所述的多姿态步距校正定位方法,其中该感测信号用于该多姿态判断包含磁力计的感测值。
32.如权利要求30所述的多姿态步距校正定位方法,其中该移动装置更包括信号前处理单元,连接惯性感测元件,以处理该至少一感测信号。
33.如权利要求32所述的多姿态步距校正定位方法,其中经处理后用于该多姿态判断的感测信号更包含加速度计、陀螺仪及磁力计三者其中之一的翻滚、俯仰或偏摆。
34.如权利要求30所述的多姿态步距校正定位方法,其中更包括取得图资特征信息的步骤。
35.如权利要求30所述的多姿态步距校正定位方法,其中调整该计步阈值是依据经处理过的感测数据在一方向的振幅值。
36.如权利要求30所述的多姿态步距校正定位方法,其中调整该计步阈值是依据若该步距大于该条件时,则调低该计步阈值;若该步距小于该条件时,则调高该计步阈值。
37.如权利要求30所述的多姿态步距校正定位方法,其中该步距回归曲线是根据步距回归演算而得到的。
38.如权利要求37所述的多姿态步距校正定位方法,其中该步距回归演算是线性回归方法、非线性回归方法的其中之一。
39.如权利要求30所述的多姿态步距校正定位方法,其中更包括图资定位校正的步骤,此步骤包含转弯信号图资校正与多追踪路径图资校正。
40.如权利要求39所述的多姿态步距校正定位方法,其中该转弯信号图资校正是依据经处理过的感测信号中的两个连续转弯信号,与行走距离而决定的。
41.如权利要求40所述的多姿态步距校正定位方法,其中行走距离可由全球定位系统(Global Positioning System;GPS)、红外线(Infrared)、超音波(Ultrasound)、射频辨识(Radio Frequency Identification)、超宽带(Ultra Wideband)、可见光通讯(VisibleLight Communication)、蓝芽(Bluetooth)、Zigbee、影像定位、WiFi与惯性感测元件的其中之一取得的。
42.如权利要求41所述的多姿态步距校正定位方法,其中该多追踪路径图资校正是依据判断路径的转弯特征而决定的。
43.一种多姿态步距校正定位方法,适用于移动装置与伺服装置,其中该移动装置包含:
感测移动装置的至少一感测信号;
依据该感测信号,进行姿态判断,以决定该移动装置的姿态;其中该伺服装置包含:
接收步数、步频与姿态;
依据该步数、该步频与该姿态,进行步距计算,并判断该步距是否符合条件;
当该步距符合时,则依据该步距与该步频,更新步距回归曲线;当该步距不符合时,则调整计步阈值,并传送更改信息。
44.如权利要求43所述的多姿态步距校正定位方法,其中该感测信号用于该多姿态判断包含磁力计的感测值。
45.如权利要求43所述的多姿态步距校正定位方法,其中该移动装置更包括信号前处理单元,连接惯性感测元件,以处理该至少一感测信号。
46.如权利要求45所述的多姿态步距校正定位方法,其中经处理后用于该多姿态判断的感测信号更包含加速度计、陀螺仪及磁力计三者其中之一的翻滚、俯仰或偏摆。
47.如权利要求43所述的多姿态步距校正定位方法,其中该移动装置更包括以下步骤:
依据处理过的感测信号,进行计步演算,以计算出步数与每一步的步频;
传送该步数、该步频与该姿态,并接收更改信息。
48.如权利要求43所述的多姿态步距校正定位方法,其中更包括取得图资特征信息的步骤。
49.如权利要求43所述的多姿态步距校正定位方法,其中调整该计步阈值是依据经处理过的感测数据在一方向的振幅值。
50.如权利要求43所述的多姿态步距校正定位方法,其中调整该计步阈值是依据若该步距大于该条件时,则调低该计步阈值;若该步距小于该条件时,则调高该计步阈值。
51.如权利要求43所述的多姿态步距校正定位方法,其中该步距回归曲线是根据步距回归演算而得到的。
52.如权利要求51所述的多姿态步距校正定位方法,其中该步距回归演算是线性回归方法、非线性回归方法的其中之一。
53.如权利要求43所述的多姿态步距校正定位方法,其中更包括图资定位校正的步骤,此步骤包含转弯信号图资校正与多追踪路径图资校正。
54.如权利要求53所述的多姿态步距校正定位方法,其中该转弯信号图资校正是依据经处理过的感测信号中的两个连续转弯信号,与行走距离而决定。
55.如权利要求54所述的多姿态步距校正定位方法,其中行走距离可由全球定位系统(Global Positioning System;GPS)、红外线(Infrared)、超音波(Ultrasound)、射频辨识(Radio Frequency Identification)、超宽带(Ultra Wideband)、可见光通讯(VisibleLight Communication)、蓝芽(Bluetooth)、Zigbee、影像定位、WiFi与惯性感测元件的其中之一取得的。
56.如权利要求53所述的多姿态步距校正定位方法,其中该多追踪路径图资校正是依据判断路径的转弯特征而决定的。
CN201310137189.4A 2012-12-19 2013-04-19 多姿态步距校正定位系统与方法 Active CN103884337B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
TW101148475A TWI457539B (zh) 2012-12-19 2012-12-19 多姿態步距校正定位系統與方法
TW101148475 2012-12-19

Publications (2)

Publication Number Publication Date
CN103884337A CN103884337A (zh) 2014-06-25
CN103884337B true CN103884337B (zh) 2017-06-30

Family

ID=50931913

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310137189.4A Active CN103884337B (zh) 2012-12-19 2013-04-19 多姿态步距校正定位系统与方法

Country Status (3)

Country Link
US (1) US20140172361A1 (zh)
CN (1) CN103884337B (zh)
TW (1) TWI457539B (zh)

Families Citing this family (38)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9159115B1 (en) * 2013-09-30 2015-10-13 Emc Corporation Processing vectorized elements associated with IT system images
US10222208B2 (en) * 2013-12-27 2019-03-05 Intel Corporation Apparatus, system and method of estimating an orientation of a mobile device
CN103925921A (zh) * 2014-04-25 2014-07-16 上海斐讯数据通信技术有限公司 一种基于电子罗盘和计步器的辅助定位装置及方法
US11959749B2 (en) * 2014-06-20 2024-04-16 Profound Positioning Inc. Mobile mapping system
US11504029B1 (en) 2014-10-26 2022-11-22 David Martin Mobile control using gait cadence
US20160166180A1 (en) * 2014-12-11 2016-06-16 David Martin Enhanced Real Time Frailty Assessment for Mobile
US10342462B2 (en) * 2014-10-26 2019-07-09 David Martin Application of gait characteristics for mobile
CN104613982B (zh) * 2015-01-28 2017-09-22 齐鲁工业大学 一种室内组合导航仿真验证系统
CN105091903B (zh) * 2015-06-30 2018-04-13 小米科技有限责任公司 步行状态监测方法及装置
CN105516251B (zh) * 2015-11-26 2020-04-10 阿坝师范学院 一种定位校准方法及其位置服务推送系统
TWI579530B (zh) * 2015-11-30 2017-04-21 逢甲大學 行動裝置計步系統及其步態分析方法
US10018474B2 (en) * 2015-12-21 2018-07-10 Invensense, Inc. Method and system for using offline map information aided enhanced portable navigation
US10024680B2 (en) * 2016-03-11 2018-07-17 Toyota Motor Engineering & Manufacturing North America, Inc. Step based guidance system
US10302469B2 (en) * 2016-06-08 2019-05-28 Under Armour, Inc. Method and apparatus for determining, recommending, and applying a calibration parameter for activity measurement
CN106092130B (zh) * 2016-06-24 2019-02-19 Oppo广东移动通信有限公司 计步器的计步方法、装置及移动终端
CN106354250B (zh) * 2016-08-05 2017-11-17 广东欧珀移动通信有限公司 一种设置计步参数的方法、装置及终端
KR102252269B1 (ko) 2016-08-31 2021-05-14 애플 인크. 수영 분석 시스템 및 방법
US11896368B2 (en) 2016-08-31 2024-02-13 Apple Inc. Systems and methods for determining swimming metrics
WO2018076205A1 (zh) 2016-10-26 2018-05-03 华为技术有限公司 一种步幅校准方法、相关设备及系统
TWI641808B (zh) * 2016-11-28 2018-11-21 財團法人資訊工業策進會 行動裝置、操作方法及非揮發性電腦可讀取記錄媒體
CN108426573B (zh) * 2017-02-14 2023-04-07 中兴通讯股份有限公司 一种终端设备的行人步态检测方法及终端设备
US11051720B2 (en) * 2017-06-01 2021-07-06 Apple Inc. Fitness tracking for constrained-arm usage
CN113218395A (zh) * 2017-06-23 2021-08-06 北京方位捷讯科技有限公司 行人步行轨迹检测方法、装置及系统
CN107588775A (zh) * 2017-09-21 2018-01-16 哈尔滨理工大学 一种新型室内定位方法
CN107483085A (zh) * 2017-09-29 2017-12-15 深圳市深层互联科技有限公司 一种基于蓝牙室内定位的ai导览技术
US11015954B2 (en) * 2017-10-16 2021-05-25 Uti Limited Partnership Step detection using IMU and magnetometer data fusion
CN108106630B (zh) * 2017-12-08 2020-11-06 北京理工大学 一种行人导航的二维人体里程计及里程计算方法
CN108981744B (zh) * 2018-08-06 2020-07-07 浙江大学 一种基于机器学习与低通滤波的步频实时计算方法
TWI669615B (zh) * 2018-12-10 2019-08-21 中華電信股份有限公司 行動定位修正之系統與方法
US11937904B2 (en) 2019-09-09 2024-03-26 Apple Inc. Detecting the end of cardio machine activities on a wearable device
CN110645980B (zh) * 2019-09-27 2021-04-30 成都市灵奇空间软件有限公司 一种室内外一体化定位导航方法及其系统
GB201914863D0 (en) * 2019-10-14 2019-11-27 Sweatco Ltd Movement verification system and method
CN111141308B (zh) * 2019-12-25 2022-03-01 歌尔科技有限公司 一种步距校正方法、装置和可穿戴设备
CN111753938B (zh) * 2020-06-23 2021-12-24 联想(北京)有限公司 一种位置获取方法、装置及电子设备
TWI741821B (zh) * 2020-10-07 2021-10-01 廣達電腦股份有限公司 具有重力感測器輔助定位的電子裝置
CN112629554A (zh) * 2020-12-10 2021-04-09 维沃移动通信有限公司 运动轨迹获取方法、装置和电子设备
TWI803043B (zh) * 2021-11-04 2023-05-21 獵戶科技股份有限公司 混合型室內定位系統
TWI809983B (zh) * 2022-07-15 2023-07-21 國立虎尾科技大學 室外運動記錄系統

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100287611B1 (ko) * 1995-09-12 2001-04-16 타테이시 요시오 보수계
JP3449951B2 (ja) * 1999-08-30 2003-09-22 ヤーマン株式会社 健康歩数管理装置
US6813582B2 (en) * 2002-07-31 2004-11-02 Point Research Corporation Navigation device for personnel on foot
TW200701949A (en) * 2005-07-15 2007-01-16 You-Yu Chen Pedometer with automatic step correction device
WO2008108788A2 (en) * 2006-05-31 2008-09-12 Trx Systems, Inc. Method and system for locating and monitoring first responders
KR100800874B1 (ko) * 2006-10-31 2008-02-04 삼성전자주식회사 보폭 추정 방법 및 이를 위한 휴대 단말
US8165840B2 (en) * 2008-06-12 2012-04-24 Cardiac Pacemakers, Inc. Posture sensor automatic calibration
US7930135B2 (en) * 2008-07-10 2011-04-19 Perception Digital Limited Method of distinguishing running from walking
CN101881625B (zh) * 2008-08-19 2012-09-12 幻音科技(深圳)有限公司 步幅校正方法、测距方法及计步装置
KR20120020051A (ko) * 2010-08-27 2012-03-07 야마하 가부시키가이샤 보수 계측 장치, 샘플링 장치 및 파형 분석 장치
US20130085711A1 (en) * 2011-09-30 2013-04-04 Apple Inc. Techniques for improved pedometer readings
US9116000B2 (en) * 2012-10-22 2015-08-25 Qualcomm, Incorporated Map-assisted sensor-based positioning of mobile devices

Also Published As

Publication number Publication date
TW201425878A (zh) 2014-07-01
CN103884337A (zh) 2014-06-25
TWI457539B (zh) 2014-10-21
US20140172361A1 (en) 2014-06-19

Similar Documents

Publication Publication Date Title
CN103884337B (zh) 多姿态步距校正定位系统与方法
Kang et al. Improved heading estimation for smartphone-based indoor positioning systems
CN105004340B (zh) 结合惯性导航技术和指纹定位技术的定位误差修正方法
CN110501011B (zh) 确定移动设备在地理区域中的位置
CN109579853B (zh) 基于bp神经网络的惯性导航室内定位方法
CN104395696B (zh) 估计设备位置的方法和实施该方法的装置
CN103889049A (zh) 基于惯性测量元件辅助的无线信号室内定位系统与方法
CN112334737A (zh) 定位设备、定位方法和程序
WO2006104140A1 (ja) 進行方向計測装置及び進行方向計測方法
CN107515384A (zh) 基于uwb与多传感器的室内机器人的定位与环境建模方法
CN105556547B (zh) 用于数据的带注释捕获以及活动的群建模的方法和系统
WO2014134710A1 (en) Method and apparatus for fast magnetometer calibration
CN104197929B (zh) 一种基于地磁和wifi的定位方法、装置及系统
CN108245880A (zh) 基于多穿戴环带传感器融合的体感检测可视化方法和系统
CN106646366A (zh) 基于粒子滤波算法和智能设备的可见光定位方法和系统
CN108733206A (zh) 一种坐标对齐方法、系统和虚拟现实系统
CN107110654A (zh) 定位设备和用于定位的方法
CN108225324A (zh) 一种基于智能终端的地磁匹配与pdr融合的室内定位方法
CN107330240A (zh) 一种基于双手环传感器的智能远程特护监控系统及方法
CN107270931A (zh) 一种IOS和android平台通用的步态自相关计步器
CN112729301A (zh) 一种基于多源数据融合的室内定位方法
CN106643711A (zh) 一种基于手持设备的室内定位方法及系统
CN109708631A (zh) 一种基于手机模态识别的行人导航航向修正方法
Sun et al. A step length estimation model for position tracking
US20170322031A1 (en) Apparatus and method for using map data in a calibration process

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant