CN104883733A - Cooperative localization method of combining exterior penalty function method and Powell algorithm - Google Patents
Cooperative localization method of combining exterior penalty function method and Powell algorithm Download PDFInfo
- Publication number
- CN104883733A CN104883733A CN201510176063.7A CN201510176063A CN104883733A CN 104883733 A CN104883733 A CN 104883733A CN 201510176063 A CN201510176063 A CN 201510176063A CN 104883733 A CN104883733 A CN 104883733A
- Authority
- CN
- China
- Prior art keywords
- coordinate
- node
- function
- target function
- exterior penalty
- 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
- 238000000034 method Methods 0.000 title claims abstract description 62
- 230000004807 localization Effects 0.000 title abstract 4
- 238000006243 chemical reaction Methods 0.000 claims abstract description 3
- 238000005259 measurement Methods 0.000 claims description 6
- 238000004064 recycling Methods 0.000 claims description 4
- 238000005457 optimization Methods 0.000 abstract description 5
- 238000004088 simulation Methods 0.000 abstract 1
- 230000000452 restraining effect Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000000205 computational method Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
Classifications
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
The present invention provides a cooperative localization method of combining an exterior penalty function method and a Powell algorithm. In a wireless sensing network, absolute coordinates can be obtained by utilizing the relative coordinates and by the coordinate system conversion, so that a problem can be solved by the known relative coordinates. According to the present invention, supposing that all distances among nodes can be measured by a time of arrival (TOA) method, and a relative position problem namely, the cooperative localization, among the nodes can be solved by establishing a nonlinear programming method. In a nonlinear programming problem, a programming problem with a constraint condition is resolved into the programming problem without constraint by utilizing an exterior penalty, and then the optimal solution problem of each node in the cooperative localization is solved by utilizing the Powell algorithm. By a simulation experiment, even on the condition that a ranging value is very large, the precision of the relative coordinates among the nodes also can be guaranteed, the initial coordinate influence is not obvious, the more is the number of the nodes, the stronger is the connectivity, and the final optimization precision is higher.
Description
Technical field
The present invention relates to a kind of Nonlinear Programming Algorithm, namely extrapunitiveness method and Powell (Bao Weier) combination algorithm namely obtain the optimum coordinates solution meeting euclidean distance between node pair relation by the minimum problem solving function, and namely the problem efficiently solved without architecture only need know that internodal distance value just can calculate the relative coordinate of node.
Background technology
Colocated system has huge using value and market potential, is generally used for the region cannot disposing base station, and provides the service of position-based information for it, such as outdoor personnel tracking and merge the positioning precision etc. improving building periphery with GPS.TOA (Time of arrival, time arrive) distance-finding method has higher range accuracy, is distance-finding method conventional in current many object locating systems, have compared with GPS that equipment is small and exquisite, cost less, precision high.Nonlinear programming problem is the advantageous methods solving optimal solution problem, utilize extrapunitiveness method and Powell (Bao Weier) combination algorithm can solve without the colocated problem under base station case by structure target function and constraints, and precision is high, efficiency is fast, initial coordinate impact is less.
Summary of the invention
The technical problem to be solved in the present invention is, in positioning field, when the Location-Unknown of all nodes, only need the internodal distance value recorded by TOA, then the colocated method that this exterior penalty function method of proposition is combined with Powell algorithm is utilized, extrapunitiveness method is utilized to be combined the optimization problem solved in colocated with Powell by structure target function and constraints, the method can improve positioning precision, its method is simply effective, the feature such as have high accuracy, low amount of calculation, overhead is little, efficiency is fast.
For solving the problems of the technologies described above, the present invention proposes a kind of colocated method that exterior penalty function method is combined with Powell algorithm, comprises step:
(1) random arrangement node in TOA ranging region, when all node location the unknowns, the target function solving optimal solution is configured to by the distance measurement value between node, range error is gone out according to range error model assessment, bound for objective function is constructed by range error, make the minimum finding target function in the scope of constraints, as the optimal solution of the elements of a fix;
(2) by exterior penalty function method, target function and constraints are converted into unconfined planning problem, using calling Powell algorithm as input parameter ask the minimum of target function and corresponding elements of a fix result as output without constrained objective function, initial coordinate, distance measurement value after conversion;
(3) judge whether coordinate result meets the condition of convergence of exterior penalty function method, stop exterior penalty function iterated conditional if meet, export and optimize coordinate result; If do not meet, repeat step (2).
Further, the initial coordinate of step (1) interior joint is OriginalAxis=[(x
1, y
1), (x
2, y
2) ... (x
n, y
n)], wherein n is node number;
Target function
Wherein x, y representation node coordinate, the distance between Distance representation node.
Further, the exterior penalty function method principle in described step (2) is:
Without constrained objective function be then
Further, describedly determine that elements of a fix result comprises following two steps:
A) utilize advance and retreat method to determine the scope of the region of search, the gained region of search;
B) determine the region of search by advance and retreat method, recycling Fibonacci method determines step-size in search; The coordinate of unknown position node is tried to achieve eventually through Powel l algorithm.
Further, in described step (3), output condition is:
1.
wherein F
1for last iteration target function minimum, F
2for current iteration target function minimum;
2. (X
1-X
2)
2≤ e
-4wherein (X
1for the coordinate vector that current iteration calculates, X
2for the coordinate vector that last iteration calculates.
In the present invention, the distance supposing between node can be passed through TOA (Time Of Arrival, the time arrives method) and records.Internodal relative position problem is solved, i.e. co-positioned by the method setting up Non-Linear Programming.In nonlinear programming problem, utilize extrapunitiveness method that the planning problem of band Prescribed Properties is dissolved as unconfined planning problem, recycling Powell (Powell algorithm) solves the optimal solution problem of each node in co-positioned.Found by emulation experiment, even if when distance measurement value is very large, the precision of internodal relative coordinate also can be ensured, and initial coordinate impact and not obvious, node number is more, and connectedness is stronger, and final optimization precision is higher.
Accompanying drawing explanation
Fig. 1 is the flow chart of the colocated method that a kind of exterior penalty function method of the embodiment of the present invention is combined with Powell algorithm;
Fig. 2 is the true coordinate deployment diagram of embodiment of the present invention random distribution;
Fig. 3 is the coordinate deployment diagram that the embodiment of the present invention is calculated by the colocated method optimization that exterior penalty function method is combined with Powell algorithm;
Fig. 4 is embodiment of the present invention Powell (Bao Weier) algorithm flow chart;
Fig. 5 is the flow chart that the embodiment of the present invention utilizes the advance and retreat method determination region of search;
Fig. 6 is the flow chart that the embodiment of the present invention utilizes Fibonacci method determination step-size in search.
Embodiment
Below in conjunction with accompanying drawing, the present invention is described further:
See Fig. 1, the figure shows the colocated method that a kind of exterior penalty function method of the embodiment of the present invention is combined with Powell algorithm, specifically comprise step:
Step S101: when all need location node Location-Unknown, initial coordinate is OriginalAxis=[(x
1, y
1), (x
2, y
2) ... (x
n, y
n)].
Wherein n is node number.
Step S102: utilize internodal distance relation between two to construct objective function F,
Wherein
Wherein x, y representation node coordinate, the distance between Distance representation node.
Then according to outdoor range error model, arrange range error E=ε, distance measurement value is larger than actual value under normal circumstances, and the scope being limited euclidean distance between node pair by range error can not exceed+ε, so carry out structure constraint condition by the scope of range error; Namely under line of sight conditions, produce average is 1.25, and variance is the range error of 0.5, and in non line of sight situation, produce average is 4.5, and variance is the range error of 0.5, by the random range error structure bound for objective function produced;
Wherein
Wherein x, y representation node coordinate, the distance between Distance representation node, ε represents range error.
Step S103: utilize exterior penalty function method that the target function of belt restraining is changed into the target function of not belt restraining,
Its exterior penalty function method principle is:
The then target function of not Problem with Some Constrained Conditions
Step S104: utilize Powel l (Bao Weier) algorithm ask the minimum of the target function of not belt restraining and make to become minimizing coordinate figure, wherein Powel l (Bao Weier) calculates ratio juris and is divided into two steps to try to achieve with reference to the computational methods of λ in figure 4, Fig. 4:
1. utilize advance and retreat method to determine the scope of the region of search, the flow process of method of wherein retreating is as Fig. 5; Wherein a
0=0, h=e
-5, [a, the b] of gained is the region of search.
2. determine the region of search [a, b] by advance and retreat method, recycling Fibonacci method determines step-size in search λ, and wherein the flow process of Fibonacci method is as Fig. 6, and wherein gained approximate solution r is then required λ.
Can in the hope of the coordinate of unknown position node eventually through Powell (Bao Weier) algorithm
Step S105: by the condition of convergence, that is:
3.
wherein F
1for last iteration target function minimum, F
2for current iteration target function minimum
4. (X
1-X
2)
2≤ e
-4wherein (X
1for the coordinate vector that current iteration calculates, X
2for the coordinate vector that last iteration calculates
When simultaneously meet 1. 2. time, optimize terminate, then this coordinate calculated is final optimization coordinate, forwards step S106 to.
If do not meet, the coordinate OptimizeAxis after upgrading is re-used the target function that extrapunitiveness method calculates not Problem with Some Constrained Conditions, then repeats step S104.
Eventually through embodiment, final optimum results is as Fig. 3, wherein can be for communication between internodal line representation node, the co-positioned problem without base station can well be solved as seen from the figure by the method for Non-Linear Programming, by contrasting with Fig. 2 physical location, can find to be combined with Powel l (Bao Weier) algorithm by extrapunitiveness method that to process this problem precision very high.
The present invention also can have other various embodiments; when not deviating from the present invention's spirit and essence thereof; those skilled in the art are when making various corresponding change and distortion according to the present invention, but these change accordingly and are out of shape the protection range that all should belong to the claim appended by the present invention.
Claims (5)
1. the colocated method that is combined with Powell algorithm of exterior penalty function method, is applied to the sensor network system without base station, it is characterized in that, comprise the following steps:
(1) random arrangement node in TOA ranging region, when all node location the unknowns, the target function solving optimal solution is configured to by the distance measurement value between node, range error is gone out according to range error model assessment, bound for objective function is constructed by range error, make the minimum finding target function in the scope of constraints, as the optimal solution of the elements of a fix;
(2) by exterior penalty function method, target function and constraints are converted into unconfined planning problem, using calling Powell algorithm as input parameter ask the minimum of target function and corresponding elements of a fix result as output without constrained objective function, initial coordinate, distance measurement value after conversion;
(3) judge whether coordinate result meets the condition of convergence of exterior penalty function method, stop exterior penalty function iterated conditional if meet, export and optimize coordinate result; If do not meet, repeat step (2).
2. colocated method according to claim 1, is characterized in that, the initial coordinate of step (1) interior joint is OriginalAxis=[(x
1, y
1), (x
2, y
2) ... (x
n, y
n)], wherein n is node number;
Target function
Wherein x, y representation node coordinate, the distance between Distance representation node.
3. colocated method according to claim 2, is characterized in that, the exterior penalty function method principle in described step (2) is:
Without constrained objective function be then
4. colocated method according to claim 3, is characterized in that, describedly determines that elements of a fix result comprises following two steps:
A) utilize advance and retreat method to determine the scope of the region of search, the gained region of search;
B) determine the region of search by advance and retreat method, recycling Fibonacci method determines step-size in search; The coordinate of unknown position node is tried to achieve eventually through Powell algorithm.
5. colocated method according to claim 4, is characterized in that, in described step (3), output condition is:
1.
wherein F
1for last iteration target function minimum, F
2for current iteration target function minimum;
2. (X
1-X
2)
2≤ e
-4wherein (X
1for the coordinate vector that current iteration calculates, X
2for the coordinate vector that last iteration calculates.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510176063.7A CN104883733B (en) | 2015-04-14 | 2015-04-14 | A kind of co-located method of exterior penalty function method in conjunction with Powell algorithm |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510176063.7A CN104883733B (en) | 2015-04-14 | 2015-04-14 | A kind of co-located method of exterior penalty function method in conjunction with Powell algorithm |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104883733A true CN104883733A (en) | 2015-09-02 |
CN104883733B CN104883733B (en) | 2019-01-29 |
Family
ID=53951030
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510176063.7A Active CN104883733B (en) | 2015-04-14 | 2015-04-14 | A kind of co-located method of exterior penalty function method in conjunction with Powell algorithm |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104883733B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109282817A (en) * | 2018-10-16 | 2019-01-29 | 中山大学 | A kind of multirobot co-located and control method |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050288888A1 (en) * | 2004-06-09 | 2005-12-29 | Yinyu Ye | Semi-definite programming method for ad hoc network node localization |
CN101917762A (en) * | 2010-08-09 | 2010-12-15 | 哈尔滨工程大学 | Node positioning method of particle swarm optimization sensor with penalty function |
CN102325370A (en) * | 2011-06-28 | 2012-01-18 | 山东大学威海分校 | High-precision three-dimensional positioner for wireless sensor network node |
CN104023390A (en) * | 2014-05-14 | 2014-09-03 | 浙江工业大学 | WSN node positioning method based on combination of PSO and UKF |
-
2015
- 2015-04-14 CN CN201510176063.7A patent/CN104883733B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050288888A1 (en) * | 2004-06-09 | 2005-12-29 | Yinyu Ye | Semi-definite programming method for ad hoc network node localization |
CN101917762A (en) * | 2010-08-09 | 2010-12-15 | 哈尔滨工程大学 | Node positioning method of particle swarm optimization sensor with penalty function |
CN102325370A (en) * | 2011-06-28 | 2012-01-18 | 山东大学威海分校 | High-precision three-dimensional positioner for wireless sensor network node |
CN104023390A (en) * | 2014-05-14 | 2014-09-03 | 浙江工业大学 | WSN node positioning method based on combination of PSO and UKF |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109282817A (en) * | 2018-10-16 | 2019-01-29 | 中山大学 | A kind of multirobot co-located and control method |
CN109282817B (en) * | 2018-10-16 | 2022-04-12 | 中山大学 | Multi-robot cooperative positioning and control method |
Also Published As
Publication number | Publication date |
---|---|
CN104883733B (en) | 2019-01-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102026370A (en) | Time difference on arrival (TDOA) locating method based on circumferentially distributed monitoring nodes | |
CN101378592A (en) | Method for locating wireless sensing network node base on RSSI | |
CN104853317A (en) | WiFi indoor positioning fingerprint database construction and update method | |
CN107820206B (en) | Non-line-of-sight positioning method based on signal intensity | |
CN101695190A (en) | Three-dimensional wireless sensor network node self-locating method based on neural network | |
CN104469942A (en) | Indoor positioning method based on hidden Markov model | |
CN103885028B (en) | A kind of associating method for positioning mass center based on error correction being applicable to wireless sensor network node location | |
Chuku et al. | An RSSI based localization scheme for wireless sensor networks to mitigate shadowing effects | |
Kim et al. | Cooperative localization with distributed ADMM over 5G-based VANETs | |
CN105188082A (en) | Evaluation method for RSS (Received Signal Strength)/AOA (Angle of Arrival)/TDOA (Time Difference of Arrival) positioning performance under indoor WLAN (Wireless Local Area Network) environment | |
CN104066179A (en) | Improved method for positioning WSN nodes through adaptive iterative UKF | |
CN114585082B (en) | Wireless positioning method, device and storage medium of electric power Internet of things equipment | |
CN105353351A (en) | Improved positioning method based on multi-beacon arrival time differences | |
Cho et al. | Improving TDoA based positioning accuracy using machine learning in a LoRaWan environment | |
KR100953435B1 (en) | Positioning method with combination of AoA and ToA using two base station | |
CN104683949A (en) | Antenna-array-based hybrid self-positioning method applied to wireless Mesh network | |
CN104883733A (en) | Cooperative localization method of combining exterior penalty function method and Powell algorithm | |
Xiong et al. | Hybrid WSN-RFID cooperative positioning based on extended Kalman filter | |
Chen et al. | Hybrid ToA/AoA schemes for mobile location in cellular communication systems | |
He et al. | A hybrid data fusion based cooperative localization approach for cellular networks | |
Landolsi et al. | TOAI/AOA/RSS maximum likelihood data fusion for efficient localization in wireless networks | |
Tilwari et al. | Autonomous 3D UAV localization using taylor series linearized TDOA-based approach with machine learning algorithms | |
Shao et al. | Multi-layer and multi-dimensional information based cooperative vehicle localization in highway scenarios | |
CN105101403A (en) | Emergency cellular communication network-based precise positioning method | |
Brida et al. | A novel adaptive algorithm for RSS positioning in GSM networks |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20231208 Address after: 300392, 3rd Floor, No. 6 Haitai West Road, Huayuan Industrial Zone (Outer Ring), Binhai High tech Zone, Binhai New Area, Tianjin Patentee after: TIANJIN TIAN'AN BORUI TECHNOLOGY CO.,LTD. Address before: 100083 No. 30, Haidian District, Beijing, Xueyuan Road Patentee before: University OF SCIENCE AND TECHNOLOGY BEIJING |
|
TR01 | Transfer of patent right |