0 引言

    基于位置的服務(wù)^[1]由于便捷、智能、精確等良好的用戶服務(wù)體驗(yàn)而受到青睞。目前，針對(duì)室內(nèi)定位技術(shù)的研究主要有WiFi^[2]、UWB^[3-4]、位置指紋^[5]、藍(lán)牙^[6-7]等?；贛EMS的室內(nèi)行人航跡推算(Pedestrian Dead Reckoning，PDR)作為一種新興的室內(nèi)行人導(dǎo)航定位方法，具有短時(shí)間定位精度高、自主性強(qiáng)、不易受外界環(huán)境因素影響等特點(diǎn)，因而受到廣泛關(guān)注。在基于PDR的室內(nèi)行人定位系統(tǒng)中，步長(zhǎng)精度對(duì)導(dǎo)航定位結(jié)果有著直接影響。目前的步長(zhǎng)估計(jì)方法有線性估計(jì)和非線性估計(jì)兩種方法。利用步長(zhǎng)與步頻的線性關(guān)系的線性方法估計(jì)^[8]步長(zhǎng)，卻沒(méi)有考慮個(gè)體的加速度方差等因素對(duì)步長(zhǎng)的影響；利用步長(zhǎng)和加速度值的相互關(guān)系的非線性步長(zhǎng)估計(jì)^[9]方法，沒(méi)有考慮步頻、身高等個(gè)體因素對(duì)步長(zhǎng)的作用。針對(duì)上述問(wèn)題，本文提出一種基于模糊邏輯的步長(zhǎng)估計(jì)方法，該方法采用非線性步長(zhǎng)估計(jì)模型，通過(guò)模糊邏輯系統(tǒng)實(shí)現(xiàn)可變地估算步長(zhǎng)，同時(shí)對(duì)比分析了不同的步長(zhǎng)估計(jì)方法在PDR系統(tǒng)中的應(yīng)用，驗(yàn)證了該方法在室內(nèi)行人定位系統(tǒng)中的有效性。

1 步長(zhǎng)估計(jì)

    在實(shí)際中，步長(zhǎng)與步頻、加速度方差、身高等因素存在非線性關(guān)系，而模糊理論在不確定性和非線性系統(tǒng)中有著廣泛的應(yīng)用。因此，可以通過(guò)模糊邏輯推理系統(tǒng)得到估計(jì)步長(zhǎng)值。

    文獻(xiàn)[11]中提出了一種非線性計(jì)算步長(zhǎng)方法, 如下所示：

    A_max和A_min分別為一步內(nèi)的加速度最大值和最小值。由于人體加速度和步頻、加速度波峰值等的相互關(guān)系，使得C值主要取決于個(gè)人的步頻、身高等?？梢酝ㄟ^(guò)模糊邏輯推理系統(tǒng)確定C值后，再由式(1)得到估計(jì)的步長(zhǎng)值。

2 模糊邏輯系統(tǒng)設(shè)計(jì)

    模糊邏輯推理是一種基于“如果--則”^[12]規(guī)則的智能控制，對(duì)非線性控制有很好的魯棒性，可以較好地抑制環(huán)境變量對(duì)權(quán)重值的影響。模糊邏輯系統(tǒng)中常用的推理方式有Mamdani型模糊推理和Sugeno^[13]型模糊推理。本文使用Mamdani型模糊推理算法。

    圖1為Mamdani模糊邏輯推理系統(tǒng)框圖。系統(tǒng)主要由輸入、模糊化、模糊推理規(guī)則工具、解模糊化、輸出等組成。輸入時(shí)將個(gè)人的身高、體重、步頻作為模糊邏輯的3個(gè)輸入，先經(jīng)過(guò)去模糊化，然后設(shè)置模糊規(guī)則，再經(jīng)過(guò)去模糊化后輸出期望值C，最后將C值帶入式(1)中，得到步長(zhǎng)。由于個(gè)體差異，需要在首次使用時(shí)調(diào)整模糊邏輯系統(tǒng)的參數(shù)，以適應(yīng)不同的個(gè)體。

2.1 輸入輸出隸屬度函數(shù)

    在模糊邏輯推理系統(tǒng)中，用隸屬度來(lái)衡量數(shù)值高低的歸屬，相應(yīng)的模糊規(guī)則是定義在模糊集合上的規(guī)則。本文將個(gè)人的步頻、身高、體重作為模糊邏輯的3個(gè)輸入，每個(gè)輸入都由高、中、低這3條隸屬度函數(shù)曲線構(gòu)成，變量的隸屬度函數(shù)曲線是由高斯型函數(shù)、三角函數(shù)、高斯型函數(shù)組合等構(gòu)成。高斯型函數(shù)^[14]的表達(dá)式為：

式中，參數(shù)μ表示函數(shù)中心點(diǎn)橫坐標(biāo)，σ表示曲線的陡峭程度。根據(jù)實(shí)際及模糊統(tǒng)計(jì)法為每個(gè)隸屬度函數(shù)選取最佳參數(shù)。

    行人在正常行走中的步頻為1 Hz~3 Hz，可以將正常人的行走速度分為慢速、中速、快速^[15]3種。

    圖2為步頻的隸屬度函數(shù)。根據(jù)實(shí)際的步長(zhǎng)與步頻生成一定的線性關(guān)系，步頻采用三角隸屬度函數(shù)，慢速的步頻范圍為1 Hz~1.6 Hz，中速對(duì)應(yīng)的步頻范圍為1.2 Hz~2.0 Hz，快速的步頻范圍為2 Hz~3 Hz。

    圖3為身高的隸屬度函數(shù)，由于估計(jì)步長(zhǎng)與實(shí)際的身高的非線性關(guān)系，所以采用高斯函數(shù)隸屬度函數(shù)。因?yàn)閷?shí)際中體重與步長(zhǎng)之間的非線性關(guān)系，因此體重的隸屬度函數(shù)為高斯組合隸屬度函數(shù)。

2.2 模糊推理規(guī)則

    在輸入的規(guī)則變量中，輸入為步頻、身高、體重，輸出變量為式(1)中的常數(shù)C。由于步頻是決定常數(shù)輸出值的主要控制器，因此將步頻分為高、中、低3個(gè)模糊集表示。步頻值大則輸出值較高，反之亦然；當(dāng)步頻值相對(duì)中等時(shí)，輸出結(jié)果由另外2個(gè)輸入?yún)?shù)(身高、體重)來(lái)調(diào)節(jié)；若輸入為步頻高、身高高、體重低，則輸出值高；如果輸入為步頻低、體重大、身高低，則輸出值低。

2.3 位置計(jì)算

    從一已知點(diǎn)開(kāi)始，行人的當(dāng)前位置可表示^[16]為：

式中，SL_err是行走步長(zhǎng)估計(jì)誤差，SL_act為實(shí)際行走平均步長(zhǎng)，SL_es為行走估計(jì)步長(zhǎng)。

3 實(shí)驗(yàn)結(jié)果討論

3.1 實(shí)驗(yàn)平臺(tái)搭建

    系統(tǒng)的核心部分是32 bit的微處理器芯片STM32F103，主要負(fù)責(zé)采集及處理慣性傳感器數(shù)據(jù)。慣性傳感器電路主要有MPU9150和外圍電路供電電路，上位機(jī)軟件負(fù)責(zé)接收處理后的數(shù)據(jù)，然后在MATLAB中仿真驗(yàn)證。測(cè)試時(shí)MPU9150的采樣頻率為50 Hz。為了證明本文方法的有效性，進(jìn)行室內(nèi)行走試驗(yàn)，行走路線主要為直線和矩形。

3.2 實(shí)驗(yàn)結(jié)果分析

    表1中，1為矩形行走試驗(yàn)，步數(shù)為16步，總距離為10.4 m，誤差為0.8 m；2為直線行走試驗(yàn),步數(shù)為40步，誤差為1.9 m。經(jīng)過(guò)30 m以內(nèi)多次行走試驗(yàn)，測(cè)得行走距離誤差在3 m以內(nèi)。

    圖4為具體的步長(zhǎng)曲線。從圖中可以看出本文算法在0.4~0.8之間步幅變化較為合理，與實(shí)際的步長(zhǎng)吻合比較好；非線性方法1步長(zhǎng)變化較大，步長(zhǎng)超出1.2 m，與實(shí)際不符；線性步長(zhǎng)方法則明顯偏小。

    根據(jù)式(5)、式(6)、式(7)可得到表2。表2中對(duì)比分析了3種不同算法在實(shí)際中的動(dòng)態(tài)具體估計(jì)步長(zhǎng)數(shù)據(jù)。由表2可以得到，本文算法的精度高，比傳統(tǒng)的線性步長(zhǎng)估計(jì)方法提高約9%，比非線性方法1提高5%。同時(shí)，步長(zhǎng)的大小及變化幅度比較合理，與實(shí)際的步長(zhǎng)吻合比較好；非線性方法1及線性步長(zhǎng)估計(jì)得到的步長(zhǎng)幅度范圍變化比較大，與實(shí)際不符，且精度比本文方法低，從而降低了實(shí)際的距離精度。

4 結(jié)束語(yǔ)

    本文采用非線性估計(jì)模型，通過(guò)模糊邏輯系統(tǒng)得到步長(zhǎng)，并比較分析PDR算法中不同的步長(zhǎng)估計(jì)算法的精度對(duì)行走距離的影響。經(jīng)過(guò)實(shí)驗(yàn)驗(yàn)證，基于模糊邏輯的步長(zhǎng)估計(jì)方法的精度比傳統(tǒng)的步長(zhǎng)估計(jì)方法提高9%，可以應(yīng)用于室內(nèi)定位導(dǎo)航系統(tǒng)中。

參考文獻(xiàn)

[1] ZHOU L，WANG H.Toward blind scheduling in mobile media cloud：fairness，simplicity，and asymptotic optimality[J].IEEE Transactions on Multimedia，2013，15(4)：735-746.

[2] BAN R，KAJI K，HIROI K，et al.Indoor positioning method integrating pedestrian dead reckoning with magnetic field and WiFi fingerprints[C].Mobile Computing and Ubiquitous Networking(ICMU)，2015 Eighth International Conference on.IEEE，2015：167-172.

[3] GARCIA E，POUDEREUX P，HERNANDEZ A，et al.A robust UWB indoor positioning system for highly complex environments[C].IEEE International Conference on Industrial Technology.IEEE，2015.

[4] JERABEK J，ZAPLATILEK L，POLA M.A proposal of radio ultrawideband systems for precision indoor localization[C].Radioelektronika.IEEE，2015.

[5] Muòoz-Organero M，KLOOS C D，Muòoz-Merino P J.Using bluetooth to implement a pervasive indoor positioning system with minimal requirements at the application level[J].Mobile Information Systems，2012，43(8)：73-82.

[6] BAHILLO A，ANGULO I，ONIEVA E，et al.Low-cost Bluetooth foot-mounted IMU for pedestrian tracking in industrial environments[C].Industrial Technology(ICIT)，2015 IEEE International Conference on.IEEE，2015.

[7] Muòoz-Organero M，KLOOS C D，Muòoz-Merino P J.Using bluetooth to implement a pervasive indoor positioning system with minimal requirements at the application level[J].Mobile Information Systems，2012，43(8)：73-82.

[8] 孫作雷，茅旭初，田蔚風(fēng)，等.基于動(dòng)作識(shí)別和步幅估計(jì)的步行者航位推算[J].上海交通大學(xué)學(xué)報(bào)，2008，42(12)：2002-2005.

[9] SCARLETT J.Enhancing the performance of pedometers using a single accelerometer[Z].Application Note，Analog Devices，2007.

[10] LI F.A reliable and accurate indoor localization method using phone inertial sensors[C].UbiComp′12.ACM.New York，2012.

[11] WEINBERG H.Using the ADXL202 in pedometer and personal navigation applications[Z].Analog Devices AN-602 Application Note，2002.

[12] 張國(guó)良，曾靜.模糊控制及其MATLAB應(yīng)用[M].西安：交通大學(xué)出版社，2002.

[13] 王萬(wàn)良，石浩，李燕君.基于Mamdani型模糊推理的加權(quán)質(zhì)心定位算法[J].計(jì)算機(jī)科學(xué)，2015，42(10)：101-105.

[14] 王璐，張文濤.人體手掌靜脈圖像采集系統(tǒng)研究[J].激光與紅外，2013，43(4)：404-408.

[15] 李若涵，張金藝，徐德政，等.運(yùn)動(dòng)分類步頻調(diào)節(jié)的微機(jī)電慣性測(cè)量單元室內(nèi)行人航跡推算[J].上海大學(xué)學(xué)報(bào)：自然科學(xué)版，2014(5)：612-623.

[16] Liu Zexi，Aduba Chukwuemeka，Won Chang-Hee.In-plane dead reckoning with knee and waist attched gyroscopes[J].Measurement，2011，44：1860-1868.