CN102175253B - Multi-hypothesis map matching method based on vehicle state transition - Google Patents

Multi-hypothesis map matching method based on vehicle state transition Download PDF

Info

Publication number
CN102175253B
CN102175253B CN201010622517A CN201010622517A CN102175253B CN 102175253 B CN102175253 B CN 102175253B CN 201010622517 A CN201010622517 A CN 201010622517A CN 201010622517 A CN201010622517 A CN 201010622517A CN 102175253 B CN102175253 B CN 102175253B
Authority
CN
China
Prior art keywords
node
hypothetical
hypothesis
automobile
car
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.)
Expired - Fee Related
Application number
CN201010622517A
Other languages
Chinese (zh)
Other versions
CN102175253A (en
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.)
Tsinghua University
Wuxi Research Institute of Applied Technologies of Tsinghua University
Original Assignee
Tsinghua 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 Tsinghua University filed Critical Tsinghua University
Priority to CN201010622517A priority Critical patent/CN102175253B/en
Publication of CN102175253A publication Critical patent/CN102175253A/en
Application granted granted Critical
Publication of CN102175253B publication Critical patent/CN102175253B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种基于汽车状态转移的多假设地图匹配方法,包括以下步骤:S1、获取全球定位系统GPS数据和惯性导航系统INS数据;S2、根据GPS数据和INS数据定义一颗多假设树,所述多假设树用于记录汽车走过的所有路径,其有一个根节点,所述根节点代表汽车的起始点;S3、在汽车每获得一次GPS数据时,在多假设树中生成新的假设节点;S4、根据所述GPS数据和INS数据计算所述假设节点的权重,所述权重表示该假设节点包含的信息与真实信息的相似性;S5、根据假设节点的权重删除一部分假设节点;S6、选择权重最大的假设节点作为最佳的假设节点。本发明能记录汽车所走过的连续路径,在GPS信号不太好,或者道路密集的区域,能够获得较好的匹配结果。

The invention discloses a multi-hypothesis map matching method based on vehicle state transition, comprising the following steps: S1, acquiring GPS data of a global positioning system and INS data of an inertial navigation system; S2, defining a multi-hypothesis tree according to the GPS data and INS data , the multi-hypothesis tree is used to record all paths that the car has walked, and it has a root node, and the root node represents the starting point of the car; S3, when the car obtains GPS data once, generate a new one in the multi-hypothesis tree the hypothetical node; S4, calculate the weight of the hypothetical node according to the GPS data and the INS data, and the weight represents the similarity between the information contained in the hypothetical node and the real information; S5, delete a part of the hypothetical node according to the weight of the hypothetical node ; S6. Select the hypothetical node with the largest weight as the best hypothetical node. The invention can record the continuous path traveled by the car, and can obtain better matching results in areas where the GPS signal is not very good or where the roads are dense.

Description

Many hypothesis map-matching method based on the vehicle condition transfer
Technical field
The present invention relates to the map match field, specifically is that a kind of vehicle condition transitional information that utilizes limits many hypothesis map-matching method that the hypothesis node generates, and this method can be used to mate the path that automobile is passed by.
Background technology
Map-matching algorithm matees GPS (Global Positioning System, GPS)/INS (Inertial Navigation System, inertial navigation system) data and electronic map data, to find out the position of automobile in electronic chart.Map-matching algorithm is mainly used in aspects such as auto navigation, record automobilism track.
From 20 end of the centurys till now, a lot of map-matching algorithms have been arranged, comprise the map-matching algorithm, map-matching algorithm, fuzzy logic algorithm, curve fitting algorithm of position-based point coupling etc. based on the area-method criterion.
These algorithms have been obtained extraordinary effect aspect navigation of electronic map, yet in the application of record automobilism track, but not necessarily can access good equally effect.Navigation of electronic map requires very high to the real-time of algorithm and accuracy, it is not very high that the continuity of matching result is required.And in the application of record automobilism track, except to the real-time of algorithm with the accuracy requirement very high, also require matching result to have continuity preferably.
Existing algorithm can not satisfy the requirement of road charge system under scenario: 1, in the zone of road than comparatively dense, existing algorithm may matching error; If very short path is arranged in 2 maps, then these paths may be ignored by algorithm; 3, in the bad zone of gps signal, as: high block, tunnel etc., the possibility that existing algorithmic match is made mistakes can be very big.
Summary of the invention
The technical matters that (one) will solve
The technical matters that the present invention will solve is: how to write down the continuous path that automobile is passed by exactly; The zone bad at gps signal simultaneously, that road is intensive obtains the better map matching result, so that map-matching algorithm can be applied in the automobile charge system better.
(2) technical scheme
For solving the problems of the technologies described above, the invention provides a kind of many hypothesis map-matching method that shifts based on vehicle condition, may further comprise the steps:
S1, obtain global position system GPS data and inertial navigation system INS data;
S2, according to gps data and INS data definition hypothesis tree more than, said many hypothesis trees are used to write down all paths that automobile is passed by, it has a root node, said root node is represented the starting point of automobile;
S3, when gps data of the every acquisition of automobile, in many hypothesis trees, generate new hypothesis node;
S4, according to the weight of said gps data and the said hypothesis node of INS data computation, said weight is represented the information that this hypothesis node comprises and the similarity of real information;
S5, according to the weight deletion a part of hypothesis node of hypothesis node;
S6, the maximum hypothesis node of selection weight are supposed node as the best.
Repeating step S1~S5 then, each is taken turns and can obtain a best hypothesis node, and the branch at this best hypothesis node place has write down the path locus that automobile is passed by.
Wherein, when in step S2, defining many hypothesis trees, suppose that each said hypothesis node comprises following information at least:
Suppose the time that node produces;
Automobile current state, this state have four kinds: initial, stop, quickening and move, the automobile current state is passed through the acquisition of INS data computation;
The current path link that possibly belong to of automobile;
The direction that automobile moves on link;
Automobile is at Δ tThe angle that turns in time, it obtains through the INS data;
Automobile is at Δ tThe mileage of passing by in the time, it obtains through the INS data;
The direction that automobile is current, it obtains through gps data and INS data;
The mileage that automobile is passed by on link;
Suppose the weight of node;
Suppose the activity of node, represent the hypothesis node of automobile current state to be called live-vertex, represent the hypothesis node of automobile historic state to be called non-live-vertex.
Wherein, in step S2, be father node with the root node, to the path that each bar automobile possibly belong to, generate two the path is identical but hypothesis node that direction is different, step specifically comprises:
S21, the validity of judgement gps data if gps data is effectively then carried out following step, otherwise is not carried out initialization;
S22 calculates the automobile current state;
S23 is the center of circle with the gps coordinate, is that radius is drawn a circle with the error range R of GPS, finds all and this circle that the path of common factor is arranged, and these paths all are the current path link that possibly belong to of automobile;
S24 to the possible path link of each bar, is father node with the root node; Generate two hypothesis nodes of representing this path, suppose the in the opposite direction of nodes for two, represent the both direction in this path; These two all possibly be the automobile current state, and the out of Memory of hypothesis node is set then;
S25, said father node is set to non-live-vertex, and the hypothesis node that is generated is set to live-vertex.
Wherein, When obtaining gps data for the first time; Judge according to effective marker position, precision and the number of satellite of said gps data whether these data are effective, when obtaining gps data once more, effective marker position, precision, number of satellite and gps data and the Δ of said gps data tThe range difference of preceding gps data is apart from judging whether these data are effective.
Wherein, if to suppose that node j is that father node generates new hypothesis node, the step that then generates new hypothesis node among the step S3 is specially: state and automobile current state according to said hypothesis node j generate new hypothesis node.
Wherein, the step of the said weight of calculating is following among the step S4:
Suppose G n, A n, O nThe mileage number that gps coordinate when being illustrated respectively in t=n, automobile deflects angle and automobile are passed by, the current path h that possibly belong to of automobile during to any t=n uses X kThe position and the automobile steering information of hypothesis node when being illustrated in t=k, then the weight calculation formula of path h is following:
P ( h | G 1 , A 1 , O 1 , . . . , G n , A n , O n )
= P ( G n | X n ) P ( A n , O n | X n - 1 , X n ) P ( X n | X n - 1 ) P ( G n , A n , O n ) · P ( h 0 | G 1 , A 1 , O 1 , · · · , G n - 1 , A n - 1 , O n - 1 )
= λ n P ( G n | X n ) P ( A n , O n | X n - 1 , X n ) P ( X n | X n - 1 ) · P ( h 0 | G 1 , A 1 , O 1 , . . . G n - 1 , A n - 1 , O n - 1 )
P (* | * *) is illustrated in the conditional probability of calculating " * " under " * * " condition.
Wherein, step S5 is specially:
The hypothesis node that all are active sorts by weight from big to small;
Suppose only to allow to occur MaxActiveHypos active hypothesis node, then weighting weighs maximum MaxActiveHypos active hypothesis node, and deletes other nodes;
Suppose that many hypothesis trees at most only preserve the result in MaxHypoLength step, then begin back to travel through, fall surpassing the hypothesis knot removal that MaxHypoLength goes on foot from each live-vertex.
(3) beneficial effect
All paths that method of the present invention possibly passed by automobile all are recorded on the tree data structure; With tree root is the starting point of automobile; Gps data of the every acquisition of automobile all upgrades once many hypothesis trees, in tree, adds new leaf node (promptly supposing node).Each branch is all being represented one section road sequence that automobile possibly passed by in the tree, thereby has solved the problem that short path is omitted through the continuity that guarantees the path; Through preserving all possibilities simultaneously, even and guaranteed to occur once in a while than mistake at GPS, still can correct the mistake that produces than mistake because of this afterwards; In addition,, the INS data in method, have been introduced: when GPS is accurate, use gps data, when gps data is inaccurate, use the INS data that automobile position is estimated in order to overcome the bad problem of gps signal.
Description of drawings
Fig. 1 is the structure of many hypothesis trees of the present invention's definition;
Fig. 2 is a method flow diagram of the present invention;
Fig. 3 is the vehicle condition transition diagram;
Fig. 4 shows when producing new hypothesis node, the transfer process of vehicle condition;
A) be employed road synoptic diagram in the embodiment of the invention among Fig. 5; B) show many hypothesis trees that the embodiment of the invention generates;
Fig. 6 shows the experimental result picture of the embodiment of the invention.
Embodiment
Below in conjunction with accompanying drawing and embodiment, specific embodiments of the invention is done further explain.Following examples are used to explain the present invention, but are not used for limiting scope of the present invention.
As shown in Figure 2, method of the present invention may further comprise the steps:
S1, obtain global position system GPS data and inertial navigation system INS data;
S2, according to gps data and INS data (below be abbreviated as the GPS/INS data) definition hypothesis tree more than, the definition of said many hypothesis trees is following:
Many hypothesis trees are one tree (as shown in Figure 1, among Fig. 1, r1~r7 represent the path, and d1~d7 representes the travel direction of automobile on this path);
This tree has only a root node (root node, the i.e. node represented of r1 and d1), represents the starting point of automobile;
Except root node, all the other all nodes all are the hypothesis nodes that produces because of the GPS/INS data.The information that each hypothesis node comprises at least is following:
Parent: the pointer that points to father node.
BeginTime: suppose the time that node produces.
Type: the running status that automobile is current.The possible state of automobile has four: initial (initially); Stopping (stopping); Accelerating (acceleration); Running (operation).The automobile current states can obtain through the INS data computation.This automobile current state, automobile possibly belong to path, the direction of automobile on this path, have formed the state of this hypothesis node jointly.
Link: the current path that possibly belong to of automobile.
Direction: the direction that automobile moves on current link.
TurnAngle: automobile is at Δ tThe angle that turns in time.Obtain through the INS data.
RunDis: automobile is at Δ tThe mileage of passing by in the time.Obtain through the INS data.
FinalBear: the direction that automobile is current.Obtain through the GPS/INS data.
DisOnLink: the mileage that automobile is passed by on this link.
Weight: the weight of supposing node.Said weight is represented the information that this hypothesis node comprises and the similarity of real information.
Active: the activity of supposing node.Represent the hypothesis node of automobile current state to be called live-vertex, the hypothesis node of representing the automobile historic state is non-live-vertex.When automobile receives the GPS/INS data, have only live-vertex can generate new hypothesis node.
Any one hypothesis node and all child nodes thereof constitute hypothesis tree more than again.
Before obtaining first effective GPS data, be to obtain the current absolute position of automobile.So the initialization of many hypothesis trees is a prerequisite with effective GPS data.Before obtaining first gps data, many hypothesis trees are in no initializtion state (initial has only the root node) always.
In step S2, be father node with the root node, the steps that generate two hypothesis nodes specifically comprise:
S21, the validity of judgement gps data if gps data is effectively then carried out following step, otherwise is not carried out initialization;
S22 calculates the automobile current state;
S23 is the center of circle with the gps coordinate, is that radius is drawn a circle with the error range R of GPS, finds all and this circle that the path of common factor is arranged, and these paths all are the current path link that possibly belong to of automobile;
S24 to the possible path link of each bar, is father node with the root node; Generate two hypothesis nodes of representing this path, suppose the in the opposite direction of nodes for two, represent the both direction in this path; These two all possibly be the automobile current state, and the out of Memory of hypothesis node is set then;
S25, said father node is set to non-live-vertex, and the hypothesis node that is generated is set to live-vertex.
The factor that influences gps data validity has a lot.In gps data, have three parameters directly to influence the reliability of gps data, they are: the precision (PDOP) of the effective marker position of gps data, gps data, number of satellite.When the effective marker position of gps data this gps data of mark is invalid, can think the current no signal of GPS; When these data of effective marker mark of gps data were effective, the PDOP value in the gps data had provided the precision of this gps data; When number of satellite less than 4 the time, we can think that this gps data is unreliable.So, have only when the gps data zone bit effectively, and the gps data precision is greater than certain threshold value, and number of satellite is not less than at 4 o'clock, we think that just this gps data is effective.When obtaining gps data for the first time, we can only judge the validity of gps data according to the standard of S211
In addition, in order to guarantee the reliability of algorithm, when obtaining gps data for the second time and later on, also introduced the factor of another one judgement gps data validity.Because the speed of automobilism is limited, automobile is at Δ tThe mileage of passing by in the time also is limited.So, if thought Δ tGps data before time is effectively, and current GPS data and Δ tBefore the range difference of gps data apart from greater than certain threshold value the time, can think that then the current GPS data are invalid.Otherwise, can think that this gps data is effective.
Fig. 3 explains running status how to judge automobile now:
The possible running status of automobile is following:
Initial: original state.When automobile just starts, think that automobile is in this state.
Stopping: halted state.Automobile is at Δ tSpeed in time and deflection angle think that automobile is in the stopping state during all less than threshold value necessarily.
Running: running status.Automobile is at Δ tSpeed in time is greater than certain threshold value, and deflection angle thinks that automobile is in the running state during less than certain threshold value.
Accelerating: acceleration mode., automobile during three kinds of states, thinks that automobile is in acceleration mode above not being in.
The mode of judging motoring condition is following:
Judge the validity of gps data.If gps data is invalid, and many hypothesis trees no initializtion also, then explanation need not be calculated vehicle condition.
According to the INS data of automobile, calculate speed, yawing moment and the mileage of automobile.
If the speed of automobile is less than stopping threshold speed, and the automobile deflects angle is during less than the stop angle threshold value, and it is the stopping state that vehicle condition is set.
If the degree of automobile is greater than operational threshold speed, and the automobile deflects angle is during less than the operation angle threshold value, and it is the running state that vehicle condition is set.
Under other situation, it is the accelerating state that vehicle condition is set.
S3, when gps data of the every acquisition of automobile, in many hypothesis trees, generate new hypothesis node; If with hypothesis node j is that father node generates new hypothesis node, the step that then generates new hypothesis node among the step S3 is specially: state and automobile current state according to said hypothesis node j generate new hypothesis node (being the child node of selected hypothesis node).
Among Fig. 4, (a) previous state of expression automobile; (b) the expression automobile is stopping from the stopping state exchange; (c) expression is accelerating from the stopping state exchange; (d) expression converts stopping into from accelerating; (e) expression converts accelerating into from accelerating; (f) expression converts stopping into from running; (g) expression converts accelerating into from running; (h) expression converts running into from stopping; (i) expression converts running into from accelerating; (j) expression converts running into from runing.
As shown in Figure 4, the mode that generates said new hypothesis node is following:
Non-live-vertex does not produce new hypothesis node.
Like Fig. 4 (b), if the vehicle condition in the selected hypothesis node is stopping, and the automobile current state is stopping, then need not produce new node.
Like Fig. 4 (c); If the vehicle condition in the selected hypothesis node is stopping, and the automobile current state is accelerating, then generates two node for selected node; One child node is identical with the direction of father node, another child node and father node in the opposite direction.
Like Fig. 4 (d), if the vehicle condition in the selected hypothesis node is accelerating, and the automobile current state is stopping, then is that selected node generates a child node identical with the father node direction.It is non-live-vertex that father node is set.
Like Fig. 4 (e), if the vehicle condition in the selected hypothesis node is accelerating, and the automobile current state is accelerating, and the automobile distance of on Ben Tiaolu, passing by does not then produce new node less than the length of this road.Otherwise, find and terminal all roads that link to each other of this road, to each bar road, generate a new son hypothesis node.
Like Fig. 4 (f), if the vehicle condition in the selected hypothesis node is running, and the automobile current state is stopping, then is that selected hypothesis node generates a child node identical with the father node direction.It is non-live-vertex that father node is set.
Like Fig. 4 (g), if the vehicle condition in the selected hypothesis node is running, and the automobile current state is accelerating, then is that selected hypothesis node generates a child node identical with the father node direction.It is non-live-vertex that father node is set.
Like Fig. 4 (h); If the vehicle condition in the selected hypothesis node is stopping, and the automobile current state is running, then generates two node for selected hypothesis node; One child node is identical with the direction of father node, another child node and father node in the opposite direction.It is non-live-vertex that father node is set.
Like Fig. 4 (i); If the vehicle condition in the selected hypothesis node is accelerating, and the automobile current state is running, then generates two node for selected hypothesis node; One child node is identical with the direction of father node, another child node and father node in the opposite direction.It is non-live-vertex that father node is set.
Like Fig. 4 (j), if the vehicle condition in the selected hypothesis node is running, and the automobile current state is running, and the automobile distance of on this road, passing by does not then produce new node less than the length of this road.Otherwise, find with this road terminal link to each other and with this road angle all roads less than certain threshold value, to each bar road, generate a new son and suppose node.
S4, according to the weight of said gps data and the said hypothesis node of INS data computation, said weight is represented the information that this hypothesis node comprises and the similarity of real information:
Use the GPS/INS data to calculate the weight of hypothesis node.Suppose G n, A n, O nThe mileage number that gps coordinate when being illustrated respectively in t=n, automobile deflects angle and automobile are passed by, the current path h that possibly belong to of automobile during to any t=n uses X kThe position and the automobile steering information of hypothesis node when being illustrated in t=k, then the weight calculation formula of path h is following:
P ( h | G 1 , A 1 , O 1 , . . . , G n , A n , O n )
= P ( G n | X n ) P ( A n , O n | X n - 1 , X n ) P ( X n | X n - 1 ) P ( G n , A n , O n ) · P ( h 0 | G 1 , A 1 , O 1 , · · · , G n - 1 , A n - 1 , O n - 1 )
= λ n P ( G n | X n ) P ( A n , O n | X n - 1 , X n ) P ( X n | X n - 1 ) · P ( h 0 | G 1 , A 1 , O 1 , . . . G n - 1 , A n - 1 , O n - 1 )
P (* | * *) is illustrated in the conditional probability of calculating " * " under " * * " condition.
Top computing formula is merely the most basic computing formula.In addition, we also need consider more situation:
A. represent automobile on an one-way road during reverse going when some hypothesis nodes, we will carry out very big punishment to this weight of supposing node.This punishment is specially weight is deducted a very big fixed value OneWayPunishment.
B. when the direction in automobile steering and the path of a certain hypothesis through the INS data estimation differs greatly, carry out bigger punishment to this weight of supposing node.This punishment is specially weight is deducted a number, this number equal two angles difference square multiply by a COEFFICIENT K 1.
C. think that automobile has run to new path when a certain hypothesis, but through INS add up obtain in the distance of running on the original path during much smaller than the total length in original path, we will carry out less punishment to this weight of supposing node.This punishment is specially weight is deducted a number, and the path of not covering that this number equals to obtain according to the INS data is with respect to the COEFFICIENT K 2 that square multiply by of the ratio of total length.
S5, according to the weight deletion a part of hypothesis node of hypothesis node:
The hypothesis node that all are active sorts by weight from big to small.
Suppose only to allow to occur MaxActiveHypos active hypothesis node, then weighting weighs maximum MaxActiveHypos active hypothesis node, and deletes other nodes;
Suppose that many hypothesis trees at most only preserve the result in MaxHypoLength step, then begin back to travel through, fall surpassing the hypothesis knot removal that MaxHypoLength goes on foot from each live-vertex.MaxActiveHypos and MaxHypoLength are positive integer, and each the hypothesis node in the said branch is represented a step.
S6, select the maximum hypothesis node of weight to suppose node as the best, repeating step S1~S5 then, each is taken turns and can obtain a best hypothesis node, and the branch at this best hypothesis node place has write down the path locus that automobile is passed by.We can use this best hypothesis node; Come calculating optimum to suppose the degree of confidence of node with second largest hypothesis node of weight; Computing formula is following: belief=1-exp (secondweight-biggestweight); Wherein, secondweight representes the weight of the second largest hypothesis node of weight in all hypothesis nodes, and biggestweight representes the weight of the hypothesis node that weight is maximum.
Illustrate method of the present invention below.
As shown in Figure 5, suppose to have two four roads (being path above-mentioned) to form a crossroad, these four roads are respectively: OA, OB, OC, OD, intersection point are the O point.Fig. 5 a) in engrave drawn some during the t1-t5 of coordinate and represent automobile in the t1-t5 position that automobile belongs to constantly the time.To describe below and how begin, constantly upgrade many hypothesis trees according to gps data from t1.
The node of each many hypothesis tree all can comprise the numbering of road, and the direction on this road, walked of automobile.Suppose: (AO) the expression automobile is walked on this road of AO, and direction is by the direction running of A to O.If automobile is to go to A from O, then use (OA) to represent this node.
Step is following:
Suppose that automobile is walked on this road of AO at t1 constantly, direction is driven towards O from A, and the state of automobile is operation.
During the moment, the state of automobile has become acceleration at t2.According to the vehicle condition conversion table of Fig. 4, when automobile when running status is transformed into acceleration mode, automobile only generates a node, and direction is constant.
During the moment, the state of automobile has become and has stopped (waiting red light such as automobile) at t3.According to the vehicle condition conversion table, when automobile when acceleration mode is transformed into halted state, automobile only generates a node, and direction is constant.
During the moment, the state of automobile has become acceleration at t4.Learn according to the vehicle condition conversion table, when automobile when halted state becomes acceleration mode, will on all directions, generate corresponding hypothesis node.
During the moment, the state of automobile has become operation at t5.Learn according to the vehicle condition conversion table, when automobile when acceleration mode becomes running status, will on all directions, generate corresponding hypothesis node.But because in the present embodiment, the automobile crossroad of having passed by, so, only on original road of automobile and direction, generated the hypothesis node of a running status.
As shown in Figure 6; In experiment; On real electronic chart, carry out the resulting coupling path profile of method of the present invention; Map among the figure is depicted as Beijing international trade bridge, and near the beam the coupling path is a gps data, and method as can be seen from the figure of the present invention can guarantee the accuracy and the continuity of road matching well.
Above embodiment only is used to explain the present invention; And be not limitation of the present invention; The those of ordinary skill in relevant technologies field under the situation that does not break away from the spirit and scope of the present invention, can also be made various variations and modification; Therefore all technical schemes that are equal to also belong to category of the present invention, and scope of patent protection of the present invention should be defined by the claims.

Claims (3)

1.一种基于汽车状态转移的多假设地图匹配方法,其特征在于,包括以下步骤:1. A multi-hypothesis map matching method based on automobile state transition, is characterized in that, comprises the following steps: S1、获取全球定位系统GPS数据和惯性导航系统INS数据;S1. Acquire GPS data from the global positioning system and INS data from the inertial navigation system; S2、根据GPS数据和INS数据定义一颗多假设树,所述多假设树用于记录汽车走过的所有路径,其有一个根节点,所述根节点代表汽车的起始点;S2, define a multi-hypothesis tree according to GPS data and INS data, described multi-hypothesis tree is used for recording all paths that automobile walks, and it has a root node, and described root node represents the starting point of automobile; S3、在汽车每获得一次GPS数据时,在多假设树中生成新的假设节点;S3. When the car obtains GPS data once, a new hypothesis node is generated in the multi-hypothesis tree; S4、根据所述GPS数据和INS数据计算所述假设节点的权重,所述权重表示该假设节点包含的信息与真实信息的相似性;S4. Calculating the weight of the hypothetical node according to the GPS data and the INS data, the weight representing the similarity between the information contained in the hypothetical node and the real information; S5、根据假设节点的权重删除一部分假设节点;S5. Delete a part of hypothetical nodes according to the weight of the hypothetical nodes; S6、选择权重最大的假设节点作为最佳假设节点;S6. Select the hypothetical node with the largest weight as the best hypothetical node; 然后重复步骤S1~S5,每一轮获得一个最佳假设节点,该最佳假设节点所在的分支记录了汽车走过的路径轨迹;Then repeat steps S1-S5 to obtain a best hypothetical node in each round, and the branch where the best hypothetical node is located records the path track of the car; 在步骤S2中定义多假设树时,假设每个所述假设节点至少包含如下信息:When defining a multi-hypothesis tree in step S2, it is assumed that each of the hypothesis nodes contains at least the following information: 假设节点产生的时间;The time when the hypothetical node was generated; 汽车当前状态,该状态有四种:初始、停止、加速和运行,汽车当前状态通过INS数据计算获得;The current state of the car. There are four states: initial, stop, acceleration and running. The current state of the car is calculated through INS data; 汽车当前可能所在的路径link;The current possible path link of the car; 汽车在link上运行的方向;The direction the car is running on the link; 汽车在Δt时间内转过的角度,其通过INS数据获得;The angle that the car turns within Δt time, which is obtained through INS data; 汽车在Δt时间内走过的里程,其通过INS数据获得;The mileage traveled by the car within Δt time, which is obtained through INS data; 汽车当前的方向,其通过GPS数据和INS数据获得;The current direction of the car, which is obtained through GPS data and INS data; 汽车在link上走过的里程;The mileage traveled by the car on the link; 假设节点的权重;Assume the weight of the node; 假设节点的活跃性,代表汽车当前状态的假设节点称为活跃节点,代表汽车历史状态的假设节点称为非活跃节点;Assuming the activity of the node, the hypothetical node representing the current state of the car is called an active node, and the hypothetical node representing the historical state of the car is called an inactive node; 在步骤S2中以根节点为父节点,对每一条汽车可能所在的路径,生成两个路径相同但方向不同的假设节点,步骤具体包括:In step S2, with the root node as the parent node, for each possible path of the car, two hypothetical nodes with the same path but different directions are generated. The steps specifically include: S21,判断GPS数据的有效性,若GPS数据有效则执行如下的步骤,否则不进行初始化;S21, judging the validity of the GPS data, if the GPS data is valid, perform the following steps, otherwise do not initialize; S22,计算汽车当前状态;S22, calculating the current state of the vehicle; S23,以GPS坐标为圆心,以GPS的误差范围R为半径画一个圆,找到所有与该圆有交集的路径,这些路径都是汽车当前可能所在的路径link;S23, draw a circle with the GPS coordinates as the center and the GPS error range R as the radius, and find all the paths that intersect with the circle, and these paths are the current possible path links of the car; S24,针对每一条可能的路径link,都以根节点为父节点,生成两个代表该路径的假设节点,两个假设节点的方向相反,代表该路径的两个方向,这两个都可能是汽车当前状态,然后设置假设节点的其它信息;S24, for each possible path link, the root node is used as the parent node, and two hypothetical nodes representing the path are generated. The directions of the two hypothetical nodes are opposite, representing the two directions of the path, both of which may be The current state of the car, and then set other information of the hypothetical node; S25,把所述父节点设置为非活跃节点,把所生成的假设节点设置为活跃节点。S25. Set the parent node as an inactive node, and set the generated hypothetical node as an active node. 2.如权利要求1所述的基于汽车状态转移的多假设地图匹配方法,其特征在于,当第一次获得GPS数据时,根据所述GPS数据的有效标志位、精度以及卫星数量判断该数据是否有效,当再次获得GPS数据时,所述GPS数据的有效标志位、精度、卫星数量以及GPS数据与Δt前的GPS数据的距离差距来判断该数据是否有效。2. The multi-hypothesis map matching method based on automobile state transfer as claimed in claim 1, wherein, when the GPS data is obtained for the first time, the data is judged according to the effective flag position, precision and the number of satellites of the GPS data Whether it is valid or not, when the GPS data is obtained again, it is judged whether the data is valid according to the effective flag position, precision, satellite quantity and the distance gap between the GPS data and the GPS data before Δ t of the GPS data. 3.如权利要求2所述的基于汽车状态转移的多假设地图匹配方法,其特征在于,若以假设节点j为父节点生成新的假设节点,则步骤S3中生成新的假设节点的步骤具体为:根据所述假设节点j中表示的汽车状态和汽车当前状态生成新的假设节点。3. The multi-hypothesis map matching method based on automobile state transfer as claimed in claim 2, wherein if a new hypothetical node is generated as a parent node with hypothetical node j, the step of generating a new hypothetical node in step S3 is specifically To: generate a new hypothetical node according to the state of the vehicle represented in the hypothetical node j and the current state of the vehicle.
CN201010622517A 2010-12-28 2010-12-28 Multi-hypothesis map matching method based on vehicle state transition Expired - Fee Related CN102175253B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201010622517A CN102175253B (en) 2010-12-28 2010-12-28 Multi-hypothesis map matching method based on vehicle state transition

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201010622517A CN102175253B (en) 2010-12-28 2010-12-28 Multi-hypothesis map matching method based on vehicle state transition

Publications (2)

Publication Number Publication Date
CN102175253A CN102175253A (en) 2011-09-07
CN102175253B true CN102175253B (en) 2012-09-05

Family

ID=44518464

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201010622517A Expired - Fee Related CN102175253B (en) 2010-12-28 2010-12-28 Multi-hypothesis map matching method based on vehicle state transition

Country Status (1)

Country Link
CN (1) CN102175253B (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102011083375A1 (en) * 2011-09-26 2013-03-28 Robert Bosch Gmbh Method for transmitting route data for traffic telematics
CN103940435B (en) * 2014-05-04 2019-04-23 乔东江 The improving method of road-map, system and through its perfect road-map
CN104089619B (en) * 2014-05-14 2016-12-07 北京联合大学 The accurate matching system of GPS navigation map of pilotless automobile and operational approach thereof
CN105409306B (en) * 2014-06-11 2019-01-18 华为技术有限公司 Mobile terminal locations prediction technique and device
CN104034338B (en) * 2014-06-17 2017-08-29 百度在线网络技术(北京)有限公司 A kind of dynamic navigation method and device
CN109522385B (en) * 2018-11-22 2021-05-11 首都师范大学 A method for judging M-N matching mode of multi-scale road network
CN111191080B (en) * 2019-08-22 2021-04-30 腾讯科技(深圳)有限公司 Data processing method and device

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004226341A (en) * 2003-01-27 2004-08-12 Alpine Electronics Inc Map matching method
CN1710624A (en) * 2005-06-02 2005-12-21 上海交通大学 Method for Obtaining the Average Speed of Urban Road Network Traffic Flow Interval
CN101101214A (en) * 2006-07-03 2008-01-09 日本电气株式会社 Link setting system suitable for map matching, method and program thereof
CN101270997A (en) * 2007-03-21 2008-09-24 北京交通发展研究中心 Floating car dynamic real-time traffic information processing method based on GPS data
WO2009060776A1 (en) * 2007-11-06 2009-05-14 Mitsubishi Heavy Industries, Ltd. On-vehicle equipment for detecting traveling route

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004226341A (en) * 2003-01-27 2004-08-12 Alpine Electronics Inc Map matching method
CN1710624A (en) * 2005-06-02 2005-12-21 上海交通大学 Method for Obtaining the Average Speed of Urban Road Network Traffic Flow Interval
CN101101214A (en) * 2006-07-03 2008-01-09 日本电气株式会社 Link setting system suitable for map matching, method and program thereof
CN101270997A (en) * 2007-03-21 2008-09-24 北京交通发展研究中心 Floating car dynamic real-time traffic information processing method based on GPS data
WO2009060776A1 (en) * 2007-11-06 2009-05-14 Mitsubishi Heavy Industries, Ltd. On-vehicle equipment for detecting traveling route

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
柳林等.实时高精度地图匹配技术的研究与实现.《测绘科学》.2010,第35卷(第5期), *
王建钊等.一种近似推理的地图匹配算法.《计算机仿真》.2010,第27卷(第8期), *

Also Published As

Publication number Publication date
CN102175253A (en) 2011-09-07

Similar Documents

Publication Publication Date Title
CN102175253B (en) Multi-hypothesis map matching method based on vehicle state transition
JP7048517B2 (en) Map matching method and system
CN109416256B (en) Travel lane estimation system
CN106104656B (en) Map information generating systems, method and program
Hashemi et al. A critical review of real-time map-matching algorithms: Current issues and future directions
CN113126618B (en) Unmanned global path planning and re-planning method in cross-country environment
Jung et al. Monocular visual-inertial-wheel odometry using low-grade IMU in urban areas
CN103439731A (en) GPS/INS integrated navigation method based on unscented Kalman filtering
CN103777220A (en) Real-time and accurate pose estimation method based on fiber-optic gyroscope, speed sensor and GPS
CN103453913A (en) Integrated positioning method of vehicle in parking lot
CN107664993A (en) A kind of paths planning method
CN101900573B (en) Method for realizing landtype inertial navigation system movement aiming
CN105928529A (en) Map-matching algorithm for combining multiple evidences
Dogramadzi et al. Accelerated map matching for GPS trajectories
CN111412929A (en) A method for evaluating the performance of combined inertial navigation based on high-precision maps
KR20180068555A (en) System for positioning location information of car
JP2008077349A (en) Vehicle state quantity estimation device and vehicle steering control device using the device
CN114690231A (en) vehicle positioning method
CN114061597A (en) Vehicle map matching autonomous positioning method
CN115307628A (en) Map information simulation method, device and storage medium for integrated navigation positioning platform
CN112525207A (en) Unmanned vehicle positioning method based on vehicle pitch angle map matching
CN101545781A (en) Method for determining pulse equivalent of speedometer in on-board integrated navigation
Xi et al. Map matching algorithm and its application
JP7260668B2 (en) Method and Apparatus for Generating First Map
Kauffman et al. Navigation via H-field signature map correlation and INS integration

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
ASS Succession or assignment of patent right

Owner name: TSINGHUA UNIVERSITY

Effective date: 20131118

Owner name: WUXI APPLICATION TECHNOLOGY RESEARCH INSTITUTE OF

Free format text: FORMER OWNER: TSINGHUA UNIVERSITY

Effective date: 20131118

C41 Transfer of patent application or patent right or utility model
COR Change of bibliographic data

Free format text: CORRECT: ADDRESS; FROM: 100084 HAIDIAN, BEIJING TO: 214072 WUXI, JIANGSU PROVINCE

TR01 Transfer of patent right

Effective date of registration: 20131118

Address after: 214072 Jiangsu Province Road DiCui Binhu District of Wuxi City No. 100, No. 1 building, 530 floor 12

Patentee after: WUXI RESEARCH INSTITUTE OF APPLIED TECHNOLOGIES, TSINGHUA UNIVERSITY

Patentee after: Tsinghua University

Address before: 100084 Beijing Haidian District Tsinghua Yuan 100084-82 mailbox

Patentee before: Tsinghua University

CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20120905

Termination date: 20141228

EXPY Termination of patent right or utility model