KR102101706B1 - System and method for improving accuracy of low-cost commercial GNSS reciver - Google Patents

Abstract

The present invention relates to a system for improving positioning accuracy of a low-cost commercial GNSS and to a method thereof. According to the present invention, an environmental sensor scanning around a vehicle and a precision map are used to correct coordinate information obtained from a low-cost GPS, so that the position accuracy can be improved in an autonomous driving vehicle environment.

Description

System and method for improving accuracy of low-cost commercial GNSS reciver using curb shape information and precision maps

The present invention relates to a system and method for improving positioning accuracy of a low-cost commercial GNSS, and more particularly, to a technology that can accurately locate a vehicle even in a lane unit even if a low-cost GPS is used.

In the field of smart cars or self-driving cars, a technology for accurately locating (locating) the location of the own vehicle is essential.

GNSS is used as the most widely used positioning system. GNSS (Global Navigation Satelite System) is a system that provides information on the position, altitude, and speed of objects on the ground using satellites, and the United States' Global Positioning System (GPS) is representative.

In the case of the widely used low-cost GPS, it is sufficient to determine the direction or location of the vehicle, and which road it is currently located on. However, in the case of a low-cost GPS, an error of about 2 meters occurs, and when the signal reception environment is poor, such as an urban area or mountainous area with many high-rise buildings, a large error of 7 meters or more may occur. Therefore, the low-cost GPS is difficult to use in an autonomous driving environment in which the driving lane must be classified. To this end, after mounting an expensive GPS module with high positioning accuracy, a technology demonstration of an autonomous vehicle may be demonstrated, but it is difficult to commercialize it because the price of an expensive GPS is equivalent to 30 million to 100 million won.

On the other hand, a conventional technique related to positioning of a vehicle is Korean Patent Registration No. 10-1752342 (2017.06.23. 'Vehicle Positioning Method').

The present invention has been devised to solve the problems of the prior art as described above, by enabling the environment information to scan the vehicle surroundings and precision map to correct the coordinate information obtained from the low-cost GPS, autonomous vehicle environment The aim is to provide a technique that can improve the positioning accuracy in.

A system for improving positioning accuracy according to the present invention for achieving the above object includes: an environmental sensor that scans a vehicle surroundings and recognizes an object; A GPS module for obtaining GPS coordinate information; Position correction means for updating and outputting the GPS coordinate information by using the curve information of the curb according to the scan data of the environmental sensor and the curve information of the curb extracted from the precision map corresponding to the coordinates obtained from the GPS module; And object classification means for determining whether the object recognized by the environmental sensor is fixed and moved.

Here, the position correction means, a map data extracting unit for extracting the precision map data corresponding to the GPS coordinate information obtained from the GPS module from the precision map DB; A road information extraction unit for extracting the curb shape of the curb from the object recognized by the environment sensor, or extracting the curb shape of the curb located on the driving path of the vehicle from the extracted precision map data; Convert the first curve for the curve shape of the curb extracted from the road information extraction unit into a third order equation on the coordinate system based on the vehicle, and GPS the second curve for the curve shape of the curb extracted from the precision map data A curve information acquisition unit that converts the cubic system to a cubic system based on coordinates; A correction information generation unit generating coordinate correction information by applying an ICP algorithm so that curves on different coordinate systems converted by the curve information acquisition unit match; And a location updater that updates location information by reflecting the coordinate correction information to the GPS coordinate information.

In addition, the object classification means, a feature point extraction unit for extracting a feature point from the object recognized by the environmental sensor; An area calculation unit repeatedly calculating an area of a triangle consisting of three characteristic points with a parallax through a relative coordinate system of the characteristic points extracted from the characteristic point extraction unit; A change rate confirmation unit that checks a change rate of the triangular area calculated by the area calculation unit; And a determining unit for distinguishing the fixed object and the moving object according to the result of checking the change in the triangular area of the change rate checking unit.

In addition, the object identification means, vehicle movement confirmation unit for confirming whether or not the vehicle stops further comprises; the determination unit is first fixed object and when the vehicle is confirmed to be stopped through the vehicle movement confirmation unit The moving object is classified, but when the area change rate of the triangle is less than the reference, objects for three feature points are determined as fixed objects. Then, when it is confirmed through the vehicle movement confirmation unit that the vehicle is not in a stopped state, the feature point extraction unit The determination unit extracts two feature points from the feature points of the object determined as fixed objects, and one feature point of the object to be determined, and the area calculation unit determines the area of the triangle consisting of two fixed feature points and one feature point to be determined. If the area change rate is confirmed to be lower than the reference in the change rate confirmation unit, the determination unit attempts to determine When the confirmation an object to a fixed object, and not less than the area rate of change based on confirmation by the confirmation unit the rate of change can be determined for the object to be determined the determining section to the mobile object.

On the other hand, the method for improving positioning accuracy according to the present invention for achieving the above object is a step (a) of recognizing an object by scanning the vehicle surroundings through an environmental sensor; (B) obtaining GPS coordinate information; Updating and outputting the GPS coordinate information by using the curb information of the curb according to the scan data of the environmental sensor and the curb information extracted from the precision map corresponding to the coordinates obtained from the GPS module; And (d) determining whether the object recognized by the environmental sensor is fixed and moved.

Here, the step (c), (c-1) step of extracting the precision map data corresponding to the GPS coordinate information obtained in the step (b) from the precision map DB; Step (c-2) of extracting the curb shape of the curb from the object recognized by the environmental sensor, and converting the first curve for the curb shape into a cubic equation based on the vehicle; Based on the GPS coordinates, the curvature of the curb located on the driving route of the vehicle is extracted from the precise map data extracted in the step (c-1), and the second curve for the curvature of the curb extracted from the precise map data is based on GPS coordinates. (C-3) converting to a cubic equation on the coordinate system; (C-4) generating coordinate correction information by applying an ICP algorithm such that curves on different coordinate systems converted in steps (c-2) and (c-2) are matched; And (c-5) updating location information by reflecting the coordinate correction information to the GPS coordinate information.

In addition, step (d) may be performed prior to step (c), and step (d) includes: (d-1) step of recognizing a plurality of objects through the environment sensor; (D-2) extracting feature points from the recognized object; Step (d-3) of repeatedly calculating an area of a triangle consisting of three feature points with a parallax through the relative coordinate system of the extracted feature points; And (d-4) step of distinguishing the fixed object and the moving object according to the area change rate of the triangle; may include.

In addition, the (d-5) step (d-5) to first check whether the vehicle is stopped before the (d-1) step further includes; and, in the (d-5) step, if the vehicle is in a stopped state, the ( Steps d-1) to (d-3) are performed, and in step (d-4), objects for three feature points can be determined as fixed objects when the area change rate of the triangle is less than a reference.

In addition, in step (d-5), if the subject vehicle is not in a stopped state, steps (d-1) to (d-3) are performed, but three feature points extracted in step (d-3) Two of the feature points are feature points for the fixed object determined through step (d-4), and the other one is a feature point for the object to be determined, and the area change rate of the triangle in step (d-4) is If it is less than the reference, the object to be determined may be determined as a fixed object, and when the area change rate of the triangle is more than the reference, the object to be determined may be determined as a moving object.

According to the present invention, even if a low-cost GPS module is mounted, it is possible to check errors in GPS coordinates by using riders and precision map data, and correct location data by correcting GPS coordinate information by the identified errors. Therefore, it is possible to accelerate the commercialization of autonomous vehicles by improving location accuracy at a low price in the field of autonomous vehicles.

In addition, in order to correct the GPS coordinate information including the error, the curbstone included in the precision map data must be scanned and analyzed through the rider, and it is possible to accurately determine the curbstone as a fixed object through the object classification means, so that it is similar to the curbstone. Errors can be eliminated by applying the correction algorithm through the moving object of.

That is, the position correction means must first accurately identify the shape of the curb among the objects scanned through the lidar. If a moving object having a shape similar to the curb is judged as a curb, an error may occur when generating correction information. Accordingly, in the present invention, the possibility of an error when applying a correction algorithm can be prevented by recognizing a curb after excluding a moving object from the scan data of the lidar through the object classification means.

1 is a block diagram illustrating a positioning accuracy improvement system according to an embodiment of the present invention.
Figure 2 is a block diagram for explaining the position correction means in the positioning accuracy improvement system shown in Figure 1;
3 is a block diagram for explaining the object classification means in the positioning accuracy improvement system shown in FIG.
4 is a flowchart illustrating a method for improving positioning accuracy according to an embodiment of the present invention.
5 is a view for explaining a first curve for a curb shape recognized in an actual vehicle location and a second curve for a curb shape extracted based on a location obtained through a GPS module.
6 is a flowchart for explaining a method of classifying a fixed object and a moving object.
7 is a flow chart for explaining the process of determining a fixed object in the stopped state of the own vehicle.
8 is a flow chart for explaining a process of distinguishing a fixed object from a moving object in a moving state of the own vehicle.
9 is a view for explaining an area change between three fixed objects.
10 is a view for explaining an area change between two fixed objects and one moving object.

Hereinafter, preferred embodiments of the present invention will be described with reference to the accompanying drawings. However, some components irrelevant to the subject matter of the invention will be omitted or compressed, but the omitted components are not necessarily required in the present invention, and may be used in combination with those skilled in the art to which the present invention pertains. You can.

1 is a block diagram illustrating a positioning accuracy improving system according to an embodiment of the present invention. The positioning accuracy improving system 100 grasps the exact position of the magnetic vehicle 10 and tracks the direction of travel, and also precisely tracks whether the objects around the magnetic vehicle 10 are fixed or moved. The positioning accuracy improvement system 100 includes an environmental sensor, a GPS module 120, a position correction means 130, an object classification means 140, and an object tracking unit 150. In addition, each component of the positioning accuracy improving system 100 is mounted on the vehicle 10, and each component may be integrated into a hardware configuration, or may be composed of individual hardware and interlocked with each other. Also, some components of the positioning accuracy improving system 100 may be designed in software.

The environment sensor is provided to recognize objects by scanning or photographing objects around the vehicle 10 and acquiring and processing data. As an environmental sensor, a laser scanner, a radar, a lidar, a camera, and the like may be used, and in this embodiment, an example in which the lidar 110 is used as an environmental sensor will be illustrated and described.

The GPS module 120 is provided to receive GPS signals through satellites and process data to obtain coordinate information. Coordinate information obtained through the GPS module 120 includes a longitude value and a latitude value, and may further include altitude information according to the implementation.

The GPS module 120 used in the positioning accuracy improving system 100 according to an embodiment of the present invention is a low-cost product, and thus the obtained coordinate information may have an error. Of course, even if there are some errors, it is possible to sufficiently check on which road, etc., but in order to accurately determine which lane 161 is driving, it is necessary to grasp more precisely.

The position correction means 130 is provided to correct the error of the coordinate information obtained from the GPS module 120 using the data scanned through the lidar 110 to update the coordinate information of the GPS signal.

The object classification means 140 is provided to determine whether objects around the vehicle 10 are fixed objects or moving objects.

The object tracking unit 150 uses the coordinate information updated and output by the position correction means 130 to track the exact position change and the moving direction of the own vehicle 10, or to accurately track the objects around the own vehicle 10 It is prepared to.

FIG. 2 is a block diagram illustrating the position correction means 130 in the positioning accuracy improvement system 100 shown in FIG. 1. 2, the location correction means 130 includes a road information extraction unit 131, a curve information acquisition unit 132, a map data extraction unit 133, a correction information generation unit 134, and a location update unit ( 135) and the precision map DB (136).

The road information extraction unit 131 is provided to recognize curbs from the scan data of the lidar 110. In addition, the road information extraction unit 131 is provided to extract the curb shape using the precision map data extracted from the map data extraction unit 133, which will be described below.

The curve information acquisition unit 132 is provided to extract curve information about the curb shape extracted by the road information extraction unit 131. That is, the curve information acquisition unit 132 acquires curve information for the curb shape recognized from the scan data of the lidar 110 and curve information for the curb shape extracted from the precision map data. The curve information acquisition unit 132 converts the curve information for the curb shape extracted from the scan data of the lidar 110 into a cubic equation based on the own vehicle, and also GPS the curve information for the curb shape extracted from the precision map data. Convert it to a cubic equation based on coordinates.

The map data extraction unit 133 is provided to extract map data near the coordinates from the precision map DB 136 based on the coordinate information acquired through the GPS module 120.

The precision map DB 136 is a database that stores precision maps. The precision map can be expressed in detail up to the lane unit, and further includes detailed information such as traffic lights, signs, road marks, road facilities, buildings, curbs, and the like. The precision image image stored in the precision map DB 136 is a collection of numerous points, and each point has three-dimensional absolute coordinates such as latitude and longitude.

The correction information generating unit 134 is provided to generate coordinate correction information for correcting the coordinate information obtained from the GPS module 120 correctly. The correction information generation unit 134 generates correction information and performs verification by applying an Iterative Closest Point (ICP) algorithm using curve information having different standards (different origins) in the curve information acquisition unit 132. do.

The location update unit 135 updates the coordinate information of the GPS signal obtained from the GPS module 120 using the coordinate correction information generated by the correction information generation unit 134. That is, correct coordinate information is output by reflecting coordinate correction information to incorrect coordinate information.

When the coordinate information corrected by the location update unit 135 is output, the object tracking unit 150 may track the state of the own vehicle 10 using a Kalman filter.

The position correction means 130 described above will be further embodied from the description of the object tracking method through improvement of position accuracy, which will be described with reference to FIG. 4 below.

3 is a block diagram for explaining the object classification means 140 in the positioning accuracy improvement system 100 shown in FIG. 1. 3, the object classification means 140 includes a vehicle movement confirmation unit 141, a feature point extraction unit 142, an area calculation unit 143, a change rate confirmation unit 144, and a determination unit 145. . The object classification means 140 determines whether a specific object is fixed and moved through the scan data of the lidar 110, and outputs the determination result to the object tracking unit 150 to accurately track the fixed object or the moving object. To make.

The vehicle movement confirmation unit 141 is provided to check whether the own vehicle 10 is in a stopped state or a moved state. For example, the vehicle movement confirmation unit 141 analyzes coordinate information obtained from the GPS module 120 to check whether the vehicle 10 is moving, or obtains related information from an ECU, etc. of the vehicle 10, and checks the movement. You can.

The feature point extracting unit 142 is provided to recognize feature objects such as corners or vertices of the corresponding object when the object is recognized through the lidar 110.

The area calculation unit 143 is provided to calculate the area of the triangle consisting of three selected feature points among the feature points extracted from the feature point extraction unit 142.

The change rate checking unit 144 is provided to check the change rate of how much the area of the triangle calculated according to the time difference changes when the area calculation unit 143 calculates the triangle area of the same feature points with a time difference.

The determination unit 145 is provided to determine whether a specific object is a fixed object or a moving object according to the confirmation result of the change rate confirmation unit 144 and output the result.

The object classification means 140 described above will be further clarified by a method of classifying a fixed object and a moving object, which will be described with reference to FIGS. 6 to 10 below.

4 is a flowchart illustrating a method for improving positioning accuracy according to an embodiment of the present invention. That is, in the positioning accuracy improvement system 100 shown in FIGS. 1 and 2, the position correction means 130 updates the coordinate information including the error obtained from the GPS module 120 with correct coordinate information, and then the vehicle 10 ) Is about the process of tracking the status.

First, in order to correct the GPS coordinate information, the vehicle surroundings are scanned through the lidar 110 and the shape of the curb is recognized by the road information extraction unit 131 <S405>. Lidar is a device capable of accurately measuring the distance and direction to a target object by firing a high-power pulse laser with high linearity instead of radio waves and receiving the light reflected from the target object.

The lidar 110 may include an optical unit such as a lens, a laser emitting / receiving unit, a laser driving unit, a processor that processes a laser signal, and the like. Using the lidar 110, high-precision data in the form of a point cloud (point cloud), which is a set of points, can be secured, and three-dimensional points reflecting width, distance, and height are gathered together to extract shape data of objects. I can do it. Due to this feature of the lidar 110, the lidar 110 is essentially mounted for object recognition in an autonomous vehicle.

When the data is scanned through the lidar 110, the road information extraction unit 131 analyzes the scan data to recognize the curb shape, and extracts the first curve information, which is a curve formed by the curb <S410>.

Referring to Figure 5 for a moment. 5 is a view for explaining a first curve for a curb shape recognized in an actual vehicle location and a second curve for a curb shape extracted based on a location obtained through a GPS module.

As shown in Fig. 5, a curb is provided at the border of the road to separate the road from the sidewalk. The curbstone is continuously installed along the road boundary at a height of approximately 25 cm, and the virtual curve generated by connecting the corners of these curbs is the first curve 163. That is, the road information extraction unit 131 analyzes the shape of each object from the scan data of the lidar 110 and then connects the corners of the curb to generate the shape of the first curve 163, and then obtains the curve information acquisition unit ( 132) converts information about the first curve 163 into a cubic equation based on the position 11R of the actual vehicle 10 as an origin.

Thereafter, the GPS module 120 receives a GPS signal and processes the signal to obtain GPS coordinate information <S415>. Since the GPS module 120 applied in the present invention is a low-cost type, the acquired GPS coordinate information may have an error. That is, referring to FIG. 5, the location according to the obtained GPS coordinate information is indicated by reference numeral 11G, which is adjacent to the location 11R of the actual vehicle 10, but has a different direction and a different direction of travel due to an error. have.

When the GPS module 120 obtains the coordinate information, the map data extracting unit 133 extracts map data of a nearby area corresponding to the GPS coordinate information from the precision map DB 136 <S420>. The precision map data stored in the precision map DB 136 is very large, and the map data extraction unit 133 extracts only map data in a reference area using GPS coordinate information.

Subsequently, the road information extraction unit 131 acquires information on the curb shape from the precision map data extracted by the map data extraction unit 133 <S425>.

That is, although the coordinate information obtained from the GPS module 120 is different from the actual vehicle location, it is certain that it is adjacent coordinates. It is also possible to acquire the direction of travel through the GPS coordinates acquired over a time difference. Accordingly, the road information extraction unit 131 may acquire curb information located in the forward direction of the extracted precision map data, and the curve information acquisition unit 132 may obtain information about the second curve 165 for the curb shape. Is converted to a cubic equation using GPS coordinates (11G) as the origin <S430>.

As can be seen through Figure 5, the road information extracting unit 131 obtained the cubic equations for the two curves (163, 165), each curve (163, 165) is located on a different coordinate system. That is, the first curve 163 is formed in the xy-axis coordinate system, where the position 11R of the actual vehicle 10 is the origin, but the direction of travel of the actual vehicle 10 is the y-axis and the direction perpendicular to this is the x-axis. do. In addition, the second curve 165 is in the x'-y 'axis coordinate system, where the GPS coordinates (11G) with errors are the origin, and the direction of error is the y' axis, and the vertical direction is the x 'axis. Is formed. Here, the axis unit of the xy-axis coordinate system generated based on the data of the lidar 110 is a distance unit (for example, a meter), and the axis unit of the x'-y 'axis coordinate system generated using precision map data and GPS coordinate information is It can be in latitude and longitude units. Therefore, the curve information acquisition unit 132 converts the axis units of the x'-y 'axis coordinate system into distance units.

Subsequently, the correction information generation unit 134 generates correction information for the GPS coordinate information by applying an Iterative Closest Point (ICP) algorithm using curves 163 and 165 formed on two different relative coordinate systems <S435> do.

The Iterative Closest Point (ICP) is an algorithm for matching with a minimum error when there is an error between the data scanned through the lidar 110 and the already constructed precision map-based data. That is, it is to repeat the process of scale conversion, rotation, and movement to match the measurement data and the construction data to minimize errors, so that matching is achieved.

If the correction information generation unit 134 rotates and moves any one of the two relative coordinate systems through the ICP algorithm so that the two curves 163 and 165 match (maximum overlap), the It is possible to know the difference (Δx, Δy, Δα) between the origins 11G and 11R. In this way, the difference between the origins (11G, 11R) of the two relative coordinate systems obtained through the ICP algorithm becomes coordinate correction information.

When the coordinate correction information is generated by the correction information generating unit 134, the location update unit 135 may update the coordinate information of the GPS signal by reflecting the correction information in the GPS coordinate information (S440). That is, the coordinate information obtained from the GPS module 120 was the location of 11G, but when the coordinate correction information is reflected, it is updated and output with the location information of 11R. That is, the location information of the actual vehicle 10 is output. This can correct the coordinate error in real time by reflecting the received signal of the GPS module 120 that is received later. Of course, the error rate can also be changed from time to time, so the previous process is repeated over a period of time to ensure that the latest correction information is always reflected.

Here, Δx and Δy included in the coordinate correction information are distance units (for example, meters), and the real-time acquired GPS coordinate information to reflect the coordinate correction information is a latitude and longitude unit. Accordingly, the location update unit 135 converts the coordinate correction information into latitude and longitude units and reflects the obtained GPS coordinate information in real time.

When the GPS coordinate information corrected by the location update unit 135 is output, the object tracking unit 150 tracks the object (where the object refers to its own vehicle 10) using the accurately corrected coordinate information <S445 > At this time, the object tracking unit 150 tracks the state of the vehicle 10 using a Kalman Filter. The Kalman filter repeatedly performs state prediction and measurement update to estimate the current state of the vehicle 10 and subsequent motion.

As described above, according to the present invention, even if the low-cost GPS module 120 is mounted, it is possible to check the error of the GPS coordinates by using the rider 110 and the precision map data, and correct the GPS coordinate information by the identified error. Accurate location data can be secured. Therefore, the positioning accuracy improvement system 100 can be applied at a low price in the field of autonomous vehicles, which can accelerate the commercialization of autonomous vehicles.

On the other hand, looking at the process of generating the correction information of the position correction means 130, it is necessary to accurately recognize the curb from the data scanned through the lidar 110. That is, the road information extraction unit 131 analyzes the shape of each object from the scan data of the lidar 110 and recognizes an object having a continuous curved shape as a curb. However, when a moving object similar to a curb shape is located around the vehicle 10, there is a possibility that a moving object other than the curb is mistaken for a curb.

To this end, the road information extraction unit 131 of the position correction means 13 analyzes the scan data, and even if the object has a curb-shaped curve, the height is the standard (the height of the curb is usually 25 cm, so it can be caught based on 50 cm). Ex), it may be determined that the object is not a curb.

Also, even if the height does not exceed the standard, there may be cases in which other objects of a continuous shape are recognized. This is the case, for example, when many bicycles are grouping along the road. In this case, there is a possibility that the curve connecting the same points on the bicycle is mistaken for a curb shape. Therefore, the positioning accuracy improvement system 100 according to the present invention, when recognizing the curb form in the road information extraction unit 131 of the position correction means 130, can completely exclude the moving object and recognize the curb form among the fixed objects. To make. The determination of the distinction between the moving object and the fixed object is made in the object classification means 140.

Hereinafter, a process of classifying a fixed object and a moving object through FIGS. 6 to 10 will be described in detail.

6 is a flowchart illustrating a method of classifying a fixed object and a moving object according to an embodiment of the present invention. That is, the object classification means 140 of the positioning accuracy improvement system 100 shown in FIGS. 1 and 3 is for a process of recognizing an object and determining whether it is moved / fixed.

First, in order to determine whether it is fixed or moved, an object is recognized through the rider 110 <S605>. After recognizing the object through the lidar 110, the feature point extracting unit 142 extracts the feature points of each object <S610>. The data acquired through the lidar 110 is a set of points having information on distance and direction. By filtering the set of these points, you can distinguish the face or edge of a specific object, and also the vertices where the edges meet. The feature point may be a point that can be used as a reference in the object, for example, a vertex where specific edges meet.

After the feature points are extracted from the feature point extractor 142 through the data scanned through the lidar 110, and the feature points for multiple objects are extracted <S610>, the feature point extractor 142 determines three feature points among the multiple feature points, The area calculation unit 143 calculates an area of a triangle consisting of three feature points (S615).

That is, each feature point has distance and direction information based on the own vehicle 10. Therefore, the feature points can be placed on the relative coordinate system based on the own vehicle 10, and the area calculating unit 143 can calculate the area of the triangle through the coordinate information. If the coordinate information of the three points is known in plane coordinates or spatial coordinates, the area of the triangle having three points as the vertices can be obtained by a predetermined formula.

At this time, the area calculation unit 143 does not calculate the area of the triangle only once, but repeats several times (for example, 10 times) for the scanned data over a time difference to calculate the triangle area of the same feature points. When the triangular area for the same feature points is calculated with the time difference in this way, the area change rate can be checked by the rate of change confirmation unit 144, and the determination unit 145 is determined according to the area change rate of the triangle checked by the rate change unit 144. The fixed object and the moving object are classified <S620>.

That is, if the area change rate of the triangle is less than a predetermined criterion, the determination unit 145 determines that all objects corresponding to the three feature points are fixed objects, and if it is more than the reference object, the object corresponding to at least one feature point is a moving object. It is judged.

Of course, in order to determine the correct fixation / movement, it is necessary to calculate for different objects, not the area change rate between the same objects, and thus, it is possible to verify whether the fixation / movement object is correct through cross check <S625>.

In the present invention, in order to accurately determine the fixed / moving object, the fixed object is first determined in the state where the vehicle 10 is stopped, and then, when the vehicle 10 is moved, it is verified whether a specific object is fixed or moving. This will be described with reference to FIGS. 7 and 8.

7 is a flowchart for explaining a process of determining a stationary object in a stopped state of the own vehicle. The vehicle movement confirmation unit 141 receives the speed information of the vehicle 10 in real time in connection with an ECU, etc., and confirms whether the vehicle 10 is being stopped through this (S705). Of course, whether the vehicle 10 is stopped may be checked through a GPS signal.

If it is confirmed that the vehicle 10 is stationary, <S710>, the periphery of the own vehicle 10 is scanned through the lidar 110 and a plurality of objects are recognized <S715>. Also, the feature point extraction unit 142 extracts the feature points from a plurality of objects recognized by the lidar 110 <S720>.

Thereafter, the feature point extracting unit 142 randomly extracts three feature points from the plurality of feature points, and the area calculating unit 143 calculates an area of a triangle consisting of three feature points. At this time, the area calculation unit 143 repeats several times (for example, 10 times) for the scanned data over a time difference to calculate a triangular area of the same feature points, and the change rate confirmation unit 144 is calculated with the time difference from the area calculation unit 143 Check the area change rate of the triangle <S725>.

That is, it is checked whether the area change rate of the triangle shows a reference change rate, for example, a change rate of less than 10%, and if it shows a change rate of less than 10%, the determination unit 145 fixes all objects corresponding to the three feature points Confirm as an object.

If the area change rate of the triangle shows more than the reference (10%), it means that at least one of the objects corresponding to the three feature points is a moving object. However, since it is impossible to accurately determine which object is currently moving, the process of scanning the new lidar 110 data and extracting new feature points is repeated.

That is, in the process of FIG. 7, rather than confirming what the moving object is, the surrounding area is scanned while the vehicle 10 is stopped, and the area change rate of the triangle consisting of the feature points of the three randomly extracted objects is checked to determine the fixed object. It is a process to determine what is. Therefore, in the process of FIG. 7, it is not meaningful to determine what the moving object is.

Through the process of FIG. 7, if it is determined whether a fixed object for several objects is in a state where the vehicle 10 is stopped, then it is possible to accurately determine whether a specific object is fixed / moved when the vehicle 10 is driving. . The process for this will be described with reference to FIG. 8 as follows.

The vehicle movement confirmation unit 141 checks whether the vehicle 10 is stopped <S805>, and if it is still stopping, performs the process of determining the fixed object again through the process of FIG. 7, and if it is not moving, If it is confirmed < S810 >, the object is recognized through the scan of the lidar 110 <S815>, and then the feature point extraction unit 142 extracts the feature points.

At this time, the feature point extracting unit 142 does not extract feature points for 3 random objects, but is determined in a stationary state through the process of FIG. 7, that is, a new object to determine whether it is fixed object or fixed object or moving. One feature point of the object is extracted <S820>. Here, the object to be determined may be a newly recognized object in this process, or an object that is not accurately identified as a fixed object or a moving object in the process of FIG. 7. That is, it is intended to make a judgment by matching an object with a fixed / moving object with two objects with a fixed fixed object.

After the three feature points are extracted (fixed 2, the object to be judged 1), the area calculating unit 143 calculates the area of the triangle consisting of the three characteristic points several times over a time difference, and the rate of change checking unit 144 is the area calculating unit 143 Check the rate of change of the triangle area calculated in) (S825).

If it is confirmed that the area change rate of the triangle is less than the reference (10%) <S830>, the determination unit 145 determines the object to be determined as a fixed object <S835>.

That is, if the magnetic vehicle 10 is in a moving state, even if it is a fixed object, the relative coordinates of the magnetic vehicle 10 are different. However, the area of the triangle formed by three fixed points on the relative coordinate system will not change. Accordingly, if there is no change in the area of the triangle formed by the two feature points that have been confirmed to be fixed and one feature point to be determined regardless of whether the own vehicle 10 is moving, the object corresponding to one of the feature points to be determined is a fixed object. Im sure.

On the other hand, if it is determined that the area change rate of the two feature points of the fixed object and one feature point of the object to be judged is greater than or equal to the reference, the determination unit 145 determines the object to be determined as the moving object <S840>. When the moving object is determined in this way, the object tracking unit 150 may intensively track the object. In addition, when the fixed object is determined by the determination unit 145, the determined result is provided to the location correction means 130, and accordingly, the road information extraction unit 131 of the location correction means 130 generates a specific object for generating correction information. When extracting the feature points of, only the feature points for the fixed object included in both the scan data and the precision map data of the lidar 110 can be extracted.

9 and 10 are conceptual diagrams for explaining a change in area of a triangle formed by objects. First, referring to FIG. 9 (a), the first object 210, the second object 220, and the third object 230 can be recognized by scanning the rider 110 of the own vehicle 10. The feature point extraction unit 142 extracts the feature points 1-1 (211), the feature points 2-1 (221), and the feature points 3-1 (231) from each object, and then the area calculation unit (143) has three feature points (211,221,231). You can check the area of the triangle with a) as the vertex.

If the magnetic vehicle 10 moves as shown in FIG. 9 (b), the relative coordinates for the three feature points 211,221,231 are also changed. However, if the three feature points (211,221,231) are in a fixed state, it can be confirmed that even if the magnetic vehicle 10 is moving, the area of the triangle formed by the three feature points (211,221,231) does not change.

On the other hand, in the case of a triangular area connecting two feature points 211 and 221 that are fixed or not and a feature point 4-1 (241) of the fourth object 240 to be determined as shown in FIG. As shown in b), it can be seen that the area of the triangle changes as the fourth object 240 moves. Here, if the two feature points 211 and 221 are fixed or not, the fourth object 240 corresponding to the feature point 4-1 241 can be determined to be a moving object regardless of whether the own vehicle 10 moves. .

According to the object classification means 140 and the object classification method of the positioning accuracy improvement system 100 according to the present invention, the feature points are extracted from three different objects through the lidar 110 and the magnetic vehicle 10 is referenced. The accuracy is high by classifying the fixed object and the moving object according to the area change rate of the triangle formed by the three feature points according to the relative coordinate system.

That is, in the conventional method of classifying moving objects according to the relative speed, when the magnetic vehicle 10 and the relative object move at the same speed in the same direction, there are cases in which the moving object is mistaken for a fixed object even though it is a clear moving object. Since the fixed object is determined and it is determined whether the moving object is a moving object according to the area change rate of the triangle formed by the two fixed objects and the object to be determined, the fixed object is fixed even when the own vehicle 10 is moving. It is possible to accurately determine whether it is moving.

On the other hand, the determination unit 145 has been described through the process of FIG. 7 to determine that all the objects are fixed objects when the area change rate of the triangle consisting of three feature points is less than the reference. At this time, additional conditions for more accurately determining the fixed objects You can also add more. That is, it is determined whether the object is a fixed object by considering height information.

In general, fixed objects such as signs, traffic lights, street trees, buildings, etc. often have a topmost point of more than 3 meters from the ground. On the other hand, moving objects such as automobiles (excluding some vehicles 10), bicycles, and pedestrians are often less than 3 meters.

Therefore, even if the area change rate is less than the reference in the process of FIG. 7, the height of the object, more specifically, the height of the feature point extracted from the object is determined as a fixed object only when the height is greater than the reference height (for example, 3 meters), and is less than the reference height If it is, it is desirable to go directly to the triangle area calculation process using the feature points of other objects.

For example, if the height of the feature point is 3 meters or more and the area change rate is less than the standard, the object having the feature point is very likely to be a fixed object. Therefore, if the area of change between the three feature points is monitored by extracting two fixed objects with a height of 3 meters or more from the feature points of the target object to be determined and the fixed objects that have already been determined, the determination of whether to move or fix is more certain. You can. That is, even if the area change rate between the three feature points is less than the reference, the possibility that these three objects are objects moving in the same direction cannot be excluded. Therefore, in this case, it is necessary to check the area change rate of the triangle consisting of the feature points of two predetermined fixed objects having a feature point and a height of 3 meters or more of any one of these objects, and through this, whether the object to be judged is a fixed object or not Can be determined more reliably.

Of course, when the feature point extraction unit 142 extracts three feature points for area calculation, if only feature points higher than a reference height are selected as the area calculation object, the operation speed for determining the fixed object may be faster.

Here, the height of the feature point can be calculated through a simple trigonometric formula through the relative coordinate system. That is, the point coordinates obtained through the scan data of the lidar 110 include distance and direction information, and thus can be expressed as a relative coordinate system based on the own vehicle 10. If the relative coordinates are known, the corresponding coordinates with the own vehicle 10 The angle of the straight line connecting the points with the ground is also known. Multiplying the sine value for this angle by the distance to that point yields the height of that point.

The above-described preferred embodiments of the present invention are disclosed for the purpose of illustration, and those skilled in the art having ordinary knowledge of the present invention will be able to make various modifications, changes and additions within the spirit and scope of the present invention. And additions should be considered to fall within the scope of the claims of the present invention.

10: vehicle
100: positioning accuracy improvement system
110: Lida
120: GPS module
130: location correction means
131: Road information extraction department
132: Curve information acquisition department
133: Map data extraction unit
134: correction information generation unit
135: location update unit
136: Precision map DB
140: object classification means
141: Vehicle movement confirmation unit
142: feature point extraction unit
143: Area computation department
144: Change rate confirmation unit
145: judgment unit
150: object tracking unit
161: Lane
163: first curve
165: second curve
210: first object
211: Feature point 1-1
220: second object
221: Feature point 2-1
230: third object
231: Feature point 3-1
240: fourth object
241: 4th feature point 4-1

Claims (9)

An environment sensor for recognizing objects by scanning around the vehicle;
A GPS module for obtaining GPS coordinate information;
Position correction means for updating and outputting the GPS coordinate information by using the curve information of the curb according to the scan data of the environmental sensor and the curve information of the curb extracted from the precision map corresponding to the coordinates obtained from the GPS module; And
Includes; object identification means for determining whether the object is fixed and moved by the environmental sensor;
The object classification means,
A feature point extraction unit for extracting a feature point from the object recognized by the environmental sensor;
An area calculation unit repeatedly calculating an area of a triangle consisting of three characteristic points with a parallax through a relative coordinate system of the characteristic points extracted from the characteristic point extraction unit;
A change rate confirmation unit that checks a change rate of the triangular area calculated by the area calculation unit; And
Includes a determination unit for distinguishing the fixed object and the moving object according to the result of the change in the triangle area change rate check unit
The object classification means,
Further comprising; a vehicle movement confirmation unit for confirming whether the vehicle is stopped,
The determination unit first distinguishes the fixed object and the moving object when it is confirmed that the vehicle is in the stopped state through the vehicle movement confirmation unit, but when the area change rate of the triangle is less than the reference, objects for three feature points are determined as fixed objects And
Subsequently, when it is confirmed through the vehicle movement confirmation unit that the vehicle is not in a stopped state, the feature point extraction unit extracts two feature points from the feature points of the object determined by the determination unit as a fixed object, and one feature point of the object to be determined. Then, the area calculation unit calculates the area of a triangle consisting of two fixed feature points and one feature point to be judged. When it is confirmed that the area change rate is less than the standard, the determination unit determines the object to be determined as a fixed object. And, when it is confirmed that the area change rate is higher than the reference in the change rate confirmation unit, the determination unit determines the object to be determined as a moving object.

delete delete delete (A) step of recognizing an object by scanning the vehicle surroundings through an environmental sensor;
(B) obtaining GPS coordinate information;
Updating and outputting the GPS coordinate information by using the curb information of the curb according to the scan data of the environmental sensor and the curb information extracted from the precision map corresponding to the coordinates obtained from the GPS module; And
Including (d) step of determining whether the object recognized by the environmental sensor is fixed and moved;
Step (d) may be performed prior to step (c),
Step (d) is,
Step (d-1) of recognizing a plurality of objects through the environmental sensor;
(D-2) extracting feature points from the recognized object;
Step (d-3) of repeatedly calculating an area of a triangle consisting of three feature points with a parallax through the relative coordinate system of the extracted feature points; And
(D-4) step of separating the fixed object and the moving object according to the area change rate of the triangle; containing
Further comprising (d-5) step (d-5) to first check whether the vehicle is stopped before step (d-1);
In step (d-5), when the subject vehicle is in a stopped state, steps (d-1) to (d-3) are performed,
In the step (d-4), when the area change rate of the triangle is less than a reference, objects for three feature points are determined as fixed objects.
The method of claim 5,
Step (c) is,
(C-1) extracting precision map data corresponding to the GPS coordinate information obtained in step (b) from the precision map DB;
Step (c-2) of extracting the curb shape of the curb from the object recognized by the environmental sensor, and converting the first curve for the curb shape into a cubic equation based on the vehicle;
Based on the GPS coordinates, the curvature of the curb located on the driving route of the vehicle is extracted from the precise map data extracted in the step (c-1), and the second curve for the curvature of the curb extracted from the precise map data is based on GPS coordinates. (C-3) converting to a cubic equation on the coordinate system;
(C-4) generating coordinate correction information by applying an ICP algorithm such that curves on different coordinate systems converted in steps (c-2) and (c-2) are matched; And
And (c-5) updating location information by reflecting the coordinate correction information to the GPS coordinate information.
delete delete The method of claim 5,
In step (d-5), if the subject vehicle is not in a stopped state, steps (d-1) to (d-3) are performed,
Of the three feature points extracted in the step (d-3), two of the feature points are feature points for the fixed object determined through the step (d-4), and the other one is the feature point of the object to be determined,
In step (d-4), when the area change rate of the triangle is less than the reference, the object to be determined is determined as a fixed object, and when the area change rate of the triangle is more than the reference, the object to be determined is determined as a moving object. How to improve positioning accuracy.

Images