CN104251702B - A kind of pedestrian navigation method measured based on relative pose - Google Patents
A kind of pedestrian navigation method measured based on relative pose Download PDFInfo
- Publication number
- CN104251702B CN104251702B CN201410477615.3A CN201410477615A CN104251702B CN 104251702 B CN104251702 B CN 104251702B CN 201410477615 A CN201410477615 A CN 201410477615A CN 104251702 B CN104251702 B CN 104251702B
- Authority
- CN
- China
- Prior art keywords
- foot
- coordinate system
- relative
- pedestrian
- diaphragm
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Multimedia (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
Description
Claims (9)
- A kind of 1. pedestrian navigation method measured based on relative pose, it is characterised in that:(1) it is installed respectively on pedestrian or so foot 3 groups of relative pose measuring apparatus;(2) navigational coordinate system is determined;(3) using the electronic switch detection row mounted on left and right foot sole Contact of people or so foot with ground;(4) left and right foot is measured respectively using multi-target radio electricity range-measuring circuit and optical camera to sit Relative pose between mark system, and then relative pose when contacting ground before and after the foot of left and right twice is measured respectively;Use left and right 9 axis Inertial Measurement Units on foot measure relative pose when contacting ground before and after the foot of left and right twice respectively;(5) by three groups of positions Appearance measurement result carries out data fusion, the constantly repeatedly pose measurement process of step (3)-(5);(6) left and right foot coordinate system is determined It is respectively relative to the relative position and relative attitude of navigational coordinate system;(7) display of left and right foot travel track and its posture.
- 2. the pedestrian navigation method according to claim 1 measured based on relative pose, it is characterised in that:The opposite position Appearance measurement refers to, when foot contacts ground when left and right, measures the relative position between pedestrian or so foot coordinate system and opposite appearance State;Relative position between left foot coordinate system and relative attitude and row when measuring 2 contact ground before and after pedestrian's left foot The relative position and relative attitude between right crus of diaphragm coordinate system before and after people's right crus of diaphragm during 2 contact ground.
- 3. the pedestrian navigation method according to claim 1 measured based on relative pose, it is characterised in that:The opposite position Appearance measuring apparatus is mounted on pedestrian or so foot;Right shoe installs 9 axis IMU Inertial Measurement Units with place, is installed extremely on the inside of right crus of diaphragm At least three optical characteristic point is installed in few 3 distance measuring signal Tx transmitter units, right crus of diaphragm inside, and 2 positions are distinguished before and after right shoe bottom Electronic switch module is installed;Left shoe installs 9 axis IMU Inertial Measurement Units with place, and at least three distance measuring signal is installed on the inside of left foot Optical camera is installed in Rx receiving units and distance measuring signal processing unit, left foot inside, and 2 positions are installed respectively before and after left shoe bottom Electronic switch module.
- 4. the pedestrian navigation method according to claim 1 measured based on relative pose, it is characterised in that:The navigation is sat Mark system refers to the inertial coodinate system of left foot before initial navigation.
- 5. the pedestrian navigation method according to claim 1 measured based on relative pose, it is characterised in that:Left and right foot sole Electronic switch for detecting contact situation of pedestrian or so foot with ground, switch and be closed behind sole, front switch is opened When, represent that pedestrian's heel starts to contact ground;When sole former and later two switches are closed, entire sole contact ground is represented, It switchs and opens behind sole, when front switch is closed, represent that heel initially moves off ground;When two switches of sole are opened When, represent that shoes leave ground completely;When two feet contact ground, the measuring circuit work of triggering relative pose.
- 6. the pedestrian navigation method according to claim 1 measured based on relative pose, it is characterised in that:The use is more The relative pose that targeted radio range-measuring circuit is measured between the foot coordinate system of left and right refers to, measures and is installed at least on the inside of right crus of diaphragm 3 distance measuring signal Tx transmitter units and the distance between at least three distance measuring signal Rx receiving units of installation on the inside of left foot, according to Spherical equation group calculates position coordinates of any transmitter unit of right crus of diaphragm in left foot coordinate system, since transmitter unit is in right crus of diaphragm Coordinate in coordinate system is it is known that so as to calculate the relative position and relative attitude square between right crus of diaphragm coordinate system and left foot coordinate system Battle array.
- 7. the pedestrian navigation method according to claim 1 measured based on relative pose, it is characterised in that:Transmitter unit and Multi-Goal Measure circuit between receiving unit using radio distance-measuring technology, transmitting signal using frequency division multiple access FDMA modes or Person time division multiple acess TDMA modes are mutually distinguished.
- 8. the pedestrian navigation method according to claim 1 measured based on relative pose, it is characterised in that:It is described to use light It learns the relative pose that camera measurement goes out between the foot coordinate system of left and right to refer to, the optical camera on the inside of left foot is on the inside of right crus of diaphragm Optical characteristic point carry out spark photograph, measure position of these characteristic points in camera coordinates system and left foot coordinate system and sit Mark, due to these optical characteristic points in right crus of diaphragm coordinate system coordinate it is known that being sat so as to calculate right crus of diaphragm coordinate system and left foot Relative position and relative attitude matrix between mark system.
- 9. the pedestrian navigation method according to claim 1 measured based on relative pose, it is characterised in that:It is described to use a left side The relative pose that 9 axis Inertial Measurement Units on right crus of diaphragm measure when contacting ground twice before and after the foot of left and right respectively refers to, will be used Property measuring unit acquisition 3 axle accelerations, 3 axis angular rates, 3 axis magnetometer datas calculate left and right foot using inertial navigation algorithm Relative position and relative attitude during the front and rear ground of contact twice.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410477615.3A CN104251702B (en) | 2014-09-18 | 2014-09-18 | A kind of pedestrian navigation method measured based on relative pose |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410477615.3A CN104251702B (en) | 2014-09-18 | 2014-09-18 | A kind of pedestrian navigation method measured based on relative pose |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104251702A CN104251702A (en) | 2014-12-31 |
CN104251702B true CN104251702B (en) | 2018-06-29 |
Family
ID=52186818
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410477615.3A Active CN104251702B (en) | 2014-09-18 | 2014-09-18 | A kind of pedestrian navigation method measured based on relative pose |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104251702B (en) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104698434A (en) * | 2015-01-16 | 2015-06-10 | 梁二 | Ultra-wideband based indoor emergent positioning method |
CN104567862B (en) * | 2015-01-19 | 2017-10-20 | 华侨大学 | A kind of movement locus acquisition methods positioned based on bipod |
CN106153067A (en) * | 2015-03-30 | 2016-11-23 | 联想(北京)有限公司 | A kind of electronic equipment, distance-finding method and Operation Processing Unit |
CN105699974B (en) * | 2016-01-20 | 2018-04-17 | 沈弼龙 | Intelligent locating method, intelligent positioner and intelligent positioning system |
CN106199507A (en) * | 2016-06-15 | 2016-12-07 | 北京工业大学 | Rigid space pose based on one way frequency modulation Electromagnetic Continuous ripple directly measures system |
CN105973264A (en) * | 2016-07-21 | 2016-09-28 | 触景无限科技(北京)有限公司 | Intelligent blind guiding system |
CN109164830A (en) * | 2018-08-03 | 2019-01-08 | 深圳市迅驰智能电子科技有限公司 | A kind of automatic follower method of balance car and balance car |
CN111256683A (en) * | 2018-12-03 | 2020-06-09 | 北京科加触控技术有限公司 | Positioning method and device |
CN111323048B (en) * | 2020-02-28 | 2022-03-04 | 上海航天控制技术研究所 | Performance test method and system for single relative attitude measurement machine |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005022040A (en) * | 2003-07-03 | 2005-01-27 | Toyota Motor Corp | Walking robot correcting positional deviation, and its control method |
US7724610B2 (en) * | 2007-09-18 | 2010-05-25 | Honeywell International Inc. | Ultrasonic multilateration system for stride vectoring |
CN101762273A (en) * | 2010-02-01 | 2010-06-30 | 北京理工大学 | Autonomous optical navigation method for soft landing for deep space probe |
CN103292804B (en) * | 2013-05-27 | 2015-07-15 | 浙江大学 | Monocular natural vision landmark assisted mobile robot positioning method |
-
2014
- 2014-09-18 CN CN201410477615.3A patent/CN104251702B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN104251702A (en) | 2014-12-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104251702B (en) | A kind of pedestrian navigation method measured based on relative pose | |
CN110645979B (en) | Indoor and outdoor seamless positioning method based on GNSS/INS/UWB combination | |
Zhuang et al. | Tightly-coupled integration of WiFi and MEMS sensors on handheld devices for indoor pedestrian navigation | |
CN106017463B (en) | A kind of Aerial vehicle position method based on orientation sensing device | |
Foxlin | Pedestrian tracking with shoe-mounted inertial sensors | |
CN106556854B (en) | A kind of indoor and outdoor navigation system and method | |
US10267646B2 (en) | Method and system for varying step length estimation using nonlinear system identification | |
US9420275B2 (en) | Visual positioning system that utilizes images of a working environment to determine position | |
CN104713554A (en) | Indoor positioning method based on MEMS insert device and android smart mobile phone fusion | |
CN103968827A (en) | Wearable human body gait detection self-localization method | |
CN107014375B (en) | Indoor positioning system and method with ultra-low deployment | |
Ladetto et al. | In step with INS navigation for the blind, tracking emergency crews | |
US20150308831A1 (en) | Apparatus for inferring pedestrian position based on pedestrian movement detection, and method therefor | |
CN105865450A (en) | Zero-speed update method and system based on gait | |
KR20130059344A (en) | Method and system for detection of a zero velocity state of an object | |
CN111024126A (en) | Self-adaptive zero-speed correction method in pedestrian navigation positioning | |
Wang et al. | A novel deep odometry network for vehicle positioning based on smartphone | |
CN104897155A (en) | Personal portable auxiliary multisource locating information correcting method | |
Zhang et al. | Indoor localization using inertial sensors and ultrasonic rangefinder | |
Davidson | Algorithms for autonomous personal navigation systems | |
Jao et al. | UWB-Foot-SLAM: Bounding position error of foot-mounted pedestrian INS with simultaneously localized UWB beacons | |
Jao et al. | Augmented uwb-zupt-slam utilizing multi-sensor fusion | |
Wei | Multi-sources fusion based vehicle localization in urban environments under a loosely coupled probabilistic framework | |
CN105091881A (en) | Indoor positioning method for wireless sensing network and having static state detection function | |
Wang | A driverless vehicle vision path planning algorithm for sensor fusion |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
CB03 | Change of inventor or designer information | ||
CB03 | Change of inventor or designer information |
Inventor after: Wang Tao Inventor after: Zong Jingjing Inventor after: Cai Yingzhuo Inventor after: Guo Shiyong Inventor after: Zheng Haisheng Inventor after: Wu Haowei Inventor after: Wang Kun Inventor after: Xie Xiaojiao Inventor after: Qiao Zishi Inventor after: Xie Zhimao Inventor after: Zhang Pan Inventor before: Wang Tao Inventor before: Cai Yingzhuo Inventor before: Zheng Haisheng Inventor before: Wang Kun Inventor before: Xie Xiaojiao Inventor before: Qiao Zishi Inventor before: Xie Zhimao Inventor before: Zhang Pan Inventor before: Wu Haowei Inventor before: Zong Jingjing |
|
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20190520 Address after: 100029 3-4 Floor of Crawford Building, 23 Huixin East Street, Chaoyang District, Beijing Patentee after: Beijing techlink intelligent Polytron Technologies Inc Address before: 400044 Communication and Control Center of Area A, Chongqing University, 174 Shazhengjie, Shapingba District, Chongqing Patentee before: Chongqing University |