WO2023019840A1 - Wireless positioning method and apparatus, electronic device, and storage medium - Google Patents

Wireless positioning method and apparatus, electronic device, and storage medium Download PDF

Info

Publication number
WO2023019840A1
WO2023019840A1 PCT/CN2021/139354 CN2021139354W WO2023019840A1 WO 2023019840 A1 WO2023019840 A1 WO 2023019840A1 CN 2021139354 W CN2021139354 W CN 2021139354W WO 2023019840 A1 WO2023019840 A1 WO 2023019840A1
Authority
WO
WIPO (PCT)
Prior art keywords
vector
coordinate
coordinate point
positioning
point
Prior art date
Application number
PCT/CN2021/139354
Other languages
French (fr)
Chinese (zh)
Inventor
吴泽先
Original Assignee
上海闻泰电子科技有限公司
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 上海闻泰电子科技有限公司 filed Critical 上海闻泰电子科技有限公司
Publication of WO2023019840A1 publication Critical patent/WO2023019840A1/en

Links

Images

Classifications

    • 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
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves

Definitions

  • the disclosure relates to a wireless positioning method, device, electronic equipment and storage medium.
  • wireless positioning technologies such as ultrasound, radio frequency identification (Radio Frequency Identification, RFID), wireless fidelity (Wireless Fidelity, WiFi), Bluetooth, and ultra-wideband (Ultra-Wide Band, UWB) are usually used to realize positioning services. .
  • UWB and other wireless positioning systems usually include a large number of positioning tags and base stations, which rely on high-frequency wireless signals for distance measurement and positioning.
  • the internal interference of the system is large, resulting in low positioning accuracy.
  • the wireless signal is a time-varying signal, and even in the absence of interference, it is prone to discontinuous positioning coordinates, stuttering, etc., which will also affect the positioning accuracy.
  • a wireless positioning method, device, electronic device, and storage medium are provided.
  • a wireless positioning method comprising:
  • the positioning coordinate value of the current coordinate point is determined according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point.
  • the determining the second vector V2 according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point includes:
  • the size of the second vector V2 is determined according to the i-order difference of the first coordinate point.
  • the value of n is 3, and the i-order difference of the first coordinate point is determined according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, including :
  • the determining the size of the second vector V2 according to the i-order difference of the first coordinate point includes:
  • the size of the second vector V2 is determined by the following formula:
  • is the modulus length of the second vector V2
  • ⁇ P represents the first-order difference of the first coordinate point
  • ⁇ P represents the second-order difference of the first coordinate point
  • the determining a composite vector according to the first vector V1 and the second vector V2 includes:
  • the composite vector is calculated by the following formula:
  • V0 a*V1+(1-a)*V2
  • V0 represents a composite vector
  • a represents the weight of the first vector V1
  • the method also includes:
  • the weight of the first vector V1 is adjusted according to the difference between the measured coordinate value corresponding to each of the reference points and the real coordinate value.
  • the method also includes:
  • the number of objects to be positioned query the correspondence between the preset number of different positioned objects and the weight of the first vector V1, and determine the weight corresponding to the number of objects to be positioned as the value of a.
  • the curve fitting is performed according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point to obtain the motion trajectory equation of the object to be positioned, including:
  • n is greater than 2
  • the motion trajectory equation of the object to be positioned is a straight line or a curve.
  • the determining the tangent direction of the motion trajectory equation as the direction of the second vector V2 includes:
  • the motion trajectory equation is a straight line equation, then determine the tangent direction of the straight line equation as the direction of the second vector V2;
  • the motion trajectory equation is a curve equation
  • the tangent direction of the motion trajectory equation at the first coordinate point adjacent to the current coordinate point is determined as the direction of the second vector V2.
  • the determining the size of the second vector V2 according to the i-order difference of the first coordinate point includes:
  • the first-order difference of the first coordinate point is the size of the second vector V2;
  • the size of the second vector V2 can be expressed as the sum of the i-order difference of the first coordinate point, or, the size of the second vector V2 can also be expressed as Wherein, ⁇ j P represents the j-order difference of the first coordinate point.
  • a wireless positioning device comprising:
  • An acquisition module configured to acquire the measured coordinate value of the current coordinate point of the object to be positioned
  • the first determination module is configured to determine the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point;
  • the second determination module is configured to determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2;
  • a third determining module configured to determine a composite vector according to the first vector V1 and the second vector V2;
  • the fourth determination module is configured to determine the positioning coordinate value of the current coordinate point according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point.
  • the second determination module includes:
  • the curve fitting unit is configured to perform curve fitting according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, so as to obtain the motion trajectory equation of the object to be positioned;
  • a vector direction determining unit configured to determine the tangent direction of the motion trajectory equation as the direction of the second vector V2;
  • the difference determining unit is configured to determine the i-order difference of the first coordinate point according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n;
  • the vector size determining unit is configured to determine the size of the second vector V2 according to the i-order difference of the first coordinate point.
  • the value of n is 3, and the difference determining unit is specifically configured as:
  • the vector size determination unit is specifically configured to:
  • the size of the second vector V2 is determined by the following formula:
  • is the modulus length of the second vector V2
  • ⁇ P represents the first-order difference of the first coordinate point
  • ⁇ P represents the second-order difference of the first coordinate point
  • the third determination module is specifically configured to:
  • the composite vector is calculated by the following formula:
  • V0 a*V1+(1-a)*V2
  • V0 represents a composite vector
  • a represents the weight of the first vector V1
  • the device also includes:
  • the reference point obtaining module is configured to obtain measured coordinate values and real coordinate values corresponding to a plurality of reference points in the wireless positioning area;
  • the adjustment module is configured to adjust the weight of the first vector V1 according to the difference between the measured coordinate value corresponding to each of the reference points and the real coordinate value.
  • the device also includes:
  • a statistical module configured to count the number of objects to be located in the wireless positioning system
  • the weight determination module is configured to, according to the number of objects to be positioned, query the correspondence between the preset number of different positioning objects and the weight of the first vector V1, and determine the weight corresponding to the number of objects to be positioned as a value of .
  • the curve fitting unit is specifically configured to:
  • n is greater than 2
  • the motion trajectory equation of the object to be positioned is a straight line or a curve.
  • An electronic device comprising a memory and one or more processors, the memory configured to store modules of computer-readable instructions; when executed by the processor, the computer-readable instructions cause the one or more processing
  • the device executes the steps of the wireless positioning method provided in any one embodiment of the present disclosure.
  • One or more non-volatile storage media storing computer-readable instructions.
  • the computer-readable instructions are executed by one or more processors, one or more processors execute the wireless device provided by any embodiment of the present disclosure. The steps of the positioning method.
  • Fig. 1 is a schematic diagram of the topology of the UWB positioning system in one or more embodiments
  • Fig. 2 is a schematic flowchart of a wireless positioning method in one or more embodiments
  • Fig. 3 is a schematic flowchart of a wireless positioning method in one or more embodiments
  • Fig. 4 is an example diagram of a coordinate trajectory of an object to be positioned in one or more embodiments
  • Fig. 5 is a structural block diagram of a wireless positioning device in one or more embodiments
  • Figure 6 is a diagram of the internal structure of an electronic device in one or more embodiments.
  • the wireless positioning method provided by the present disclosure can be applied to electronic equipment in a wireless positioning system.
  • the wireless positioning system can be a real-time positioning system such as a UWB positioning system, an RFID positioning system, and an ultrasonic positioning system.
  • the electronic equipment can be a computer, a mobile phone, a server, Wearable devices and other devices with positioning software and processing capabilities.
  • the wireless positioning method can be applied in an application environment as shown in FIG. 1 , which is a schematic topology diagram of a UWB positioning system in an embodiment.
  • UWB plays an important role in short-distance precise positioning by utilizing its characteristics of ultra-wideband and high-speed pulse carrier.
  • UWB technology is usually used to locate mobile tags in real time.
  • UWB positioning technology can be used for indoor precise positioning and navigation in various fields, including the positioning of people and large objects, such as valuables storage, mine personnel positioning, robot motion tracking, car basement parking, etc.
  • the positioning tag is the object that needs to be positioned, and it is a device that uses UWB technology to obtain its own position coordinates;
  • the positioning base station is a positioning device that uses UWB technology to locate the positioning tag;
  • UWB positioning software is installed on the electronic device. It is used to implement the wireless positioning method provided by the present disclosure.
  • the electronic equipment and the positioning base station communicate through the network to obtain the positioning data.
  • the UWB positioning software obtains the position information of the current coordinate point of the positioning tag by processing the positioning data.
  • the UWB positioning software can also realize the playback of the historical track of the positioning tag and store the historical positioning.
  • the position information of the point, through the position information of the current coordinate point and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point, the first vector can be determined, through the first n coordinate points adjacent to the current coordinate point
  • the corresponding historical positioning coordinate values respectively can determine the second vector, and then obtain the synthetic vector according to the first vector and the second vector, and determine the positioning coordinates of the current coordinate point according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point value to achieve precise positioning.
  • a wireless positioning method is provided. This embodiment is mainly illustrated by taking the wireless positioning method applied to the electronic device in FIG. 1 as an example. As shown in Figure 2, the wireless positioning method may include the following steps:
  • Step 102 acquiring the measured coordinate value of the current coordinate point of the object to be positioned.
  • the object to be positioned is an object carrying a positioning tag, and may be a person or an object carrying a positioning tag.
  • the measured coordinate value of the current coordinate point of the object to be positioned can be obtained by positioning through an existing positioning algorithm.
  • time of arrival (TOA) positioning algorithm time difference of arrival (Time Difference Of Arrival, TDOA) positioning algorithm
  • angle of arrival Angle of Arrival, AOA positioning algorithm
  • TOA time of arrival
  • TDOA time difference of arrival
  • AOA angle of arrival
  • Step 104 Determine the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point.
  • the first coordinate point is a historical positioning point adjacent to the current coordinate point in the current movement track of the object to be positioned, that is, the first coordinate point is the positioning point closest to the current coordinate point before the current coordinate point
  • the historical positioning coordinate value corresponding to the first coordinate point may be a measured coordinate value of the first positioning point, or may be an optimized positioning coordinate value.
  • the historical positioning coordinate value corresponding to the first coordinate point is the measured coordinate value calculated according to the positioning algorithm.
  • the historical positioning coordinate value corresponding to the first coordinate point is the positioning coordinate value determined by the wireless positioning method provided by the present disclosure. Optimized coordinate values.
  • the historical positioning coordinate value corresponding to the first coordinate point can be stored in the local storage space of the electronic device, and can be directly queried and obtained when needed.
  • a vector can be determined according to the coordinates of two points. Therefore, in the embodiment of the present disclosure, a vector can be determined according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point, and the vector is recorded as The first vector may be represented by V1.
  • the current coordinate point is P4 (x4, y4, z4)
  • the first coordinate point adjacent to P4 is P3 (x3, y3, z3)
  • Step 106 Determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2.
  • the first n points closest to the current coordinate point on the moving track of the object to be positioned can be obtained.
  • the historical positioning coordinate values corresponding to the coordinate points respectively, the historical positioning coordinate values can be obtained from the local storage space of the electronic device, and the second vector can be determined according to the historical positioning coordinate values corresponding to the first n coordinate points, which is denoted as V2.
  • the obtained distance between the two coordinate points can be used as the size of the second vector, and the direction of the vector determined by the two coordinate points can be used as the direction of the second vector, then The second vector V2 is then determined.
  • n is a positive integer greater than or equal to 3
  • a curve can be fitted according to the determined n coordinate points, and the tangent direction of the curve at a positioning point closest to the current coordinate point is determined as the second vector
  • the direction of the second vector can be determined according to the multi-order difference of a positioning point closest to the current coordinate point. The specific determination process will be described in subsequent embodiments, and will not be described in detail here. After the magnitude and direction of the second vector are determined, the second vector V2 is determined accordingly.
  • the components of the second vector in the x, y, and z directions can be determined, so that the second vector can be expressed as a coordinate form similar to the first vector, and the second vector It can be regarded as a vector composed of the first coordinate point and the estimated point corresponding to the current coordinate point. According to the historical positioning coordinate value corresponding to the first coordinate point and each component of the second vector, the coordinate value of the estimated point can be determined.
  • Step 108 determine a composite vector according to the first vector V1 and the second vector V2.
  • a composite vector may be determined according to the determined first vector V1 and the determined second vector V2.
  • a vector addition operation may be performed on the first vector V1 and the second vector V2 to obtain a composite vector.
  • Step 110 determine the positioning coordinate value of the current coordinate point according to the resultant vector and the historical positioning coordinate value corresponding to the first coordinate point.
  • the resultant vector can be added to the historical positioning coordinate value corresponding to the first coordinate point, and the obtained coordinate value is the positioning coordinate value of the current coordinate point.
  • the positioning coordinate value of the current coordinate point can be stored in the local storage space of the electronic device, and can be used as the historical positioning coordinate value corresponding to the first coordinate point adjacent to the next coordinate point for the next coordinate point Point positioning process.
  • the first vector is a vector determined according to the actual measured coordinate value of the coordinate point
  • the second vector is a vector estimated according to the moving track of the object to be positioned
  • the second vector can correct the first vector Therefore, according to the composite vector of the first vector and the second vector and the historical positioning coordinate value of the adjacent previous coordinate point, compared with the measured coordinate value, it can be corrected and optimized, and it is achieved by integrating the measured path and the fitting path. Solve the problem of poor positioning accuracy caused by signal drift and stuttering, and improve the positioning accuracy.
  • the solution disclosed in the present disclosure can be implemented without relying on the assistance of hardware sensors, is low in cost and easy to implement, and has strong feasibility and practicability.
  • the first vector is determined according to the measured coordinate value of the current coordinate point of the object to be positioned and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point, and then according to the The historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point respectively, determine the second vector, n is a positive integer greater than or equal to 2, and then determine the composite vector according to the first vector and the second vector, and finally according to the composite vector and the historical positioning coordinate value corresponding to the first coordinate point to determine the positioning coordinate value of the current coordinate point. Since the second vector is determined according to the historical positioning coordinate value of the first n coordinate points, the movement of the object to be positioned along the original direction is considered.
  • the final positioning coordinate value of the current coordinate point takes into account both the measurement coordinate and the original motion trend, so that the second vector plays the role of correcting and optimizing the measurement coordinate value, which can improve the accuracy of wireless positioning , making the positioning track of the coordinate point smoother.
  • step 106 may include the following steps:
  • Step 202 performing curve fitting according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point, to obtain the motion trajectory equation of the object to be positioned.
  • n is a positive integer greater than or equal to 2.
  • the first n coordinate points refer to the first n positioning points closest to the current positioning point on the moving track of the object to be positioned, including the first coordinate point adjacent to the current positioning point.
  • the historical positioning coordinate values respectively corresponding to the first n coordinate points may be obtained from the local storage space of the electronic device.
  • curve fitting is performed according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, so as to obtain the motion trajectory equation of the object to be positioned.
  • the fitted motion trajectory equation is a straight line; when n is a positive integer greater than 2, the fitted motion trajectory equation may be a straight line or a curve.
  • trajectory equation of the object to be positioned can be obtained by fitting the historical positioning coordinate values of n coordinate points by using an existing curve fitting tool, which is not described in detail in this disclosure.
  • Step 204 determine the tangent direction of the motion track equation as the direction of the second vector V2.
  • the motion direction of the object to be positioned under inertia may be determined as the direction of the second vector V2 according to the motion trajectory equation obtained through fitting.
  • the fitted motion trajectory equation is a straight line equation
  • the tangent direction is consistent with the straight line direction, which can be represented by the slope of the straight line equation
  • the curve equation can be solved
  • the first derivative determines the direction of the tangent of the motion trajectory equation at the first coordinate point adjacent to the current coordinate point as the direction of the second vector V2.
  • the tangent direction of the curve equation can be obtained by solving the tangent line of the related curve equation, which will not be described in detail in this disclosure.
  • Step 206 Determine the i-order difference of the first coordinate point according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n.
  • the i-order difference of the first coordinate point may be determined according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, where i is at least 1.
  • n 2
  • the first-order difference is the modulus length of the vector formed by the first coordinate point and the second coordinate point.
  • n is greater than 2
  • n can be set to 3, and then according to The historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point respectively, determine the i-order difference of the first coordinate point, including: according to the historical positioning coordinate value of the first coordinate point and the adjacent to the first coordinate point The historical positioning coordinate value of the second coordinate point determines the first-order difference of the first coordinate point; according to the historical positioning coordinate value of the second coordinate point and the historical positioning coordinate value of the third coordinate point adjacent to the second coordinate point, determine The first-order difference of the second coordinate point; calculate the difference between the first-order difference of the first coordinate point and the first-order difference of the second coordinate point, and obtain the second-order difference of the first coordinate point.
  • the first-order difference and the second-order difference of the first coordinate point can be calculated.
  • the first coordinate point is P3 (x3, y3, z3)
  • the second coordinate point is P2 (x2, y2, z2)
  • the third coordinate point is P1 (x1, y1, z1)
  • the first-order difference of the second coordinate point ⁇ P2
  • the second-order difference of the first coordinate point can be based on the first coordinate point
  • the second-order difference is used to represent the change range of the first-order difference, and is used to correct the first-order difference.
  • the value of the second-order difference can be positive or negative. Positive means that the first-order difference is increasing, that is, the distance of the next point will be higher than that of the previous one. The point becomes longer, and the negative indicates that the first-order difference is shortening, that is, the distance of the next point will be shorter than the previous point.
  • the number of coordinate points used to fit the motion trajectory equation of the object to be positioned may be the same as the number of coordinate points used to determine the i-order difference of the first coordinate point, It may also be different, and the present disclosure only uses the same as an example to illustrate the present disclosure, but not as a limitation to the present disclosure.
  • Step 208 Determine the magnitude of the second vector V2 according to the i-order difference of the first coordinate point.
  • the magnitude of the second vector V2 may be determined according to the i-order difference of the first coordinate point.
  • the first-order difference of the first coordinate point is the size of the second vector V2.
  • the size of the second vector V2 can be expressed as the sum of the i-order difference of the first coordinate point, or, the size of the second vector V2 can also be expressed as Wherein, ⁇ j P represents the j-order difference of the first coordinate point.
  • ⁇ j P represents the j-order difference of the first coordinate point.
  • the size of the second vector V2 can be calculated by the following formula (1).
  • is the modulus length of the second vector V2, which means the size of V2
  • ⁇ P represents the first-order difference of the first coordinate point
  • ⁇ P represents the second-order difference of the first coordinate point
  • the magnitude and direction of the second vector are determined, and the second vector V2 is also determined accordingly.
  • the motion trajectory equation of the object to be positioned is obtained, and the tangent direction of the motion trajectory equation is Determine the direction of the second vector, and determine the i-order difference of the first coordinate point according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, i is a positive integer smaller than n, and then according to The i-order difference of the first coordinate point determines the size of the second vector, thus, the second vector can be estimated according to the moving track of the object to be positioned and the historical positioning coordinate value, which provides a basis for optimizing the position of the current coordinate point according to the second vector conditions.
  • the composite vector may be determined by performing weighted summation on the first vector V1 and the second vector V2, specifically, the composite vector may be determined by the following formula (2).
  • V0 a*V1+(1-a)*V2 (2)
  • V0 represents the composite vector
  • a represents the weight of the first vector V1
  • the value of weight a can be predetermined.
  • the value of weight a can be determined according to the degree of interference in the UWB positioning system.
  • V1 can be trusted a little more, and a larger value can be assigned to V1.
  • Weight for example, the value of a can be set to 0.6; for a positioning system with severe interference, signal drift is likely to occur due to interference, and the probability of coordinate points deviating from the original movement track is relatively high, so you can trust V2 a little more and assign a larger value to V2 , the weight a of the first vector is relatively small, for example, the value of a can be set to 0.3.
  • the number of objects to be positioned in the wireless positioning system can be counted, and according to the number of objects to be positioned, the corresponding relationship between the number of different preset objects to be positioned and the weight of the first vector V1 can be queried to determine the corresponding relationship with the weight of the first vector V1.
  • the weight corresponding to the number of objects is used as the value of a.
  • the corresponding relationship between the number of different positioning objects and the weight of the first vector V1 can be preset and stored.
  • the weight of the first vector V1 corresponding to the number of objects to be positioned can be determined by looking up Table 1, and the weight can be used as an initial value of a.
  • the value of a can be continuously corrected according to the positioning result of the positioning object in the actual positioning system, so as to obtain a relatively accurate value.
  • the measured coordinate values and real coordinate values corresponding to multiple reference points in the wireless positioning area can be obtained, and the first vector is adjusted according to the difference between the measured coordinate values and real coordinate values corresponding to each reference point The weight of V1.
  • the reference point may be a plurality of positioning points randomly selected in the wireless positioning area, or may be a historical positioning point of the object to be positioned, or may be a positioning point of other positioning objects.
  • the real coordinate value of the reference point can be determined according to the actual position of the reference point, it can be a calibrated position, or it can be the positioning coordinate value of the positioning point.
  • the difference between the measured coordinate value corresponding to each reference point and the real coordinate value can be compared, and the weight of the first vector V1 can be adjusted according to the determined difference, wherein, when the difference is large, the current weight If the difference is small, adjust it higher than the current weight.
  • each reference point compare the difference between the measured coordinate value and the real coordinate value, and judge whether the difference is within the preset allowable difference range, and count the number of reference points whose difference is not within the allowable difference range , and compared with the preset threshold, when the number of reference points whose difference is not within the allowable difference range exceeds the first threshold, the weight of the first vector V1 is lowered; when the difference is not within the allowable difference range
  • the number of reference points When it is less than the second threshold, then increase the weight of the first vector V1; when the number of reference points whose difference is not within the allowable difference range is greater than or equal to the second threshold and less than or equal to the first threshold, keep the weight of the first vector V1 Change.
  • the adjustment range of the weight of the first vector can be preset, for example, it can be set to 0.1, 0.05, etc., and the weight of the first vector is adjusted according to the preset adjustment range each time.
  • the first vector is adjusted according to the difference between the measured coordinate values and the real coordinate values corresponding to each reference point Therefore, the dynamic adjustment of the weight of the first vector is realized, which is beneficial to improve the positioning accuracy.
  • Fig. 4 is an example diagram of the coordinate track of the object to be positioned in one embodiment.
  • P0, P1, P2 and P3 are the historical coordinate points of the object to be positioned, and the historical positioning coordinate values of each point can be stored in the local of the electronic device
  • P3 is the latest coordinate point, which is also the coordinate point adjacent to P4, that is, the first coordinate point described in the present disclosure.
  • the purpose is to accurately determine the positioning coordinate value of P4.
  • the position of the next point obtained through actual ranging and positioning is at point P4Test, and point P3 and point P4Test form a vector V1.
  • the motion trajectory of the object to be positioned can be obtained by fitting, and the tangent direction of the trajectory at P3 can be determined as the vector direction, and P3 can be calculated according to the positioning coordinate values of points P1, P2 and P3
  • the size of the vector can be determined according to the first-order difference and second-order difference of P3
  • the vector V2 in Figure 4 can be determined according to the direction of the vector and the size of the vector, then the estimated point P4EST of the current coordinate point The location is then determined.
  • the precise position of P4 is obtained. It can be seen from Figure 4 that, compared with the measurement point P4 Test and the estimated point P4 EST, the trajectory formed by the finalized P4 and the historical positioning points P0-P3 is smoother.
  • a wireless positioning device is provided.
  • the wireless positioning device 30 includes an acquisition module 302, a first determination module 304, a second determination module 306, a third determination module 308 and a fourth Determine module 310 . in:
  • the obtaining module 302 is configured to obtain the measured coordinate value of the current coordinate point of the object to be positioned.
  • the first determination module 304 is configured to determine the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point.
  • the second determination module 306 is configured to determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2.
  • the third determining module 308 is configured to determine a composite vector according to the first vector V1 and the second vector V2.
  • the fourth determination module 310 is configured to determine the positioning coordinate value of the current coordinate point according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point.
  • the second determination module 306 includes:
  • the curve fitting unit is configured to perform curve fitting according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point, so as to obtain the motion trajectory equation of the object to be positioned.
  • the vector direction determination unit is configured to determine the tangent direction of the motion trajectory equation as the direction of the second vector V2.
  • the difference determination unit is configured to determine the i-order difference of the first coordinate point according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n.
  • the vector size determining unit is configured to determine the size of the second vector V2 according to the i-order difference of the first coordinate point.
  • the value of n is 3, and the difference determining unit is specifically configured as:
  • a first-order difference of the first coordinate point is determined according to the historical positioning coordinate value of the first coordinate point and the historical positioning coordinate value of a second coordinate point adjacent to the first coordinate point.
  • a first-order difference of the second coordinate point is determined according to the historical positioning coordinate value of the second coordinate point and the historical positioning coordinate value of a third coordinate point adjacent to the second coordinate point.
  • the vector size determination unit is specifically configured to:
  • the size of the second vector V2 is determined by the following formula:
  • is the modulus length of the second vector V2
  • ⁇ P represents the first-order difference of the first coordinate point
  • ⁇ P represents the second-order difference of the first coordinate point
  • the third determining module 308 is specifically configured to:
  • the composite vector is calculated by the following formula:
  • V0 a*V1+(1-a)*V2
  • V0 represents a composite vector
  • a represents the weight of the first vector V1
  • the device also includes:
  • the reference point acquiring module is configured to acquire measured coordinate values and real coordinate values corresponding to multiple reference points in the wireless positioning area.
  • the adjustment module is configured to adjust the weight of the first vector V1 according to the difference between the measured coordinate value corresponding to each of the reference points and the real coordinate value.
  • the device also includes:
  • the statistical module is configured to count the number of objects to be positioned in the wireless positioning system.
  • the weight determination module is configured to, according to the number of objects to be positioned, query the correspondence between the preset number of different positioning objects and the weight of the first vector V1, and determine the weight corresponding to the number of objects to be positioned as a value of .
  • the wireless positioning device provided by the embodiments of the present disclosure first determines the first vector according to the measured coordinate value of the current coordinate point of the object to be positioned and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point, and then according to the The historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point respectively, determine the second vector, n is a positive integer greater than or equal to 2, and then determine the composite vector according to the first vector and the second vector, and finally according to the composite vector and the historical positioning coordinate value corresponding to the first coordinate point to determine the positioning coordinate value of the current coordinate point. Since the second vector is determined according to the historical positioning coordinate value of the first n coordinate points, the movement of the object to be positioned along the original direction is considered.
  • the final positioning coordinate value of the current coordinate point takes into account both the measurement coordinate and the original motion trend, so that the second vector plays the role of correcting and optimizing the measurement coordinate value, which can improve the accuracy of wireless positioning , making the positioning track of the coordinate point smoother.
  • Each module in the above wireless positioning device can be fully or partially realized by software, hardware and a combination thereof.
  • the above-mentioned modules can be embedded in or independent of the processor in the electronic device in the form of hardware, and can also be stored in the memory of the electronic device in the form of software, so that the processor can invoke and execute the corresponding operations of the above-mentioned modules.
  • an electronic device may be a device including wireless positioning software, and its internal structure may be as shown in FIG. 6 .
  • the electronic device includes a processor, memory and network interface connected by a system bus. Wherein, the processor of the electronic device is used to provide calculation and control capabilities.
  • the memory of the electronic device includes a non-volatile storage medium and an internal memory.
  • the non-volatile storage medium stores an operating system, computer programs and databases.
  • the internal memory provides an environment for the operation of the operating system and computer programs in the non-volatile storage medium.
  • the database of the electronic device is used to store the positioning coordinate values of each coordinate point of the positioning object.
  • the network interface of the electronic device is used to communicate with an external terminal through a network connection. When the computer program is executed by the processor, a wireless positioning method is realized.
  • FIG. 6 is only a block diagram of a partial structure related to the disclosed solution, and does not constitute a limitation on the electronic device to which the disclosed solution is applied.
  • the specific electronic device can be More or fewer components than shown in the figures may be included, or some components may be combined, or have a different arrangement of components.
  • the wireless positioning device provided by the present disclosure can be implemented in the form of a computer program, and the computer program can run on the electronic device as shown in FIG. 6 .
  • Various program modules constituting the wireless positioning device can be stored in the memory of the electronic device, for example, the acquisition module, the first determination module, the second determination module, the third determination module and the fourth determination module shown in FIG. 5 .
  • the computer program constituted by each program module enables the processor to execute the steps in the wireless location method of each embodiment of the present disclosure described in this specification.
  • the electronic device shown in FIG. 6 may execute the step of acquiring the measured coordinate value of the current coordinate point of the object to be positioned through the acquiring module in the wireless positioning device as shown in FIG. 5 .
  • the electronic device may perform the step of determining the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point through the first determining module.
  • the electronic device may perform the step of determining the second vector V2 according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point through the second determination module, where n is a positive integer greater than or equal to 2.
  • the electronic device may perform the step of determining the composite vector according to the first vector V1 and the second vector V2 through the third determining module.
  • the electronic device may perform the step of determining the positioning coordinate value of the current coordinate point according to the synthesized vector and the historical positioning coordinate value corresponding to the first coordinate point through the fourth determination module.
  • an electronic device comprising a memory and one or more processors, the memory configured to store computer-readable instructions; the computer-readable instructions, when executed by the processor, cause the one or more processors to perform Steps of the wireless positioning method provided by any embodiment of the present disclosure.
  • the electronic device provided in this embodiment can implement the wireless positioning method provided in the above method embodiment, and its implementation principle and technical effect are similar, and will not be repeated here.
  • One or more non-volatile storage media storing computer-readable instructions.
  • the one or more processors execute the wireless device provided in any one embodiment of the present disclosure. The steps of the positioning method.
  • Non-volatile memory may include read-only memory (Read-Only Memory, ROM), magnetic tape, floppy disk, flash memory or optical memory, etc.
  • Volatile memory can include random access memory (Random Access Memory, RAM) or external cache memory.
  • RAM Random Access Memory
  • SRAM Static Random Access Memory
  • DRAM Dynamic Random Access Memory
  • the wireless positioning method provided by the present disclosure considers the trend of the object to be positioned moving along the original direction, so that the final determined positioning coordinate value of the current coordinate point takes into account both the measurement coordinates and the original motion trend, so that the second vector starts It has the function of correcting and optimizing the measured coordinate values, which can improve the accuracy of wireless positioning, make the positioning track of coordinate points smoother, and has strong industrial practicability.

Abstract

The present invention relates to the technical field of positioning, and provides a wireless positioning method and apparatus, an electronic device, and a storage medium. The method comprises: acquiring measured coordinate values of a current coordinate point of an object to be positioned; determining a first vector V1 according to the measured coordinate values and historical positioning coordinate values corresponding to a first coordinate point adjacent to the current coordinate point; determining a second vector V2 according to historical positioning coordinate values respectively corresponding to first n coordinate points adjacent to the current coordinate point, wherein n is a positive integer greater than or equal to two; determining a composite vector according to the first vector V1 and the second vector V2; and determining positioning coordinate values of the current coordinate point according to the composite vector and the historical positioning coordinate values corresponding to the first coordinate point. By using the present method, the precision of wireless positioning can be improved.

Description

无线定位方法、装置、电子设备和存储介质Wireless positioning method, device, electronic device and storage medium
本公开要求于2021年8月18日提交中国专利局、申请号为202110951039.1、发明名称为“无线定位方法、装置、电子设备和存储介质”的中国专利申请的优先权,其全部内容通过引用结合在本公开中。This disclosure claims the priority of the Chinese patent application with the application number 202110951039.1 and the title of the invention "Wireless Positioning Method, Device, Electronic Equipment, and Storage Medium" filed with the China Patent Office on August 18, 2021, the entire contents of which are incorporated by reference in this disclosure.
技术领域technical field
本公开涉及一种无线定位方法、装置、电子设备及存储介质。The disclosure relates to a wireless positioning method, device, electronic equipment and storage medium.
背景技术Background technique
在物联网时代,物体的准确定位尤为重要。对于室内近距离定位,通常采用超声波、射频识别(Radio Frequency Identification,RFID)、无线保真(Wireless Fidelity,WiFi)、蓝牙、超宽带(Ultra-Wide Band,UWB)等无线定位技术来实现定位服务。In the era of the Internet of Things, the accurate positioning of objects is particularly important. For indoor short-distance positioning, wireless positioning technologies such as ultrasound, radio frequency identification (Radio Frequency Identification, RFID), wireless fidelity (Wireless Fidelity, WiFi), Bluetooth, and ultra-wideband (Ultra-Wide Band, UWB) are usually used to realize positioning services. .
然而,UWB等无线定位系统作为近距离的实时定位系统,通常包含大量的定位标签和基站,彼此之间依靠高频的无线信号来测距与定位,系统内部干扰大,导致定位精度低。并且,无线信号是时变信号,即使在无干扰的情况下也容易出现定位坐标不连续、卡顿等现象,这也会影响定位精度。However, as a short-distance real-time positioning system, UWB and other wireless positioning systems usually include a large number of positioning tags and base stations, which rely on high-frequency wireless signals for distance measurement and positioning. The internal interference of the system is large, resulting in low positioning accuracy. Moreover, the wireless signal is a time-varying signal, and even in the absence of interference, it is prone to discontinuous positioning coordinates, stuttering, etc., which will also affect the positioning accuracy.
发明内容Contents of the invention
(一)要解决的技术问题(1) Technical problems to be solved
如何提高近距离无线定位的精度。How to improve the accuracy of short-range wireless positioning.
(二)技术方案(2) Technical solution
根据本公开公开的各种实施例,提供一种无线定位方法、装置、电子设备和存储介质。According to various embodiments of the present disclosure, a wireless positioning method, device, electronic device, and storage medium are provided.
一种无线定位方法,所述方法包括:A wireless positioning method, the method comprising:
获取待定位对象的当前坐标点的测量坐标值;Obtain the measured coordinate value of the current coordinate point of the object to be positioned;
根据所述测量坐标值以及与所述当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量V1;Determine a first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point;
根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2,其中,n为大于等于2的正整数;Determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2;
根据所述第一向量V1和所述第二向量V2,确定合成向量;determining a composite vector according to the first vector V1 and the second vector V2;
根据所述合成向量及所述第一坐标点对应的历史定位坐标值,确定所述当前坐标点的定位坐标值。The positioning coordinate value of the current coordinate point is determined according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point.
在一个实施例中,所述根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2,包括:In one embodiment, the determining the second vector V2 according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point includes:
根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到所述待定位对象的运动轨迹方程;performing curve fitting according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, to obtain the motion trajectory equation of the object to be positioned;
将所述运动轨迹方程的切线方向确定为所述第二向量V2的方向;Determining the tangent direction of the motion trajectory equation as the direction of the second vector V2;
根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定所述第一坐标点的i阶差分,i为小于n的正整数;Determine the i-order difference of the first coordinate point according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n;
根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小。The size of the second vector V2 is determined according to the i-order difference of the first coordinate point.
在一个实施例中,n取值为3,所述根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定所述第一坐标点的i阶差分,包括:In one embodiment, the value of n is 3, and the i-order difference of the first coordinate point is determined according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, including :
根据所述第一坐标点的历史定位坐标值及与所述第一坐标点相邻的第二坐标点的历史定位坐标值,确定所述第一坐标点的一阶差分;determining the first order difference of the first coordinate point according to the historical positioning coordinate value of the first coordinate point and the historical positioning coordinate value of a second coordinate point adjacent to the first coordinate point;
根据所述第二坐标点的历史定位坐标值及与所述第二坐标点相邻的第三坐标点的历史定位坐标值,确定所述第二坐标点的一阶差分;determining the first-order difference of the second coordinate point according to the historical positioning coordinate value of the second coordinate point and the historical positioning coordinate value of a third coordinate point adjacent to the second coordinate point;
计算所述第一坐标点的一阶差分与所述第二坐标点的一阶差分的差值,得到所述第一坐标点的二阶差分。calculating the difference between the first-order difference of the first coordinate point and the first-order difference of the second coordinate point to obtain the second-order difference of the first coordinate point.
在一个实施例中,所述根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小,包括:In one embodiment, the determining the size of the second vector V2 according to the i-order difference of the first coordinate point includes:
通过如下公式确定所述第二向量V2的大小:The size of the second vector V2 is determined by the following formula:
||V2||=ΔP+ΔP*ΔΔP;||V2||=ΔP+ΔP*ΔΔP;
其中,||V2||为第二向量V2的模长,ΔP表示所述第一坐标点的一阶差分,ΔΔP表示所述第一坐标点的二阶差分。Wherein, ||V2|| is the modulus length of the second vector V2, ΔP represents the first-order difference of the first coordinate point, and ΔΔP represents the second-order difference of the first coordinate point.
在一个实施例中,所述根据所述第一向量V1和所述第二向量V2,确定合成向量,包括:In one embodiment, the determining a composite vector according to the first vector V1 and the second vector V2 includes:
通过如下公式计算得到合成向量:The composite vector is calculated by the following formula:
V0=a*V1+(1-a)*V2V0=a*V1+(1-a)*V2
其中,V0表示合成向量,a表示所述第一向量V1的权重,0<a≤1。Wherein, V0 represents a composite vector, a represents the weight of the first vector V1, and 0<a≤1.
在一个实施例中,所述方法还包括:In one embodiment, the method also includes:
获取无线定位区域中的多个参考点对应的测量坐标值与真实坐标值;Obtain the measured coordinate values and real coordinate values corresponding to multiple reference points in the wireless positioning area;
根据每个所述参考点对应的测量坐标值与真实坐标值之间的差异,调整所述第一向量V1的权重。The weight of the first vector V1 is adjusted according to the difference between the measured coordinate value corresponding to each of the reference points and the real coordinate value.
在一个实施例中,所述方法还包括:In one embodiment, the method also includes:
统计无线定位系统中待定位对象的数量;Counting the number of objects to be located in the Wireless Location System;
根据所述待定位对象的数量,查询预设的不同定位对象数量与第一向量V1的权重之间的对应关系,确定与所述待定位对象的数量对应的权重作为a的取值。According to the number of objects to be positioned, query the correspondence between the preset number of different positioned objects and the weight of the first vector V1, and determine the weight corresponding to the number of objects to be positioned as the value of a.
在一个实施例中,所述根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到所述待定位对象的运动轨迹方程,包括:In one embodiment, the curve fitting is performed according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point to obtain the motion trajectory equation of the object to be positioned, including:
当n为2时,得到所述待定位对象的运动轨迹方程是条直线;When n is 2, the motion trajectory equation of the object to be positioned is obtained as a straight line;
当n大于2时,得到所述待定位对象的运动轨迹方程是条直线,或者曲线。When n is greater than 2, it is obtained that the motion trajectory equation of the object to be positioned is a straight line or a curve.
在一个实施例中,所述将所述运动轨迹方程的切线方向确定为所述第二向量V2的方向,包括:In one embodiment, the determining the tangent direction of the motion trajectory equation as the direction of the second vector V2 includes:
如果所述运动轨迹方程是直线方程,则将所述直线方程的切线方向确定为第二向量V2的方向;If the motion trajectory equation is a straight line equation, then determine the tangent direction of the straight line equation as the direction of the second vector V2;
如果所述运动轨迹方程是曲线方程,则将所述运动轨迹方程在与当前坐标点相邻的第一坐标点处的切线方向,确定为第二向量V2的方向。If the motion trajectory equation is a curve equation, the tangent direction of the motion trajectory equation at the first coordinate point adjacent to the current coordinate point is determined as the direction of the second vector V2.
在一个实施例中,所述根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小,包括:In one embodiment, the determining the size of the second vector V2 according to the i-order difference of the first coordinate point includes:
当n为2时,第一坐标点的一阶差分即为第二向量V2的大小;When n is 2, the first-order difference of the first coordinate point is the size of the second vector V2;
当n大于2时,第二向量V2的大小可以表示为第一坐标点的i阶差分的和,或者,第二向量V2的大小还可以表示为
Figure PCTCN2021139354-appb-000001
其中,Δ jP表示第一坐标点的j阶差分。
When n is greater than 2, the size of the second vector V2 can be expressed as the sum of the i-order difference of the first coordinate point, or, the size of the second vector V2 can also be expressed as
Figure PCTCN2021139354-appb-000001
Wherein, Δ j P represents the j-order difference of the first coordinate point.
一种无线定位装置,所述装置包括:A wireless positioning device, said device comprising:
获取模块,配置成获取待定位对象的当前坐标点的测量坐标值;An acquisition module configured to acquire the measured coordinate value of the current coordinate point of the object to be positioned;
第一确定模块,配置成根据所述测量坐标值以及与所述当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量V1;The first determination module is configured to determine the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point;
第二确定模块,配置成根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2,其中,n为大于等 于2的正整数;The second determination module is configured to determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2;
第三确定模块,配置成根据所述第一向量V1和所述第二向量V2,确定合成向量;A third determining module, configured to determine a composite vector according to the first vector V1 and the second vector V2;
第四确定模块,配置成根据所述合成向量及所述第一坐标点对应的历史定位坐标值,确定所述当前坐标点的定位坐标值。The fourth determination module is configured to determine the positioning coordinate value of the current coordinate point according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point.
在一个实施例中,所述第二确定模块,包括:In one embodiment, the second determination module includes:
曲线拟合单元,配置成根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到所述待定位对象的运动轨迹方程;The curve fitting unit is configured to perform curve fitting according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, so as to obtain the motion trajectory equation of the object to be positioned;
向量方向确定单元,配置成将所述运动轨迹方程的切线方向确定为所述第二向量V2的方向;a vector direction determining unit configured to determine the tangent direction of the motion trajectory equation as the direction of the second vector V2;
差分确定单元,配置成根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定所述第一坐标点的i阶差分,i为小于n的正整数;The difference determining unit is configured to determine the i-order difference of the first coordinate point according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n;
向量大小确定单元,配置成根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小。The vector size determining unit is configured to determine the size of the second vector V2 according to the i-order difference of the first coordinate point.
在一个实施例中,n取值为3,所述差分确定单元,具体配置成:In one embodiment, the value of n is 3, and the difference determining unit is specifically configured as:
根据所述第一坐标点的历史定位坐标值及与所述第一坐标点相邻的第二坐标点的历史定位坐标值,确定所述第一坐标点的一阶差分;determining the first order difference of the first coordinate point according to the historical positioning coordinate value of the first coordinate point and the historical positioning coordinate value of a second coordinate point adjacent to the first coordinate point;
根据所述第二坐标点的历史定位坐标值及与所述第二坐标点相邻的第三坐标点的历史定位坐标值,确定所述第二坐标点的一阶差分;determining the first-order difference of the second coordinate point according to the historical positioning coordinate value of the second coordinate point and the historical positioning coordinate value of a third coordinate point adjacent to the second coordinate point;
计算所述第一坐标点的一阶差分与所述第二坐标点的一阶差分的差值,得到所述第一坐标点的二阶差分。calculating the difference between the first-order difference of the first coordinate point and the first-order difference of the second coordinate point to obtain the second-order difference of the first coordinate point.
在一个实施例中,所述向量大小确定单元,具体配置成:In one embodiment, the vector size determination unit is specifically configured to:
通过如下公式确定所述第二向量V2的大小:The size of the second vector V2 is determined by the following formula:
||V2||=ΔP+ΔP*ΔΔP;||V2||=ΔP+ΔP*ΔΔP;
其中,||V2||为第二向量V2的模长,ΔP表示所述第一坐标点的一阶差分,ΔΔP表示所述第一坐标点的二阶差分。Wherein, ||V2|| is the modulus length of the second vector V2, ΔP represents the first-order difference of the first coordinate point, and ΔΔP represents the second-order difference of the first coordinate point.
在一个实施例中,所述第三确定模块,具体配置成:In one embodiment, the third determination module is specifically configured to:
通过如下公式计算得到合成向量:The composite vector is calculated by the following formula:
V0=a*V1+(1-a)*V2V0=a*V1+(1-a)*V2
其中,V0表示合成向量,a表示所述第一向量V1的权重,0<a≤1。Wherein, V0 represents a composite vector, a represents the weight of the first vector V1, and 0<a≤1.
在一个实施例中,所述装置还包括:In one embodiment, the device also includes:
参考点获取模块,配置成获取无线定位区域中的多个参考点对应 的测量坐标值与真实坐标值;The reference point obtaining module is configured to obtain measured coordinate values and real coordinate values corresponding to a plurality of reference points in the wireless positioning area;
调整模块,配置成根据每个所述参考点对应的测量坐标值与真实坐标值之间的差异,调整所述第一向量V1的权重。The adjustment module is configured to adjust the weight of the first vector V1 according to the difference between the measured coordinate value corresponding to each of the reference points and the real coordinate value.
在一个实施例中,所述装置还包括:In one embodiment, the device also includes:
统计模块,配置成统计无线定位系统中待定位对象的数量;A statistical module configured to count the number of objects to be located in the wireless positioning system;
权重确定模块,配置成根据所述待定位对象的数量,查询预设的不同定位对象数量与第一向量V1的权重之间的对应关系,确定与所述待定位对象的数量对应的权重作为a的取值。The weight determination module is configured to, according to the number of objects to be positioned, query the correspondence between the preset number of different positioning objects and the weight of the first vector V1, and determine the weight corresponding to the number of objects to be positioned as a value of .
在一个实施例中,所述曲线拟合单元,具体配置成:In one embodiment, the curve fitting unit is specifically configured to:
当n为2时,得到所述待定位对象的运动轨迹方程是条直线;When n is 2, the motion trajectory equation of the object to be positioned is obtained as a straight line;
当n大于2时,得到所述待定位对象的运动轨迹方程是条直线,或者曲线。When n is greater than 2, it is obtained that the motion trajectory equation of the object to be positioned is a straight line or a curve.
一种电子设备,包括存储器和一个或多个处理器,所述存储器配置成存储计算机可读指令的模块;所述计算机可读指令被所述处理器执行时,使得所述一个或多个处理器执行本公开任意一个实施例所提供的无线定位方法的步骤。An electronic device comprising a memory and one or more processors, the memory configured to store modules of computer-readable instructions; when executed by the processor, the computer-readable instructions cause the one or more processing The device executes the steps of the wireless positioning method provided in any one embodiment of the present disclosure.
一个或多个存储有计算机可读指令的非易失性存储介质,计算机可读指令被一个或多个处理器执行时,使得一个或多个处理器执行本公开任意一个实施例所提供的无线定位方法的步骤。One or more non-volatile storage media storing computer-readable instructions. When the computer-readable instructions are executed by one or more processors, one or more processors execute the wireless device provided by any embodiment of the present disclosure. The steps of the positioning method.
本公开的其他特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本公开而了解。本公开的目的和其他优点在说明书、权利要求书以及附图中所特别指出的结构来实现和获得,本公开的一个或多个实施例的细节在下面的附图和描述中提出。Additional features and advantages of the disclosure will be set forth in the description which follows, and in part will be apparent from the description, or may be learned by practice of the disclosure. The objectives and other advantages of the disclosure will be realized and attained by the structure particularly pointed out in the written description, claims hereof as well as the accompanying drawings, the details of one or more embodiments of the disclosure being set forth in the accompanying drawings and the description below.
为使本公开的上述目的、特征和优点能更明显易懂,下文特举可选实施例,并配合所附附图,作详细说明如下。In order to make the above objects, features and advantages of the present disclosure more comprehensible, optional embodiments are given below and described in detail in conjunction with the accompanying drawings.
附图说明Description of drawings
此处的附图被并入说明书中并构成本说明书的一部分,示出了符合本公开的实施例,并与说明书一起用于解释本公开的原理。The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the disclosure and together with the description serve to explain the principles of the disclosure.
为了更清楚地说明本公开实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,对于本领域普通技术人员而言,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the technical solutions in the embodiments of the present disclosure or the prior art, the following will briefly introduce the drawings that need to be used in the description of the embodiments or the prior art. Obviously, for those of ordinary skill in the art, In other words, other drawings can also be obtained from these drawings without paying creative labor.
图1为一个或多个实施例中UWB定位系统的拓扑结构示意图;Fig. 1 is a schematic diagram of the topology of the UWB positioning system in one or more embodiments;
图2为一个或多个实施例中无线定位方法的流程示意图;Fig. 2 is a schematic flowchart of a wireless positioning method in one or more embodiments;
图3为一个或多个实施例中无线定位方法的流程示意图;Fig. 3 is a schematic flowchart of a wireless positioning method in one or more embodiments;
图4为一个或多个实施例中待定位对象的坐标轨迹示例图;Fig. 4 is an example diagram of a coordinate trajectory of an object to be positioned in one or more embodiments;
图5为一个或多个实施例中无线定位装置的结构框图;Fig. 5 is a structural block diagram of a wireless positioning device in one or more embodiments;
图6为一个或多个实施例中电子设备的内部结构图。Figure 6 is a diagram of the internal structure of an electronic device in one or more embodiments.
具体实施方式Detailed ways
为了使本公开的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本公开进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本公开,并不用于限定本公开。In order to make the purpose, technical solutions and advantages of the present disclosure clearer, the present disclosure will be further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described here are only used to explain the present disclosure, not to limit the present disclosure.
本公开提供的无线定位方法,可以应用于无线定位系统中的电子设备,无线定位系统可以是UWB定位系统、RFID定位系统、超声波定位系统等实时定位系统,电子设备可以是电脑、手机、服务器、可穿戴设备等安装有定位软件且具有处理能力的设备。以本公开提供的无线定位方法应用于UWB定位系统中为例,该无线定位方法可以应用于如图1所示的应用环境中,图1为一个实施例中UWB定位系统的拓扑结构示意图。UWB作为一种短程通讯工具,利用其超宽带及高速脉冲载波的特点,在短距离精确定位中占有重要地位,通常利用UWB技术来实时定位移动标签。UWB定位技术可用于各个领域的室内精确定位和导航,包括人和大型物品的定位,例如贵重物品仓储、矿井人员定位、机器人运动跟踪、汽车地库停车等。The wireless positioning method provided by the present disclosure can be applied to electronic equipment in a wireless positioning system. The wireless positioning system can be a real-time positioning system such as a UWB positioning system, an RFID positioning system, and an ultrasonic positioning system. The electronic equipment can be a computer, a mobile phone, a server, Wearable devices and other devices with positioning software and processing capabilities. Taking the application of the wireless positioning method provided in the present disclosure in a UWB positioning system as an example, the wireless positioning method can be applied in an application environment as shown in FIG. 1 , which is a schematic topology diagram of a UWB positioning system in an embodiment. As a short-range communication tool, UWB plays an important role in short-distance precise positioning by utilizing its characteristics of ultra-wideband and high-speed pulse carrier. UWB technology is usually used to locate mobile tags in real time. UWB positioning technology can be used for indoor precise positioning and navigation in various fields, including the positioning of people and large objects, such as valuables storage, mine personnel positioning, robot motion tracking, car basement parking, etc.
如图1所示,UWB定位系统的无线定位区域中有多个定位基站、多个定位标签和一个电子设备。其中,定位标签是需要被定位的对象,是利用UWB技术来获得自己位置坐标的设备;定位基站是定位设备,是利用UWB技术对定位标签进行定位的设备;电子设备上安装有UWB定位软件,用于实现本公开所提供的无线定位方法。电子设备与定位基站通过网络进行通信来获取定位数据,UWB定位软件通过对定位数据进行处理获得定位标签当前坐标点的位置信息,还可以通过UWB定位软件实现定位标签历史轨迹的回放,存储历史定位点的位置信息,通过当前坐标点的位置信息和与当前坐标点相邻的第一坐标点对应的历史定位坐标值,可以确定第一向量,通过与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,可以确定第二向量,进而根据第一向量和第二向量得到合成向量,并根据合成向量及第一坐标点对应的历史定位坐标值,确定当前坐标点的定位坐标值,实现精准定位。As shown in Figure 1, there are multiple positioning base stations, multiple positioning tags and an electronic device in the wireless positioning area of the UWB positioning system. Among them, the positioning tag is the object that needs to be positioned, and it is a device that uses UWB technology to obtain its own position coordinates; the positioning base station is a positioning device that uses UWB technology to locate the positioning tag; UWB positioning software is installed on the electronic device. It is used to implement the wireless positioning method provided by the present disclosure. The electronic equipment and the positioning base station communicate through the network to obtain the positioning data. The UWB positioning software obtains the position information of the current coordinate point of the positioning tag by processing the positioning data. The UWB positioning software can also realize the playback of the historical track of the positioning tag and store the historical positioning. The position information of the point, through the position information of the current coordinate point and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point, the first vector can be determined, through the first n coordinate points adjacent to the current coordinate point The corresponding historical positioning coordinate values respectively can determine the second vector, and then obtain the synthetic vector according to the first vector and the second vector, and determine the positioning coordinates of the current coordinate point according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point value to achieve precise positioning.
需要说明的是,在实际应用中,UWB定位系统中可能有大量的定位基站和定位标签,因篇幅限制,图1仅以定位基站为4个、定位标签为2个作为示例,而不能作为对本公开的限制。It should be noted that in practical applications, there may be a large number of positioning base stations and positioning tags in the UWB positioning system. Due to space limitations, Figure 1 only uses 4 positioning base stations and 2 positioning tags as an example, and it cannot be used as a reference for this paper. Public restrictions.
在一个实施例中,如图2所示,提供了一种无线定位方法。本实施例主要以该无线定位方法应用于图1中的电子设备来举例说明。如图2所示,该无线定位方法可以包括以下步骤:In one embodiment, as shown in FIG. 2 , a wireless positioning method is provided. This embodiment is mainly illustrated by taking the wireless positioning method applied to the electronic device in FIG. 1 as an example. As shown in Figure 2, the wireless positioning method may include the following steps:
步骤102,获取待定位对象的当前坐标点的测量坐标值。 Step 102, acquiring the measured coordinate value of the current coordinate point of the object to be positioned.
其中,待定位对象是携带了定位标签的对象,可以是携带了定位标签的人或物体。Wherein, the object to be positioned is an object carrying a positioning tag, and may be a person or an object carrying a positioning tag.
本公开实施例中,待定位对象的当前坐标点的测量坐标值,可以通过现有的定位算法进行定位得到。比如,可以通过到达时间(Time of Arrival,TOA)定位算法、达到时间差(Time Difference Of Arrival,TDOA)定位算法、到达角度(Angle of Arrival,AOA)定位算法或者上述三种定位算法的混合技术,获取当前坐标点的测量坐标值,本公开对此不作限制。In the embodiments of the present disclosure, the measured coordinate value of the current coordinate point of the object to be positioned can be obtained by positioning through an existing positioning algorithm. For example, time of arrival (TOA) positioning algorithm, time difference of arrival (Time Difference Of Arrival, TDOA) positioning algorithm, angle of arrival (Angle of Arrival, AOA) positioning algorithm or a hybrid technology of the above three positioning algorithms can be used. Obtain the measured coordinate value of the current coordinate point, which is not limited in the present disclosure.
步骤104,根据测量坐标值以及与当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量V1。Step 104: Determine the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point.
其中,第一坐标点是待定位对象的本次移动轨迹中,与当前坐标点相邻的一个历史定位点,即第一坐标点是当前坐标点之前,距离当前坐标点最近的一个定位点,第一坐标点对应的历史定位坐标值可以是第一定位点的测量坐标值,也可以是经过优化后的定位坐标值。比如,当第一坐标点为待定位对象本次移动轨迹上的第二个定位点时,第一坐标点对应的历史定位坐标值是根据定位算法计算得到的测量坐标值,当第一坐标点为待定位对象本次移动轨迹上的第三个定位点及其之后的定位点时,第一坐标点对应的历史定位坐标值是通过本公开提供的无线定位方法确定的定位坐标值,是经过优化后的坐标值。第一坐标点对应的历史定位坐标值可以存储在电子设备的本地存储空间中,并在需要时直接查询获取即可。Wherein, the first coordinate point is a historical positioning point adjacent to the current coordinate point in the current movement track of the object to be positioned, that is, the first coordinate point is the positioning point closest to the current coordinate point before the current coordinate point, The historical positioning coordinate value corresponding to the first coordinate point may be a measured coordinate value of the first positioning point, or may be an optimized positioning coordinate value. For example, when the first coordinate point is the second positioning point on the current movement track of the object to be positioned, the historical positioning coordinate value corresponding to the first coordinate point is the measured coordinate value calculated according to the positioning algorithm. When the first coordinate point When it is the third positioning point on the moving track of the object to be positioned and the following positioning points, the historical positioning coordinate value corresponding to the first coordinate point is the positioning coordinate value determined by the wireless positioning method provided by the present disclosure. Optimized coordinate values. The historical positioning coordinate value corresponding to the first coordinate point can be stored in the local storage space of the electronic device, and can be directly queried and obtained when needed.
根据两个点的坐标可以确定一个向量,因此本公开实施例中,根据测量坐标值以及与当前坐标点相邻的第一坐标点对应的历史定位坐标值,可以确定一个向量,该向量记为第一向量,可以用V1表示第一向量。A vector can be determined according to the coordinates of two points. Therefore, in the embodiment of the present disclosure, a vector can be determined according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point, and the vector is recorded as The first vector may be represented by V1.
示例性地,假设当前坐标点为P4(x4,y4,z4),与P4相邻的第一坐标点为P3(x3,y3,z3),则第一向量为V1=P4-P3=(x4-x3,y4-y3,z4-z3)。Exemplarily, assuming that the current coordinate point is P4 (x4, y4, z4), and the first coordinate point adjacent to P4 is P3 (x3, y3, z3), then the first vector is V1=P4-P3=(x4 -x3, y4-y3, z4-z3).
步骤106,根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2,其中,n为大于等于2的正整数。Step 106: Determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2.
通常,确定一条线需要至少两个点,点的数量越多,拟合得到的曲线越准确,本公开实施例中,可以获取待定位对象本次移动轨迹上距离当前坐标点最近的前n个坐标点分别对应的历史定位坐标值,历史定位坐标值可以从电子设备的本地存储空间中获取,根据前n个坐标点分别对应的历史定位坐标值,可以确定第二向量,记为V2。Usually, at least two points are required to determine a line. The more points there are, the more accurate the fitted curve will be. In the embodiment of the present disclosure, the first n points closest to the current coordinate point on the moving track of the object to be positioned can be obtained. The historical positioning coordinate values corresponding to the coordinate points respectively, the historical positioning coordinate values can be obtained from the local storage space of the electronic device, and the second vector can be determined according to the historical positioning coordinate values corresponding to the first n coordinate points, which is denoted as V2.
示例性地,当n为2时,可以将获取的这两个坐标点之间的距离作为第二向量的大小,将这两个坐标点所确定的向量的方向作为第二向量的方向,则第二向量V2随之确定。Exemplarily, when n is 2, the obtained distance between the two coordinate points can be used as the size of the second vector, and the direction of the vector determined by the two coordinate points can be used as the direction of the second vector, then The second vector V2 is then determined.
示例性地,当n为大于等于3的正整数时,可以根据确定的n个坐标点拟合出一条曲线,将曲线在距离当前坐标点最近的一个定位点处的切线方向确定为第二向量的方向,第二向量的大小则可以根据距离当前坐标点最近的一个定位点的多阶差分确定,具体确定过程将在后续实施例中进行说明,此处不作详述。确定了第二向量的大小和方向,则第二向量V2随之确定。Exemplarily, when n is a positive integer greater than or equal to 3, a curve can be fitted according to the determined n coordinate points, and the tangent direction of the curve at a positioning point closest to the current coordinate point is determined as the second vector The direction of the second vector can be determined according to the multi-order difference of a positioning point closest to the current coordinate point. The specific determination process will be described in subsequent embodiments, and will not be described in detail here. After the magnitude and direction of the second vector are determined, the second vector V2 is determined accordingly.
能够理解的是,根据第二向量的方向和大小,可以确定第二向量在x、y和z方向上的分量,从而可以将第二向量表示为与第一向量类似的坐标形式,第二向量可以看作是第一坐标点与当前坐标点对应的估计点所组成的向量,根据第一坐标点对应的历史定位坐标值和第二向量的各分量,可以确定估计点的坐标值。It can be understood that, according to the direction and magnitude of the second vector, the components of the second vector in the x, y, and z directions can be determined, so that the second vector can be expressed as a coordinate form similar to the first vector, and the second vector It can be regarded as a vector composed of the first coordinate point and the estimated point corresponding to the current coordinate point. According to the historical positioning coordinate value corresponding to the first coordinate point and each component of the second vector, the coordinate value of the estimated point can be determined.
步骤108,根据第一向量V1和第二向量V2,确定合成向量。 Step 108, determine a composite vector according to the first vector V1 and the second vector V2.
本公开实施例中,根据确定的第一向量V1和第二向量V2,可以确定合成向量。In the embodiment of the present disclosure, a composite vector may be determined according to the determined first vector V1 and the determined second vector V2.
示例性地,可以对第一向量V1和第二向量V2进行向量加法运算,得到合成向量。Exemplarily, a vector addition operation may be performed on the first vector V1 and the second vector V2 to obtain a composite vector.
步骤110,根据合成向量及第一坐标点对应的历史定位坐标值,确定当前坐标点的定位坐标值。 Step 110, determine the positioning coordinate value of the current coordinate point according to the resultant vector and the historical positioning coordinate value corresponding to the first coordinate point.
由于第一向量V1和第二向量V2可以表示为坐标形式,则可以将合成向量与第一坐标点对应的历史定位坐标值进行相加,得到的坐标值即为当前坐标点的定位坐标值。Since the first vector V1 and the second vector V2 can be expressed in the form of coordinates, the resultant vector can be added to the historical positioning coordinate value corresponding to the first coordinate point, and the obtained coordinate value is the positioning coordinate value of the current coordinate point.
能够理解的是,当前坐标点的定位坐标值可以存储在电子设备的本地存储空间中,并可以作为与下一个坐标点相邻的第一坐标点对应的历史定位坐标值,用于下一个坐标点的定位过程。It can be understood that the positioning coordinate value of the current coordinate point can be stored in the local storage space of the electronic device, and can be used as the historical positioning coordinate value corresponding to the first coordinate point adjacent to the next coordinate point for the next coordinate point Point positioning process.
本公开实施例中,第一向量是根据坐标点实际的测量坐标值确定 的向量,第二向量是根据待定位对象的移动轨迹估计得到的向量,第二向量可以起到对第一向量进行纠正的作用,从而根据第一向量和第二向量的合成向量及相邻前一个坐标点的历史定位坐标值,相较于测量坐标值得以纠正和优化,达到了通过整合实测路径和拟合路径来解决因信号漂移和卡顿导致定位精度差的目的,提高了定位正确性。并且,本公开的方案不需要依赖硬件传感器的辅助即可实现,成本低且易于实现,可行性和实用性较强。In the embodiment of the present disclosure, the first vector is a vector determined according to the actual measured coordinate value of the coordinate point, and the second vector is a vector estimated according to the moving track of the object to be positioned, and the second vector can correct the first vector Therefore, according to the composite vector of the first vector and the second vector and the historical positioning coordinate value of the adjacent previous coordinate point, compared with the measured coordinate value, it can be corrected and optimized, and it is achieved by integrating the measured path and the fitting path. Solve the problem of poor positioning accuracy caused by signal drift and stuttering, and improve the positioning accuracy. Moreover, the solution disclosed in the present disclosure can be implemented without relying on the assistance of hardware sensors, is low in cost and easy to implement, and has strong feasibility and practicability.
本公开实施例所提供的无线定位方法,先根据待定位对象当前坐标点的测量坐标值以及与当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量,再根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量,n为大于等于2的正整数,进而根据第一向量和第二向量确定合成向量,最后根据合成向量及第一坐标点对应的历史定位坐标值,确定当前坐标点的定位坐标值,由于第二向量是根据前n个坐标点的历史定位坐标值确定的,考虑了待定位对象沿原方向运动的趋势,从而最终确定的当前坐标点的定位坐标值既考虑了测量坐标又考虑了原有的运动趋势,使得第二向量起到了对测量坐标值进行纠正和优化的作用,能够提高无线定位的精度,使得坐标点的定位轨迹更平滑。In the wireless positioning method provided by the embodiments of the present disclosure, first, the first vector is determined according to the measured coordinate value of the current coordinate point of the object to be positioned and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point, and then according to the The historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point respectively, determine the second vector, n is a positive integer greater than or equal to 2, and then determine the composite vector according to the first vector and the second vector, and finally according to the composite vector and the historical positioning coordinate value corresponding to the first coordinate point to determine the positioning coordinate value of the current coordinate point. Since the second vector is determined according to the historical positioning coordinate value of the first n coordinate points, the movement of the object to be positioned along the original direction is considered. trend, so that the final positioning coordinate value of the current coordinate point takes into account both the measurement coordinate and the original motion trend, so that the second vector plays the role of correcting and optimizing the measurement coordinate value, which can improve the accuracy of wireless positioning , making the positioning track of the coordinate point smoother.
在一个实施例中,如图3所示,在如图2所示实施例的基础上,步骤106可以包括以下步骤:In one embodiment, as shown in FIG. 3, on the basis of the embodiment shown in FIG. 2, step 106 may include the following steps:
步骤202,根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到待定位对象的运动轨迹方程。 Step 202, performing curve fitting according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point, to obtain the motion trajectory equation of the object to be positioned.
其中,n为大于等于2的正整数。前n个坐标点是指待定位对象本次移动轨迹上,与当前定位点距离最近的前n个定位点,其中包括与当前定位点相邻的第一坐标点。前n个坐标点分别对应的历史定位坐标值可以从电子设备的本地存储空间中获取。Wherein, n is a positive integer greater than or equal to 2. The first n coordinate points refer to the first n positioning points closest to the current positioning point on the moving track of the object to be positioned, including the first coordinate point adjacent to the current positioning point. The historical positioning coordinate values respectively corresponding to the first n coordinate points may be obtained from the local storage space of the electronic device.
本公开实施例中,根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,可以得到待定位对象的运动轨迹方程。其中,当n为2时,拟合得到的运动轨迹方程是条直线,当n为大于2的正整数时,拟合得到的运动轨迹方程可能是条直线,也可能是条曲线。In the embodiment of the present disclosure, curve fitting is performed according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, so as to obtain the motion trajectory equation of the object to be positioned. Wherein, when n is 2, the fitted motion trajectory equation is a straight line; when n is a positive integer greater than 2, the fitted motion trajectory equation may be a straight line or a curve.
需要说明的是,待定位对象的运动轨迹方程可以采用现有的曲线拟合工具对n个坐标点的历史定位坐标值进行拟合得到,本公开对此不作详细描述。It should be noted that the trajectory equation of the object to be positioned can be obtained by fitting the historical positioning coordinate values of n coordinate points by using an existing curve fitting tool, which is not described in detail in this disclosure.
步骤204,将运动轨迹方程的切线方向确定为第二向量V2的方向。 Step 204, determine the tangent direction of the motion track equation as the direction of the second vector V2.
根据惯性原理,物体有沿原方向运动的趋势,而原方向则在曲线的切线方向上或者沿直线方向,尤其对于UWB技术,其本身占空比低,具有很高的距离敏感度,能分辨到很短的距离,即很短距离就能出一个坐标点,所以很适合惯性原理。因此本公开实施例中,可以根据拟合得到的运动轨迹方程,确定待定位对象在惯性下的运动方向作为第二向量V2的方向。According to the principle of inertia, objects tend to move in the original direction, and the original direction is in the tangent direction of the curve or along the straight line direction, especially for UWB technology, which has a low duty cycle and has high distance sensitivity. To a very short distance, that is, a coordinate point can be drawn in a very short distance, so it is very suitable for the principle of inertia. Therefore, in the embodiment of the present disclosure, the motion direction of the object to be positioned under inertia may be determined as the direction of the second vector V2 according to the motion trajectory equation obtained through fitting.
示例性地,如果拟合得到的运动轨迹方程为直线方程,则切线方向与直线方向一致,可以用直线方程的斜率表示;如果拟合得到的运动轨迹方程为曲线方程,则可以求解曲线方程的一阶导数,将运动轨迹方程在与当前坐标点相邻的第一坐标点处的切线方向,确定为第二向量V2的方向。曲线方程的切线方向可以采用相关的曲线方程的切线求解方式求解得到,本公开对此不作详细描述。Exemplarily, if the fitted motion trajectory equation is a straight line equation, then the tangent direction is consistent with the straight line direction, which can be represented by the slope of the straight line equation; if the fitted motion trajectory equation is a curve equation, then the curve equation can be solved The first derivative determines the direction of the tangent of the motion trajectory equation at the first coordinate point adjacent to the current coordinate point as the direction of the second vector V2. The tangent direction of the curve equation can be obtained by solving the tangent line of the related curve equation, which will not be described in detail in this disclosure.
步骤206,根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第一坐标点的i阶差分,i为小于n的正整数。Step 206: Determine the i-order difference of the first coordinate point according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n.
本公开实施例中,根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,可以确定第一坐标点的i阶差分,i至少为1。In the embodiment of the present disclosure, the i-order difference of the first coordinate point may be determined according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, where i is at least 1.
示例性地,当n为2时,获取当前坐标点相邻的前两个坐标点,包括第一坐标点和第二坐标点,其中,第一坐标点与当前坐标点相邻,根据第一坐标点和第二坐标点分别对应的历史定位坐标值,可以确定第一坐标点的一阶差分。其中,一阶差分为第一坐标点与第二坐标点所形成向量的模长。Exemplarily, when n is 2, obtain the first two coordinate points adjacent to the current coordinate point, including the first coordinate point and the second coordinate point, wherein the first coordinate point is adjacent to the current coordinate point, according to the first The historical positioning coordinate values corresponding to the coordinate point and the second coordinate point respectively can determine the first-order difference of the first coordinate point. Wherein, the first-order difference is the modulus length of the vector formed by the first coordinate point and the second coordinate point.
示例性地,当n大于2时,获取当前坐标点相邻的前n个坐标点,包括与当前坐标点相邻的第一坐标点,以及距离第一坐标点最近的前(n-1)个坐标点,根据前n个坐标点分别对应的历史定位坐标值,可以确定第一坐标点的一阶差分、二阶差分、三阶差分至(n-1)阶差分。Exemplarily, when n is greater than 2, obtain the first n coordinate points adjacent to the current coordinate point, including the first coordinate point adjacent to the current coordinate point, and the previous (n-1) closest to the first coordinate point coordinate points, according to the historical positioning coordinate values corresponding to the first n coordinate points, the first-order difference, second-order difference, third-order difference to (n-1)-order difference of the first coordinate point can be determined.
空间中的点通常用三维坐标表示,已知三个点的坐标即可确定一条曲线,从而,在一个实施例中,为了降低计算复杂度,降低计算开销,可以取n为3,则根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第一坐标点的i阶差分,包括:根据第一坐标点的历史定位坐标值及与第一坐标点相邻的第二坐标点的历史定位坐标值,确定第一坐标点的一阶差分;根据第二坐标点的历史定位坐标值及与第二坐标点相邻的第三坐标点的历史定位坐标值,确定第二坐标点的一阶差分;计算第一坐标点的一阶差分与第二坐标点的一阶差分的差值,得到第一坐标点的二阶差分。Points in space are usually represented by three-dimensional coordinates, and a curve can be determined by knowing the coordinates of three points. Therefore, in one embodiment, in order to reduce computational complexity and computational overhead, n can be set to 3, and then according to The historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point respectively, determine the i-order difference of the first coordinate point, including: according to the historical positioning coordinate value of the first coordinate point and the adjacent to the first coordinate point The historical positioning coordinate value of the second coordinate point determines the first-order difference of the first coordinate point; according to the historical positioning coordinate value of the second coordinate point and the historical positioning coordinate value of the third coordinate point adjacent to the second coordinate point, determine The first-order difference of the second coordinate point; calculate the difference between the first-order difference of the first coordinate point and the first-order difference of the second coordinate point, and obtain the second-order difference of the first coordinate point.
本实施例中,当n取值为3时,可以计算第一坐标点的一阶差分 和二阶差分。In this embodiment, when the value of n is 3, the first-order difference and the second-order difference of the first coordinate point can be calculated.
示例性地,假设第一坐标点为P3(x3,y3,z3),第二坐标点为为P2(x2,y2,z2),第三坐标点为P1(x1,y1,z1),则第一坐标点的一阶差分为ΔP3=||(P3-P2)||,即第二坐标点与第一坐标点所形成向量(P3-P2)的模长,第二坐标点的一阶差分为ΔP2=||(P2-P1)||,即第三坐标点与第二坐标点所形成向量(P2-P1)的模长,第一坐标点的二阶差分则可以根据第一坐标点的一阶差分与第二坐标点的一阶差分的差值得到,即第一坐标点的二阶差分(记为ΔΔP)可以表示为ΔΔP=||(P3-P2)||-||(P2-P1)||。其中,二阶差分用来表征一阶差分的变化幅度,用来修正一阶差分,二阶差分的值有正有负,正表示一阶差分在增长,即下一个点的距离会较上一个点变长,负表示一阶差分在缩短,即下一个点的距离会较上一个点变短。Exemplarily, assuming that the first coordinate point is P3 (x3, y3, z3), the second coordinate point is P2 (x2, y2, z2), and the third coordinate point is P1 (x1, y1, z1), then the first The first-order difference of a coordinate point is ΔP3=||(P3-P2)||, that is, the modulus length of the vector (P3-P2) formed by the second coordinate point and the first coordinate point, and the first-order difference of the second coordinate point ΔP2=||(P2-P1)||, that is, the modulus length of the vector (P2-P1) formed by the third coordinate point and the second coordinate point, the second-order difference of the first coordinate point can be based on the first coordinate point The difference between the first-order difference and the first-order difference of the second coordinate point is obtained, that is, the second-order difference of the first coordinate point (denoted as ΔΔP) can be expressed as ΔΔP=||(P3-P2)||-||( P2-P1) ||. Among them, the second-order difference is used to represent the change range of the first-order difference, and is used to correct the first-order difference. The value of the second-order difference can be positive or negative. Positive means that the first-order difference is increasing, that is, the distance of the next point will be higher than that of the previous one. The point becomes longer, and the negative indicates that the first-order difference is shortening, that is, the distance of the next point will be shorter than the previous point.
需要说明的是,本公开实施例中,用于拟合得到待定位对象的运动轨迹方程的坐标点的个数可以与用于确定第一坐标点的i阶差分的坐标点的个数相同,也可以不同,本公开仅以两者相同作为示例来解释说明本公开,而不能作为对本公开的限制。It should be noted that, in the embodiment of the present disclosure, the number of coordinate points used to fit the motion trajectory equation of the object to be positioned may be the same as the number of coordinate points used to determine the i-order difference of the first coordinate point, It may also be different, and the present disclosure only uses the same as an example to illustrate the present disclosure, but not as a limitation to the present disclosure.
步骤208,根据第一坐标点的i阶差分,确定第二向量V2的大小。Step 208: Determine the magnitude of the second vector V2 according to the i-order difference of the first coordinate point.
本公开实施例中,根据第一坐标点的i阶差分,可以确定第二向量V2的大小。In the embodiment of the present disclosure, the magnitude of the second vector V2 may be determined according to the i-order difference of the first coordinate point.
示例性地,当n为2时,第一坐标点的一阶差分即为第二向量V2的大小。当n大于2时,第二向量V2的大小可以表示为第一坐标点的i阶差分的和,或者,第二向量V2的大小还可以表示为
Figure PCTCN2021139354-appb-000002
其中,Δ jP表示第一坐标点的j阶差分。本公开实施例中,根据第一坐标点的i阶差分确定第二向量的大小的方式不止一种,除了本公开提供的计算方式外,本公开未记载的其他能够确定第二向量的大小的方式也应属于本公开公开的内容。
Exemplarily, when n is 2, the first-order difference of the first coordinate point is the size of the second vector V2. When n is greater than 2, the size of the second vector V2 can be expressed as the sum of the i-order difference of the first coordinate point, or, the size of the second vector V2 can also be expressed as
Figure PCTCN2021139354-appb-000002
Wherein, Δ j P represents the j-order difference of the first coordinate point. In the embodiment of the present disclosure, there are more than one ways to determine the size of the second vector according to the i-order difference of the first coordinate point. In addition to the calculation method provided in the present disclosure, there are other methods that can determine the size of the second vector not described in the present disclosure. The method should also belong to the content of this disclosure.
在一个实施例中,当n取值为3时,可以通过如下公式(1)计算得到第二向量V2的大小。In one embodiment, when the value of n is 3, the size of the second vector V2 can be calculated by the following formula (1).
||V2||=ΔP+ΔP*ΔΔP    (1)||V2||=ΔP+ΔP*ΔΔP (1)
其中,||V2||为第二向量V2的模长,即表示V2的大小,ΔP表示第 一坐标点的一阶差分,ΔΔP表示第一坐标点的二阶差分。Wherein, ||V2|| is the modulus length of the second vector V2, which means the size of V2, ΔP represents the first-order difference of the first coordinate point, and ΔΔP represents the second-order difference of the first coordinate point.
本公开实施例中,确定了第二向量的大小和方向,第二向量V2也随之确定。In the embodiment of the present disclosure, the magnitude and direction of the second vector are determined, and the second vector V2 is also determined accordingly.
本实施例的无线定位方法,通过根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到待定位对象的运动轨迹方程,将运动轨迹方程的切线方向确定为第二向量的方向,并根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第一坐标点的i阶差分,i为小于n的正整数,进而根据第一坐标点的i阶差分,确定第二向量的大小,由此,能够根据待定位对象的移动轨迹和历史定位坐标值估计出第二向量,为根据第二向量优化当前坐标点的位置提供了条件。In the wireless positioning method of this embodiment, by performing curve fitting according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, the motion trajectory equation of the object to be positioned is obtained, and the tangent direction of the motion trajectory equation is Determine the direction of the second vector, and determine the i-order difference of the first coordinate point according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, i is a positive integer smaller than n, and then according to The i-order difference of the first coordinate point determines the size of the second vector, thus, the second vector can be estimated according to the moving track of the object to be positioned and the historical positioning coordinate value, which provides a basis for optimizing the position of the current coordinate point according to the second vector conditions.
在一个实施例中,可以合成向量可以通过对第一向量V1和第二向量V2进行加权求和的方式确定,具体地,可以通过如下公式(2)确定合成向量。In an embodiment, the composite vector may be determined by performing weighted summation on the first vector V1 and the second vector V2, specifically, the composite vector may be determined by the following formula (2).
V0=a*V1+(1-a)*V2      (2)V0=a*V1+(1-a)*V2 (2)
其中,V0表示合成向量,a表示第一向量V1的权重,0<a≤1。Wherein, V0 represents the composite vector, a represents the weight of the first vector V1, and 0<a≤1.
本公开实施例中,权重a的取值可以预先确定,比如,可以根据UWB定位系统中的干扰程度确定权重a的值,对于无干扰定位系统,可以信任V1多一点,为V1分配较大的权重,比如可以将a的取值设为0.6;对于干扰严重的定位系统,因干扰容易造成信号漂移,坐标点偏离原移动轨迹的概率较大,因此可以信任V2多一点,为V2分配较大的权重,第一向量的权重a较小,比如可以将a的取值设为0.3。In the embodiment of the present disclosure, the value of weight a can be predetermined. For example, the value of weight a can be determined according to the degree of interference in the UWB positioning system. For a non-interference positioning system, V1 can be trusted a little more, and a larger value can be assigned to V1. Weight, for example, the value of a can be set to 0.6; for a positioning system with severe interference, signal drift is likely to occur due to interference, and the probability of coordinate points deviating from the original movement track is relatively high, so you can trust V2 a little more and assign a larger value to V2 , the weight a of the first vector is relatively small, for example, the value of a can be set to 0.3.
在一个实施例中,可以统计无线定位系统中待定位对象的数量,根据待定位对象的数量,查询预设的不同定位对象数量与第一向量V1的权重之间的对应关系,确定与待定位对象的数量对应的权重作为a的取值。In one embodiment, the number of objects to be positioned in the wireless positioning system can be counted, and according to the number of objects to be positioned, the corresponding relationship between the number of different preset objects to be positioned and the weight of the first vector V1 can be queried to determine the corresponding relationship with the weight of the first vector V1. The weight corresponding to the number of objects is used as the value of a.
其中,不同定位对象数量与第一向量V1的权重之间的对应关系可以预先设定并存储。Wherein, the corresponding relationship between the number of different positioning objects and the weight of the first vector V1 can be preset and stored.
示例性地,不同定位对象数量与第一向量V1的权重之间的对应关系如表1所示。Exemplarily, the corresponding relationship between the number of different positioning objects and the weight of the first vector V1 is shown in Table 1.
表1Table 1
定位系统中定位对象数量Number of positioning objects in the positioning system 第一向量V1的权重The weight of the first vector V1
1~51~5 11
6~106~10 0.90.9
50~6050~60 0.60.6
61~8061~80 0.50.5
150以上150 or more 0.10.1
如表1所示,系统中的定位对象数量越多,干扰越严重,第一向量V1的权重就越小。As shown in Table 1, the more the number of positioning objects in the system and the more serious the interference, the smaller the weight of the first vector V1 is.
本公开实施例中,根据无线定位系统中待定位对象的数量,通过查询表1,可以确定与待定位对象数量对应的第一向量V1的权重,该权重可以作为a的初始值。其中,a的值可以根据实际定位系统中定位对象的定位结果不断地进行修正,以得到相对准确的值。In the embodiment of the present disclosure, according to the number of objects to be positioned in the wireless positioning system, the weight of the first vector V1 corresponding to the number of objects to be positioned can be determined by looking up Table 1, and the weight can be used as an initial value of a. Wherein, the value of a can be continuously corrected according to the positioning result of the positioning object in the actual positioning system, so as to obtain a relatively accurate value.
在一个实施例中,可以获取无线定位区域中的多个参考点对应的测量坐标值与真实坐标值,根据每个参考点对应的测量坐标值与真实坐标值之间的差异,调整第一向量V1的权重。In one embodiment, the measured coordinate values and real coordinate values corresponding to multiple reference points in the wireless positioning area can be obtained, and the first vector is adjusted according to the difference between the measured coordinate values and real coordinate values corresponding to each reference point The weight of V1.
其中,参考点可以是无线定位区域中随机选取的多个定位点,也可以是待定位对象的历史定位点,还可以是其他定位对象的定位点。参考点的真实坐标值可以根据参考点的实际位置确定,可以是标定的位置,也可以是定位点的定位坐标值。Wherein, the reference point may be a plurality of positioning points randomly selected in the wireless positioning area, or may be a historical positioning point of the object to be positioned, or may be a positioning point of other positioning objects. The real coordinate value of the reference point can be determined according to the actual position of the reference point, it can be a calibrated position, or it can be the positioning coordinate value of the positioning point.
本公开实施例中,可以比较每个参考点对应的测量坐标值与真实坐标值之间的差异,根据确定的差异来调整第一向量V1的权重,其中,当差异大时,则在当前权重的基础上调低一些,当差异小时,则在当前权重的基础上调高一些。In the embodiment of the present disclosure, the difference between the measured coordinate value corresponding to each reference point and the real coordinate value can be compared, and the weight of the first vector V1 can be adjusted according to the determined difference, wherein, when the difference is large, the current weight If the difference is small, adjust it higher than the current weight.
示例性地,针对每个参考点,比较测量坐标值与真实坐标值之间的差异,并判断该差异是否在预设的允许差异范围内,统计差异不在允许差异范围内的参考点的个数,并与预设阈值比较,当差异不在允许差异范围内的参考点的个数超过第一阈值时,则调低第一向量V1的权重;当差异不在允许差异范围内的参考点的个数小于第二阈值时,则调高第一向量V1的权重;当差异不在允许差异范围内的参考点的个数大于等于第二阈值且小于等于第一阈值时,保持第一向量V1的权重不变。其中,第一阈值大于第二阈值,第一向量的权重的调整幅度可 以预先设定,比如可以设置为0.1、0.05等,每次按照预设的调整幅度来调整第一向量的权重。Exemplarily, for each reference point, compare the difference between the measured coordinate value and the real coordinate value, and judge whether the difference is within the preset allowable difference range, and count the number of reference points whose difference is not within the allowable difference range , and compared with the preset threshold, when the number of reference points whose difference is not within the allowable difference range exceeds the first threshold, the weight of the first vector V1 is lowered; when the difference is not within the allowable difference range The number of reference points When it is less than the second threshold, then increase the weight of the first vector V1; when the number of reference points whose difference is not within the allowable difference range is greater than or equal to the second threshold and less than or equal to the first threshold, keep the weight of the first vector V1 Change. Wherein, the first threshold is greater than the second threshold, the adjustment range of the weight of the first vector can be preset, for example, it can be set to 0.1, 0.05, etc., and the weight of the first vector is adjusted according to the preset adjustment range each time.
本公开实施例中,通过获取无线定位区域中的多个参考点对应的测量坐标值与真实坐标值,根据每个参考点对应的测量坐标值与真实坐标值之间的差异,调整第一向量的权重,由此,实现了第一向量权重的动态调整,有利于提高定位精度。In the embodiment of the present disclosure, by acquiring the measured coordinate values and real coordinate values corresponding to multiple reference points in the wireless positioning area, the first vector is adjusted according to the difference between the measured coordinate values and the real coordinate values corresponding to each reference point Therefore, the dynamic adjustment of the weight of the first vector is realized, which is beneficial to improve the positioning accuracy.
图4为一个实施例中待定位对象的坐标轨迹示例图,图4中,P0、P1、P2和P3为待定位对象的历史坐标点,各点的历史定位坐标值可以存储在电子设备的本地存储空间中,其中,P3为最新的坐标点,也是与P4相邻的坐标点,即本公开所述的第一坐标点。假设待定位对象的当前坐标点为P4,目的是准确地确定P4的定位坐标值。如图4所示,通过实际测距定位得到的下一个点的位置在点P4 Test,点P3与点P4Test组成向量V1。根据P4之前的坐标点P0~P3可以拟合得到待定位对象的运动轨迹,可以将该轨迹在P3处的切线方向确定为向量方向,根据点P1、P2和P3的定位坐标值可以计算得到P3的一阶差分和二阶差分,根据P3的一阶差分和二阶差分可以确定向量的大小,根据向量的方向和向量的大小可以确定图4中的向量V2,则当前坐标点的估计点P4EST的位置随之确定。根据V1和V2,可以合成向量V0,其中,V0=a*V1+(1-a)*V2,进而根据V0和P3的定位坐标值,可以确定P4的定位坐标值,其中,P4=V0+P3。由此,得到了P4的精确位置。从图4可以看出,相较于测量点P4 Test和估计点P4 EST,最终确定的P4与历史定位点P0~P3所形成的运动轨迹更平滑。Fig. 4 is an example diagram of the coordinate track of the object to be positioned in one embodiment. In Fig. 4, P0, P1, P2 and P3 are the historical coordinate points of the object to be positioned, and the historical positioning coordinate values of each point can be stored in the local of the electronic device In the storage space, P3 is the latest coordinate point, which is also the coordinate point adjacent to P4, that is, the first coordinate point described in the present disclosure. Assuming that the current coordinate point of the object to be positioned is P4, the purpose is to accurately determine the positioning coordinate value of P4. As shown in Figure 4, the position of the next point obtained through actual ranging and positioning is at point P4Test, and point P3 and point P4Test form a vector V1. According to the coordinate points P0~P3 before P4, the motion trajectory of the object to be positioned can be obtained by fitting, and the tangent direction of the trajectory at P3 can be determined as the vector direction, and P3 can be calculated according to the positioning coordinate values of points P1, P2 and P3 According to the first-order difference and second-order difference of P3, the size of the vector can be determined according to the first-order difference and second-order difference of P3, and the vector V2 in Figure 4 can be determined according to the direction of the vector and the size of the vector, then the estimated point P4EST of the current coordinate point The location is then determined. According to V1 and V2, the vector V0 can be synthesized, wherein, V0=a*V1+(1-a)*V2, and then according to the positioning coordinate values of V0 and P3, the positioning coordinate value of P4 can be determined, wherein, P4=V0+P3 . Thus, the precise position of P4 is obtained. It can be seen from Figure 4 that, compared with the measurement point P4 Test and the estimated point P4 EST, the trajectory formed by the finalized P4 and the historical positioning points P0-P3 is smoother.
应该理解的是,虽然图2-3的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图2-3中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。It should be understood that although the various steps in the flow charts in FIGS. 2-3 are displayed sequentially as indicated by the arrows, these steps are not necessarily executed sequentially in the order indicated by the arrows. Unless otherwise specified herein, there is no strict order restriction on the execution of these steps, and these steps can be executed in other orders. Moreover, at least some of the steps in Figures 2-3 may include multiple sub-steps or multiple stages, these sub-steps or stages are not necessarily performed at the same time, but may be performed at different times, these sub-steps or stages The order of execution is not necessarily performed sequentially, but may be performed alternately or alternately with at least a part of other steps or sub-steps or stages of other steps.
在一个实施例中,如图5所示,提供了一种无线定位装置,该无线定位装置30包括获取模块302、第一确定模块304、第二确定模块306、第三确定模块308和第四确定模块310。其中:In one embodiment, as shown in FIG. 5 , a wireless positioning device is provided. The wireless positioning device 30 includes an acquisition module 302, a first determination module 304, a second determination module 306, a third determination module 308 and a fourth Determine module 310 . in:
获取模块302,配置成获取待定位对象的当前坐标点的测量坐标值。The obtaining module 302 is configured to obtain the measured coordinate value of the current coordinate point of the object to be positioned.
第一确定模块304,配置成根据测量坐标值以及与当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量V1。The first determination module 304 is configured to determine the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point.
第二确定模块306,配置成根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2,其中,n为大于等于2的正整数。The second determination module 306 is configured to determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2.
第三确定模块308,配置成根据第一向量V1和第二向量V2,确定合成向量。The third determining module 308 is configured to determine a composite vector according to the first vector V1 and the second vector V2.
第四确定模块310,配置成根据合成向量及第一坐标点对应的历史定位坐标值,确定当前坐标点的定位坐标值。The fourth determination module 310 is configured to determine the positioning coordinate value of the current coordinate point according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point.
在一个实施例中,所述第二确定模块306,包括:In one embodiment, the second determination module 306 includes:
曲线拟合单元,配置成根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到所述待定位对象的运动轨迹方程。The curve fitting unit is configured to perform curve fitting according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point, so as to obtain the motion trajectory equation of the object to be positioned.
向量方向确定单元,配置成将所述运动轨迹方程的切线方向确定为所述第二向量V2的方向。The vector direction determination unit is configured to determine the tangent direction of the motion trajectory equation as the direction of the second vector V2.
差分确定单元,配置成根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定所述第一坐标点的i阶差分,i为小于n的正整数。The difference determination unit is configured to determine the i-order difference of the first coordinate point according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n.
向量大小确定单元,配置成根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小。The vector size determining unit is configured to determine the size of the second vector V2 according to the i-order difference of the first coordinate point.
在一个实施例中,n取值为3,所述差分确定单元,具体配置成:In one embodiment, the value of n is 3, and the difference determining unit is specifically configured as:
根据所述第一坐标点的历史定位坐标值及与所述第一坐标点相邻的第二坐标点的历史定位坐标值,确定所述第一坐标点的一阶差分。A first-order difference of the first coordinate point is determined according to the historical positioning coordinate value of the first coordinate point and the historical positioning coordinate value of a second coordinate point adjacent to the first coordinate point.
根据所述第二坐标点的历史定位坐标值及与所述第二坐标点相邻的第三坐标点的历史定位坐标值,确定所述第二坐标点的一阶差分。A first-order difference of the second coordinate point is determined according to the historical positioning coordinate value of the second coordinate point and the historical positioning coordinate value of a third coordinate point adjacent to the second coordinate point.
计算所述第一坐标点的一阶差分与所述第二坐标点的一阶差分的差值,得到所述第一坐标点的二阶差分。calculating the difference between the first-order difference of the first coordinate point and the first-order difference of the second coordinate point to obtain the second-order difference of the first coordinate point.
在一个实施例中,所述向量大小确定单元,具体配置成:In one embodiment, the vector size determination unit is specifically configured to:
通过如下公式确定所述第二向量V2的大小:The size of the second vector V2 is determined by the following formula:
||V2||=ΔP+ΔP*ΔΔP;||V2||=ΔP+ΔP*ΔΔP;
其中,||V2||为第二向量V2的模长,ΔP表示所述第一坐标点的一阶差分,ΔΔP表示所述第一坐标点的二阶差分。Wherein, ||V2|| is the modulus length of the second vector V2, ΔP represents the first-order difference of the first coordinate point, and ΔΔP represents the second-order difference of the first coordinate point.
在一个实施例中,所述第三确定模块308,具体配置成:In one embodiment, the third determining module 308 is specifically configured to:
通过如下公式计算得到合成向量:The composite vector is calculated by the following formula:
V0=a*V1+(1-a)*V2V0=a*V1+(1-a)*V2
其中,V0表示合成向量,a表示所述第一向量V1的权重,0<a≤1。Wherein, V0 represents a composite vector, a represents the weight of the first vector V1, and 0<a≤1.
在一个实施例中,所述装置还包括:In one embodiment, the device also includes:
参考点获取模块,配置成获取无线定位区域中的多个参考点对应的测量坐标值与真实坐标值。The reference point acquiring module is configured to acquire measured coordinate values and real coordinate values corresponding to multiple reference points in the wireless positioning area.
调整模块,配置成根据每个所述参考点对应的测量坐标值与真实坐标值之间的差异,调整所述第一向量V1的权重。The adjustment module is configured to adjust the weight of the first vector V1 according to the difference between the measured coordinate value corresponding to each of the reference points and the real coordinate value.
在一个实施例中,所述装置还包括:In one embodiment, the device also includes:
统计模块,配置成统计无线定位系统中待定位对象的数量。The statistical module is configured to count the number of objects to be positioned in the wireless positioning system.
权重确定模块,配置成根据所述待定位对象的数量,查询预设的不同定位对象数量与第一向量V1的权重之间的对应关系,确定与所述待定位对象的数量对应的权重作为a的取值。The weight determination module is configured to, according to the number of objects to be positioned, query the correspondence between the preset number of different positioning objects and the weight of the first vector V1, and determine the weight corresponding to the number of objects to be positioned as a value of .
本公开实施例所提供的无线定位装置,先根据待定位对象当前坐标点的测量坐标值以及与当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量,再根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量,n为大于等于2的正整数,进而根据第一向量和第二向量确定合成向量,最后根据合成向量及第一坐标点对应的历史定位坐标值,确定当前坐标点的定位坐标值,由于第二向量是根据前n个坐标点的历史定位坐标值确定的,考虑了待定位对象沿原方向运动的趋势,从而最终确定的当前坐标点的定位坐标值既考虑了测量坐标又考虑了原有的运动趋势,使得第二向量起到了对测量坐标值进行纠正和优化的作用,能够提高无线定位的精度,使得坐标点的定位轨迹更平滑。The wireless positioning device provided by the embodiments of the present disclosure first determines the first vector according to the measured coordinate value of the current coordinate point of the object to be positioned and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point, and then according to the The historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point respectively, determine the second vector, n is a positive integer greater than or equal to 2, and then determine the composite vector according to the first vector and the second vector, and finally according to the composite vector and the historical positioning coordinate value corresponding to the first coordinate point to determine the positioning coordinate value of the current coordinate point. Since the second vector is determined according to the historical positioning coordinate value of the first n coordinate points, the movement of the object to be positioned along the original direction is considered. trend, so that the final positioning coordinate value of the current coordinate point takes into account both the measurement coordinate and the original motion trend, so that the second vector plays the role of correcting and optimizing the measurement coordinate value, which can improve the accuracy of wireless positioning , making the positioning track of the coordinate point smoother.
关于无线定位装置的具体限定可以参见上文中对于无线定位方法的限定,在此不再赘述。上述无线定位装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于电子设备中的处理器中,也可以以软件形式存储于电子设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。For specific limitations on the wireless positioning device, refer to the above-mentioned limitations on the wireless positioning method, which will not be repeated here. Each module in the above wireless positioning device can be fully or partially realized by software, hardware and a combination thereof. The above-mentioned modules can be embedded in or independent of the processor in the electronic device in the form of hardware, and can also be stored in the memory of the electronic device in the form of software, so that the processor can invoke and execute the corresponding operations of the above-mentioned modules.
在一个实施例中,提供了一种电子设备,该电子设备可以是包含无线定位软件的设备,其内部结构图可以如图6所示。该电子设备包括通过系统总线连接的处理器、存储器和网络接口。其中,该电子设备的处理器用于提供计算和控制能力。该电子设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该电子设备的数据库用于存储带定位对 象各个坐标点的定位坐标值。该电子设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种无线定位方法。In one embodiment, an electronic device is provided. The electronic device may be a device including wireless positioning software, and its internal structure may be as shown in FIG. 6 . The electronic device includes a processor, memory and network interface connected by a system bus. Wherein, the processor of the electronic device is used to provide calculation and control capabilities. The memory of the electronic device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system, computer programs and databases. The internal memory provides an environment for the operation of the operating system and computer programs in the non-volatile storage medium. The database of the electronic device is used to store the positioning coordinate values of each coordinate point of the positioning object. The network interface of the electronic device is used to communicate with an external terminal through a network connection. When the computer program is executed by the processor, a wireless positioning method is realized.
本领域技术人员可以理解,图6中示出的结构,仅仅是与本公开方案相关的部分结构的框图,并不构成对本公开方案所应用于其上的电子设备的限定,具体的电子设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。Those skilled in the art can understand that the structure shown in FIG. 6 is only a block diagram of a partial structure related to the disclosed solution, and does not constitute a limitation on the electronic device to which the disclosed solution is applied. The specific electronic device can be More or fewer components than shown in the figures may be included, or some components may be combined, or have a different arrangement of components.
在一个实施例中,本公开提供的无线定位装置可以实现为一种计算机程序的形式,计算机程序可在如图6所示的电子设备上运行。电子设备的存储器中可存储组成该无线定位装置的各个程序模块,比如,图5所示的获取模块、第一确定模块、第二确定模块、第三确定模块和第四确定模块。各个程序模块构成的计算机程序使得处理器执行本说明书中描述的本公开各个实施例的无线定位方法中的步骤。In one embodiment, the wireless positioning device provided by the present disclosure can be implemented in the form of a computer program, and the computer program can run on the electronic device as shown in FIG. 6 . Various program modules constituting the wireless positioning device can be stored in the memory of the electronic device, for example, the acquisition module, the first determination module, the second determination module, the third determination module and the fourth determination module shown in FIG. 5 . The computer program constituted by each program module enables the processor to execute the steps in the wireless location method of each embodiment of the present disclosure described in this specification.
例如,图6所示的电子设备可以通过如图5所示的无线定位装置中的获取模块执行获取待定位对象的当前坐标点的测量坐标值的步骤。电子设备可通过第一确定模块执行根据测量坐标值以及与当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量V1的步骤。电子设备可通过第二确定模块执行根据与当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2的步骤,其中,n为大于等于2的正整数。电子设备可通过第三确定模块执行根据第一向量V1和第二向量V2,确定合成向量的步骤。电子设备可通过第四确定模块执行根据合成向量及第一坐标点对应的历史定位坐标值,确定当前坐标点的定位坐标值的步骤。For example, the electronic device shown in FIG. 6 may execute the step of acquiring the measured coordinate value of the current coordinate point of the object to be positioned through the acquiring module in the wireless positioning device as shown in FIG. 5 . The electronic device may perform the step of determining the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point through the first determining module. The electronic device may perform the step of determining the second vector V2 according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point through the second determination module, where n is a positive integer greater than or equal to 2. The electronic device may perform the step of determining the composite vector according to the first vector V1 and the second vector V2 through the third determining module. The electronic device may perform the step of determining the positioning coordinate value of the current coordinate point according to the synthesized vector and the historical positioning coordinate value corresponding to the first coordinate point through the fourth determination module.
在一个实施例中,提供了一种电子设备,包括存储器和一个或多个处理器,存储器配置成存储计算机可读指令;计算机可读指令被处理器执行时,使得一个或多个处理器执行本公开任意一个实施例提供的无线定位方法的步骤。In one embodiment, an electronic device is provided, comprising a memory and one or more processors, the memory configured to store computer-readable instructions; the computer-readable instructions, when executed by the processor, cause the one or more processors to perform Steps of the wireless positioning method provided by any embodiment of the present disclosure.
本实施例提供的电子设备,可以实现上述方法实施例提供的无线定位方法,其实现原理与技术效果类似,此处不再赘述。The electronic device provided in this embodiment can implement the wireless positioning method provided in the above method embodiment, and its implementation principle and technical effect are similar, and will not be repeated here.
一个或多个存储有计算机可读指令的非易失性存储介质,计算机可读指令被一个或多个处理器执行时,使得一个或多个处理器执行本公开任意一个实施例中提供的无线定位方法的步骤。One or more non-volatile storage media storing computer-readable instructions. When the computer-readable instructions are executed by one or more processors, the one or more processors execute the wireless device provided in any one embodiment of the present disclosure. The steps of the positioning method.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程 序在执行时,可包括如上述各方法的实施例的流程。其中,本公开所提供的各实施例中所使用的对存储器、数据库或其它介质的任何引用,均可包括非易失性和易失性存储器中的至少一种。非易失性存储器可包括只读存储器(Read-Only Memory,ROM)、磁带、软盘、闪存或光存储器等。易失性存储器可包括随机存取存储器(Random Access Memory,RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,比如静态随机存取存储器(Static Random Access Memory,SRAM)和动态随机存取存储器(Dynamic Random Access Memory,DRAM)等。Those of ordinary skill in the art can understand that all or part of the processes in the methods of the above embodiments can be implemented through computer programs to instruct related hardware, and the computer programs can be stored in a non-volatile computer-readable memory In the medium, when the computer program is executed, it may include the processes of the embodiments of the above-mentioned methods. Wherein, any reference to storage, database or other media used in the various embodiments provided by the present disclosure may include at least one of non-volatile and volatile storage. Non-volatile memory may include read-only memory (Read-Only Memory, ROM), magnetic tape, floppy disk, flash memory or optical memory, etc. Volatile memory can include random access memory (Random Access Memory, RAM) or external cache memory. By way of illustration and not limitation, RAM is available in various forms such as Static Random Access Memory (SRAM) and Dynamic Random Access Memory (DRAM), among others.
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above embodiments can be combined arbitrarily. To make the description concise, all possible combinations of the technical features in the above embodiments are not described. However, as long as there is no contradiction in the combination of these technical features, they should be It is considered to be within the range described in this specification.
以上所述实施例仅表达了本公开的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本公开构思的前提下,还可以做出若干变形和改进,这些都属于本公开的保护范围。因此,本公开专利的保护范围应以所附权利要求为准。The above-mentioned embodiments only express several implementation modes of the present disclosure, and the descriptions thereof are relatively specific and detailed, but should not be construed as limiting the scope of the patent for the invention. It should be noted that those skilled in the art can make several modifications and improvements without departing from the concept of the present disclosure, and these all belong to the protection scope of the present disclosure. Therefore, the scope of protection of the disclosed patent should be based on the appended claims.
工业实用性Industrial Applicability
本公开提供的无线定位方法,考虑了待定位对象沿原方向运动的趋势,从而最终确定的当前坐标点的定位坐标值既考虑了测量坐标又考虑了原有的运动趋势,使得第二向量起到了对测量坐标值进行纠正和优化的作用,能够提高无线定位的精度,使得坐标点的定位轨迹更平滑,具有很强的工业实用性。The wireless positioning method provided by the present disclosure considers the trend of the object to be positioned moving along the original direction, so that the final determined positioning coordinate value of the current coordinate point takes into account both the measurement coordinates and the original motion trend, so that the second vector starts It has the function of correcting and optimizing the measured coordinate values, which can improve the accuracy of wireless positioning, make the positioning track of coordinate points smoother, and has strong industrial practicability.

Claims (20)

  1. 一种无线定位方法,其特征在于,包括:A wireless positioning method, characterized in that, comprising:
    获取待定位对象的当前坐标点的测量坐标值;Obtain the measured coordinate value of the current coordinate point of the object to be positioned;
    根据所述测量坐标值以及与所述当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量V1;Determine a first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point;
    根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2,其中,n为大于等于2的正整数;Determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2;
    根据所述第一向量V1和所述第二向量V2,确定合成向量;determining a composite vector according to the first vector V1 and the second vector V2;
    根据所述合成向量及所述第一坐标点对应的历史定位坐标值,确定所述当前坐标点的定位坐标值。The positioning coordinate value of the current coordinate point is determined according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point.
  2. 根据权利要求1所述的无线定位方法,其中,所述根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2,包括:The wireless positioning method according to claim 1, wherein said determining the second vector V2 according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point comprises:
    根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到所述待定位对象的运动轨迹方程;performing curve fitting according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, to obtain the motion trajectory equation of the object to be positioned;
    将所述运动轨迹方程的切线方向确定为所述第二向量V2的方向;Determining the tangent direction of the motion trajectory equation as the direction of the second vector V2;
    根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定所述第一坐标点的i阶差分,i为小于n的正整数;Determine the i-order difference of the first coordinate point according to the historical positioning coordinate values corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n;
    根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小。The size of the second vector V2 is determined according to the i-order difference of the first coordinate point.
  3. 根据权利要求2所述的无线定位方法,其中,n取值为3,所述根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定所述第一坐标点的i阶差分,包括:The wireless positioning method according to claim 2, wherein the value of n is 3, and the first coordinate is determined according to the historical positioning coordinate values respectively corresponding to the previous n coordinate points adjacent to the current coordinate point The i-order difference of the point, including:
    根据所述第一坐标点的历史定位坐标值及与所述第一坐标点相邻的第二坐标点的历史定位坐标值,确定所述第一坐标点的一阶差分;determining the first order difference of the first coordinate point according to the historical positioning coordinate value of the first coordinate point and the historical positioning coordinate value of a second coordinate point adjacent to the first coordinate point;
    根据所述第二坐标点的历史定位坐标值及与所述第二坐标点相邻的第三坐标点的历史定位坐标值,确定所述第二坐标点的一阶差分;determining the first-order difference of the second coordinate point according to the historical positioning coordinate value of the second coordinate point and the historical positioning coordinate value of a third coordinate point adjacent to the second coordinate point;
    计算所述第一坐标点的一阶差分与所述第二坐标点的一阶差分的差值,得到所述第一坐标点的二阶差分。calculating the difference between the first-order difference of the first coordinate point and the first-order difference of the second coordinate point to obtain the second-order difference of the first coordinate point.
  4. 根据权利要求3所述的无线定位方法,其中,所述根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小,包括:The wireless positioning method according to claim 3, wherein said determining the size of the second vector V2 according to the i-order difference of the first coordinate point includes:
    通过如下公式确定所述第二向量V2的大小:The size of the second vector V2 is determined by the following formula:
    ||V2||=ΔP+ΔP*ΔΔP;||V2||=ΔP+ΔP*ΔΔP;
    其中,||V2||为第二向量V2的模长,ΔP表示所述第一坐标点的一阶差分,ΔΔP表示所述第一坐标点的二阶差分。Wherein, ||V2|| is the modulus length of the second vector V2, ΔP represents the first-order difference of the first coordinate point, and ΔΔP represents the second-order difference of the first coordinate point.
  5. 根据权利要求1-4任一项所述的无线定位方法,其中,所述根据所述第一向量V1和所述第二向量V2,确定合成向量,包括:The wireless positioning method according to any one of claims 1-4, wherein said determining a composite vector according to said first vector V1 and said second vector V2 includes:
    通过如下公式计算得到合成向量:The composite vector is calculated by the following formula:
    V0=a*V1+(1-a)*V2V0=a*V1+(1-a)*V2
    其中,V0表示合成向量,a表示所述第一向量V1的权重,0<a≤1。Wherein, V0 represents a composite vector, a represents the weight of the first vector V1, and 0<a≤1.
  6. 根据权利要求5所述的无线定位方法,其中,所述方法还包括:The wireless positioning method according to claim 5, wherein the method further comprises:
    获取无线定位区域中的多个参考点对应的测量坐标值与真实坐标值;Obtain the measured coordinate values and real coordinate values corresponding to multiple reference points in the wireless positioning area;
    根据每个所述参考点对应的测量坐标值与真实坐标值之间的差异,调整所述第一向量V1的权重。The weight of the first vector V1 is adjusted according to the difference between the measured coordinate value corresponding to each of the reference points and the real coordinate value.
  7. 根据权利要求5所述的无线定位方法,其中,所述方法还包括:The wireless positioning method according to claim 5, wherein the method further comprises:
    统计无线定位系统中待定位对象的数量;Counting the number of objects to be located in the Wireless Location System;
    根据所述待定位对象的数量,查询预设的不同定位对象数量与第一向量V1的权重之间的对应关系,确定与所述待定位对象的数量对应的权重作为a的取值。According to the number of objects to be positioned, query the correspondence between the preset number of different positioned objects and the weight of the first vector V1, and determine the weight corresponding to the number of objects to be positioned as the value of a.
  8. 根据权利要求2所述的无线定位方法,其中,所述根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到所述待定位对象的运动轨迹方程,包括:The wireless positioning method according to claim 2, wherein the curve fitting is performed according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point to obtain the motion of the object to be positioned Trajectory equations, including:
    当n为2时,得到所述待定位对象的运动轨迹方程是条直线;When n is 2, the motion trajectory equation of the object to be positioned is obtained as a straight line;
    当n大于2时,得到所述待定位对象的运动轨迹方程是条直线,或者曲线。When n is greater than 2, it is obtained that the motion trajectory equation of the object to be positioned is a straight line or a curve.
  9. 根据权利要求2或8任意一项所述的方法,其中,所述将所述运动轨迹方程的切线方向确定为所述第二向量V2的方向,包括:The method according to any one of claims 2 or 8, wherein the determining the tangent direction of the motion trajectory equation as the direction of the second vector V2 includes:
    如果所述运动轨迹方程是直线方程,则将所述直线方程的切线方向确定为第二向量V2的方向;If the trajectory equation is a straight line equation, then determine the tangent direction of the straight line equation as the direction of the second vector V2;
    如果所述运动轨迹方程是曲线方程,则将所述运动轨迹方程在与当前坐标点相邻的第一坐标点处的切线方向,确定为第二向量V2的方向。If the motion trajectory equation is a curve equation, the tangent direction of the motion trajectory equation at the first coordinate point adjacent to the current coordinate point is determined as the direction of the second vector V2.
  10. 根据权利要求2所述的无线定位方法,其中,所述根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小,包括:The wireless positioning method according to claim 2, wherein said determining the size of the second vector V2 according to the i-order difference of the first coordinate point includes:
    当n为2时,第一坐标点的一阶差分即为第二向量V2的大小;When n is 2, the first-order difference of the first coordinate point is the size of the second vector V2;
    当n大于2时,第二向量V2的大小可以表示为第一坐标点的i阶 差分的和,或者,第二向量V2的大小还可以表示为
    Figure PCTCN2021139354-appb-100001
    其中,Δ jP表示第一坐标点的j阶差分。
    When n is greater than 2, the size of the second vector V2 can be expressed as the sum of the i-order difference of the first coordinate point, or, the size of the second vector V2 can also be expressed as
    Figure PCTCN2021139354-appb-100001
    Wherein, Δ j P represents the j-order difference of the first coordinate point.
  11. 一种无线定位装置,包括:A wireless positioning device, comprising:
    获取模块,配置成获取待定位对象的当前坐标点的测量坐标值;An acquisition module configured to acquire the measured coordinate value of the current coordinate point of the object to be positioned;
    第一确定模块,配置成根据所述测量坐标值以及与所述当前坐标点相邻的第一坐标点对应的历史定位坐标值,确定第一向量V1;The first determination module is configured to determine the first vector V1 according to the measured coordinate value and the historical positioning coordinate value corresponding to the first coordinate point adjacent to the current coordinate point;
    第二确定模块,配置成根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定第二向量V2,其中,n为大于等于2的正整数;The second determination module is configured to determine the second vector V2 according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where n is a positive integer greater than or equal to 2;
    第三确定模块,配置成根据所述第一向量V1和所述第二向量V2,确定合成向量;A third determining module, configured to determine a composite vector according to the first vector V1 and the second vector V2;
    第四确定模块,配置成根据所述合成向量及所述第一坐标点对应的历史定位坐标值,确定所述当前坐标点的定位坐标值。The fourth determination module is configured to determine the positioning coordinate value of the current coordinate point according to the synthetic vector and the historical positioning coordinate value corresponding to the first coordinate point.
  12. 根据权利要求11所述的装置,其中,所述第二确定模块,包括:The device according to claim 11, wherein the second determining module comprises:
    曲线拟合单元,配置成根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值进行曲线拟合,得到所述待定位对象的运动轨迹方程;The curve fitting unit is configured to perform curve fitting according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, so as to obtain the motion trajectory equation of the object to be positioned;
    向量方向确定单元,配置成将所述运动轨迹方程的切线方向确定为所述第二向量V2的方向;a vector direction determining unit configured to determine the tangent direction of the motion trajectory equation as the direction of the second vector V2;
    差分确定单元,配置成根据与所述当前坐标点相邻的前n个坐标点分别对应的历史定位坐标值,确定所述第一坐标点的i阶差分,i为小于n的正整数;The difference determining unit is configured to determine the i-order difference of the first coordinate point according to the historical positioning coordinate values respectively corresponding to the first n coordinate points adjacent to the current coordinate point, where i is a positive integer smaller than n;
    向量大小确定单元,配置成根据所述第一坐标点的i阶差分,确定所述第二向量V2的大小。The vector size determining unit is configured to determine the size of the second vector V2 according to the i-order difference of the first coordinate point.
  13. 根据权利要求12所述的装置,其中,n取值为3,所述差分确定单元,具体配置成:The device according to claim 12, wherein the value of n is 3, and the difference determination unit is specifically configured as:
    根据所述第一坐标点的历史定位坐标值及与所述第一坐标点相邻的第二坐标点的历史定位坐标值,确定所述第一坐标点的一阶差分;determining the first order difference of the first coordinate point according to the historical positioning coordinate value of the first coordinate point and the historical positioning coordinate value of a second coordinate point adjacent to the first coordinate point;
    根据所述第二坐标点的历史定位坐标值及与所述第二坐标点相邻的第三坐标点的历史定位坐标值,确定所述第二坐标点的一阶差分;determining the first-order difference of the second coordinate point according to the historical positioning coordinate value of the second coordinate point and the historical positioning coordinate value of a third coordinate point adjacent to the second coordinate point;
    计算所述第一坐标点的一阶差分与所述第二坐标点的一阶差分的差值,得到所述第一坐标点的二阶差分。calculating the difference between the first-order difference of the first coordinate point and the first-order difference of the second coordinate point to obtain the second-order difference of the first coordinate point.
  14. 根据权利要求12所述的装置,其中,所述向量大小确定单元,具体配置成:The device according to claim 12, wherein the vector size determination unit is specifically configured to:
    通过如下公式确定所述第二向量V2的大小:The size of the second vector V2 is determined by the following formula:
    ||V2||=ΔP+ΔP*ΔΔP;||V2||=ΔP+ΔP*ΔΔP;
    其中,||V2||为第二向量V2的模长,ΔP表示所述第一坐标点的一阶差分,ΔΔP表示所述第一坐标点的二阶差分。Wherein, ||V2|| is the modulus length of the second vector V2, ΔP represents the first-order difference of the first coordinate point, and ΔΔP represents the second-order difference of the first coordinate point.
  15. 根据权利要求11所述的装置,其中,所述第三确定模块,具体配置成:The device according to claim 11, wherein the third determination module is specifically configured to:
    通过如下公式计算得到合成向量:The composite vector is calculated by the following formula:
    V0=a*V1+(1-a)*V2V0=a*V1+(1-a)*V2
    其中,V0表示合成向量,a表示所述第一向量V1的权重,0<a≤1。Wherein, V0 represents a composite vector, a represents the weight of the first vector V1, and 0<a≤1.
  16. 根据权利要求11所述的装置,其中,所述装置还包括:The device according to claim 11, wherein the device further comprises:
    参考点获取模块,用于获取无线定位区域中的多个参考点对应的测量坐标值与真实坐标值;A reference point obtaining module, configured to obtain measured coordinate values and real coordinate values corresponding to multiple reference points in the wireless positioning area;
    调整模块,用于根据每个所述参考点对应的测量坐标值与真实坐标值之间的差异,调整所述第一向量V1的权重。An adjustment module, configured to adjust the weight of the first vector V1 according to the difference between the measured coordinate value corresponding to each of the reference points and the real coordinate value.
  17. 根据权利要求11所述的装置,其中,所述装置还包括:The device according to claim 11, wherein the device further comprises:
    统计模块,用于统计无线定位系统中待定位对象的数量;A statistical module, used for counting the number of objects to be positioned in the wireless positioning system;
    权重确定模块,用于根据所述待定位对象的数量,查询预设的不同定位对象数量与第一向量V1的权重之间的对应关系,确定与所述待定位对象的数量对应的权重作为a的取值。The weight determination module is used to query the correspondence between the preset number of different positioning objects and the weight of the first vector V1 according to the number of objects to be positioned, and determine the weight corresponding to the number of objects to be positioned as a value of .
  18. 根据权利要求12所述的装置,其中,所述曲线拟合单元,具体配置成:The device according to claim 12, wherein the curve fitting unit is specifically configured to:
    当n为2时,得到所述待定位对象的运动轨迹方程是条直线;When n is 2, the motion trajectory equation of the object to be positioned is obtained as a straight line;
    当n大于2时,得到所述待定位对象的运动轨迹方程是条直线,或者曲线。When n is greater than 2, it is obtained that the motion trajectory equation of the object to be positioned is a straight line or a curve.
  19. 一种电子设备,包括:存储器和一个或多个处理器,所述存储器存储有计算机可读指令,其特征在于,所述计算机可读指令被所述一个或多个处理器执行时,使得所述一个或多个处理器执行权利要求1至10中任一项所述的无线定位方法的步骤。An electronic device, comprising: a memory and one or more processors, the memory stores computer-readable instructions, wherein when the computer-readable instructions are executed by the one or more processors, the The one or more processors execute the steps of the wireless positioning method according to any one of claims 1 to 10.
  20. 一个或多个存储有计算机可读指令的非易失性计算机可读存储介质,所述计算机可读指令被一个或多个处理器执行时,使得所述一个或多个处理器执行权利要求1至10中任一项所述的无线定位方法的步骤。One or more non-transitory computer-readable storage media storing computer-readable instructions that, when executed by one or more processors, cause the one or more processors to perform claim 1 Steps of the wireless positioning method described in any one of to 10.
PCT/CN2021/139354 2021-08-18 2021-12-17 Wireless positioning method and apparatus, electronic device, and storage medium WO2023019840A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202110951039.1 2021-08-18
CN202110951039.1A CN113820658A (en) 2021-08-18 2021-08-18 Wireless positioning method, device, electronic equipment and storage medium

Publications (1)

Publication Number Publication Date
WO2023019840A1 true WO2023019840A1 (en) 2023-02-23

Family

ID=78913220

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/139354 WO2023019840A1 (en) 2021-08-18 2021-12-17 Wireless positioning method and apparatus, electronic device, and storage medium

Country Status (2)

Country Link
CN (1) CN113820658A (en)
WO (1) WO2023019840A1 (en)

Citations (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007333652A (en) * 2006-06-16 2007-12-27 Toyota Motor Corp Positioning system and navigation system
CN103902086A (en) * 2012-12-28 2014-07-02 北京汇冠新技术股份有限公司 Curve fitting based touch trajectory smoothing method and system
CN103929809A (en) * 2014-05-07 2014-07-16 徐金苟 Indoor wireless positioning method
CN104007416A (en) * 2014-05-30 2014-08-27 成都旗客科技有限公司 Indoor location error correcting method
US20140365117A1 (en) * 2011-12-09 2014-12-11 Tokyo Keiki Inc. Position output device using satellite navigation system
CN104567860A (en) * 2014-12-29 2015-04-29 深圳市科松电子有限公司 Robot autonomous-navigation method, device and system
CN107976193A (en) * 2017-11-21 2018-05-01 出门问问信息科技有限公司 A kind of pedestrian's flight path estimating method, device, flight path infer equipment and storage medium
CN109313253A (en) * 2017-05-26 2019-02-05 苏州宝时得电动工具有限公司 Mobile object and its localization method, automatic working system, storage medium
CN110068794A (en) * 2019-04-24 2019-07-30 华宇智联科技(武汉)有限公司 A kind of AOA positioning and optimizing compensation method
CN110334167A (en) * 2019-06-26 2019-10-15 浪潮软件集团有限公司 Positional shift method for early warning and device based on neural network track
CN110631589A (en) * 2019-09-29 2019-12-31 广东星舆科技有限公司 Method for correcting positioning track in real time
CN110913338A (en) * 2019-12-17 2020-03-24 深圳奇迹智慧网络有限公司 Positioning track correction method and device, computer equipment and storage medium
CN111016908A (en) * 2019-12-19 2020-04-17 东软集团股份有限公司 Vehicle driving position determining method and device, storage medium and electronic equipment
CN111366161A (en) * 2020-05-29 2020-07-03 北京晶众智慧交通科技股份有限公司 Vehicle positioning method and electronic equipment
KR102181369B1 (en) * 2019-11-21 2020-11-20 연세대학교 산학협력단 Apparatus and method for estimating direction of movement for pedestrian dead reckoning
CN112415558A (en) * 2021-01-25 2021-02-26 腾讯科技(深圳)有限公司 Processing method of travel track and related equipment
CN112714398A (en) * 2021-01-26 2021-04-27 上海明略人工智能(集团)有限公司 Method, device and equipment for correcting positioning coordinate drift of indoor positioning system
CN113176784A (en) * 2021-06-09 2021-07-27 北京轻舟智航科技有限公司 Space-time joint trajectory optimization method for automatic driving

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3607516B2 (en) * 1999-01-20 2005-01-05 松下電器産業株式会社 Mobile map matching device
KR101837107B1 (en) * 2011-09-01 2018-03-09 에스케이 텔레콤주식회사 Terminal And Computer-Readable Recording Medium with Program for Providing Indoor Location Based Services by Using Augmented Reality
CN108398701B (en) * 2017-10-20 2020-07-03 蔚来汽车有限公司 Vehicle positioning method and device
CN109308721B (en) * 2018-10-31 2020-10-30 东软集团股份有限公司 Image key point positioning method and device, storage medium and electronic equipment
CN110493710B (en) * 2019-07-22 2021-01-26 香港中文大学(深圳) Trajectory reconstruction method and apparatus, computer device and storage medium

Patent Citations (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007333652A (en) * 2006-06-16 2007-12-27 Toyota Motor Corp Positioning system and navigation system
US20140365117A1 (en) * 2011-12-09 2014-12-11 Tokyo Keiki Inc. Position output device using satellite navigation system
CN103902086A (en) * 2012-12-28 2014-07-02 北京汇冠新技术股份有限公司 Curve fitting based touch trajectory smoothing method and system
CN103929809A (en) * 2014-05-07 2014-07-16 徐金苟 Indoor wireless positioning method
CN104007416A (en) * 2014-05-30 2014-08-27 成都旗客科技有限公司 Indoor location error correcting method
CN104567860A (en) * 2014-12-29 2015-04-29 深圳市科松电子有限公司 Robot autonomous-navigation method, device and system
CN109313253A (en) * 2017-05-26 2019-02-05 苏州宝时得电动工具有限公司 Mobile object and its localization method, automatic working system, storage medium
CN107976193A (en) * 2017-11-21 2018-05-01 出门问问信息科技有限公司 A kind of pedestrian's flight path estimating method, device, flight path infer equipment and storage medium
CN110068794A (en) * 2019-04-24 2019-07-30 华宇智联科技(武汉)有限公司 A kind of AOA positioning and optimizing compensation method
CN110334167A (en) * 2019-06-26 2019-10-15 浪潮软件集团有限公司 Positional shift method for early warning and device based on neural network track
CN110631589A (en) * 2019-09-29 2019-12-31 广东星舆科技有限公司 Method for correcting positioning track in real time
KR102181369B1 (en) * 2019-11-21 2020-11-20 연세대학교 산학협력단 Apparatus and method for estimating direction of movement for pedestrian dead reckoning
CN110913338A (en) * 2019-12-17 2020-03-24 深圳奇迹智慧网络有限公司 Positioning track correction method and device, computer equipment and storage medium
CN111016908A (en) * 2019-12-19 2020-04-17 东软集团股份有限公司 Vehicle driving position determining method and device, storage medium and electronic equipment
CN111366161A (en) * 2020-05-29 2020-07-03 北京晶众智慧交通科技股份有限公司 Vehicle positioning method and electronic equipment
CN112415558A (en) * 2021-01-25 2021-02-26 腾讯科技(深圳)有限公司 Processing method of travel track and related equipment
CN112714398A (en) * 2021-01-26 2021-04-27 上海明略人工智能(集团)有限公司 Method, device and equipment for correcting positioning coordinate drift of indoor positioning system
CN113176784A (en) * 2021-06-09 2021-07-27 北京轻舟智航科技有限公司 Space-time joint trajectory optimization method for automatic driving

Also Published As

Publication number Publication date
CN113820658A (en) 2021-12-21

Similar Documents

Publication Publication Date Title
CN109696653B (en) Base station coordinate calibration method and device
US10397895B2 (en) Range finding base station selection method and apparatus
US20140249771A1 (en) Location estimation using a mobile device
Park et al. Smartphone-based pedestrian tracking in indoor corridor environments
EP2939482B1 (en) Trilateration processing of abnormal location data
US9541629B2 (en) Apparatus and method for integrated positioning
CN107484123B (en) WiFi indoor positioning method based on integrated HWKNN
TW201235687A (en) Positioning apparatus, positioning method and computer program product thereof
CN112272782A (en) Temporary location of mobile devices using nearby ultrasound signals
CN103596265A (en) Multiple-user indoor positioning method based on voice distance measuring and movement vector
WO2023019840A1 (en) Wireless positioning method and apparatus, electronic device, and storage medium
US20160065629A1 (en) System and Method for Proximity-based Social Networking
US20120263050A1 (en) Wireless network access device with positioning function and method thereof
SE542003C2 (en) Method and device for determining vehicle site location
CN116161040B (en) Parking space information generation method, device, electronic equipment and computer readable medium
CN102749614A (en) Sound-array network self-positioning method based on assistance of static sound source
CN109041213A (en) Adaptive location modification method and device in a kind of room AP
WO2014139377A1 (en) Method and device for monitoring road flow
WO2020107141A1 (en) Positioning method and device
CN110169088B (en) System and method for improving stability of displayed user location using recent location history
KR101294284B1 (en) Method and apparatus for measuring position using radio communication
CN104101860A (en) Positioner capable of detecting wireless sensor network node flip fuzzyness based on quadrature projection
CN112533285B (en) Positioning correction method, device, computer equipment and storage medium
CN113917394B (en) Positioning method, device, equipment and storage medium based on infrared sensor
WO2023093313A1 (en) Device positioning method and apparatus, electronic device, storage medium, and program product

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21954075

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE