CN109640253A - A kind of method for positioning mobile robot - Google Patents
A kind of method for positioning mobile robot Download PDFInfo
- 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
Links
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Systems for determining distance or velocity not using reflection or reradiation
- G01S11/02—Systems for determining distance or velocity not using reflection or reradiation using radio waves
- G01S11/06—Systems for determining distance or velocity not using reflection or reradiation using radio waves using intensity measurements
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/33—Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/80—Services using short range communication, e.g. near-field communication [NFC], radio-frequency identification [RFID] or low energy communication
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE 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/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing 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
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.
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)
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)
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 |
-
2018
- 2018-12-26 CN CN201811601879.XA patent/CN109640253B/en active Active
Patent Citations (9)
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)
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)
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 |