KR102037129B1 - Apparatus and Method for Compensating Position of Vehicle, System for Compensating Position of Vehicle and Unmanned Vehicle Using the Same - Google Patents

Abstract

An apparatus for correcting a position of a vehicle according to an exemplary embodiment of the present disclosure may include: a lane detecting unit configured to detect a lane of a lane in which the vehicle is currently driven using information photographed by an image photographing apparatus installed in a vehicle; A location information generator for generating current location information of the vehicle using the detected lane; A location information receiver configured to receive current location information of the vehicle from a global positioning system (GPS) installed in the vehicle; A road information map storage unit which stores information about a middle position of a width between lanes for each lane at predetermined intervals; And current position information of the vehicle generated by the position information generator, current position information of the vehicle received by the position information receiver, and information on an intermediate position of the width between lanes stored in the road information map storage unit. It may include a position correction unit for correcting the current position information of the received vehicle using.

Description

Apparatus and Method for Compensating Position of Vehicle, System for Compensating Position of Vehicle and Unmanned Vehicle Using the Same}

The present invention relates to a vehicle position correction apparatus and method, a vehicle position correction system using the same, and a vehicle capable of unmanned operation.

Unmanned vehicles mean vehicles that drive to their destination by grasping the road and the terrain on their own without having to hold the steering wheel. Also called an autonomous driving vehicle or an autonomous driving vehicle.

In order for an unmanned vehicle to drive to a destination by grasping roads and terrain on its own without human manipulation, accurate positioning of the vehicle is required. Currently, GPS is used to determine the location of a vehicle.

However, when determining the location of the vehicle using only the satellite navigation apparatus, some errors may occur, and the larger the error, the higher the possibility of causing an accident. For example, the vehicle may cross the center line or the curb if the vehicle is unable to determine the exact location of the vehicle due to the noise value of the GPS information on the two-lane road.

In order to solve such a problem, there exists a technology of measuring visual mileage using 3D point matching or a stereo camera, but there is a problem that a process time is required and an error rate is accumulated over time.

Therefore, there is a need for a technology capable of accurately identifying the location of the vehicle with a small amount of resources.

The technical problem to be solved by the present invention is to generate a distance from the middle of the lane to the position of the vehicle by using an image photographing apparatus, the distance from the generated middle of the lane to the position of the vehicle, the position of the middle of the lane stored in the road information map And a vehicle position correcting apparatus and method for correcting the position of the vehicle measured by using the position of the vehicle measured using the satellite navigation apparatus, and a vehicle position correction system using the same.

In addition, another technical problem to be solved by the present invention is to provide a vehicle capable of unmanned operation using at least one of the vehicle position correction device and method and the vehicle position correction system using the same according to the present invention.

Technical problems of the present invention are not limited to the aforementioned technical problems, and other technical problems not mentioned will be clearly understood by those skilled in the art from the following description.

According to an aspect of the present invention, there is provided a device for correcting a position of a vehicle, using the information photographed by an image photographing apparatus installed in a vehicle to detect a lane of a lane in which the vehicle is currently driving. Lane detection unit; A location information generator for generating current location information of the vehicle using the detected lane; A location information receiver configured to receive current location information of the vehicle from a global positioning system (GPS) installed in the vehicle; A road information map storage unit which stores information about a middle position of a width between lanes for each lane at predetermined intervals; And current position information of the vehicle generated by the position information generator, current position information of the vehicle received by the position information receiver, and information on an intermediate position of the width between lanes stored in the road information map storage unit. It may include a position correction unit for correcting the current position information of the received vehicle using.

According to an embodiment of the present disclosure, the location information generation unit generates information on a distance between an intermediate point of the lane in which the current vehicle is located and the location of the vehicle using the detected lane, and the location correction unit is configured to generate the current vehicle. The current position information of the received vehicle may be corrected by further using information about the distance between the intermediate point of the located lane and the position of the vehicle.

According to an embodiment of the present disclosure, the position corrector may be configured to be located at a position closest to the current position information of the vehicle generated by the position information generator, from among the information regarding the intermediate position of the width between the lanes stored in the road information map storage. Obtaining information about an intermediate position of the existing lane width, and obtaining information about a position difference between the intermediate position of the lane width existing in the nearest position and the current position of the vehicle received by the location information receiver. The information about the generated position difference may be used to correct the current position information of the received vehicle.

According to an embodiment, the location information generation unit generates information on a distance between an intermediate point of the lane where the current vehicle is located and the location of the vehicle using the detected lane, and the location correction unit is configured to perform the location information. The received position information of the vehicle may be corrected by comparing the information on the distance generated by the generation unit with the position difference generated by the position correction unit.

According to one embodiment, the position correction unit, the generated position difference is a difference between the X coordinate between the intermediate position of the width between the lane and the current position of the received vehicle, the difference of the X coordinate is the position information generation unit It is possible to correct the current position information of the received vehicle to be equal to the magnitude of the distance generated by the.

According to one embodiment, the information about the intermediate position of the width between the lanes stored in the road information storage unit and the current position information of the vehicle received by the location information receiver is X coordinate, Y coordinate and heading value (Heading) Value).

According to an embodiment of the present disclosure, the position corrector may correct only the X value among the current position information of the received vehicle.

According to an embodiment, when an error value that is a difference value between the difference between the X coordinate and the size of the distance generated by the location information generator is obtained by a predetermined number, the position correction unit may determine the error value of the preset number. The current position information of the received vehicle may be corrected using the average value.

According to an embodiment, when the predetermined number of error values are obtained at time t, the position correction unit uses the first error value obtained after the time t to calculate the average value, and the time t In calculating the average value, an error value at a time point when the most acquired time passes among the error values used to calculate the average value may be excluded.

According to an embodiment, the road information map storage unit may include information on at least one of a pedestrian crossing position and a stop line position, and the lane detection unit may be configured to use the information captured by the image photographing apparatus installed in the vehicle. Detecting at least one of the crosswalk and the stop line existing in the driving lane, the location information generation unit generates the current position information of the vehicle using at least one of the detected crosswalk and the stop line, correcting the position The current information of the vehicle generated by the location information generation unit using at least one of the information on at least one of the crosswalk position and the stop line position stored in the road information map storage unit, the detected crosswalk and the stop line position Location information and the current of the vehicle received by the location information receiver It is possible to correct a Y-axis information of the current position information of the vehicle received by the position information reception unit using the location information.

According to a second aspect of the present invention, a system for correcting a position of a vehicle includes: an image photographing apparatus installed in a vehicle to photograph a front of the vehicle; A global positioning system (GPS) for acquiring current position information of the vehicle; A road information map storage device for storing information about a middle position of a width between lanes for each lane at predetermined intervals; A lane detection device that detects a lane of a lane in which the vehicle is currently driving by using information captured by the image photographing device; A location information generation device for generating current location information of the vehicle using the detected lane; And current position information of the vehicle generated by the position information generating apparatus, current position information of the vehicle obtained by the satellite navigation apparatus, and information on an intermediate position of the width between lanes stored in the road information map storage device. It may include a position correction device for correcting the current position information of the vehicle obtained by the satellite navigation device using.

According to an embodiment, the image capturing apparatus may be connected to a black box apparatus installed in the vehicle.

According to an aspect of the present invention, there is provided a vehicle capable of unmanned operation, comprising: an image photographing apparatus installed in a vehicle and photographing the front of the vehicle; A global positioning system (GPS) for acquiring current position information of the vehicle; A road information map storage device for storing information about a middle position of a width between lanes for each lane at predetermined intervals; A lane detection device that detects a lane of a lane in which the vehicle is currently driving by using information captured by the image photographing device; A location information generation device for generating current location information of the vehicle using the detected lane; Current position information of the vehicle generated by the position information generating apparatus, current position information of the vehicle obtained by the satellite navigation apparatus, and information on an intermediate position of the width between lanes stored in the road information map storage device. A position correction device for correcting current position information of the vehicle obtained by the satellite navigation apparatus; And a control device for controlling the unmanned driving of the vehicle by using the corrected current position information of the vehicle.

According to an aspect of the present invention, there is provided a method for correcting a position of a vehicle, by detecting information on a lane of a lane in which the vehicle is currently driven by using information captured by an image photographing apparatus installed in the vehicle. Lane detection step; A location information generation step of generating current location information of the vehicle by using the detected lane; A location information receiving step of receiving current location information of the vehicle from a global positioning system (GPS) installed in the vehicle; A road information receiving step of receiving, from a road information map storage device, information regarding a middle position of a width between lanes closest to a current location of the vehicle received in the location information receiving step; And current position information of the vehicle generated in the position information generating step, current position information of the vehicle received in the position information receiving step, and information on an intermediate position of the width between the lanes received in the road information receiving step. It may include a position correction step of correcting the current position information of the received vehicle by using.

According to an embodiment of the present disclosure, the generating of the location information may include generating information about a distance between an intermediate point of the lane where the current vehicle is located and the location of the vehicle using the detected lane, and the correcting of the location may include: The current position information of the received vehicle may be corrected by further using information about the distance between the midpoint of the lane where the current vehicle is located and the position of the vehicle.

According to an embodiment of the present disclosure, the generating of the location information may include generating information about a distance between an intermediate point of the lane where the current vehicle is located and the location of the vehicle using the detected lane, and the correcting of the location may include: Information about the distance generated by the location information generation step is generated by generating information on a position difference between the intermediate location of the lane width existing at the nearest location and the current location of the vehicle received in the location information receiving step; The position difference may be compared to correct current position information of the received vehicle.

The present invention can accurately determine the current position of the vehicle.

In addition, the present invention can quickly determine the current location of the vehicle with a minimum of resources.

In addition, the present invention by accurately grasp the current position of the vehicle, it is possible to drive the unmanned vehicle safely and accurately.

In addition, the present invention can use the camera and the navigation device for navigation (Navigation) for the black box image installed in the vehicle bar, it may not install a separate image recording device and satellite navigation device.

Effects of the present invention are not limited to the above-mentioned effects, and other effects not mentioned will be clearly understood by those skilled in the art from the following description.

FIG. 1 is a diagram illustrating an example of a problem that may occur when autonomous driving of an unmanned vehicle is performed when the position correction apparatus of the vehicle according to an embodiment of the present invention is not used.
2 is a block diagram of a system for correcting a position of a vehicle according to an exemplary embodiment of the present invention.
FIG. 3 is a diagram for describing an example of storing information about an intermediate position for each lane at predetermined intervals.
4 is a diagram illustrating an example of a right starting point and a left starting point detected by the lane detecting apparatus.
5 is a diagram illustrating an example of a method of generating location information of a vehicle by the location information generating apparatus.
6 is a diagram illustrating an example of a method of correcting a position of a vehicle measured by a satellite navigation apparatus by a position correction system of a vehicle according to an exemplary embodiment of the present invention.
7 is a block diagram of an apparatus for correcting a position of a vehicle according to an exemplary embodiment of the present invention.
8 is a block diagram of a vehicle position correction method according to an embodiment of the present invention.

Hereinafter, exemplary embodiments of the present invention will be described in detail with reference to the accompanying drawings. Advantages and features of the present invention, and methods for achieving them will be apparent with reference to the embodiments described below in detail in conjunction with the accompanying drawings. However, the present invention is not limited to the embodiments disclosed below, but can be implemented in various forms. The embodiments of the present invention make the posting of the present invention complete and the general knowledge in the technical field to which the present invention belongs. It is provided to fully convey the scope of the invention to those skilled in the art, and the present invention is defined only by the scope of the claims. Like reference numerals refer to like elements throughout.

When a component is referred to as being “connected” or “connected” to another component, it may be directly connected to or connected to that other component, but it may be understood that other components may exist in between. Should be. On the other hand, when a component is referred to as being "directly connected" or "directly connected" to another component, it should be understood that there is no other component in between.

Unless otherwise defined, all terms (including technical and scientific terms) used in the present specification may be used in a sense that can be commonly understood by those skilled in the art. In addition, the terms defined in the commonly used dictionaries are not ideally or excessively interpreted unless they are specifically defined clearly.

In this specification, the singular may also include the plural unless specifically stated otherwise in the phrase. As used herein, “comprises” and / or “comprising” refers to the presence of one or more other components, steps, operations and / or elements. Or does not exclude additions.

An apparatus and method for correcting a position of a vehicle and a vehicle position correcting system using the same according to an embodiment of the present invention may be effectively used for an unmanned vehicle that is a vehicle capable of autonomous driving. It can be used effectively anywhere.

FIG. 1 is a diagram illustrating an example of a problem that may occur when autonomous driving of an unmanned vehicle is performed when the position correction apparatus of the vehicle according to an embodiment of the present invention is not used.

Referring to FIG. 1, the location where the rectangle 11 is located represents the current vehicle location, and the location where the triangle 12 is located is the location of the current vehicle measured by the Global Positioning System (GPS) 200. Indicates.

The current position of the vehicle measured by GPS is somewhat different from the actual position of the vehicle due to ionospheric error, convective error, satellite orbit error, clock error, multipath error, cycle slip error and selective availability error. Error may occur.

Such an error may cause a serious problem of invading the center line as shown in FIG. 1.

That is, in FIG. 1, when the vehicle is to make a left turn and the left turn lane is the first lane, the current position of the vehicle measured by the GPS is the second lane, and the unmanned vehicle changes the lane to the first lane to the target point ( Go to Goal_1).

However, the actual vehicle is currently located on the primary road, and when driving to the target point (Goal_1) based on the current position of the vehicle in which the error exists, the vehicle may be positioned at the Goal_2 point beyond the center line.

Using the vehicle position correction device 600 and / or the vehicle position correction system 1000 according to an embodiment of the present invention to determine whether there is an error in the current position of the vehicle measured by the GPS, and the error If is present, the error can be corrected.

2 is a block diagram of a system for correcting a position of a vehicle according to an exemplary embodiment of the present invention.

Referring to FIG. 2, the vehicle position correction system 1000 according to an exemplary embodiment of the present invention may include an image photographing apparatus 100, a satellite navigation apparatus 200, a road information map storage apparatus 300, and a lane detecting apparatus ( 200, the location information generation device 500, and the location correction device 600 of the vehicle.

The image capturing apparatus 100 may be installed in a vehicle to photograph a front portion of a driving direction of the vehicle. Images captured by the image capturing apparatus 100 may include lanes on both sides of a lane where a vehicle is located.

For example, the image capturing apparatus 100 may be a camera, and a black box camera of the vehicle may be the image capturing apparatus 100.

The satellite navigation apparatus 200 may be a device installed in a vehicle and capable of measuring a current position of the vehicle by receiving a signal transmitted from a GPS satellite.

For example, the satellite navigation apparatus 200 may be a GPS used for navigation installed in a vehicle.

When the satellite navigation device 200 is installed in a vehicle, not only means that the satellite navigation apparatus is physically connected, but also may exist in the interior of the vehicle.

That is, in some cases, the satellite navigation device 200 may be a driver or a device such as a smart phone, a tablet PC, or the like with a GPS present inside the vehicle.

When the satellite navigation device 200 is a GPS embedded in a device existing inside the vehicle, the vehicle position correcting device 600 is connected to the device by wire or wirelessly and is measured by the satellite navigation device 200. The location of the vehicle can be received.

The road information map storage device 300 is a device that stores various information of roads, such as RNDF (The Route Network Definition File).

The road information stored in the road information map storage device 300 is not limited to the format according to the RNDF. The road information map storage device 300 may store information about an intermediate position for each lane of the road on which the vehicle is currently driven at predetermined intervals. The middle position of each lane means the middle position of the width of each lane.

FIG. 3 is a diagram for describing an example of storing information about an intermediate position for each lane at predetermined intervals.

Referring to FIG. 3, there is 31, which is an intermediate position of the lane width in the first lane. The intermediate position of the primary lane means a set of points having the same shortest distance to both lanes of the primary lane based on any one point of 31. That is, for example, it means that the length of 32 and 33 are the same.

Similarly, there is a middle position 32 of the lane width in the second lane, and the middle position of the second lane means a set of points having the same shortest distance to both lanes of the primary lane based on any one point of 32. That is, for example, it means that the length of 35 and 36 are the same.

The road information map storage device 300 may store the information on the intermediate position of each of the lanes at predetermined intervals. Referring to FIG. 3, the information on the intermediate position of the first lane may be m11, m12, m13, m14, m15. , m16, m17 and the like.

Similarly, the information about the intermediate position of the secondary road stored in the road information map storage device 300 may be m21, m22, m23, m24, m25, m26, m27 and the like.

However, the information about the intermediate position for each lane stored in the road information map storage device 300 may not be an exact intermediate position, and a predetermined error may exist.

The predetermined interval may be changed according to a format or setting situation of collecting information stored in the road information map storage device 300, and may be set at an interval of about 30 cm to 5 m, but is not limited thereto.

The lane detecting apparatus 200 may detect a lane included in an image captured by the image capturing apparatus 100. The lane detecting apparatus 200 may detect a lane included in an image by using known techniques. In addition, the lane detection apparatus 200 may not detect all lanes included in the image. The lane detecting apparatus 200 includes only a point corresponding to a position closest to the current vehicle (right starting point) among the right lanes located in the front of the vehicle driving direction and a point corresponding to a position nearest to the current vehicle among the left lane (left starting point). Can also be obtained.

4 is a diagram illustrating an example of a right starting point and a left starting point detected by the lane detecting apparatus.

Referring to FIG. 4, a point (right starting point) corresponding to a position closest to the current vehicle among the right lanes located in the front of the vehicle driving direction detected by the lane detecting apparatus 200 becomes P _right , and is present among the left lanes. The point (left starting point) corresponding to the position closest to the vehicle may be P _left .

The location information generating apparatus 500 may generate current location information of the vehicle using the right starting point and the left starting point detected by the lane detecting apparatus 200.

The location information generating apparatus 500 may store information about the center point 41 of the vehicle width in front of the vehicle.

In more detail, the location information generating device 500 may generate information about a location in an x-axis direction in a lane where a vehicle is located.

In the lane, the x-axis direction may be referred to as the y-axis direction and the direction perpendicular to the y-axis direction may be referred to as the x-axis direction. Alternatively, the tangential direction of the lines connecting the intermediate positions of the lanes stored in the road information map storage device 300 for each lane may be referred to as the y-axis direction, and the direction perpendicular to the y-axis direction may be referred to as the x-axis direction.

The location information generating apparatus 500 may calculate a distance from the center point 41 of the vehicle width to the left starting point in the front of the vehicle and calculate a distance from the center point 41 of the vehicle width to the right starting point in the front of the vehicle.

5 is a diagram illustrating an example of a method of generating location information of a vehicle by the location information generating apparatus.

Referring to FIG. 5, the distance from the center point 41 of the vehicle width to the left starting point is D _left at the front of the vehicle calculated by the position information generating apparatus 500, and from the center point 41 of the vehicle width to the vehicle front. You can see that the distance from the right starting point is D _right .

The location information generating apparatus 500 may generate information on which side the vehicle is located at a midway point of the current lane using the D _left and / or D _right information.

Specifically, the intermediate position is half of the value of D _left and D _right in the lane where the vehicle is currently located.

The intermediate position in the lane where the current vehicle generated by the position information generating device 500 using D _left and / or D _right is located on the x-axis line passing through the center point 41 of the vehicle width in front of the vehicle that is stored in advance. Can be located.

Position information generating apparatus 500 according to the distance to D _left and D _right drive of the middle position information and D _left and / or D _right vehicle width center point (41) from the intermediate position of the car by using a obtained by using the Information can be generated. When the position information generating apparatus 500 generates information about the distance from the middle position of the lane to the center point 41 of the vehicle width, the position information generating apparatus 500 does not use the information about the middle position of the lane using D _left and D _right information. Information on an intermediate position of the lane stored in the road information map storage device 300 may be used.

For example, the size of the distance from the middle position of the lane to the center point 41 of the vehicle width is the size of D _left and D _right minus the value of (D _left + D _right ) / 2. Can be.

The location information generating apparatus 500 may also generate information regarding whether the vehicle is separated from the right side or the left side from the middle position of the vehicle according to which value of D _left and D _right is larger.

The vehicle position correcting apparatus 600 may provide information about the distance L_t_lane from the middle position of the lane generated by the position information generating apparatus 500 to the center point 41 of the vehicle width, and by the satellite navigation apparatus 200. The vehicle may be present in the information about the current location of the vehicle measured by the satellite navigation apparatus 200 by using the information about the measured current position of the vehicle and the information about the intermediate position of each lane stored in the road information map storage device 300. Error can be corrected.

The information about the position may include coordinate information of the x-axis and the y-axis. In addition, the information about the current position of the vehicle measured by the satellite navigation apparatus 200 and the information about the intermediate position for each lane stored in the road information map storage device 300 may include a heading value.

Specifically, for example, the vehicle position correcting apparatus 600 relates to a current position coordinate (X_t_gps) of the vehicle obtained by the satellite navigation apparatus 200 and an intermediate position for each lane stored in the road information map storage device 300. The distance difference between X_t_gps and X_t_road may be calculated using the location coordinates X_t_road of the distance closest to the location of the vehicle generated by the location information generator at the current time.

The vehicle position correcting apparatus 600 may calculate a distance difference between the x-axis of X_t_gps and X_t_road.

The vehicle position correction apparatus 600 measures the vehicle measured by the satellite navigation apparatus 200 such that the magnitude of the distance difference between the x-axis of X_t_gps and X_t_road is equal to the distance size of L_t_lane generated by the position information generator 500. Information about the current position of the can be corrected.

Specifically, for example, the position correction apparatus 600 of the vehicle is the x-axis coordinates of the information on the current position of the vehicle measured by the satellite navigation device 200 is the magnitude of the distance difference between the x-axis of X_t_gps and X_t_road It may be corrected to be equal to the distance size of L_t_lane generated by the information generating apparatus 500.

Correction of the y-coordinate may be corrected by using a crosswalk, a stop line, and the like stored in the road information map storage device 300.

6 is a diagram illustrating an example of a method of correcting a position of a vehicle measured by a satellite navigation apparatus by a position correction system of a vehicle according to an exemplary embodiment of the present invention.

In FIG. 6, the rectangle represents the current position of the vehicle generated by the location information generating apparatus 500, and the triangle represents the current position of the vehicle measured by the satellite navigation apparatus 200.

An example of a method of correcting the position of the vehicle measured by the satellite navigation apparatus 200 by the position correction system 1000 of the vehicle will be described with reference to FIGS. 6 and 8.

[Equation 1]

[Equation 2]

[Equation 3]

[Equation 4]

[Equation 5]

[Equation 6]

[Equation 7]

[Equation 8]

Referring to FIG. 6, POS _gps is position coordinates of a current vehicle obtained from the satellite navigation device 200 (GPS).

POS _{lane _c} may select the intermediate position coordinates of the position closest to the position of the current vehicle generated by the location information generating apparatus 500 among the intermediate position coordinates stored as the intermediate position coordinates of the _lane stored in the road storage map storage device. have.

Alternatively, when the preset interval is set to a small value and the intermediate position coordinates of the lane are collected and stored in the road storage map storage device 300, the intermediate position coordinates of the nearest position are the next nearest intermediate position coordinates or some of the nearest intermediate position coordinates. It can be meant to include the average of dogs.

Alternatively, the point closest to the position of the current vehicle generated by the location information generating apparatus 500 among the points forming the virtual lines connecting the intermediate position coordinates of the lane stored in the road storage map storage device is the middle position coordinate of the nearest position. It may be chosen.

The POS _lane may indicate the current location of the vehicle generated by the location information generating apparatus 500.

The heading value of the POS _{gps and} the heading value of the road stored in the road information map storage 300 may be different, which may mean that the vehicle is not located parallel to the lane.

That is, when the heading value of the POS _{gps and} the heading value of the road stored in the road information map storage device 300 are different, calculating the distance between the POS _gps and the POS _{lane _c} may not be accurate.

Accordingly, the vehicle position correcting apparatus 600 may rotate the POS _gps and the POS _{lane _c} to be positioned on the same axis in order to improve the accuracy of the position correction of the vehicle.

Referring to Figure 6, POS _gps is present on the xy plane, POS _{lane _c} may be present in the x'-y 'plane.

Equations 1 and 2 may be examples of formulas in which the vehicle position correcting apparatus 600 rotates two coordinates of POS _gps and POS _{lane _c} on an xy plane having magnetic north (90 degrees) as the y axis. .

POS _gps ^{^} is a POS _gps coordinate rotated according to Equation 1, and POS _{lane _c} ^{^} may mean a POSlane_c coordinate rotated according to Equation 2.

Both rotated POS _gps ^{^} and POS _{lane _c} ^{^} may exist in the x "-y" plane.

In Equations 1 and 2, θ may mean a heading value of POS _{lane _c} .

Continuing with reference to FIG. 6) and equation (3, Diff _cur is meant the difference between the X coordinates (POS _gps ^{^} .x) and the X-coordinate (POS _{lane _c} ^{^} .x) of the POS POS _{lane _c} ^{^} of ^{^} _gps.

6 and 4, Diff _exp may mean a difference between D _left and Lwidth / 2.

D _left may have a distance D _left from a center point of the vehicle width in front of the vehicle calculated by the location information generating apparatus 500. Lwidth may refer to the lane width of the lane in which the vehicle is currently located.

That is, Diff _exp may mean a difference distance calculated by using a current location coordinate of the vehicle generated by the location information generating apparatus 500 and a middle point coordinate of a road stored in the road information map storage device 300. In detail, the vehicle position correcting apparatus 600 may determine the Lwidth using the information stored in the road information map storage 300, and may determine the width using D _left and D _right as described with reference to FIG. 5. have.

The vehicle position correction system 1000 according to the present invention assumes that the current position coordinates of the vehicle generated by the position information generating apparatus 500 are accurate compared to the current position coordinates of the vehicle measured by the GPS. Do. Therefore, if the current position coordinates of the vehicle measured by the satellite navigation device 200 are correct, the value Diff _exp obtained from the distance between Dleft and the intermediate coordinates of the lane is measured by the satellite navigation device 200. The difference between the position coordinates and the intermediate coordinates of the lane will be the same (Diff _cur ).

If Diff _exp and Diff _cur are not the same at the current time, the current position coordinates of the vehicle measured by the satellite navigation apparatus 200 may be inaccurate and may have an error value Err _gps ^t at the current time t. have.

The position correction apparatus 600 of the vehicle may correct the current position coordinates of the vehicle measured by the satellite navigation apparatus 200 such that the error value Err _gps ^t is not generated.

Specifically, for example, the vehicle position correcting apparatus 600 may correct the X-axis coordinates among the current position coordinates of the vehicle measured by the satellite navigation apparatus 200 such that Errgps ^t , which is such an error value, does not occur. The Y-axis coordinates of the current position coordinates of the vehicle measured by the satellite navigation apparatus 200 may be corrected using pedestrian crossing coordinates and stop line coordinates stored in the road map storage device.

The vehicle position correcting apparatus 600 may correct the current position of the vehicle measured by the satellite navigation apparatus 200 at t seconds in order to increase the accuracy of the correction. That is, the vehicle position correcting apparatus 600 includes Err _gps ^{t −n} to Err _gps ^t collected from tn seconds to t seconds to correct the current position of the vehicle measured by the satellite navigation device 200 at t seconds. Position correction may be performed using the average value as shown in Equations 7 and 8.

n in tn may be a preset value and may be set and changed based on the number or time of Err _gps to be collected. If the position correction of the vehicle device 600 is using an average of 500 Err _gps value if you want to correct the current position of the vehicle measured by the navigation apparatus 200, for 500 Err _gps values collected in the first If it took n seconds from tn seconds to t seconds, then after 500 / n seconds, 500 Err _gps values from t-n + 500 / n seconds to t + 500 / n seconds will be collected. You can correct it.

That is, the position correction unit 600 of the vehicle continues to not have to wait until the n seconds Err _gps value collected, Err since the _gps value group obtained by the number has been set, when a new Err _gps is obtained in the present time From the preset number of Err _gps , the oldest Err _gps value can be excluded and the average value can be obtained.

More specifically with respect to the equation (7) and 8, the equation (7) is the average Err _gps (aveErr _gps), the current position of the vehicle measured by the satellite navigation system 200, the error value is corrected using the (POS _{gps _ new} ^{^} )

Since the vehicle position correction device 600 calculates only the error value based on the X axis in the process of obtaining Diff _exp and Diff _cur , the error value can be offset by adding avgErr _gps to the X coordinate only in the process of correcting the error value. have.

Referring to FIG. 6 and Equations 1 and 2, the position (POS _{gps _ new ^} ) of the corrected vehicle calculated by Equation 7 is the coordinate of the plane x "-y". This is about inverse rotation in the plane. That is, the current position of the vehicle measured by the satellite navigation apparatus 200 finally corrected by the vehicle position correcting apparatus 600 may be equal to POS _{gps _ new} of Equation 8.

As described above, the vehicle position correction system 1000 according to an embodiment of the present invention is focused on correcting the X-axis error of the satellite navigation device 200, but the road information map storage device 300 is provided. By using the stop line, pedestrian crossing, etc. stored in the y-axis error of the satellite navigation apparatus 200 can be corrected in a similar manner.

6 and 8 use D _left , but D _right may also be used.

7 is a block diagram of an apparatus for correcting a position of a vehicle according to an exemplary embodiment of the present invention.

1 and 7, the vehicle position correcting apparatus 600 according to an embodiment of the present invention is a vehicle position correcting apparatus 600 of the vehicle position correcting system 1000 according to an embodiment of the present invention. Play the same or similar role as). However, the position correction system 1000 of the vehicle according to an embodiment of the present invention plays a role of the lane detecting apparatus 200, the position information generating apparatus 500, and the road information map storing apparatus 300. It may also be performed by the position correction device according to an embodiment.

Referring to FIG. 7, the vehicle position correcting apparatus 600 according to an exemplary embodiment of the present invention may include a lane detecting unit 610, a location information generating unit 620, a location information receiving unit 630, and a road information map storage unit ( 640 and the position corrector 650.

The lane detecting unit 610 and the location information generating unit 620 have the same or similar functions as the lane detecting device 200 and the location information generating device 500 of the vehicle position correction system 1000 according to an exemplary embodiment of the present invention. Can be performed.

The location information receiver 630 may receive current location information of the vehicle measured by the satellite navigation apparatus 200.

The location information receiver 630 may be connected to the satellite navigation apparatus 200 by wire or wirelessly.

The road information map storage unit 640 may perform the same or similar function as the road information map storage device 300. The road information map storage unit 640 may include coordinate information about an intermediate point of the lane width of each lane.

The position correction unit 650 is a satellite navigation device received by the position information receiving unit 630, information about the distance (L_t_lane) from the middle position of the lane generated by the position information generation unit 620 to the center point of the vehicle width By using the information about the current position of the vehicle measured by the 200 and the information about the intermediate position of the lanes stored in the road information map storage unit 640 to the current position of the vehicle measured by the satellite navigation apparatus 200. Errors that may be present in the related information can be corrected.

The position correcting unit 650 is an error of the X-axis coordinates of the information about the current position of the vehicle measured by the satellite navigation apparatus 200 received by the position information receiving unit 630 as shown in Figs. Can be corrected.

The position correction unit 650 uses the information of the current position of the vehicle measured by the satellite navigation apparatus 200 using information such as a pedestrian crossing or a stop line stored in the road information map storage unit 640, and an error of the Y-axis coordinate. Can be corrected.

8 is a block diagram of a vehicle position correction method according to an embodiment of the present invention.

8, the lane detecting unit 610 or the lane detecting apparatus 200 may detect the lane of the lane in which the vehicle is currently driving (S810). step).

The location information generation unit 620 or the location information device may generate current location information of the vehicle using the detected lane (S820).

The location information receiver 630 may receive current location information of the vehicle measured by the GPS system 200 (GPS, Global Positioning System) of the vehicle (step S830).

The road information map storage unit 640 or the road information map storage device 300 may store information about the intermediate position of the width of the lanes forming the lane, the vehicle position correction device 600 or the position correction unit 650 may receive the information stored in the road information map storage unit 640 or the road information map storage device 300 for use in correcting the current position information of the vehicle measured by the satellite navigation apparatus 200. (Step S840).

The vehicle position correcting apparatus 600 or the position correcting unit 650 may detect the current position information of the vehicle generated using the detected lane, the road information map storage 640, or the lanes stored in the road information map storage 300. The current position information of the vehicle measured by the satellite navigation apparatus 200 may be corrected using the information about the intermediate position of the width and the current position information of the vehicle measured by the satellite navigation apparatus 200 (S850). ).

The vehicle position correction apparatus 600 and the method and the vehicle position correction system 1000 using the same according to an embodiment of the present invention and the vehicle capable of unmanned driving may be used in an unmanned vehicle capable of autonomous driving.

If only the location information of the current vehicle generated using the lane detected by the image capturing apparatus 100 is used, it may be possible to drive the unmanned vehicle along the cruise control function or the lane, but autonomous driving is difficult. In order for the unmanned vehicle to be able to autonomously operate, the position information of the current vehicle measured by the satellite navigation apparatus 200 is required. Therefore, the present invention provides the current vehicle position information measured by the accurate satellite navigation apparatus 200. This may be necessary.

At least one of the vehicle position correction apparatus 600 and the method and the vehicle position correction system 1000 using the same according to an embodiment of the present invention may be applied to the vehicle and used during autonomous driving. The current position information of the vehicle measured by the satellite navigation device 200 corrected by the vehicle position correction device 600 and method, and the vehicle position correction system 1000 using the same according to an embodiment of the present invention It may be used to autonomously drive the vehicle (not shown).

The vehicle position correcting apparatus 600 and the method according to an embodiment of the present invention, the position correction system 1000 of the vehicle using the same, and the vehicle capable of unmanned driving can accurately determine the current position of the vehicle.

In addition, the vehicle position correction apparatus 600 and the method according to an embodiment of the present invention, the vehicle position correction system 1000 using the same, and the vehicle capable of unmanned operation can quickly determine the current position of the vehicle with a minimum of resources. Can be.

In addition, the vehicle position correcting apparatus 600 and method according to an embodiment of the present invention, the vehicle position correction system 1000 using the same, and the vehicle capable of unmanned operation by accurately grasp the current position of the vehicle, Can drive unmanned vehicles accurately.

In addition, the vehicle position correction apparatus 600 and method, a vehicle position correction system 1000 using the same, and a vehicle capable of unmanned operation, the camera for photographing the black box installed in the vehicle and Since the satellite navigation apparatus 200 for navigation may be used, the separate image photographing apparatus 100 and the satellite navigation apparatus 200 may not be installed.

Effects of the present invention are not limited to the above-mentioned effects, and other effects not mentioned will be clearly understood by those skilled in the art from the following description.

2 and 7 may refer to software or hardware such as a field-programmable gate array (FPGA) or an application-specific integrated circuit (ASIC). However, the components are not limited to software or hardware, and may be configured to be in an addressable storage medium or may be configured to execute one or more processors. The functions provided in the above components may be implemented by more detailed components, or may be implemented as one component that performs a specific function by combining a plurality of components.

Although the embodiments of the present invention have been described above with reference to the accompanying drawings, those skilled in the art to which the present invention pertains may implement the present invention in other specific forms without changing the technical spirit or essential features thereof. I can understand that. Therefore, it should be understood that the embodiments described above are exemplary in all respects and not restrictive.

Claims (16)

A lane detector which detects a lane of a lane in which the vehicle is currently driving, using information captured by an image photographing apparatus installed in a vehicle;
A location information generator for generating current location information of the vehicle using the detected lane;
A location information receiver configured to receive current location information of the vehicle from a global positioning system (GPS) installed in the vehicle;
A road information map storage unit which stores information about a middle position of a width between lanes for each lane at predetermined intervals; And
Current position information of the vehicle generated by the position information generation unit, current position information of the vehicle received by the position information receiver, and information on an intermediate position of the width between the lanes stored in the road information map storage unit; Including a position correction unit for correcting the current position information of the received vehicle,
The location information generation unit,
Using the detected lanes, generate information on a distance between an intermediate point of a lane where a current vehicle is located and the position of the vehicle
The position correction unit,
And correcting the current position information of the received vehicle by further using information about the distance between the midpoint of the lane where the current vehicle is located and the position of the vehicle. delete The method of claim 1,
The position correction unit,
Regarding the intermediate position of the width between lanes existing in the position closest to the current position information of the vehicle generated by the position information generation unit among the information on the intermediate position of the lane width stored in the road information map storage unit. Obtain information,
Generating information about a position difference between the intermediate position of the lane width existing at the closest position and the current position of the vehicle received by the position information receiver, and receiving the information on the generated position difference. A device for correcting a position of a vehicle, used to correct current position information of a vehicle. delete delete delete delete delete delete delete delete delete In a vehicle that can run unattended,
An image photographing apparatus installed in the vehicle and photographing the front of the vehicle;
A global positioning system (GPS) for acquiring current position information of the vehicle;
A road information map storage device for storing information about a middle position of a width between lanes for each lane at predetermined intervals;
A lane detection device that detects a lane of a lane in which the vehicle is currently driving by using information captured by the image photographing device;
A location information generation device for generating current location information of the vehicle using the detected lane;
Current position information of the vehicle generated by the position information generating apparatus, current position information of the vehicle obtained by the satellite navigation apparatus, and information on an intermediate position of the width between lanes stored in the road information map storage device. A position correction device for correcting current position information of the vehicle obtained by the satellite navigation apparatus; And
And a control device for unmanned driving control of the vehicle using the corrected current position information of the vehicle. A lane detecting step of detecting a lane of a lane in which the vehicle is currently driven by using information captured by an image photographing apparatus installed in a vehicle;
A location information generation step of generating current location information of the vehicle by using the detected lane;
A location information receiving step of receiving current location information of the vehicle from a global positioning system (GPS) installed in the vehicle;
A road information receiving step of receiving, from a road information map storage device, information about a middle position of a lane width closest to a current location of the vehicle, received in the location information receiving step; And
Using the current position information of the vehicle generated in the position information generation step, the current position information of the vehicle received in the position information receiving step and information on the intermediate position of the width between the lanes received in the road information receiving step And a position correction step of correcting the received current position information of the vehicle. delete delete

Images