CN104020441A - Two-dimensional vehicle positioning method in tunnel environment and based on radio frequency identification - Google Patents

Two-dimensional vehicle positioning method in tunnel environment and based on radio frequency identification Download PDF

Info

Publication number
CN104020441A
CN104020441A CN201410270067.7A CN201410270067A CN104020441A CN 104020441 A CN104020441 A CN 104020441A CN 201410270067 A CN201410270067 A CN 201410270067A CN 104020441 A CN104020441 A CN 104020441A
Authority
CN
China
Prior art keywords
frequency identification
radio
vehicle
writer
coordinate
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201410270067.7A
Other languages
Chinese (zh)
Inventor
宋翔
高怀堃
徐启敏
李旭
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
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 Southeast University filed Critical Southeast University
Priority to CN201410270067.7A priority Critical patent/CN104020441A/en
Publication of CN104020441A publication Critical patent/CN104020441A/en
Pending legal-status Critical Current

Links

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

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Traffic Control Systems (AREA)

Abstract

The invention discloses a two-dimensional vehicle positioning method in a tunnel environment and based on radio frequency identification. A radio frequency identification (RFID) technology is adopted in the urban tunnel environment and combined with an RFID positioning algorithm and a constrained optimization algorithm to position a vehicle, so that accuracy of vehicle positioning is improved, and two-dimensional position information of the vehicle in the tunnel environment can be accurately estimated in real time. The two-dimensional vehicle positioning method has the remarkable advantages of being high in positioning speed and accuracy, good in real-time performance and the like.

Description

Vehicle two-dimensional location method under a kind of tunnel environment based on less radio-frequency
Technical field
The invention belongs to automobile navigation positioning field, relate to a kind of vehicle fast two-dimensional localization method towards tunnel environment.
Background technology
Be accompanied by development and the progress of every science and technology and application technology, urban transportation has also started to have moved towards gradually intellectuality, the road of hommization, thereby produced intelligent transportation system (IntelligentTraffic System, ITS) concept, it is by advanced infotech, data communication transmission technology, electron controls technology, the various technology such as sensor technology and computing machine treatment technology effectively integrated use in traffic system, thereby it is more accurate to traffic system to realize, in real time, integrated management efficiently and control, realize to greatest extent people, car, harmony between road.The traffic problems such as intelligent transportation system is solving urban traffic blocking effectively, and traffic hazard takes place frequently, traffic environment deterioration, have become one of topmost developing direction of urban transportation.Automobile navigation is positioned in intelligent transportation system and plays an important role how rapidly, in real time, exactly, determine that the position of vehicle becomes the focus of research.
Common automobile navigation location technology comprises at present: dead reckoning (DeadReckoning, DR), inertial navigation system (Inertial Navigation System, INS), numerical map coupling (Map Match, MM), satellite navigation (Global Navigation Satellite System, GNSS) and various integrated navigation technology.
Dead reckoning (DR) collection vehicle motion sensor information is carried out self-contained continuous navigation, but due to sensor and the error of calculation constantly accumulation in time, therefore, can only guarantee the positioning precision of short time.Inertial navigation system (INS), mainly by accelerometer and gyroscope, formed, it can rely on equipment autonomously completely and complete navigation task, there is not any photoelectricity contact with the external world, good concealment, work is not subject to the restriction of weather condition, but the positioning error of inertial navigation can be along with accumulated time, work long hours and can cause positioning precision and reliability decrease, and needed long initial alignment before using.Map match (MM) is the technology that a kind of method by pure software is proofreaied and correct the positioning error of the localization methods such as satellite or dead reckoning, to improve the very effective means of positioning precision, but, the precision of map match depends on the quality of numerical map and the precision of map-matching algorithm, when original position-information deviation is larger before coupling, be difficult to match correct position.In satellite navigation (GNSS), mainly contain the GPS (GPS) of the U.S., the dipper system of Muscovite GPS (Global Position System) (GLONASS) and China etc.
GPS in various localization methods (GPS) has obtained application the most widely, GPS (GPS) can be real-time the information such as three-dimensional position, speed, time are provided for carrier, realize global, round-the-clock, omnibearing location and navigation feature, positioning precision is higher, but GPS is easily subject to the impact that weather, multipath effect and signal block, thereby cause the positioning precision even complete failure that declines, in order to make up the deficiency of GPS location, various integrated navigation technologies arise at the historic moment.Common integrated navigation mode has at present: GPS/DR, GPS/MM, the integrated navigations such as GPS/INS, these technology can make up the deficiency of single employing GPS location to a certain extent, GPS/DR Combinated navigation method for example, when gps signal transient loss, can continue location by dead reckoning system DR.If but gps signal is blocked (as in tunnel environment) for a long time, the error of dead reckoning system is constantly accumulation in time, GPS/DR integrated navigation just cannot guarantee the precision of location, therefore, these Combinated navigation methods based on GPS still cannot meet the vehicle location demand under tunnel environment.
Except GPS, radio-frequency (RF) identification (Radio Frequency Identification in recent years, RFID) technology has obtained developing rapidly, radio-frequency (RF) identification (RFID) technology is a kind of contactless automatic identification technology, there is feature quick, that accurate, real-time is good, rfid system is mainly by radio-frequency identification reader/writer, radio frequency recognizing electronic label, and dual-mode antenna forms.Present Domestic is outer mainly concentrates on location algorithm and targeting scheme two aspects to the research of radio-frequency (RF) identification (RFID) location technology, particularly along with the maturation of active active radio frequency recognition technology, radio-frequency (RF) identification (RFID) having arrived widely in indoor positioning applied, the research of various location algorithms and location technology also makes great progress, tunnel environment is similar to indoor environment, but this technology not yet applies to the location under tunnel environment.
In sum, existing airmanship, various airmanships based on GPS particularly, in the tunnel environment being blocked at gps signal, all there are various shortcomings, cannot meet urban transportation for the requirement of automobile navigation location, and that radio-frequency (RF) identification (RFID) technology has advantages of is many, can under tunnel environment, realizes highly reliable, the accurate location of vehicle.
Summary of the invention
Technical matters: the invention provides a kind of realization block under environment to vehicle accurately, location in real time, there is vehicle two-dimensional location method under the tunnel environment based on less radio-frequency of the remarkable advantages such as locating speed is fast, precision is high, real-time is good.
Technical scheme: vehicle two-dimensional location method under the tunnel environment based on less radio-frequency of the present invention, comprises the following steps:
Step 1) at vehicle roof, arrange active active radio frequency identification label, in the unobstructed position of tunnel top, equidistantly arrange successively along the longitudinal radio-frequency identification reader/writer, take the position at any one radio-frequency identification reader/writer place in tunnel is initial point O, longitudinally for Ox points to, laterally for Oy points to, set up a rectangular coordinate system Oxy, determine the coordinate of all radio-frequency identification reader/writers in Oxy coordinate system, each radio-frequency identification reader/writer periodically sends radiofrequency signal;
Step 2) the active active radio frequency identification label of arranging on vehicle receives after the radiofrequency signal of radio-frequency identification reader/writer transmission, identify the numbering of radio-frequency identification reader/writer, thereby determine the radio-frequency identification reader/writer quantity j that current time recognizes, and the coordinate (x of this j the radio-frequency identification reader/writer recognizing 1, y 1), (x 2, y 2) ..., (x i, y i) ..., (x j, y j), wherein i is radio-frequency identification reader/writer sequence number, (x i, y i) be the coordinate of the sequence number radio-frequency identification reader/writer that is i;
Step 3) according to following condition, determine the scope of the two-dimensional coordinate (x, y) of vehicle current time:
0 ≤ x ≤ L 0 ≤ y ≤ W ( x - x 1 ) 2 + ( y - y 1 ) 2 - R ≤ 0 ( x - x 2 ) 2 + ( y - y 2 ) 2 - R ≤ 0 ( x - x 3 ) 2 + ( y - y 3 ) 2 - R ≤ 0 · · · ( x - x j ) 2 + ( y - y j ) 2 - R ≤ 0
Wherein, (x, y) is the two-dimensional coordinate of vehicle current time, i.e. the current time two-dimensional coordinate of active active radio frequency identification label on vehicle, and L, W are respectively the length in tunnel and wide, and R is the maximum decipherment distance of frequency read/write in tunnel environment;
Step 4) ask for and meet non-linear constrain and make the minimum two-dimensional coordinate (x, y) of objective function δ (x, y), and the two-dimensional coordinate using it as vehicle current time;
Described non-linear constrain is g i(x, y)≤0i=1,2 ..., j
G wherein i(x, y) is constraint function, g i ( x , y ) = ( x - x i ) 2 + ( y - y i ) 2 - R ;
Described objective function δ (x, y) is:
δ ( x , y ) = Σ i = 1 j ( x - x i ) 2 + ( y - y i ) 2 .
In the preferred version of the inventive method, step 1), in, the spacing of two adjacent radio-frequency identification reader/writers is 5 meters to 20 meters.
In the preferred version of the inventive method, step 4) in, ask for and meet non-linear constrain and make the idiographic flow of the minimum two-dimensional coordinate (x, y) of objective function δ (x, y) be:
41) using described step 3) scope of the two-dimensional coordinate (x, y) of the vehicle current time undetermined determined is as feasible zone D, therefrom optional a bit as iteration initial point (x 0, y 0), the convergence departure ε of setting penalty 1with precision departure ε 2, and the penalty factor r of penalty kcoefficient of reduction c, wherein penalty is:
φ ( x , y , r k ) = δ ( x , y ) - r k Σ i = 1 j ln [ - g i ( x , y ) ]
Wherein, ε 1and ε 2all be greater than 0,0.1≤c≤0.7, r kfor the penalty factor of penalty, k is the calculation times of the approximate optimal solution of vehicle coordinate (x, y), k initial value be 0, ln for the function in bracket is got to natural logarithm, the penalty factor initial value of penalty r 0 = | δ ( x 0 , y 0 ) Σ i = 1 j 1 g i ( x 0 , y 0 ) | ;
42) make k=k+1, adopt minimum value min φ (x, y, the r of newton's Analytic Method penalty k):
Solving equation group ∂ φ ( x , y , r k ) ∂ x = 0 ∂ φ ( x , y , r k ) ∂ y = 0 , Obtain the approximate optimal solution (x of vehicle coordinate (x, y) k, y k), r wherein k=cr k-1;
43) if | φ ( x k , y k , r k ) x k - 1 , y k - 1 , r k - 1 - 1 | ≤ ϵ 1 And ( x k - x k - 1 ) 2 + ( y k - y k - 1 ) 2 ≤ ϵ 2 , By (x k, y k) as the optimum solution of vehicle coordinate (x, y), meet non-linear constrain and make the minimum two-dimensional coordinate (x, y) of objective function δ (x, y), process ends; Otherwise, return to step 42).
In the preferred version of the inventive method, step 4) in, penalty factor r kcoefficient of reduction get c=0.4.
Beneficial effect: the present invention compared with prior art, has the following advantages:
1. reliability is higher.In tunnel environment, because gps signal is blocked for a long time, cause GPS to lose efficacy, traditional localization method based on GPS has not been suitable for this operating mode, and radio-frequency (RF) identification is with its non line of sight, non-contacting technological merit, can guarantee the vehicle in tunnel to carry out continuously, locate reliably;
2. real-time is better.Because the location algorithm in the present invention only need to obtain the identifying information between active active radio frequency identification label and radio-frequency identification reader/writer, be number and the numbering thereof of the label read write line that can recognize at current time, and do not need to consider distance between label and read write line and the conversion relation of radio-frequency (RF) signal strength, than the radio frequency location algorithm based on signal strength values, more simple, directly perceived, therefore, the present invention can estimate the position of vehicle fast, has good real-time.
3. positioning precision is higher.The present invention utilizes REID Primary Location vehicle, then adopts constrained optimization method to improve the precision of location, finally determines the position of vehicle, can guarantee higher vehicle location precision.
4. technical costs is relatively low.Compare with traditional localization method, REID is relatively ripe, and equipment cost is lower, is conducive to the application of the method.
Accompanying drawing explanation
Fig. 1 is process flow diagram of the present invention.
Fig. 2 is active active radio frequency identification label and the layout of radio-frequency identification reader/writer under tunnel environment.
Fig. 3 is for being determined the illustraton of model of label current time two-dimensional coordinate scope by the identifying information of label and read write line.
Fig. 4 is for determining the algorithm model figure of the two-dimensional coordinate scope of label current time.
Fig. 5 is the constrained optimization method process flow diagram of determining label current time two-dimensional coordinate.
In figure, have: radio-frequency identification reader/writer 1, RFID tag 2, the first radio-frequency identification reader/writer 11, the second radio-frequency identification reader/writer 12, the 3rd radio-frequency identification reader/writer 13, the 4th radio-frequency identification reader/writer 14
Embodiment
Below in conjunction with embodiment and Figure of description, the present invention is done to further concrete detailed explanation:
The present invention has chosen active active radio frequency identification label and radio-frequency identification reader/writer, be used in tunnel environment, a kind of vehicle two-dimensional location method towards tunnel environment has been proposed, by the identifying information of active active radio frequency identification label and radio-frequency identification reader/writer, determine the scope of the two-dimensional coordinate of vehicle, then adopt constrained optimization method to determine the accurate location of vehicle, thereby the orientation problem that has solved vehicle under the tunnel environment that gps signal blocked for a long time, its concrete steps are as follows:
Step 1) for common tunnel environment, in the scope of 50 to 100 meters, tunnel space can be regarded the certain interior space of width as, its width is W, unit is rice, in the unobstructed position of tunnel top, equidistantly arrange successively along the longitudinal radio-frequency identification reader/writer, spacing between read write line is S, unit is rice, the scope of the interval S of the radio-frequency identification reader/writer that the present invention chooses is five meters to 20 meters, take the position at any one radio-frequency identification reader/writer place in tunnel is initial point O, longitudinally for Ox points to, laterally for Oy points to, set up a rectangular coordinate system Oxy, determine the coordinate of all radio-frequency identification reader/writers in Oxy coordinate system, each radio-frequency identification reader/writer periodically sends radiofrequency signal, the layout of read write line as shown in Figure 2, at the vehicle roof that enters tunnel, arrange active active radio frequency identification label, it is the two-dimensional coordinate of vehicle current time that label is at the coordinate of current time,
Step 2) the active active radio frequency identification label of arranging on vehicle receives after the radiofrequency signal of radio-frequency identification reader/writer transmission, identify the numbering of radio-frequency identification reader/writer, thereby determine the radio-frequency identification reader/writer quantity j that current time recognizes, and the coordinate (x of this j the radio-frequency identification reader/writer recognizing 1, y 1), (x 2, y 2) ..., (x i, y i) ..., (x j, y j), wherein i is radio-frequency identification reader/writer sequence number, (x i, y i) be the coordinate of the sequence number radio-frequency identification reader/writer that is i;
Step 3) the maximum decipherment distance that frequency read/write can form spherical identified region and each read write line in tunnel environment is R, and the maximum decipherment distance R of the read write line adopting and the interval S of read write line meet following formula: 0.707S≤R≤S;
" comprising " and " not comprising " two concepts in the location algorithm of system, have been defined, in the time of in the sensing range of label in read write line, just claim read write line to comprise this label, on the contrary, if label is outside the sensing range of read write line, just claim read write line not comprise this label, when label undetermined is arranged in the identified region of four read write lines compositions, according to the identifying information of read write line, be that read write line " comprises " and " not comprising " label, can determine that thereby the residing region of label undetermined estimates the position of label undetermined, take areal model as example, as shown in Figure 2, suppose position shown in the figure, label undetermined place, it is in the first radio-frequency identification reader/writer 11, the second radio-frequency identification reader/writer 12, in the sensing range of the 4th radio-frequency identification reader/writer 14, but outside the sensing range in the 3rd radio-frequency identification reader/writer 13, obviously, now the residing Probability Area of label undetermined is the shadow region in Fig. 3, and if label undetermined can be identified by four read write lines simultaneously, the residing Probability Area of label undetermined is the shadow region in Fig. 4.
According to the identifying information between active active radio frequency identification label and radio-frequency identification reader/writer, read write line " comprises " and " not comprising " label, has determined the scope of the two-dimensional coordinate (x, y) of vehicle current time:
0 ≤ x ≤ L 0 ≤ y ≤ W ( x - x 1 ) 2 + ( y - y 1 ) 2 - R ≤ 0 ( x - x 2 ) 2 + ( y - y 2 ) 2 - R ≤ 0 ( x - x 3 ) 2 + ( y - y 3 ) 2 - R ≤ 0 · · · ( x - x j ) 2 + ( y - y j ) 2 - R ≤ 0
Wherein, (x, y) is the two-dimensional coordinate of vehicle current time, i.e. the current time two-dimensional coordinate of active active radio frequency identification label on vehicle, and L, W are respectively the length in tunnel and wide, and R is the maximum decipherment distance of frequency read/write in tunnel environment;
Step 4) ask for and meet non-linear constrain and make the minimum two-dimensional coordinate (x, y) of objective function δ (x, y), and the two-dimensional coordinate using it as vehicle current time;
Non-linear constrain is g i(x, y)≤0i=1,2 ..., j
G wherein i(x, y) is constraint function, g i ( x , y ) = ( x - x i ) 2 + ( y - y i ) 2 - R ;
Objective function δ (x, y) be:
δ ( x , y ) = Σ i = 1 j ( x - x i ) 2 + ( y - y i ) 2 .
Objective function δ (x, y), for the register distance sum of all discernible read write lines of radio frequency identification marking, asks for and meets constraint condition and make objective function δ (x, y) value minimum (x, y), can obtain the two-dimensional coordinate of vehicle current time.
Step 1) in, consider restriction and the impact of distance on the identification between radio-frequency (RF) tag and read write line of tunnel width, the spacing span of two adjacent radio-frequency identification reader/writers is 5 meters to 20 meters, can either guarantee that like this radio-frequency identification reader/writer recognizes accurately radio-frequency (RF) tag in maximum reading/writing distance, improve the stability of positioning system, can guarantee again the precision of location.
The step 4 of the inventive method) in, adopted penalty interior point method to solve the optimum solution of non-linear constrain, the method by the inequality constrain function in constrained optimization problem after weighting, be combined into new objective function---penalty with former objective function, constrained optimization problem is converted to unconstrained optimization problem, solve the minimal value of unconstrained optimization problem, thereby obtain the optimum solution of former constrained optimization problem.The method is mainly applicable to have the mathematical model of inequality constrain, in iterative computation, each point is feasible design proposal, but speed of convergence is general, if need algorithm speed of convergence faster, also can adopt other constrained optimization methods, as penalty outer point method.
The step 4 of a kind of preferred embodiment of the inventive method) in, adopting penalty interior point method to ask for meets non-linear constrain and makes objective function δ (x, y) minimum two-dimensional coordinate (x, y) idiographic flow is: 41) by step 3) two-dimensional coordinate (x of the vehicle current time undetermined determined, y) scope is as feasible zone D, D={ (x, y) | 0≤x≤L, 0≤y≤W, g i(x, y)≤0, i=1,2 ..., j}, therefrom optional a bit as iteration initial point (x 0, y 0), the convergence departure ε of setting penalty 1with precision departure ε 2, and the penalty factor r of penalty kcoefficient of reduction c, wherein penalty is:
φ ( x , y , r k ) = δ ( x , y ) - r k Σ i = 1 j ln [ - g i ( x , y ) ]
Wherein, r kfor the penalty factor of penalty, k is the calculation times of the approximate optimal solution of vehicle coordinate (x, y), and k initial value is that 0, ln is for to get natural logarithm to the function in bracket;
The departure of penalty affects precision and the speed of convergence of iterative computation, if convergence departure is too small, can cause that speed of convergence is slack-off even cannot be restrained, if precision departure is excessive, can reduce the precision of algorithm, so this method is got the convergence departure ε of penalty 1=0.1, precision departure ε 2=0.1, value like this, can either Fast Convergent, can guarantee again the precision of result of calculation.
Equally, the initial value r of penalty factor 0also suitable value, otherwise can affect normally carrying out of iterative computation, too conference increases iterations, and too little meeting degenerates the form of penalty, is difficult to converge to extreme point.
In this method, get penalty factor initial value r 0 = | δ ( x 0 , y 0 ) Σ i = 1 j 1 g i ( x 0 , y 0 ) | ; Choose like this r 0value, can make the value of obstacle item in penalty and former objective function about equally, guarantee the speed of convergence.
At structure during penalty, penalty factor r is one and is successively decremented to 0 ordered series of numbers, and the pass of the penalty factor of twice adjacent iteration is: r k=cr k-1, the coefficient of reduction that wherein c is penalty factor, generally, the span of c is 0.1≤c≤0.7, in order to guarantee the real-time of algorithm, chooses c=0.4 in this method.
42) make k=k+1, adopt minimum value min φ (x, y, the r of newton's Analytic Method penalty k):
Solving equation group ∂ φ ( x , y , r k ) ∂ x = 0 ∂ φ ( x , y , r k ) ∂ y = 0 , Obtain the approximate optimal solution (x of vehicle coordinate (x, y) k, y k), r wherein k=cr k-1;
43) if | φ ( x k , y k , r k ) x k - 1 , y k - 1 , r k - 1 - 1 | ≤ ϵ 1 And ( x k - x k - 1 ) 2 + ( y k - y k - 1 ) 2 ≤ ϵ 2 , By (x k, y k) as the optimum solution of vehicle coordinate (x, y), meet non-linear constrain and make the minimum two-dimensional coordinate (x, y) of objective function δ (x, y), process ends; Otherwise, return to step 42).
By said method, finally can determine the coordinate of RFID tag undetermined in Oxy coordinate system, because label is the roof place being arranged in directly over vehicle barycenter, therefore the coordinate of RFID tag current time undetermined can be thought the coordinate of vehicle current time in Oxy coordinate system, thereby has determined the real time position of vehicle in tunnel.

Claims (4)

1. towards the vehicle two-dimensional location method under tunnel environment, the method comprises the following steps:
Step 1) at vehicle roof, arrange active active radio frequency identification label, in the unobstructed position of tunnel top, equidistantly arrange successively along the longitudinal radio-frequency identification reader/writer, take the position at any one radio-frequency identification reader/writer place in tunnel is initial point O, longitudinally for Ox points to, laterally for Oy points to, set up a rectangular coordinate system Oxy, determine the coordinate of all radio-frequency identification reader/writers in Oxy coordinate system, each radio-frequency identification reader/writer periodically sends radiofrequency signal;
Step 2) the active active radio frequency identification label of arranging on vehicle receives after the radiofrequency signal of radio-frequency identification reader/writer transmission, identify the numbering of radio-frequency identification reader/writer, thereby determine the radio-frequency identification reader/writer quantity j that current time recognizes, and the coordinate (x of this j the radio-frequency identification reader/writer recognizing 1, y 1), (x 2, y 2) ..., (x i, y i) ..., (x j, y j), wherein i is radio-frequency identification reader/writer sequence number, (x i, y i) be the coordinate of the sequence number radio-frequency identification reader/writer that is i;
Step 3) according to following condition, determine the scope of the two-dimensional coordinate (x, y) of vehicle current time:
0 ≤ x ≤ L 0 ≤ y ≤ W ( x - x 1 ) 2 + ( y - y 1 ) 2 - R ≤ 0 ( x - x 2 ) 2 + ( y - y 2 ) 2 - R ≤ 0 ( x - x 3 ) 2 + ( y - y 3 ) 2 - R ≤ 0 · · · ( x - x j ) 2 + ( y - y j ) 2 - R ≤ 0
Wherein, (x, y) is the two-dimensional coordinate of vehicle current time, i.e. the current time two-dimensional coordinate of active active radio frequency identification label on vehicle, and L, W are respectively the length in tunnel and wide, and R is the maximum decipherment distance of frequency read/write in tunnel environment;
Step 4) ask for and meet non-linear constrain and make the minimum two-dimensional coordinate (x, y) of objective function δ (x, y), and the two-dimensional coordinate using it as vehicle current time;
Described non-linear constrain is g i(x, y)≤0i=1,2 ..., j
G wherein i(x, y) is constraint function, g i ( x , y ) = ( x - x i ) 2 + ( y - y i ) 2 - R ;
Described objective function δ (x, y) be:
δ ( x , y ) = Σ i = 1 j ( x - x i ) 2 + ( y - y i ) 2 .
2. the vehicle two-dimensional location method under tunnel environment according to claim 1, is characterized in that described step 1) in, the spacing of two adjacent radio-frequency identification reader/writers is 5 meters to 20 meters.
3. the vehicle two-dimensional location method under tunnel environment according to claim 1 and 2, it is characterized in that, described step 4) in, ask for and meet non-linear constrain and make the idiographic flow of the minimum two-dimensional coordinate (x, y) of objective function δ (x, y) be:
41) using described step 3) scope of the two-dimensional coordinate (x, y) of the vehicle current time undetermined determined is as feasible zone D, therefrom optional a bit as iteration initial point (x 0, y 0), the convergence departure ε of setting penalty 1with precision departure ε 2, and the penalty factor r of penalty kcoefficient of reduction c, wherein penalty is:
φ ( x , y , r k ) = δ ( x , y ) - r k Σ i = 1 j ln [ - g i ( x , y ) ]
Wherein, ε 1and ε 2all be greater than 0,0.1≤c≤0.7, r kfor the penalty factor of penalty, k is the calculation times of the approximate optimal solution of vehicle coordinate (x, y), k initial value be 0, ln for the function in bracket is got to natural logarithm, the penalty factor initial value of penalty r 0 = | δ ( x 0 , y 0 ) Σ i = 1 j 1 g i ( x 0 , y 0 ) | ;
42) make k=k+1, adopt minimum value min φ (x, y, the r of newton's Analytic Method penalty k):
Solving equation group ∂ φ ( x , y , r k ) ∂ x = 0 ∂ φ ( x , y , r k ) ∂ y = 0 , Obtain the approximate optimal solution (x of vehicle coordinate (x, y) k, y k), r wherein k=cr k-1;
43) if | φ ( x k , y k , r k ) x k - 1 , y k - 1 , r k - 1 - 1 | ≤ ϵ 1 And ( x k - x k - 1 ) 2 + ( y k - y k - 1 ) 2 ≤ ϵ 2 , By (x k, y k) as the optimum solution of vehicle coordinate (x, y), meet non-linear constrain and make the minimum two-dimensional coordinate (x, y) of objective function δ (x, y), process ends; Otherwise, return to step 42).
4. the vehicle two-dimensional location method under tunnel environment according to claim 3, is characterized in that described step 4) in, the coefficient of reduction of penalty factor rk is got c=0.4.
CN201410270067.7A 2014-06-17 2014-06-17 Two-dimensional vehicle positioning method in tunnel environment and based on radio frequency identification Pending CN104020441A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410270067.7A CN104020441A (en) 2014-06-17 2014-06-17 Two-dimensional vehicle positioning method in tunnel environment and based on radio frequency identification

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410270067.7A CN104020441A (en) 2014-06-17 2014-06-17 Two-dimensional vehicle positioning method in tunnel environment and based on radio frequency identification

Publications (1)

Publication Number Publication Date
CN104020441A true CN104020441A (en) 2014-09-03

Family

ID=51437300

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410270067.7A Pending CN104020441A (en) 2014-06-17 2014-06-17 Two-dimensional vehicle positioning method in tunnel environment and based on radio frequency identification

Country Status (1)

Country Link
CN (1) CN104020441A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106840156A (en) * 2017-03-28 2017-06-13 千寻位置网络有限公司 A kind of method for improving mobile phone inertial navigation performance
CN111624551A (en) * 2020-05-21 2020-09-04 南京晓庄学院 Positioning method, device and system based on visible light communication
CN116299173A (en) * 2023-01-06 2023-06-23 中铁武汉电气化局集团有限公司 Tunnel positioning method and system based on laser ranging and RFID technology

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2221757A1 (en) * 2009-02-23 2010-08-25 Champtek Incorporated RFID location method and system thereof
CN102576063A (en) * 2009-08-20 2012-07-11 天宝导航有限公司 Rfid location system
CN202548320U (en) * 2012-02-22 2012-11-21 昆山塔米机器人有限公司 Accurate positioning navigation system of autonomous mobile equipment
CN102879762A (en) * 2012-09-27 2013-01-16 东南大学 Dynamic positioning method for vehicles in tunnel based on radio frequency receipt signal intensity value
CN102928813A (en) * 2012-10-19 2013-02-13 南京大学 RSSI (Received Signal Strength Indicator) weighted centroid algorithm-based passive RFID (Radio Frequency Identification Device) label locating method

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2221757A1 (en) * 2009-02-23 2010-08-25 Champtek Incorporated RFID location method and system thereof
CN102576063A (en) * 2009-08-20 2012-07-11 天宝导航有限公司 Rfid location system
CN202548320U (en) * 2012-02-22 2012-11-21 昆山塔米机器人有限公司 Accurate positioning navigation system of autonomous mobile equipment
CN102879762A (en) * 2012-09-27 2013-01-16 东南大学 Dynamic positioning method for vehicles in tunnel based on radio frequency receipt signal intensity value
CN102928813A (en) * 2012-10-19 2013-02-13 南京大学 RSSI (Received Signal Strength Indicator) weighted centroid algorithm-based passive RFID (Radio Frequency Identification Device) label locating method

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
LANCE DOHERTY ET AL.: ""Convex Position Estimation in Wireless Sensor Networks"", 《IEEE INFOCOM》 *
史清江等: ""多功率移动锚节点辅助的分布式节点定位方法"", 《通信学报》 *
王兴华: ""惩罚函数法的改进算法及应用研究"", 《中国优秀硕士学位论文全文数据库基础科学辑》 *
赵小明: ""区域无线电定位***基站的最有几何布局"", 《中国惯性技术学报》 *
韩美林等: ""RFID定位技术和常见算法比较"", 《产业与科技论坛》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106840156A (en) * 2017-03-28 2017-06-13 千寻位置网络有限公司 A kind of method for improving mobile phone inertial navigation performance
CN106840156B (en) * 2017-03-28 2019-03-12 千寻位置网络有限公司 A method of improving mobile phone inertial navigation performance
CN111624551A (en) * 2020-05-21 2020-09-04 南京晓庄学院 Positioning method, device and system based on visible light communication
CN116299173A (en) * 2023-01-06 2023-06-23 中铁武汉电气化局集团有限公司 Tunnel positioning method and system based on laser ranging and RFID technology
CN116299173B (en) * 2023-01-06 2023-09-29 中铁武汉电气化局集团有限公司 Tunnel positioning method and system based on laser ranging and RFID technology

Similar Documents

Publication Publication Date Title
CN103777220B (en) Based on the accurate position and orientation estimation method in real time of optical fibre gyro, speed pickup and GPS
US10546400B2 (en) Method and apparatus for defining bi-directional road geometry from probe data
EP3109842B1 (en) Map-centric map matching method and apparatus
US20210323537A1 (en) Automatic Parking Method and Device
EP2107338B1 (en) Position estimation for navigation devices
Song et al. Enhancing GPS with lane-level navigation to facilitate highway driving
CN110160541A (en) Reconstructing method and device, storage medium, the electronic device of motion profile
JPWO2018008082A1 (en) Driving lane estimation system
CN106855415A (en) Map-matching method and system
CN110146910A (en) A kind of localization method and device merged based on GPS with laser radar data
CN104062671B (en) The GNSS Floating Car map-matching method of curvature limitation and device
CN110095127A (en) A kind of hidden Markov model map-matching method based on segmentation
CN105044668A (en) Wifi fingerprint database construction method based on multi-sensor device
CN108961811A (en) Parking lot vehicle positioning method, system, mobile terminal and storage medium
CN103471589A (en) Method for identifying walking mode and tracing track of pedestrian in room
CN105606102A (en) Grid model based PDR indoor positioning method and system
CN103453913A (en) Integrated positioning method of vehicle in parking lot
CN105890592A (en) Vehicle position information prediction method based on Online-WSVR algorithm
CN108362288A (en) Polarized light S L AM method based on unscented Kalman filtering
CN108387236A (en) Polarized light S L AM method based on extended Kalman filtering
CN108020813A (en) Localization method, positioner and electronic equipment
Li et al. Constrained unscented Kalman filter based fusion of GPS/INS/digital map for vehicle localization
CN104020441A (en) Two-dimensional vehicle positioning method in tunnel environment and based on radio frequency identification
CN110395297A (en) Train locating method
CN108592903A (en) A kind of vehicle geomagnetic matching localization method based on road network earth magnetism pattern library

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
WD01 Invention patent application deemed withdrawn after publication
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20140903