CN115633400B - Target positioning calculation method and device - Google Patents
Target positioning calculation method and device Download PDFInfo
- Publication number
- CN115633400B CN115633400B CN202211638165.2A CN202211638165A CN115633400B CN 115633400 B CN115633400 B CN 115633400B CN 202211638165 A CN202211638165 A CN 202211638165A CN 115633400 B CN115633400 B CN 115633400B
- Authority
- CN
- China
- Prior art keywords
- target
- base station
- range
- interval
- calculating
- 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
Images
Classifications
-
- 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 target positioning calculation method and a target positioning calculation device. The method comprises the steps of firstly estimating a possible range of target positioning, then traversing in a fast iteration mode through a dot matrix in the possible range, and calculating a point with the minimum comprehensive error as a final positioning target. The method can avoid the error accumulation problem possibly caused by algorithms such as Taylor positioning algorithm, kalman filtering algorithm and the like.
Description
Technical Field
The invention relates to a wireless positioning technology.
Background
The wireless positioning technology is a technology that calculates the angle and distance between a target and a base station through information such as the arrival angle, arrival time, signal strength and the like of a wireless signal, and then calculates the position of the target according to the angle and distance between the target and the base station and the position of the base station. The technology of positioning based on the angle of arrival of a wireless signal is generally applied to a mobile network, and the positioning technology based on short-range wireless communication such as bluetooth, wifi, zigBee and the like is generally used for performing position positioning calculation according to the distance between a base station and a target. In this technique of calculating the position location based on the distance between the base station and the object, the accuracy of the location depends on whether the distance measurement between the base station and the object is accurate. However, the real problem is that the distance between the base station and the target measured by the wireless signal is relatively large, which is determined by the characteristics of the wireless signal itself, especially in non-line-of-sight environments or strong magnetic interference. Therefore, in order to reduce the inevitable error interference of the measured distance between the base station and the target, the base stations are densely arranged in the prior art, the target is covered by the base stations in an overlapping manner, the distances between the base stations and the target are collected, and then the distances are calculated by a mathematical method to improve the positioning accuracy. In the prior art, such calculation methods include taylor positioning algorithm, kalman filtering algorithm, and the like.
Disclosure of Invention
The problems to be solved by the invention are as follows: and under the condition that the distance measured between the base station and the target has inevitable errors, the accuracy of target positioning calculation is improved.
In order to solve the problems, the invention adopts the following scheme:
the invention relates to a target positioning calculation method, which comprises the following steps:
step S1, for: acquiring position information of each base station and measurement distance data of each base station in a target;
step S2, is used for: calculating the estimated position of the target according to the position information of each base station and the measured distance data of each base station to the target(ii) a Wherein the content of the first and second substances,
respectively represent the firstiThe abscissa and ordinate of the individual base station position information;
Nit is indicated that the number of base stations minus 1,N≥3;
Step S4, is used for: to estimate the positionCentered on the intervalwInternally constructed lattice setP:
step S5, is used for: to the lattice setPCalculating the comprehensive error evaluation value at each point in theD(j):
Wherein the content of the first and second substances,D(j) Representing a set of latticesPTo middlejThe comprehensive error evaluation value of the points;
step S6, is used for: getAnd narrow the range of the intervalwRepeating the steps S4 to S6 until the interval range is reachedwLess than a predetermined thresholdeAt the approaching position of the targetAs the final calculated target location position.
Further, according to the target location calculating method of the present invention, in the step S4,;
further, according to the target location calculating method of the present invention, in the step S4,H=4; step S6 of narrowing the range of the sectionwWhen the value range of (2) is selected, the range of the interval is narrowedwTo 2w/3。
Further, according to the object location calculation method of the present invention, a threshold valueeNot more than half the required positioning accuracy.
An object location calculation apparatus according to the present invention includes the following modules:
a module M1 for: acquiring position information of each base station and measurement distance data of each base station in a target;
a module M2 for: calculating the estimated position of the target according to the position information of each base station and the measured distance data of each base station to the target(ii) a Wherein the content of the first and second substances,
respectively representiThe abscissa and ordinate of the individual base station position information;
Nit is indicated that the number of base stations minus 1,N≥3;
a module M5 for: to the lattice setPCalculating the comprehensive error evaluation value at each point in theD(j):
Wherein the content of the first and second substances,D(j) Representing a set of latticesPTo middlejThe comprehensive error evaluation value of the points;
a module M6 for: get theAnd narrow the range of the intervalwRepeating the modules M4 to M6 until reaching the interval rangewLess than a predetermined thresholdeAt the approaching position of the targetAs the final calculated target location position.
Further, according to the object location calculation device of the present invention, in the module M4,;
further, according to the object location calculation device of the present invention, in the module M4,H=4; the module M6 reduces the range of the intervalwWhen the value range of (2) is selected, the range of the interval is narrowedwTo 2w/3。
Further, according to the object localization calculation device of the present invention, the threshold valueeNot more than half the required positioning accuracy.
The invention has the following technical effects: the method comprises the steps of firstly estimating a possible range of target positioning, then traversing in a fast iteration mode through a dot matrix in the possible range, and calculating a point with the minimum comprehensive error as a final positioning target. In addition, the invention avoids the error accumulation problem possibly caused by algorithms such as Taylor positioning algorithm, kalman filtering algorithm and the like.
Drawings
Fig. 1 is a schematic structural diagram of a wireless positioning system according to an embodiment of the present invention.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings.
Fig. 1 illustrates a wireless positioning system including a control center host 100 and a plurality of base stations 200 densely arranged in a specific area, the control center host 100 being connected to the base stations 200. The object 300 under test is located within the area in which the base station 200 is disposed. When wireless positioning is performed, the target 300 to be measured interacts with the base station 200, the base station 200 measures the distance between the target 300 to be measured through the interaction with the target 300 to be measured, and the base station 200 sends distance data to the control center host 100 after measuring the distance between the target 300 to be measured and the base station 200. The control center host 100 implements the target location calculation method of the present embodiment by executing a computer program. That is, the object localization calculation method and the object localization calculation apparatus of the present invention are realized by a machine computer software program. The wireless communication technology of which technology is used by the base station 200 and the target 300 to be measured, how the base station 200 measures the distance to the target 300 to be measured, and how the base station 200 transmits the distance data to the control center host 100 are not the scope of the present disclosure, and need not be described in detail.
The target positioning calculation method of the embodiment comprises the following steps:
s1, acquiring position information of each base station and measurement distance data of each base station in a target;
s2, calculating the estimated position of the target according to the position information of each base station and the measured distance data of each base station to the target;
Step S5, aiming at the dot matrix setPCalculating the comprehensive error evaluation value at each point in theD(j) Recording the integrated error estimate thereinD(i) Minimum value corresponds toAs a target approach position;
Step S6, to approach the positionAs the estimated position, and reducing the range of the intervalwCarrying out the iteration from the step S4 to the step S6 until the interval rangewLess than a predetermined thresholde。
Step S1 indicates that the position information of each base station and the measured distance data of each base station to the target are input to the present invention. The target is the object to be measured. The location information of each base station can be expressed asThe measured distance data to the target for each base station can be expressed as(ii) a Wherein the content of the first and second substances,is shown asiHorizontal and vertical coordinates of the base station position;denotes the firstiThe distance between each base station and the target;is represented by from 0 toNIs selected. N is the base station number minus 1, i.e., N +1 is the base station number. It should be noted that the number of base stations is not the total number of base stations in the whole wireless positioning system, but the number of base stations from which effective distance data can be measured with the target to be measured. It should be noted that the target location calculation method of the present invention requires that the number of base stations capable of measuring the effective distance data of the measured target is at least 4, so as to satisfy the redundancy requirement. That is to sayN≥3。
In addition, the position information of each base station and the measurement distance data of each base station to the target can also be expressed as the following ternary structure:. Those skilled in the art will appreciate how the input data is represented in a manner that does not affect the calculation of the object location of the present invention.
From the input of step S1, those skilled in the art will appreciate that to calculate the target position, the following overdetermined system of equations for solving for the target position may be constructed from the distance formula:
in the above equation system, subtracting the first expression from the last N expressions can obtain the following equation system expressed in matrix:AX=B(ii) a Wherein the content of the first and second substances,
X=[x,y]。
from this, a positioning error function can be derived:. According to the least square method, forf(X) To findxAndyrespectively, the partial derivatives are equal to 0: ∂f(X)/ ∂x =0,∂f(X)/ ∂y =0, the estimated position of the target can be calculated:
The mathematical derivation process is the estimated position in step S2 of the present inventionThe source of the calculation of (2).
In step S3, the section rangewCalculated according to the following formula:
obviously, the range of intervalswIs essentially an average distance error value.
In step S4, the lattice setPCan be expressed as:. In this embodiment, the lattice set is constructed as followsP:
that is, in this embodiment, the lattice setPIs formed by taking the horizontal coordinate as an intervalx p -w, x p +w]The equidistant points and the ordinate in the range are the interval [ 2 ]y p -w, y p +w]A square matrix of equally spaced points within the range, the spacing of the intervals being 2w/H. Lattice setPThe number of interior points is: (H+1)×(H+ 1), that is to sayR=(H+1)×(H+1) -1。
Those skilled in the art will appreciate that the lattice set P may be constructed in other ways. For example, the lattice set P is an estimated positionPoints on the circumference of the circle as the center of the circle, and points and estimated positions on different circumferencesThe distances of (a) are in an arithmetic progression. Regardless of the manner in which the lattice set P is constructed, the abscissa of the point in the lattice set P lies in the interval [ 2 ]x p -w, x p +w]In the range, the ordinate is in the interval [ ]y p -w, y p +w]Within the range. This is also the caseCentered on the intervalwThe meaning of "inner construct".
In step S5, the overall error evaluation value D (j) is calculated by using the following formula:
wherein the content of the first and second substances,D(j) Representing a set of latticesPTo middlejAnd (4) comprehensive error evaluation values of the points.
Step S6 represents that steps S4 to S6 are a loop iteration process, and each loop passes through the reduced interval rangewConvergence is performed. Range of current intervalwLess than thresholdeWhen so, the loop iteration is ended. Threshold valueeThe predetermined value is generally not less than half of the required positioning accuracy. For example, if the positioning accuracy required by a positioning system is not less than 1 meter, the threshold value is seteAnd may be selected to be 0.5 meter or 0.4 meter.
Those skilled in the art will appreciate that step S6 narrows the rangewThe reduced scale determines the speed of the target positioning calculation method of the invention, and if the reduced scale is larger, the convergence is faster, and the overall calculation speed is faster. On the other hand, if the scale of reduction is too large, the point of minimum error may be missed. To this end, in general, the interval range is determined for each iterationwThe reduced value should not be less than half the maximum spacing between adjacent dots in the dot matrix set P. For example, the points in the lattice set P of this embodiment are constructed as follows:(ii) a Wherein the content of the first and second substances,,。Hin this embodiment, preferably, 4 points are 25 points in the lattice set P. I.e. R =24. At this time, half of the maximum distance between adjacent dots in the dot matrix set PAbout 0.36w. Therefore, step S6 reduces the range of the sectionwShould not be less than 0.36w. In this embodiment, step S6 narrows down the rangewReduced to 2w/3。
In addition, those skilled in the art understand that when constructing the lattice set P in the present embodiment, the larger H, the larger the calculation amount of each iteration. The iteration efficiency is comprehensively considered, and H is more suitable to be 3-6.
Furthermore, it is emphasized that, when calculating the integrated error evaluation value D (j),in the formula, an absolute value is taken.
In addition, the device and the method in the invention correspond, and the modules in the device and the steps in the method correspond, which are not described again.
Claims (6)
1. A method of calculating target location, the method comprising the steps of:
step S1, for: acquiring position information of each base station and measurement distance data of each base station in a target;
step S2, is used for: calculating the estimated position of the target according to the position information of each base station and the measured distance data of each base station to the target(ii) a Wherein the content of the first and second substances,
respectively represent the firstiThe abscissa and ordinate of the individual base station position information;
Nit is indicated that the number of base stations minus 1,N≥3;
Step S4, is used for: to estimate the positionCentered on the intervalwInternally constructed lattice setP:
step S5, is used for: to the lattice setPCalculating the comprehensive error evaluation value at each point in theD(j):
Wherein, the first and the second end of the pipe are connected with each other,D(j) Representing a set of latticesPTo middlejThe comprehensive error evaluation value of the points;
2. The object-locating calculation method according to claim 1, wherein, in step S4,H=4; step S6 of narrowing the range of the sectionwWhen the value range of (2) is selected, the range of the interval is narrowedwTo 2w/3。
3. The method of object localization calculation of claim 1, wherein the threshold valueeNot more than half the required positioning accuracy.
4. An object localization calculation apparatus, comprising:
a module M1 for: acquiring position information of each base station and measurement distance data of each base station in a target;
a module M2 for: calculating the estimated position of the target according to the position information of each base station and the measured distance data of each base station to the target(ii) a Wherein the content of the first and second substances,
respectively representiThe abscissa and ordinate of the individual base station position information;
Nit is indicated that the number of base stations minus 1,N≥3;
A module M4 for: to estimate the positionCentered on the intervalwInternally constructed lattice setP:
a module M5 for: to the lattice setPCalculating the comprehensive error evaluation value at each point in theD(j):
Wherein the content of the first and second substances,D(j) Representing a set of latticesPTo middlejThe comprehensive error evaluation value of the points;
5. Object-positioning computing device according to claim 4, characterized in that in said module M4,H=4; the module M6 reduces the range of the intervalwWhen the value range of (2) is selected, the range of the interval is narrowedwTo 2w/3。
6. Object localization computing device according to claim 4, characterized by a threshold valueeNot more than half the required positioning accuracy.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211638165.2A CN115633400B (en) | 2022-12-20 | 2022-12-20 | Target positioning calculation method and device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211638165.2A CN115633400B (en) | 2022-12-20 | 2022-12-20 | Target positioning calculation method and device |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115633400A CN115633400A (en) | 2023-01-20 |
CN115633400B true CN115633400B (en) | 2023-03-07 |
Family
ID=84909756
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211638165.2A Active CN115633400B (en) | 2022-12-20 | 2022-12-20 | Target positioning calculation method and device |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115633400B (en) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022027073A1 (en) * | 2020-07-31 | 2022-02-03 | Cohere Technologies, Inc. | Localization and auto-calibration in a wireless network |
CN114487998A (en) * | 2021-08-26 | 2022-05-13 | 苏州楚亦捷科技有限公司 | High-precision lattice positioning method without base station |
-
2022
- 2022-12-20 CN CN202211638165.2A patent/CN115633400B/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022027073A1 (en) * | 2020-07-31 | 2022-02-03 | Cohere Technologies, Inc. | Localization and auto-calibration in a wireless network |
CN114487998A (en) * | 2021-08-26 | 2022-05-13 | 苏州楚亦捷科技有限公司 | High-precision lattice positioning method without base station |
Non-Patent Citations (1)
Title |
---|
李正东等.基于测距技术的井下动目标精确定位方法.《工矿自动化》.2015,(第05期), * |
Also Published As
Publication number | Publication date |
---|---|
CN115633400A (en) | 2023-01-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109141427B (en) | EKF positioning method based on distance and angle probability model under non-line-of-sight environment | |
CN102685887B (en) | Method, device and system for positioning node in wireless sensor network | |
CN103759732B (en) | A kind of centralized multisensor multiple hypotheis tracking method of angle information auxiliary | |
CN102062587A (en) | Laser sensor-based method for determining poses of multiple mobile robots | |
CN111536967A (en) | EKF-based multi-sensor fusion greenhouse inspection robot tracking method | |
CN110516350B (en) | ERS point error correction method based on anisotropic weighting | |
CN110493869B (en) | RSSI-based K-nearest neighbor differential correction centroid positioning method | |
CN110806561B (en) | Self-calibration method for multiple base stations | |
CN110572779B (en) | System error estimation method of base station based on ToF model | |
CN106932752A (en) | A kind of real-time indoor orientation method based on RF phse monitoring | |
CN107371133B (en) | Method for improving positioning accuracy of base station | |
CN104363649A (en) | UKF (unscented Kalman filter)-based WSN (wireless sensor network) node location method with constraint conditions | |
CN110595479B (en) | SLAM track evaluation method based on ICP algorithm | |
CN115633400B (en) | Target positioning calculation method and device | |
CN106671081B (en) | A kind of lower-mobility robot kinematics calibration method based on monocular vision | |
KR101106265B1 (en) | Localization apparatus and method for mobile robot using rfid | |
CN104732089B (en) | A kind of historical data construction method of trans-regional alignment system filtering algorithm | |
CN108061893B (en) | Yaw collision avoidance early warning method and device based on target track | |
JP2009210408A (en) | Wireless system and its location identification method | |
CN114063150B (en) | ML-KNN algorithm-based 'seismic source-station' speed model selection method | |
CN105259533A (en) | Three-stage arrival time difference positioning method based on multidimensional scaling sub space analysis | |
CN108332784B (en) | Distance measurement verification method | |
Zhao et al. | Localization algorithm for wireless sensor networks based on modified distance estimation | |
CN113884049A (en) | Method for measuring horizontal bending of crane by using total station | |
KR101294284B1 (en) | Method and apparatus for measuring position using radio communication |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |