阅读说明：本技术 一种车辆融合定位系统及方法 (Vehicle fusion positioning system and method ) 是由 马涛 于 2021-09-09 设计创作，主要内容包括：本发明为一种车辆融合定位系统,包括所述信息处理模块内存储车道线地图,同时能够接收各模块采集的测量信息,完成融合定位计算,将计算结果输出给智能驾驶车辆的其他系统；所述惯性测量模块,用于测量车辆的角速度和加速度信息；所述卫星导航信息接收模块,用于接收全球卫星导航系统卫星信息数据,并计算车辆的定位信息和/或伪距信息；所述轮速信息采集模块,用于采集车辆的车轮速度信息；所述车道线信息采集模块,用于采集当前车辆前方的车道线信息；同时还提供了一种车辆融合定位方法,能够有效的在城市复杂环境下的结构化道路上,利用静止的道路标线的绝对位置,消除融合定位的累积误差,保持智能车辆定位的准确性,计算量小,实时效果好。(The invention relates to a vehicle fusion positioning system, which comprises an information processing module, a positioning module and a positioning module, wherein the information processing module stores a lane line map, can receive measurement information acquired by each module, completes fusion positioning calculation and outputs a calculation result to other systems of an intelligent driving vehicle; the inertia measurement module is used for measuring the angular speed and acceleration information of the vehicle; the satellite navigation information receiving module is used for receiving satellite information data of a global satellite navigation system and calculating positioning information and/or pseudo-range information of a vehicle; the wheel speed information acquisition module is used for acquiring wheel speed information of a vehicle; the lane line information acquisition module is used for acquiring lane line information in front of the current vehicle; meanwhile, the vehicle fusion positioning method is provided, the accumulated error of fusion positioning can be eliminated by effectively utilizing the absolute position of the static road marking on the structured road under the urban complex environment, the positioning accuracy of the intelligent vehicle is kept, the calculated amount is small, and the real-time effect is good.)

1. A vehicle fusion positioning system, characterized by: the system comprises an information processing module, an inertia measurement module, a satellite navigation information receiving module, a wheel speed information acquisition module and a lane line information acquisition module;

the information processing module stores lane line maps, can receive measurement information collected by each module, completes fusion positioning calculation, and outputs calculation results to other systems of the intelligent driving vehicle;

the inertia measurement module is used for measuring the angular speed and acceleration information of the vehicle;

the satellite navigation information receiving module is used for receiving satellite information data of a global satellite navigation system and calculating positioning information and/or pseudo-range information of a vehicle;

the wheel speed information acquisition module is used for acquiring wheel speed information of a vehicle;

the lane line information acquisition module is used for acquiring lane line information in front of the current vehicle.

2. The vehicle fusion positioning system of claim 1, wherein the information processing module is one of a stand-alone computer and a microprocessor chip integrated circuit.

3. The vehicle fusion positioning system of claim 2, wherein the wheel speed information acquisition module acquires wheel speed information of at least one wheel.

4. The vehicle fusion positioning system of claim 3, wherein the lane line information acquisition module is a vision acquisition module or a lidar acquisition module.

5. A vehicle fusion positioning method comprises the following steps:

step 1, acquiring motion information of a vehicle through an inertia measurement module, a satellite navigation information receiving module and a wheel speed information acquisition module which are installed on an intelligent driving vehicle.

Step 2, the information processing module calculates the current position estimated value of the vehicle through a one-time fusion positioning process;

step 3, dynamically acquiring lane line information in front of the vehicle through a forward-mounted lane line acquisition module;

and 4, processing the acquired lane line information by the information processing module, identifying the lane line condition in front of the vehicle, calculating the relative distance between the vehicle and the lane line, and calculating the absolute position information or partial absolute position information of the vehicle according to the acquired specific condition of the lane line and the specific position of the lane line in the lane line map.

And 5, performing second fusion positioning calculation by using the absolute position information or part of the absolute position information calculated in the step 4 to obtain a corrected fusion positioning result and the correction amount of the system error, and finishing a cycle fusion positioning process.

6. The vehicle fusion positioning method according to claim 5, wherein the first fusion positioning process and the second fusion positioning process are both nonlinear filtering methods.

7. The vehicle fusion positioning method according to claim 6, wherein the nonlinear filtering method is one of a Kalman filtering method, a complementary filtering method and an extended Kalman filtering method.

8. The vehicle fusion positioning method according to claim 7, wherein the step 4 includes at least two cases when calculating the absolute position information or the partial absolute position information of the vehicle:

in the first situation, when the acquired lane line information is two lane lines on two sides of the front of the vehicle or one lane line on one side, the identified lane line distance is the distance between the vehicle and two or one of the two lane lines, and the current position estimation value of the vehicle and the absolute position of the lane line in a lane line map are calculated through a primary fusion positioning process, so that the current lane of the vehicle is calculated, and the absolute position of the position point of the vehicle in the longitudinal direction of the lane line is calculated;

and secondly, when the acquired lane line information has end points, two conditions that the lane line extends to the two sides of the vehicle from the end points facing the vehicle direction and the lane line extends to a far place from the end point away from the vehicle direction are included, the end point distance between the vehicle and the lane line is identified, the current position estimation value of the vehicle calculated through one-time fusion positioning process and the absolute position of the lane line in the lane line map are calculated, the position relation between the current position of the vehicle and the end points of the lane line is calculated, and the absolute position of the vehicle is further calculated.

Technical Field

The invention relates to the technical field of automatic driving, in particular to a vehicle fusion positioning system and method.

Background

In the vehicle positioning technology, a fusion positioning system formed by inertial navigation, satellite navigation and a wheel speed meter is a very general means, and satisfactory positioning performance can be obtained in many scenes. Compared with the single navigation equipment, the method has the advantages of complete autonomy, all weather and no interference of external information. However, the development of the automatic driving technology puts higher requirements on the performance of the fusion positioning system, the fusion positioning device needs to realize real-time uninterrupted full-scene centimeter-level positioning, and the fusion positioning device composed of inertial navigation, satellite navigation and a wheel speed meter is difficult to meet the requirements. Under the condition that satellite signals are lost for a long time, the positioning error of the inertial/wheel speed meter fusion positioning can be accumulated along with the increase of the driving mileage of the vehicle, so that the positioning result gradually deviates from the real position of the vehicle, and automatic driving cannot be continued. In order to solve the problem, the commonly adopted technical scheme includes technical means such as increasing map matching, increasing laser radar positioning, increasing visual navigation and the like or superposition of several means. However, continuous high-precision positioning of map matching requires that a driving route has obvious geometric characteristics, and the actual driving route of a vehicle is difficult to ensure the characteristic requirements; the relative positioning of the laser radar also has the problem of error accumulation, and the absolute positioning needs to be mapped in advance; the visual navigation also has the problem of error accumulation, the accumulated error can be eliminated only by the closed-loop path through loop-back verification, and the actual driving route of the vehicle is difficult to ensure the closed-loop path.

Disclosure of Invention

The invention aims to provide a vehicle fusion positioning system, and provides a fusion positioning system and a method based on inertia/satellite/wheel speed/lane line map in automatic driving. The method comprises the steps of further carrying out vehicle transverse positioning based on a road lane map near the coordinates of a current positioning point by combining current road lane line information acquired by an intelligent driving vehicle with positioning information of inertial navigation and satellite navigation and speed information of a wheel speed meter, so as to correct the accurate position of the current vehicle.

In order to achieve the purpose, the invention provides the following technical scheme: a vehicle fusion positioning system, characterized by: the system comprises an information processing module, an inertia measurement module, a satellite navigation information receiving module, a wheel speed information acquisition module and a lane line information acquisition module;

the information processing module stores lane line maps, can receive measurement information collected by each module, completes fusion positioning calculation, and outputs calculation results to other systems of the intelligent driving vehicle;

the inertia measurement module is used for measuring the angular speed and acceleration information of the vehicle;

the satellite navigation information receiving module is used for receiving satellite information data of a global satellite navigation system and calculating positioning information and/or pseudo-range information of a vehicle;

the wheel speed information acquisition module is used for acquiring wheel speed information of a vehicle;

the lane line information acquisition module is used for acquiring lane line information in front of the current vehicle.

The invention further provides that the information processing module is one of an independent computer and a microprocessor chip integrated circuit.

The invention is further configured such that the wheel speed information acquisition module acquires wheel speed information of at least one wheel.

The invention is further provided that the lane line information acquisition module is a visual acquisition module or a laser radar acquisition module.

The invention also provides a vehicle fusion positioning method, which comprises the following steps:

step 1, acquiring motion information of a vehicle through an inertia measurement module, a satellite navigation information receiving module and a wheel speed information acquisition module which are installed on an intelligent driving vehicle.

Step 2, the information processing module calculates the current position estimated value of the vehicle through a one-time fusion positioning process;

step 3, dynamically acquiring lane line information in front of the vehicle through a forward-mounted lane line acquisition module;

and 4, processing the acquired lane line information by the information processing module, identifying the lane line condition in front of the vehicle, calculating the relative distance between the vehicle and the lane line, and calculating the absolute position information or partial absolute position information of the vehicle according to the acquired specific condition of the lane line and the specific position of the lane line in the lane line map.

And 5, performing second fusion positioning calculation by using the absolute position information or part of the absolute position information calculated in the step 4 to obtain a corrected fusion positioning result and the correction amount of the system error, and finishing a cycle fusion positioning process.

The invention further provides that the first fusion positioning process and the second fusion positioning process are both nonlinear filtering methods.

The invention further provides that the nonlinear filtering method is one of a Kalman filtering method, a complementary filtering method and an extended Kalman filtering method.

The invention further provides that, when calculating the absolute position information or the partial absolute position information of the vehicle in step 4, at least the following two conditions are included:

in the first situation, when the acquired lane line information is two lane lines on two sides of the front of the vehicle or one lane line on one side, the identified lane line distance is the distance between the vehicle and two or one of the two lane lines, and the current position estimation value of the vehicle and the absolute position of the lane line in a lane line map are calculated through a primary fusion positioning process, so that the current lane of the vehicle is calculated, and the absolute position of the position point of the vehicle in the longitudinal direction of the lane line is calculated;

and secondly, when the acquired lane line information has end points, two conditions that the lane line extends to the two sides of the vehicle from the end points facing the vehicle direction and the lane line extends to a far place from the end point away from the vehicle direction are included, the end point distance between the vehicle and the lane line is identified, the current position estimation value of the vehicle calculated through one-time fusion positioning process and the absolute position of the lane line in the lane line map are calculated, the position relation between the current position of the vehicle and the end points of the lane line is calculated, and the absolute position of the vehicle is further calculated.

The invention comprises at least one of the following beneficial effects:

1. the method has the advantages that the absolute position of the static road marking can be effectively utilized on the structured road under the urban complex environment, the accumulated error of fusion positioning is eliminated under the condition that the satellite navigation signal is invalid, the positioning accuracy of the intelligent vehicle is kept, the calculated amount is small, and the real-time effect is good.

2. When the lane line map is used for carrying out position correction, a local search for a very large similar area on the map is not needed, and when the current lane line is stained and incomplete and cannot be completely subjected to image threshold segmentation, the method can still finish positioning error correction through the relative distance given by the lane line on one side, and has the advantages of good robustness and wide practical area.

Drawings

The accompanying drawings, which are included to provide a further understanding of the application and are incorporated in and constitute a part of this application, illustrate embodiment(s) of the application and together with the description serve to explain the application and not to limit the application. In the drawings:

FIG. 1 is a schematic block diagram of a vehicle fusion positioning system in embodiment 1 of the present invention

FIG. 2 is a flowchart of a vehicle fusion positioning method in embodiment 2 of the present invention

Fig. 3 is a schematic diagram 1 of the measurement of the distance between the vehicle and the lane line and the positioning of the vehicle in the lane line direction in embodiment 2 of the present invention.

Fig. 4 is a schematic view of vehicle positioning when a lane line in front of a vehicle has an end line in embodiment 2 of the present invention 2.

Detailed Description

The following detailed description of the embodiments of the present application will be provided with reference to the drawings and examples, so that how to implement the technical means for solving the technical problems and achieving the technical effects of the present application can be fully understood and implemented.

Example 1:

as shown in fig. 1, the present embodiment is a vehicle fusion positioning system, which includes an information processing module, an inertia measurement module, a satellite navigation information receiving module, a wheel speed information collecting module, and a lane line information collecting module;

the information processing module is communicated with other modules, can receive the measurement information acquired by each module, is stored with a lane line map, the lane line map is mainly a lane line map of a vehicle running area, but not only comprises the vehicle running area, but also can store a global lane line map, and meanwhile, the information processing module can obtain the lane line map of a nearby area in real time through the lane line information acquisition module, can also store and update the lane line map of the nearby area in real time, and has the functions of completing fusion positioning calculation after receiving the measurement information acquired by each module in real time and outputting the calculation result to other systems of the intelligent driving vehicle. The information processing module is one of an independent computer or a processor chip integrated circuit.

The positioning system also comprises the inertial measurement module, a positioning module and a control module, wherein the inertial measurement module is used for measuring the angular speed and acceleration information of the vehicle; the satellite navigation information receiving module is used for receiving satellite information data of a global satellite navigation system and calculating positioning information and/or pseudo-range information of a vehicle; the wheel speed information acquisition module is used for acquiring wheel speed information of a vehicle; the lane line information acquisition module is used for acquiring lane line information in front of the current vehicle. The wheel speed information acquisition module acquires wheel speed information of at least one wheel. I.e. it is possible to collect a single wheel or a plurality of wheels, the number of wheels being collected up to the vehicle category. The lane line information acquisition module is a visual acquisition module or a laser radar acquisition module.

Example 2:

based on the positioning system in embodiment 1, the present invention provides, in embodiment 2, a vehicle fusion positioning method, including the steps of:

step 1, acquiring motion information of a vehicle through an inertia measurement module, a satellite navigation information receiving module and a wheel speed information acquisition module which are installed on an intelligent driving vehicle.

Step 2, the information processing module calculates the current position estimated value of the vehicle through a one-time fusion positioning process; however, due to the fact that the environment seriously shields the antenna of the satellite navigation information receiving module, the satellite navigation information receiving module fails to work, and correct positioning information cannot be acquired, so that a certain deviation exists between a primary Kalman filtering fusion positioning result and the real position of the vehicle, and the following steps are required;

step 3, dynamically acquiring lane line information in front of the vehicle through a forward-mounted lane line acquisition module;

and 4, processing the acquired lane line information by the information processing module, identifying the lane line condition in front of the vehicle, calculating the relative distance between the vehicle and the lane line, and calculating the absolute position information or partial absolute position information of the vehicle according to the acquired specific condition of the lane line and the specific position of the lane line in the lane line map.

And 5, performing second fusion positioning calculation by using the absolute position information or part of the absolute position information calculated in the step 4 to obtain a corrected fusion positioning result and the correction amount of the system error, and finishing a cycle fusion positioning process.

Step 1 and step 3 may be performed simultaneously in the above steps;

the first fusion positioning process and the second fusion positioning process are both nonlinear filtering methods, wherein the nonlinear filtering method is one of a Kalman filtering method, a complementary filtering method and an extended Kalman filtering method.

In step 4, when the absolute position information or the partial absolute position information of the vehicle is calculated, at least the following two conditions are included:

in the first case, when the acquired lane line information is two lane lines on two sides of the front of the vehicle or one lane line on one side, the identified lane line distance is the distance between the vehicle and two or one of the two lane lines, and the current position estimation value of the vehicle and the absolute position of the lane line in the lane line map are calculated through one-time fusion positioning process, so that the current lane of the vehicle is calculated, and the absolute position of the vehicle position point in the longitudinal direction of the lane line is calculated, which can be referred to specifically as fig. 3;

the second situation, when the acquired lane line information has an end point, two situations that the lane line extends from the end point to the two sides of the vehicle facing the vehicle direction and the lane line extends from the end point to a far place away from the vehicle direction are included, the end point distance between the vehicle and the lane line is identified, the current position estimation value of the vehicle and the absolute position of the lane line in the lane line map are calculated through one-time fusion positioning process, the position relation between the current position of the vehicle and the end point of the lane line is calculated, and then the absolute position of the vehicle is calculated, and the specific situation is shown in fig. 4;

the method can effectively eliminate the accumulated error of fusion positioning on the structured road under the urban complex environment by using the absolute position of the static road marking under the condition of satellite navigation signal failure, keeps the accuracy of intelligent vehicle positioning, and has small calculated amount and good real-time effect. In addition, in the process of position correction by using the lane line map, a local search of a very large similar area in the map is not needed, and when the current lane line is stained and incomplete and cannot be completely subjected to image threshold segmentation, the method can still finish the correction of the positioning error through the relative distance given by the lane line on one side, and has good robustness and wide practical area.

As used in the specification and in the claims, certain terms are used to refer to particular components. As one skilled in the art will appreciate, manufacturers may refer to a component by different names. This specification and claims do not intend to distinguish between components that differ in name but not function. In the following description and in the claims, the terms "include" and "comprise" are used in an open-ended fashion, and thus should be interpreted to mean "include, but not limited to. "substantially" means within an acceptable error range, and a person skilled in the art can solve the technical problem within a certain error range to substantially achieve the technical effect.

While the foregoing description shows and describes several preferred embodiments of the invention, it is to be understood, as noted above, that the invention is not limited to the forms disclosed herein, but is not intended to be exhaustive of other embodiments, and is capable of use in various other combinations, modifications, and environments and is capable of changes within the scope of the inventive concept as expressed above, or as otherwise known in the relevant art. And that modifications and variations may be effected by those skilled in the art without departing from the spirit and scope of the invention as defined by the appended claims.