CN109640253A - A kind of method for positioning mobile robot - Google Patents

A kind of method for positioning mobile robot Download PDF

Info

Publication number
CN109640253A
CN109640253A CN201811601879.XA CN201811601879A CN109640253A CN 109640253 A CN109640253 A CN 109640253A CN 201811601879 A CN201811601879 A CN 201811601879A CN 109640253 A CN109640253 A CN 109640253A
Authority
CN
China
Prior art keywords
point
signal strength
determined
denoted
coordinate
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.)
Granted
Application number
CN201811601879.XA
Other languages
Chinese (zh)
Other versions
CN109640253B (en
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.)
Dongyang Weichuang industrial product design Co., Ltd
Original Assignee
Hefei Best Control Technology 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 Hefei Best Control Technology Co Ltd filed Critical Hefei Best Control Technology Co Ltd
Priority to CN201811601879.XA priority Critical patent/CN109640253B/en
Publication of CN109640253A publication Critical patent/CN109640253A/en
Application granted granted Critical
Publication of CN109640253B publication Critical patent/CN109640253B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02Services making use of location information
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S11/00Systems for determining distance or velocity not using reflection or reradiation
    • G01S11/02Systems for determining distance or velocity not using reflection or reradiation using radio waves
    • G01S11/06Systems for determining distance or velocity not using reflection or reradiation using radio waves using intensity measurements
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/30Services specially adapted for particular environments, situations or purposes
    • H04W4/33Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/80Services using short range communication, e.g. near-field communication [NFC], radio-frequency identification [RFID] or low energy communication
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W64/00Locating users or terminals or network equipment for network management purposes, e.g. mobility management
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02DCLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
    • Y02D30/00Reducing energy consumption in communication networks
    • Y02D30/70Reducing energy consumption in communication networks in wireless communication networks

Abstract

The invention discloses a kind of method for positioning mobile robot, comprising the following steps: Bluetooth beacon deployment acquires radio signal strength characteristic and forms characteristic matrix, calculate the distance between point to be determined and four beacons, calculates (xw,yw), the characteristic calculated in signal strength characteristics data and set carries out similarity, calculates (xs,ys), fusion obtains final estimated location.The method have the advantages that: it does not need additional expensive device and does not need clock synchronization, therefore power consumption and cost are all lower, have stronger robustness.

Description

A kind of method for positioning mobile robot
Technical field
The present invention relates to robot fields, more particularly to a kind of method for positioning mobile robot.
Background technique
With the fast development of wireless communication, Internet technology and artificial intelligence, location technology is got the attention. It indoors in environment, is influenced since signal is blocked by building with multipath effect, Global Satellite Navigation System (Global Navigation Satellite System, GNSS) positioning accuracy seriously restricted, be unable to satisfy indoor location service Needs.Indoor positioning technologies complete the positioning to target labels mainly by building indoor locating system, by more base stations.Mesh Before, indoor positioning technologies are broadly divided into based on ranging and without ranging two major classes.The common method based on ranging mainly has base In received signal strength indicator (RSSI), based on signal transmission time (TOA), based on signal transmission time poor (TDOA) and being based on Direction of arrival degree (AOA) scheduling algorithm.Wherein, RSSI positioning mode do not need that clock is synchronous and angle measurement, power consumption and cost compared with It is low, and it is not required to additional hardware supported, therefore the present invention uses the distance measuring method based on RSSI.
Currently, extensive research has also been obtained based on RSSI positioning.Document " node positioning method based on RSSI, application Number: CN201410834896.3 " discloses a kind of node positioning method based on RSSI, can certainly solve for any mesh The problem of mark node calculates its node location, secondly, further correction can be carried out to node location to improve its essence True property.Document " a kind of RSSI indoor positioning algorithms based on Grid Clustering, application number: CN201810371361.5 " be directed to due to Complicated indoor environment and caused by the not high problem of positioning accuracy, propose a kind of indoor positioning of Grid Clustering based on RSSI Algorithm.It is characterized in that not needing the prior information of acquisition indoor environment, complicated indoor environment is widely used in, it can be achieved that concentrating The autonomous positioning of formula or distributed object label.The program is to need in advance a large amount of mark of arrangement on the ground based on RFID Label, therefore higher cost, certain influence is also brought to environment.A kind of document " indoor positioning side MLE-PSO based on RSSI Method, application number: CN201710234962.7 " discloses a kind of MLE-PSO indoor orientation method based on RSSI, can be significant It improves and is based on indoor position accuracy, while guaranteeing acquisition data volume size, iteration time needed for the calculating speed of location algorithm, positioning The dynamics performance capabilities such as number.
However, non line-of-sight communication is very significant with multipath effect due to indoor environment complexity, therefore it is based on triangle above The method reliability of positioning is lower.Another localization method based on RSSI is information fingerprint positioning, it refers to acquisition positioning Then the radio signal characteristics vector in region carries out matched localization method by radio signal characteristics vector.It is such fixed at present Position technique study is less.
Summary of the invention
The technology of the present invention overcome the deficiencies in the prior art, solve traditional indoor locating system robustness based on fingerprint compared with The problem of difference.
To solve the above problems, the invention discloses a kind of method for positioning mobile robot, specifically includes the following steps:
Step S1: 4 Bluetooth beacons are disposed in room area to be positioned first, four vertex is located at, is denoted as B1, B2,B3,B4, the position of this four beacons it is known that be denoted as respectively
Step S2: the signal for the beacon radiation disposed in step S1 can form radio wave signal field indoors, undetermined The different sample fingerprint points of the room area of position are denoted as RP, acquire radio signal strength characteristic, form characteristic square Battle array
Wherein,Indicate beacon BiIn sample point RPjThe nothing at place Line electrical signal intensity, N are sample point quantity, and the coordinate of each RP is (xj,yj);A similarity system is distributed for each sample point Number weight αj=1;
Step S3: acquisition point to be determined receives the signal strength data of four beacons, is denoted as respectively And it is calculated by the following formula between point to be determined and four beacons Distance:
RSSI=A-10nlg (d),
In above formula, RSSI indicates that certain puts the signal strength data received in area to be targeted, and A indicates reference distance 1m The unit of the received signal strength data at place, signal strength data is dBm, and n is path-loss factor, its value is actually measured Empirical value, barrier is more, and n value is bigger, d indicate the distance between point to be determined and beacon;
Step S4: calculating the coordinate of point to be determined with following formula, and the coordinate that this method is calculated is denoted as (xw, yw):
Wherein,Indicate the coordinate position of four beacons, wi, each letter of i=1,2,3,4 expression The weight of cursor position, these weights are the distance between point to be determined and each beacon by calculating in step S3 di, i= 1,2,3,4 decision, g is a constant;
Step S5: successively strong to the signal of point to be determined by signal strength characteristics set obtained in scanning step S2 The characteristic spent in characteristic and set carries out similarity calculation, and the formula of similarity calculation is as follows:
Wherein, sjIndicate the similarity between point to be determined and j-th of sample point;
Step S6: a series of similarities calculated in step S5 are arranged in descending order, the highest K sample of similarity Point is screened out, and the coordinate of point to be determined is calculated according to the position coordinates of this K sample point, what this method was calculated Coordinate is denoted as (xs,ys), calculation method is as follows:
Wherein, C is the serial number set for being selected the sample point of the K come, has K element in set;
Step S7: two position coordinates (x obtained in step S4 and step S6 are soughtw,yw) and (xs,ys) be averaged, count Final estimated location (x, y), if (xs,ys) and (xw,yw) the distance between less than one preset constant, τ, then It calculates
Otherwise x=x is enabledw, y=yw, and to αjIt is updated, it is as follows: the sample of the K nearest with it is found around (x, y) This point, serial number set are denoted as C ', askAndThen α is updatedjIt is as follows:Wherein δ > 0.
Compared with existing technology, the invention has the following advantages that
1. the present invention is based on Bluetooth technologies to carry out indoor positioning, since Bluetooth technology has been widely used for daily life In, so that the proposed localization method of the invention is implemented without additional expensive device, cost is relatively low;
2. using the distance measuring method based on RSSI, does not need clock and synchronize, power consumption and cost are all lower;
3. merging traditional location fingerprint localization method and weighted mass center location algorithm, the robust of localization method is enhanced Property.
Detailed description of the invention
Fig. 1 is flow chart of the present invention.
Specific embodiment
In order to make the objectives, technical solutions, and advantages of the present invention clearer, below in conjunction with attached drawing and specific implementation The present invention is described in detail for example.
A kind of method for positioning mobile robot, as shown in Figure 1, specifically includes the following steps:
Step S1: 4 Bluetooth beacons are disposed in room area to be positioned first, four vertex is located at, is denoted as B1, B2,B3,B4, the position of this four beacons it is known that be denoted as respectively
Step S2: the signal for the beacon radiation disposed in step S1 can form radio wave signal field indoors, undetermined The different sample fingerprint points of the room area of position are denoted as RP, acquire radio signal strength characteristic, form characteristic square Battle array
Wherein,Indicate beacon BiIn sample point RPjThe nothing at place Line electrical signal intensity, N are sample point quantity, and the coordinate of each RP is (xj,yj);A similarity system is distributed for each sample point Number weight αj=1;
Step S3: acquisition point to be determined receives the signal strength data of four beacons, is denoted as respectively And it is calculated by the following formula between point to be determined and four beacons Distance:
RSSI=A-10nlg (d),
In above formula, RSSI indicates that certain puts the signal strength data received in area to be targeted, and A indicates reference distance 1m The unit of the received signal strength data at place, signal strength data is dBm, and n is path-loss factor, its value is actually measured Empirical value, barrier is more, and n value is bigger, d indicate the distance between point to be determined and beacon;
Step S4: calculating the coordinate of point to be determined with following formula, and the coordinate that this method is calculated is denoted as (xw, yw):
Wherein,Indicate the coordinate position of four beacons, wi, each letter of i=1,2,3,4 expression The weight of cursor position, these weights are the distance between point to be determined and each beacon by calculating in step S3 di, i= 1,2,3,4 decision, g is a constant;
Step S5: successively strong to the signal of point to be determined by signal strength characteristics set obtained in scanning step S2 The characteristic spent in characteristic and set carries out similarity calculation, and the formula of similarity calculation is as follows:
Wherein, sjIndicate the similarity between point to be determined and j-th of sample point;
Step S6: a series of similarities calculated in step S5 are arranged in descending order, the highest K sample of similarity Point is screened out, and the coordinate of point to be determined is calculated according to the position coordinates of this K sample point, what this method was calculated Coordinate is denoted as (xs,ys), calculation method is as follows:
Wherein, C is the serial number set for being selected the sample point of the K come, has K element in set;
Step S7: two position coordinates (x obtained in step S4 and step S6 are soughtw,yw) and (xs,ys) be averaged, count Final estimated location (x, y), if (xs,ys) and (xw,yw) the distance between less than one preset constant, τ, then It calculates
Otherwise x=x is enabledw, y=yw, and to αjIt is updated, it is as follows: the sample of the K nearest with it is found around (x, y) This point, serial number set are denoted as C ', askAndThen α is updatedjIt is as follows:Wherein δ > 0.
Above embodiments are provided just for the sake of the description purpose of the present invention, and are not intended to limit the scope of the invention.This The range of invention is defined by the following claims.It does not depart from spirit and principles of the present invention and the various equivalent replacements made and repairs Change, should all cover within the scope of the present invention.

Claims (1)

1. a kind of method for positioning mobile robot, which is characterized in that specifically includes the following steps:
Step S1: 4 Bluetooth beacons are disposed in room area to be positioned first, four vertex is located at, is denoted as B1,B2, B3,B4, the position of this four beacons it is known that be denoted as respectively
Step S2: the signal for the beacon radiation disposed in step S1 can form radio wave signal field indoors, to be positioned The different sample fingerprint points of room area are denoted as RP, acquire radio signal strength characteristic, form characteristic matrix
Wherein,Indicate beacon BiIn sample point RPjThe radio at place Signal strength, N are sample point quantity, and the coordinate of each RP is (xj,yj);A coefficient of similarity power is distributed for each sample point Weight αj=1;
Step S3: acquisition point to be determined receives the signal strength data of four beacons, is denoted as respectively And it is calculated by the following formula between point to be determined and four beacons Distance:
RSSI=A-10nlg (d),
In above formula, RSSI indicates that certain puts the signal strength data received in area to be targeted, and A is indicated at reference distance 1m The unit of received signal strength data, signal strength data is dBm, and n is path-loss factor, its value is actually measured warp Value is tested, barrier is more, and n value is bigger, and d indicates the distance between point to be determined and beacon;
Step S4: calculating the coordinate of point to be determined with following formula, and the coordinate that this method is calculated is denoted as (xw,yw):
Wherein,Indicate the coordinate position of four beacons, wi, each beacon position of i=1,2,3,4 expression The weight set, these weights are the distance between point to be determined and each beacon by calculating in step S3 di, i=1,2, 3,4 decisions, g is a constant;
Step S5: successively special to the signal strength of point to be determined by signal strength characteristics set obtained in scanning step S2 The characteristic levied in data and set carries out similarity calculation, and the formula of similarity calculation is as follows:
Wherein, sjIndicate the similarity between point to be determined and j-th of sample point;
Step S6: a series of similarities calculated in step S5 are arranged in descending order, the highest K sample point quilt of similarity It screens, the coordinate of point to be determined, the coordinate that this method is calculated is calculated according to the position coordinates of this K sample point It is denoted as (xs,ys), calculation method is as follows:
Wherein, C is the serial number set for being selected the sample point of the K come, has K element in set;
Step S7: two position coordinates (x obtained in step S4 and step S6 are soughtw,yw) and (xs,ys) be averaged, calculate most Whole estimated location (x, y), if (xs,ys) and (xw,yw) the distance between less than one preset constant, τ, then calculate
Otherwise x=x is enabledw, y=yw, and to αjIt is updated, it is as follows: the sample of the K nearest with it is found around (x, y) Point, serial number set are denoted as C ', askAnd, then update αjIt is as follows: Wherein δ > 0.
CN201811601879.XA 2018-12-26 2018-12-26 Mobile robot positioning method Active CN109640253B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811601879.XA CN109640253B (en) 2018-12-26 2018-12-26 Mobile robot positioning method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811601879.XA CN109640253B (en) 2018-12-26 2018-12-26 Mobile robot positioning method

Publications (2)

Publication Number Publication Date
CN109640253A true CN109640253A (en) 2019-04-16
CN109640253B CN109640253B (en) 2020-09-29

Family

ID=66077962

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811601879.XA Active CN109640253B (en) 2018-12-26 2018-12-26 Mobile robot positioning method

Country Status (1)

Country Link
CN (1) CN109640253B (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111050275A (en) * 2019-11-26 2020-04-21 武汉虹信技术服务有限责任公司 Bluetooth positioning method based on RSSI characteristic value
CN113206502A (en) * 2021-06-08 2021-08-03 中铁电气化铁路运营管理有限公司 Power supply quality improving device

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011067466A1 (en) * 2009-12-04 2011-06-09 Nokia Corporation Method and apparatus for on-device positioning using compressed fingerprint archives
CN102883262A (en) * 2012-09-17 2013-01-16 北京大学 Wi-Fi indoor positioning method on basis of fingerprint matching
CN103476115A (en) * 2013-09-22 2013-12-25 中国地质大学(武汉) Method for WiFi fingerprint positioning based on AP set similarity
CN103596267A (en) * 2013-11-29 2014-02-19 哈尔滨工业大学 Fingerprint map matching method based on Euclidean distances
CN106376081A (en) * 2016-10-28 2017-02-01 江南大学 Mixed similarity-based indoor fingerprint positioning method
CN106792524A (en) * 2016-12-12 2017-05-31 太原理工大学 A kind of mixing indoor positioning system algorithm based on dynamic environment bidirectional correcting
CN107027168A (en) * 2016-02-02 2017-08-08 高德信息技术有限公司 Localization method and device
CN107302793A (en) * 2016-04-15 2017-10-27 华为技术有限公司 A kind of localization method based on wireless signal, server, terminal and system
CN108989976A (en) * 2018-06-04 2018-12-11 华中师范大学 Fingerprint positioning method and system in a kind of wisdom classroom

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011067466A1 (en) * 2009-12-04 2011-06-09 Nokia Corporation Method and apparatus for on-device positioning using compressed fingerprint archives
CN102883262A (en) * 2012-09-17 2013-01-16 北京大学 Wi-Fi indoor positioning method on basis of fingerprint matching
CN103476115A (en) * 2013-09-22 2013-12-25 中国地质大学(武汉) Method for WiFi fingerprint positioning based on AP set similarity
CN103596267A (en) * 2013-11-29 2014-02-19 哈尔滨工业大学 Fingerprint map matching method based on Euclidean distances
CN107027168A (en) * 2016-02-02 2017-08-08 高德信息技术有限公司 Localization method and device
CN107302793A (en) * 2016-04-15 2017-10-27 华为技术有限公司 A kind of localization method based on wireless signal, server, terminal and system
CN106376081A (en) * 2016-10-28 2017-02-01 江南大学 Mixed similarity-based indoor fingerprint positioning method
CN106792524A (en) * 2016-12-12 2017-05-31 太原理工大学 A kind of mixing indoor positioning system algorithm based on dynamic environment bidirectional correcting
CN108989976A (en) * 2018-06-04 2018-12-11 华中师范大学 Fingerprint positioning method and system in a kind of wisdom classroom

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
PENG YANG ET.AL: "Position fingerprint localization method based on linear interpolation in robot auditory system", 《2017 CHINESE AUTOMATION CONGRESS》 *
乐志伟: "基于RSSI的室内定位算法研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111050275A (en) * 2019-11-26 2020-04-21 武汉虹信技术服务有限责任公司 Bluetooth positioning method based on RSSI characteristic value
CN113206502A (en) * 2021-06-08 2021-08-03 中铁电气化铁路运营管理有限公司 Power supply quality improving device
CN113206502B (en) * 2021-06-08 2021-10-29 中铁电气化铁路运营管理有限公司 Power supply quality improving device

Also Published As

Publication number Publication date
CN109640253B (en) 2020-09-29

Similar Documents

Publication Publication Date Title
Zhao et al. Crowdsourcing and multisource fusion-based fingerprint sensing in smartphone localization
KR101660002B1 (en) Device and method for determining an orientation of a mobile device
CN106556854B (en) A kind of indoor and outdoor navigation system and method
KR102116824B1 (en) Positioning system based on deep learnin and construction method thereof
He et al. Contour-based trilateration for indoor fingerprinting localization
CN106125045B (en) A kind of ADAPTIVE MIXED indoor orientation method based on Wi-Fi
CN105704652B (en) Fingerprint base acquisition and optimization method in a kind of positioning of WLAN/ bluetooth
He et al. INTRI: Contour-based trilateration for indoor fingerprint-based localization
CN108716918A (en) A kind of RSSI indoor positioning algorithms based on Grid Clustering
CN108414972B (en) Mobile robot RFID positioning method based on phase characteristics
CN109275095A (en) A kind of indoor locating system based on bluetooth, positioning device and localization method
CN105717483B (en) A kind of location determining method and device based on multi-source positioning method
CN105353341A (en) Wireless sensor network positioning method based on unmanned autonomous aircraft
CN109141427A (en) EKF localization method under nlos environment based on distance and angle probabilistic model
CN104181500A (en) Real-time locating method based on inertia information and chance wireless signal characteristics
CN112533163A (en) Indoor positioning method based on NB-IoT (NB-IoT) improved fusion ultra-wideband and Bluetooth
CN110187333B (en) RFID label positioning method based on synthetic aperture radar technology
CN103929717A (en) Wireless sensor network positioning method based on weight Voronoi diagrams
CN109188360A (en) A kind of indoor visible light 3-D positioning method based on bat algorithm
CN108737952A (en) Based on the improved polygon weighted mass center localization method of RSSI rangings
CN109324321A (en) One kind is based on RFID with modified indoor positioning algorithms
CN110888108B (en) Positioning method based on RFID and phase calibration
CN109640253A (en) A kind of method for positioning mobile robot
Marquez et al. Understanding LoRa-based localization: Foundations and challenges
Hartmann et al. Antenna pattern optimization for a rssi-based direction of arrival localization system

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
TA01 Transfer of patent application right

Effective date of registration: 20200908

Address after: No.2, building 15, Dongfu community, houtang community, Jiangbei street, Dongyang City, Jinhua City, Zhejiang Province

Applicant after: Dongyang Weichuang industrial product design Co., Ltd

Address before: 230601 Room 110, Public Rental Building 1 # Building, West Qinglongtan Road, East Feiguang Road, North Export Processing Zone, Binhe District, Hefei Economic and Technological Development Zone, Anhui Province

Applicant before: HEFEI YOUKONG TECHNOLOGY Co.,Ltd.

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant