Patent Application
20140118552
The present invention relates to a technique of recognizing a shape of a lane or the like along which a vehicle travels with a camera mounted on the vehicle.
In a white line recognizing device described in Patent Document 1, an image of left and right lane markers in a travel lane along which a vehicle travels is recognized based on a result captured by a camera. An intersection of extension lines of the left and right lane markers is calculated based on the recognized left and right lane markers and a camera-mounting angle error is calculated by gathering and then averaging the intersections.
In the white line recognizing technique described in Patent Document 1, a variation in a vehicle behavior (such as a yaw rate or a transverse velocity) or a road shape (such as a curvature) may often become an error factor when an imaging angle of a camera is calculated. Therefore, in the white line recognizing technique described in Patent Document 1, it is necessary to extensively travel along a straight lane in which the variation in a vehicle behavior or a road shape is not likely to occur in order to reduce the influence of the error factor. However, generally on highways, since even if a road looks straight, it often actually has a slow curvature, it is necessary to extensively travel a long distance to collect a large amount of data.
In this case, since a large amount of data is computed, there is a problem in that an in-vehicle processor takes a large computational load to perform processes in real time.
The present invention is made in consideration of the above-mentioned circumstances and an object thereof is to correct an error of an imaging angle of an imaging unit disposed in a vehicle and to determine whether or not a road is straight, with a smaller computational load.
In order to achieve the above-mentioned object, according to an aspect of the present invention, an image of periphery of a vehicle is captured with an imaging unit disposed in the vehicle and a lane shape of a travel lane along which the vehicle travels is recognized from the captured image. According to an aspect of the present invention, it is determined that the travel lane is a straight lane, when it is determined that a bias between an intersection of extension lines obtained by approximating left and right lane markers located in a near area to a straight line, and an intersection of extension lines obtained by approximating left and right lane markers located in a far area to a straight line, is equal to or less than a predetermined threshold value, on the basis of the lane shape in the near area relatively close to the vehicle and the lane shape in the far area distant from the vehicle out of the recognized lane shapes.
According to the present invention, it is possible to determine whether or not a road is straight with a smaller computational load.
Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings. In the following description, elements in each drawing same as those in other drawings will be indicated by the same reference signs.
The camera 10 captures an image ahead of the vehicle 1.
The camera 10 is a digital camera including an imaging element such as a COD (Charge Coupled Device) or a CMOS (Complementary Metal Oxide Semiconductor). More specifically, the camera 10 is a 3CMOS camera of a progressive scan type that captures an image at a high speed.
The camera 10 is disposed, for example, at the front center of the ceiling in the interior of the vehicle 1 so as to capture an image ahead of the vehicle 1 and to capture an image of a travel lane ahead of the vehicle 1 via the front glass. Another arrangement aspect instead of this arrangement aspect may be employed as long as it is a camera capturing an image of the travel lane of the vehicle 1. For example, the camera 10 may be mounted in the back of the vehicle 1, such as a back-view camera, or may be mounted on the front end of the vehicle 1 such as a bumper, or a disposing aspect in which a vanishing point does not appear in the field of view of the camera 10 may be employed. In any case, it is possible to calculate a virtual vanishing point by detecting edges of lane markers and calculating approximate straight lines.
The image processing device 10a is a device that performs a lane recognizing process according to this embodiment. That is, the camera 10 having the image processing device 10a shown in
Information output from the image processing device 10a, the vehicle speed detecting device 20, and the steering angle detecting device 30 is input to the steering angle control device 40. The steering angle control device 40 outputs a signal for realizing a target steering to the steering angle actuator 50.
Each of the camera 10 and the steering angle control device 40 includes a microcomputer and peripheral component thereof or drive circuit of various actuators and transmit and receive information to and from each other via communication circuits. The lane recognizing process according to this embodiment is realized by the above-mentioned hardware configuration.
The camera 10 having the image processing device 10a built therein functionally includes an imaging unit 101, a lane shape recognizing unit 102, a vehicle behavior recognizing unit 103, an imaging angle deriving unit 104, an information bias determining unit 105, and an imaging angle correcting unit 106, as illustrated in
The imaging unit 101 captures an image of the periphery of the vehicle 1.
The lane shape recognizing unit 102 recognizes the lane shape of a travel lane along which the vehicle 1 travels based on the image captured by the imaging unit 101. For example, a known method described in Japanese Patent Application Publication No. 2004-252827 A can be used as a method of detecting a travel lane. For example, a known method described in Japanese Patent Application Publication No. 2004-318618 A can be employed as a method of calculating the shape of a travel lane or the position or posture of the vehicle 1.
The lane shape recognizing unit 102 calculates coordinates of intersections of extension lines of a pair of left and right lane markers in a far area and near area using the lane shape recognized as described above. The coordinates of the intersections are calculated based on the extension lines of a pair of left and right lane markers in the far area and near area, for example, in the following method.
That is, the lane shape recognizing unit 102 includes a computing device that analyzes the image captured by the imaging unit 101 and that calculates a yaw angle C of the vehicle 1, a pitch angle D of the vehicle 1, a height H of the imaging unit 101 from the road surface, a transverse displacement A from the center of a lane, and a curvature B of a travel lane. The lane shape recognizing unit 102 outputs the yaw angle C of the vehicle 1, the transverse displacement A from the center of a lane, and the curvature B of a travel lane, which have been calculated by the computing device, to the steering angle control device 40. Accordingly, for example, automatic steering or the like of the vehicle 1 is realized.
In
The white line candidate point detecting unit 200 detects candidate points of a white line forming a lane marker on the basis of the image data captured by the imaging unit 101.
The white line candidate point detecting unit 200 acquires a captured image of the travel lane of the vehicle 1 from the imaging unit 101, and detects white line edges Ed by processing the image, as shown in
The lane recognition processing unit 300 includes a road shape calculating unit 310 that approximates a road shape to a straight line and a road parameter estimating unit 320 that estimates a road shape and a vehicle posture relative to the road.
As shown in
The road parameter estimating unit 320 estimates road parameters (a road shape and a vehicle posture relative to the road) based on the approximate straight line Rf of the road shape detected by the road shape calculating unit 310 using Expression (1) as a road model formula.
Here, parameters A, B, C, D, and H in Expression (1) represent road parameters and vehicle state quantities estimated by the road parameter estimating unit 320. Parameters A, B, C, D, and H are the transverse displacement (A) of the vehicle 1 relative to the lane, the road curvature (B), the yaw angle (C) of the vehicle 1 about the lane, the pitch angle (D) of the vehicle 1, and the height (H) of the imaging unit 101 from the road surface, respectively.
W is a constant indicating a lane width (a distance between the insides of the left and right white lines on an actual road) and f is a perspective transformation constant of the camera. Here, j is a parameter for distinguishing the left and right white lines from each other, j=0 represents the left white line, and j=1 represents the right white line. In addition, (x, y) are coordinates on a road image of a point on lane inner edges of the left or right white line, with the upper-left corner of the road image taken as an origin, the right direction taken as a positive direction of an x axis, and the lower direction taken as a positive direction of a y axis.
The optical axis correcting unit 400 includes a straight lane determining unit 410 that determines whether or not the travel lane of the vehicle 1 is a straight lane, a parallel traveling determining unit 420 that determines whether or not the vehicle 1 travels in parallel to the travel lane, and a virtual vanishing point calculating unit 430 that calculates a virtual vanishing point based on the approximate straight line Rf of the road shape.
The straight lane determining unit 410 determines whether or not the travel lane of the vehicle 1 is a straight lane, based on the degree of coincidence between the slopes of linear equations and the degree of coincidence between the values of intercepts of linear equations, regarding the approximate straight lines Rf of the road shape in the far area and near area calculated by the road shape calculating unit 310.
The parallel traveling determining unit 420 determines whether or not the vehicle 1 travels in parallel to the travel lane on the basis of the vehicle posture of the vehicle 1 relative to the travel lane, which is estimated by the road parameter estimating unit 320. Specifically, the parallel traveling determining unit 420 calculates, using the transverse displacement A of the vehicle 1 relative to the lane which is one of vehicle state quantity estimated by the road parameter estimating unit 320, the transverse velocity (the differential value of the transverse displacement A) relative to the lane of the vehicle 1 based on a difference between the current value and the past value of the transverse displacement A. When the calculated transverse velocity is equal to or less than a predetermined threshold value, it is determined that the vehicle 1 travels in parallel to the travel lane. When the vehicle 1 travels in parallel to the travel lane and the travel lane is a straight lane, it means that the vehicle 1 travels straight.
The virtual vanishing point calculating unit 430 calculates an intersection of the left and right approximate straight lines Rf of the road shape as a virtual vanishing point when the straight lane determining unit 410 and the parallel traveling determining unit 420 determine that the travel lane of the vehicle 1 is a straight lane and the vehicle 1 travels in parallel to the travel lane of the vehicle 1.
As shown in
The coordinates of the intersection for the near area and the coordinates of the intersection for the far area, which are calculated as described above, are defined as (Pn_x, Pn_y) and (Pf_x, Pf_y), respectively.
Referring back to
The imaging angle deriving unit 104 calculates the imaging angle of the imaging unit 101 based on the lane shape recognized by the lane shape recognizing unit 102.
The information bias determining unit 105 determines whether or not there is a bias in at least one of results of recorganization by the lane shape recognizing unit 102 and the vehicle behavior recognizing unit 103.
The imaging angle correcting unit 106 corrects the imaging angle of the imaging unit 101 using the imaging angle output from the imaging angle deriving unit 104 when the information bias determining unit 105 determines that the bias is equal to or less than a predetermined threshold value.
The process by the in-vehicle image recognizing device according to this embodiment will be described below with reference to the flowchart illustrated in
In step S101, the lane shape recognizing unit 102 reads an image ahead of the vehicle 1 captured by the imaging unit 101. In step S102, the vehicle behavior recognizing unit 103 reads the vehicle speed of the vehicle 1 detected by the vehicle speed detecting device 20 or the steering angle detected by the steering angle detecting device 30.
In step S103, the lane shape recognizing unit 102 processes the captured image of the imaging unit 101 read in step S101 to recognize the travel lane along which the vehicle 1 travels and to calculate the position, the vehicle posture, or the like of the vehicle 1 relative to the travel lane.
In step S104, based on the extension lines of a pair of left and right lane markers in the far area and near area, the lane shape recognizing unit 102 calculates the coordinates of the intersections of the extension lines using the lane shape recognized in step S103. As described above, the intersection coordinates for the near area calculated by the lane shape recognizing unit 102 in this step are defined as (Pn_x, Pn_y) and the intersection coordinates for the far area are defined as (Pf_x, Pf_y).
In step S105, the straight lane determining unit 410 determines whether or not the travel lane is a straight lane using the following expression based on the intersection coordinates for the far area and the near area calculated in step S104. When the following expression is satisfied, the process progresses to step S106. Otherwise, the process progresses to step S110.
abs(Pn—x−Pf—x)≦TH—Px (0-1)
In Expression (0-1), abs(A) represents a function returning the absolute value of A. The value of HP_Px is a predetermined positive value such as 1.0. When Expression (0-1) is satisfied, it means that the intersection coordinates of the extension lines of the left and right lane markers detected in only the near area of the captured image by the camera is close to the intersection coordinates of the extension lines of the left and right lane markers detected in the far area. That is, when this condition is established, it means that the travel lane is a straight lane direction of which does not change from the far area to the near area.
In step S106, the parallel traveling determining unit 420 calculates the speed Ydot in the transverse direction of the vehicle by using the offset position (the distance to the lane marker in the transverse direction) Y in the transverse direction of the vehicle relative to the travel lane calculated in step S103 as an input and performing a pseudo temporal differentiation using the transfer function of the following expression. When Expression (0-4) is satisfied, the process progresses to step S107. Otherwise, the process progresses to step S110.
G(Z−1)=(c−cZ−2)/(1−aZ−1+bZ−2) (0-2)
Ydot=G(Z−1)Y (0-3)
abs(Ydot)≦TH—Ydot (0-4)
Here, Z−1 represents a delay operator and coefficients a, b, and c are all positive values and are discretized with a sampling period of 50 ms so as to have a predetermined frequency characteristic. The value of TH_Ydot is a predetermined positive value such as 0.03 and may be a large value based on the magnitude of the vehicle speed. When Expression (0-4) is satisfied, it means that the vehicle does not move in the transverse direction relative to the lane markers, i.e., the vehicle travels along the lane markers in a state where the vehicle does not wander transversely. In addition, when both Expressions (0-1) and (0-4) are satisfied, it means that the vehicle travels straight along a straight road.
In step S107, the straight lane determining unit 410 determines whether or not the road curvature Row calculated in step S103 satisfies both conditions of the following expressions. When the road curvature Row satisfies both conditions of the following expressions, the process progresses to step S108. Otherwise, the process progresses to step S110.
abs(Row)<TH_ROW (1-1)
abs(SumTotalRow+Row)<TH_ROW (1-2)
In Expressions (1-1) and (1-2), abs(A) represents a function returning the absolute value of A. SumTotalRow represents the total sum of the road curvature Row. TH_Row represents a threshold value when the travel lane is considered as a straight lane. The information bias determining unit 105 determines that the travel lane is a straight lane when the absolute value of the road curvature Row and the absolute value of the total sum SumTotalRow+Row thereof is less than TH_ROW. The value of TH_ROW is a predetermined positive value such as 0.0003, for example.
That is, when it is determined in steps S1057 and S107 that the travel lane recognized by the lane shape recognizing unit 102 is a straight lane, the imaging angle of the imaging unit 101 is corrected after step S108. In this way, the reason of limiting the scene where imaging angle of the imaging unit 101 is corrected to the scene corresponding to a straight lane is that when the travel lane is a straight lane, the point at infinity of the straight lane serves as central coordinates of an image which is processed. That is, when the central coordinates are calculated based on the intersection of the extension lines of a pair of left and right lane markers recognized on a straight lane, the accuracy is generally higher than that when the central coordinates are calculated on a curved lane and corrected by using an estimated curvature.
In step S108, the total sum SumTotalRow of the road curvature is updated using the following expression.
SumTotalRow=SumTotalRow+Row (1-3)
In step S109, the imaging angle correcting unit 106 corrects the imaging angle of the imaging unit 101 using the following expressions and determines the corrected imaging angle of the imaging unit 101.
FOE
—
Xest=0.9×FOE—X_est+0.1×Pn—x (1-4)
FOE
—
Y_est=0.9×FOE—Y_est+0.1×Pn—y (1-5)
FOE_X_est and FOE_Y_est represent coordinates on the captured image of the forward viewing from the vehicle 1 corresponding to the imaging angle of the imaging unit 101, and the initial values thereof are measured values of the camera mounting error (also referred to as a camera imaging angle error) with respect to a fixed target in an initial adjustment (calibration of a mounting error called plant aiming or the like) performed in a plant or the like. The coordinates calculated using Expressions (1-4) and (1-5) are used as origin coordinates when the lane recognizing process of step S103 is performed in the next time. Here, aiming indicates optical axis adjustment.
In step S110, a past value used in a filter or the like or a counter value used in a timer or the like is updated and the process is terminated.
The value of SumTotalRow is initialized to “0” before performing the process flow illustrated in
The above-mentioned in-vehicle image recognizing device recognizes the lane shape of the travel lane along which the vehicle 1 travels based on the captured image of the imaging unit 101 obtained by capturing an image of the runways around the vehicle 1. The imaging angle of the imaging unit 101 is calculated based on the recognized lane shape. Then, it is determined whether or not there is a bias in the recognized lane shape and then the imaging angle of the imaging unit 101 is corrected using the imaging angle when it is determined that there is no bias.
Accordingly, even when there is a bias in the road shape such as when a vehicle travels in a highway only one-way or travels in a road having a lot of right curves, it is possible to accurately correct the error of the imaging angle of the imaging unit with a smaller processing load.
In this embodiment, a standard deviation calculating unit is not provided, but a result aimed at a specific state along which a vehicle travels straight in a straight lane in a state without a bias may be used as an input and correction using Expressions (1-4) and (1-5) may be performed thereon. In this case, since the input value has a strong tendency to be a normalized distribution, the correction accuracy is high.
This embodiment exhibits the following effects.
(1) The in-vehicle image recognizing device according to this embodiment is an in-vehicle image recognizing device mounted on a vehicle 1. The imaging unit 101 captures an image of the periphery of the vehicle 1. The lane shape recognizing unit 102 recognizes the lane shape of the travel lane along which the vehicle 1 travels based on the image captured by the imaging unit 101. The imaging angle deriving unit 104 derives the imaging angle of the imaging unit 101 based on the lane shape recognized by the lane shape recognizing unit 102. The straight lane determining unit 410 determines whether or not there is an intersection bias between the intersection of the extension lines obtained by approximating the left and right lane markers located in the near area to a straight line and the intersection of the extension lines obtained by approximating the left and right lane markers located in the far area to a straight line, on the basis of the lane shape in the near area relatively close to the vehicle and the lane shape in the far area distant from the vehicle out of the lane shapes recognized by the lane shape recognizing unit. The imaging angle correcting unit 106 corrects the imaging angle of the imaging unit 101 using the imaging angle derived by the imaging angle deriving unit 104 when the straight lane determining unit 410 determines that the bias is less than a threshold value.
Accordingly, even when there is a bias in the road shape such as when a vehicle travels in a highway only one-way or travels in a road having a lot of right curves, it is possible to estimate the imaging angle of the imaging unit with a smaller computational load.
It is possible to determine whether or not a travel lane is a straight lane by using the bias of the intersections with higher accuracy.
(2) The straight lane determining unit 410 determines that the bias is less than a threshold value when the absolute value of the value indicating the recognized lane shape of the lane shape recognized by the lane shape recognizing unit 102 is less than a predetermined threshold value and the total sum of the values indicating the lane shapes is less than a threshold value. The information bias determining unit 105 determines whether or not there is a bias using the road curvature recognized by the lane shape recognizing unit 102.
Accordingly, even when there is a bias in the road shape such as when a vehicle travels in a highway only one-way or travels in a road having a lot of right curves, it is possible to estimate the imaging angle of the imaging unit with a smaller computational load.
(3) The vehicle speed detecting device 20 detects the vehicle speed of a vehicle 1. The steering angle detecting device 30 detects the steering angle of the vehicle 1. The vehicle behavior recognizing unit 103 recognizes the behavior of the vehicle 1 based on the vehicle speed detected by the vehicle speed detecting device 20 and the steering angle detected by the steering angle detecting device 30. When it is determined that the bias of the behavior of the vehicle 1 recognized by the vehicle behavior recognizing unit 103 is less than a threshold value, the imaging angle of the imaging unit 101 is corrected.
Accordingly, even when there is a bias in the road shape such as when a vehicle travels in a highway only one-way or travels in a road having a lot of right curves, it is possible to estimate the imaging angle of the imaging unit with a smaller computational load.
(4) The lane shape recognizing unit 102 detects a parameter associated with the road curvature. The information bias determining unit 105 determines whether or not the value of the parameter associated with the road curvature converges on a predetermined range. The information bias determining unit 105 integrates the parameter values within a predetermined time from the time point at which it is determined that the parameter converges. The information bias determining unit 105 determines whether or not the vehicle is in a straight traveling state by determining that the integrated value is less than a predetermined value. The image recognizing device performs an aiming process when the information bias determining unit 105 determines that the vehicle is in a straight traveling state.
Accordingly, even when there is a bias in the road shape such as when a vehicle travels in a highway only one-way or travels in a road having a lot of right curves, it is possible to estimate the imaging angle of the imaging unit with a smaller computational load.
A second embodiment will be described below with reference to the accompanying drawings. The same elements as in the first embodiment will be referenced by the same reference signs.
The basic configuration in this embodiment is similar to that in the first embodiment. However, the in-vehicle image recognizing device according to this embodiment is different from that according to the first embodiment, in that it further includes a standard deviation calculating unit.
The standard deviation calculating unit 107 calculates a standard deviation of the imaging angle derived by the imaging angle deriving unit 104 when the information bias determining unit 105 determines that there is no bias. The imaging angle correcting unit 106 corrects the imaging angle of the imaging unit 101 on the basis of the standard deviation calculated by the standard deviation calculating unit 107.
The process by the in-vehicle image recognizing device according to this embodiment will be described below with reference to the flowchart illustrated in
In step S201, the lane shape recognizing unit 102 reads an image ahead of the vehicle 1 captured by the imaging unit 101. In step S202, the vehicle behavior recognizing unit 103 reads the vehicle speed of the vehicle 1 detected by the vehicle speed detecting device 20, the steering angle detected by the steering angle detecting device 30, the acceleration in the longitudinal direction detected by an acceleration sensor, and the yaw rate value from a yaw rate sensor.
In step S203, the lane shape recognizing unit 102 processes the captured image of the imaging unit 101 read in step S201 to recognize the travel lane in which the vehicle 1 travels and to calculate the position, the vehicle posture, or the like of the vehicle 1 relative to the travel lane. In step S204, based on the extension lines of a pair of left and right lane markers in the far area and the near area, the lane shape recognizing unit 102 calculates the coordinates of the intersections of the extension lines using the lane shape recognized in step S203. As described above, the intersection coordinates for the near area calculated by the lane shape recognizing unit 102 in this step are defined as (Pn_x, Pn_y) and the intersection coordinates for the far area are defined as (Pf_x, Pf_y).
In step S205, the straight lane determining unit 410 determines whether or not the travel lane is a straight lane using the following expression based on the intersection coordinates for the far area and the near area calculated in step S204. When the following expression is satisfied, the process progresses to step S206. Otherwise, the process progresses to step S213. This process is the same as the process of step S105 in the first embodiment.
abs(Pn—x−Pf—x)<TH—PX (2-1)
abs(Pn—y−Pf—y)<TH—PY (2-2)
In these expressions, TH_PX represents a threshold value for the difference between the intersection coordinates for the far area and the near area in the horizontal direction of the captured image. TH_PY represents a threshold value for the difference between the intersection coordinates for the far area and the near area in the vertical direction of the captured image.
In step S206, the parallel traveling determining unit 420 calculates the speed Ydot in the transverse direction of the vehicle by using the offset position (the distance to the lane marker in the transverse direction) Y in the transverse direction of the vehicle relative to the travel lane calculated in step S203 as an input and performing a pseudo temporal differentiation using the transfer functions of Expressions (0-2) and (0-3). When Expression (0-4) is satisfied, the process progresses to step S207. Otherwise, the process progresses to step S213.
In step S207, the information bias determining unit 105 determines whether or not all the conditions of the following expressions are satisfied. When it is determined that all the conditions of the following expressions are satisfied, the process progresses to step S208. Otherwise, the process progresses to step S213.
abs(SumTotalPx+Pn—x−Pf—x)<TH—PX (2-3)
abs(SumTotalPy+Pn—y−Pf—y)<TH—PY (2-4)
abs(YawRate)<TH—YR (2-5)
abs(SumTotalYR+YawRate)<TH—YR (2-6)
abs(VspDot)<TH—VD (2-7)
abs(SumTotalVD+VspDot)<TH—VD (2-8)
YawRate represents a yaw rate value indicating the speed in the turning direction of the vehicle 1. SumTotalYR represents the total sum of YawRate. TH_YR represents a threshold value when the vehicle 1 is considered to travel straight, where when the absolute value of YawRate and the total sum SumTotalYR of YawRate is less than TH_YR, the vehicle 1 is considered to travel straight (Expressions (2-5) and (2-6))
VspDot represents the acceleration in the longitudinal direction of the vehicle 1. TH_VD represents a threshold value when the vehicle 1 is considered to travel at a constant speed, where the vehicle 1 is considered to travel at a constant speed when the absolute value of VspDot is less than TH_VD. SumTotalVD represents the total sum of VspDot.
That is, when the vehicle 1 is considered to travel straight in a straight lane on the basis of the lane shape recognized by the vehicle behavior recognizing unit 103 and the lane shape recognizing unit 102 (when both conditions of steps S205 and S206 are satisfied), there is no bias in the travel lane (when both Expressions (2-3) and (2-4) are satisfied), and there is no bias in traveling (when all of Expressions (2-5) to (2-8) are satisfied), the imaging angle of the imaging unit 101 is corrected in and after step S208. In this way, the reason of limiting the scene where the imaging angle of the imaging unit 101 is corrected to the scene in which the vehicle 1 travels straight in a straight lane and the case where there is no bias in the travel lane and the traveling is as follows.
That is, a time delay of hardware such as inputting of the captured image of the imaging unit 101 or a time delay of software such as image processing necessarily occurs. However, even in such a case, it is intended to calculate the intersection coordinates corresponding to the imaging angle of the imaging unit 101 with high accuracy, by making it difficult to receive the influence of disturbance due to the behavior of the vehicle 1. Even when a difference in encounter frequency between a right curve and a left curve is large, it is possible to correctly calculate a camera-mounting angle error.
In step S208, SumTotalPx, SumTotalPy, SumTotalYR, SumTotalVD, SumCount, and coordinate data for near area intersections are updated and are stored in a memory for collecting using the following expressions.
SumTotalPx=SumTotalPx+Pn—x−Pf—x (2-9)
SumTotalPy=SumTotalPy+Pn—y−Pf—y (2-10)
SumTotalYR=SumTotalYR+YawRate (2-11)
SumTotalVD=SumTotalVD+VspDot (2-12)
FOE
—
XDataRcd[SumCount]=Pn—x (2-13)
FOE
—
Y_DataRcd[SumCount]=Pn—y (2-14)
SumCount=SumCount+1 (2-15)
In these expressions, FOE_X_DataRcd[ ] represents a parameter for storing a horizontal coordinate on the captured image of the forward viewing in the traveling direction of the vehicle 1, and FOE_Y_DataRcd[ ] represents a parameter for storing a vertical coordinate on the captured image of the forward viewing in the traveling direction of the vehicle 1. These parameters are stored in a RAM memory, not shown.
SumCount represents a counter for counting the number of coordinate data pieces of the collected near area intersections and the initial value thereof is set to “0”. SumCount is initialized before performing the process illustrated in
In step S209, it is determined whether or not the number of coordinate data pieces on the collected near area intersections is equal to or more than 50. Specifically, when the condition of the following expression is satisfied (when the number of coordinate data pieces on the near area intersections is equal to or more than 50), the process progresses to step S210. Otherwise, the process progresses to step S213.
SumCount>=50 (2-16)
In step S210, the imaging angle deriving unit 104 calculates the imaging angle of the imaging unit 101 using Expressions (2-17) and (2-18). The standard deviation calculating unit 107 calculates the standard deviation of the imaging angle of the imaging unit 101 using Expressions (2-19) and (2-20).
FOE
—
X
—
e
—
tmp=ΣFOE
—
X_DataRcd/SumCount (2-17)
FOE
—
Y
—
e
—
tmp=ΣFOE
—
Y_DataRcd/SumCount (2-18)
FOE
—
X_stdev=√Σ(FOE—X—e—tmp−FOE—X_DataRcd)2/SumCount (2-19)
FOE
—
Y_stdev=√Σ(FOE—Y—e—tmp−FOE—Y_DataRcd)2/SumCount (2-20)
Σ in the above expressions represents an operator for calculating the total sum of the number of coordinate data pieces on the near area intersections, which is represented by SumCount.
In step S211, the deviation of candidates of the imaging angle of the imaging unit 101 derived by the imaging angle deriving unit 104 is determined. Specifically, when all the conditions of the following expressions are satisfied, the process progresses to step S212. Otherwise, the process progresses to step S213.
FOE
—
X_stdev<TH_STDEV (2-21)
FOE
—
Y_stdev<TH_STDEV (2-22)
TH_STDEV represents a threshold value for the deviation allowable for the candidates of the imaging angle of the imaging unit 101 derived by the imaging angle deriving unit 104. TH_STDEV has a positive value such as 1.0 pix. That is, when the values of each of the standard deviations FOE_X_stdev and FOE_Y_stdev calculated in step S210 is smaller than TH_STDEV, it is determined that the deviation of candidates of the imaging angle of the imaging unit 101 derived by the imaging angle deriving unit 104 is small and the imaging angle of the imaging unit 101 is corrected in step S212.
In this way, by performing the correction only when the deviation is small on the basis of the calculated standard deviation, it is possible to enhance correction accuracy more than that in the first embodiment. The correction accuracy of the imaging angle in the present invention after the plant aiming can be regulated as a specific value.
In step S212, the imaging angle correcting unit 106 determines the imaging angle of the imaging unit 101 after the correction using the following expressions. These coordinates are used as origin coordinates when the lane recognizing process of step S203 is performed.
FOE
—
X_est=FOE—X—e—tmp (2-23)
FOE
—
Y_est=FOE—Y—e—tmp (2-24)
In step S213, a past value used in a filter or the like or a counter value used in a timer or the like is updated and the process is terminated.
The value of SumCount is initialized to “0” before performing the process flow illustrated in
The configuration of the in-vehicle image recognizing device according to this embodiment is the same as that in the first embodiment, except for the configuration of the standard deviation calculating unit 107.
In the in-vehicle image recognizing device according to this embodiment, the standard deviation calculating unit 107 calculates the standard deviation of the imaging angle of the imaging unit 101 when it is determined that there is no bias. The imaging angle of the imaging unit 101 is corrected on the basis of the calculated standard deviation.
Accordingly, it is possible to enhance accuracy in estimating the imaging angle of the imaging unit 101.
This embodiment exhibits the following effects in addition to the effects of the first embodiment.
(1) The standard deviation calculating unit 107 calculates the standard deviation of the imaging angle derived by the imaging angle deriving unit 104 when the information bias determining unit 105 determines that the bias is less than the threshold value. The imaging angle correcting unit 106 corrects the imaging angle of the imaging unit 101 on the basis of the standard deviation calculated by the standard deviation calculating unit 107.
Accordingly, it is possible to enhance accuracy in estimating the imaging angle of the imaging unit 101. Since the information bias determining unit 105 determines whether or not there is a bias in information, collects only information determined to have no bias, and calculates the standard deviation, the deviation standard has a strong tendency to be a normalized distribution even with a small number of data pieces (for example, 50 data pieces) and it is thus possible to correctly determine the degree of deviation with a small computational load.
(2) In this embodiment, the behavior of the vehicle 1 recognized by the vehicle behavior recognizing unit 103 is information on the rotational behavior in the vehicle width direction of the vehicle 1. The vehicle behavior recognizing unit 103 recognizes the behavior of the vehicle 1 based on the temporal variation in the position in the vehicle width direction or the temporal variation in the yaw angle of the vehicle 1 relative to the travel lane recognized by the lane shape recognizing unit 102.
Accordingly, it is possible to enhance accuracy in estimating the imaging angle of the imaging unit 101.
A third embodiment will be described below with reference to the accompanying drawings. The same elements as in the first embodiment and the second embodiment will be referenced by the same reference signs.
The basic configuration in this embodiment is similar to that in the second embodiment. However, the in-vehicle image recognizing device according to this embodiment is different from that according to the second embodiment in that it further includes a termination unit.
The termination unit 108 terminates the correcting of the imaging angle when the standard deviation calculated by the standard deviation calculating unit 107 is less than a predetermined value.
The process by the in-vehicle image recognizing device according to this embodiment will be described below with reference to the flowchart illustrated in
In step S301, the lane shape recognizing unit 102 reads an image ahead of the vehicle 1 captured by the imaging unit 101. In step S302, the vehicle behavior recognizing unit 103 reads the speed in the vehicle width direction of the vehicle 1 detected by the vehicle speed detecting device 20, the steering angle detected by the steering angle detecting device 30, the acceleration in the longitudinal direction detected by an acceleration sensor, and the yaw rate value from a yaw rate sensor.
In step S303, the lane shape recognizing unit 102 processes the captured image of the imaging unit 101 read in step S301 to recognize the travel lane along which the vehicle 1 travels and to calculate the position, the vehicle posture, or the like of the vehicle 1 relative to the travel lane.
In step S304, the termination unit 108 determines whether or not the process of correcting the imaging angle of the imaging unit 101 is completed. When it is determined that the process completes, the process progresses to step S305. When it is determined that the process does not complete, the process progresses to step S314. Specifically, when the condition of the following expression is satisfied, the process progresses to step S305. Otherwise, the process progresses to step S314.
FlgAimComplt<1 (3-1)
In Expression (3-1), FlgAimComplt represents a flag indicating whether or not the process of correcting the imaging angle of the imaging unit 101 is completed. When FlgAimComplt=“0”, it means that the process of correcting the imaging angle of the imaging unit 101 is not completed. When FlgAimComplt=“1”, it means that the process of correcting the imaging angle of the imaging unit 101 is completed. The initial value of FlgAimComplt is set to “0”.
In step S305, based on the extension lines of a pair of left and right lane markers in the far area and the near area, the lane shape recognizing unit 102 calculates the coordinates of the intersections of the extension lines using the lane shape recognized in step S303. As described above, the intersection coordinates for the near area calculated by the lane shape recognizing unit 102 in this step are defined as (Pn_x, Pn_y) and the intersection coordinates for the far area are defined as (Pf_x, Pf_y).
In step S306, the straight lane determining unit 410 determines whether or not the travel lane is a straight lane using the following expression based on the intersection coordinates for the far area and the near area calculated in step S305. When Expressions (2-1) and (2-2) are both satisfied, the process progresses to step S307. Otherwise, the process progresses to step S314. This process is the same as the process of step S205 in the second embodiment.
In step S307, the parallel traveling determining unit 420 calculates the speed Ydot in the transverse direction of the vehicle by using the offset position (the distance to the lane marker in the transverse direction) Y in the transverse direction of the vehicle relative to the travel lane calculated in step S303 as an input and performing a pseudo temporal differentiation using the transfer functions of Expressions (0-2) and (0-3). When Expression (0-4) is satisfied, the process progresses to step S308. Otherwise, the process progresses to step S314. This process is the same as the process of step S206 in the second embodiment.
In step S308, the information bias determining unit 105 determines whether or not all the conditions of the following expressions are satisfied. When it is determined that all the conditions of the following expressions are satisfied, the process progresses to step S309. Otherwise, the process progresses to step S314.
abs(Row)<TH_ROW
abs(SumTotalRow+Row)<TH_ROW (3-3)
abs(ysoku)<TH—YS (3-4)
abs(SumTotalYsoku+ysoku)<TH—YS (3-5)
abs(YawRate)<TH—YR (3-6)
abs(SumTotalYR+YawRate)<TH—YR (3-7)
abs(VspDot)<TH—VD (3-8)
abs(SumTotalVD+VspDot)<TH—VD (3-9)
In these expressions, ysoku represents a parameter indicating the speed in the vehicle width direction of the vehicle 1. The value of ysoku may employ the speed in the vehicle width direction as a state variable of a Kalman filter for recognizing a lane, which is used in the lane recognizing process of step S303, without any change, or may employ a value obtained by temporally differentiating the position in the vehicle width direction relative to the travel lane. SumTotalYsoku represents the total sum of ysoku. TH_YS represents a threshold value when the vehicle 1 is considered to travel straight, whereby the vehicle 1 is determined to travel straight when the absolute value of the speed ysoku in the vehicle width direction and the absolute value of the total sum SumTotalYsoku+ysoku thereof are less than TH_YS as expressed by Expressions (3-4) and (3-5).
Similarly, the yaw rate value YawRate of the vehicle 1 in Expressions (3-6) and (3-7) may employ the yaw rate as a state variable of a Kalman filter for recognizing a lane, which is used in the lane recognizing process of step S303, without any change, or may employ a value obtained by temporally differentiating the yaw angle relative to the travel lane.
The meanings of the expressions other than Expressions (3-4) and (3-5) are the same as those in the first embodiment and the second embodiment.
In step S309, SumTotalRow, SumTotalYsoku, SumTotalYR, SumTotalVD, SumCount, and coordinate data for near area intersections are updated and are stored in a memory for collecting using the following expressions.
SumTotalRow=SumTotalRow+Row (3-10)
SumTotalYsoku=SumTotalYsoku+ysoku (3-11)
SumTotalYR=SumTotalYR+YawRate (3-12)
SumTotalVD=SumTotalVD+VspDot (3-13)
FOE
—
X_DataRcd[SumCount]=Pn—x (3-14)
FOE
—
Y_DataRcd[SumCount]=Pn—y (3-15)
SumCount=SumCount+1 (3-16)
The processes of steps S310 to S312 are the same as the processes of steps S209 to S211 illustrated in
In step S313, the imaging angle correcting unit 106 sets the completion flag FlgAimComplt of the process of estimating the imaging angle of the imaging unit 101 and determines the imaging angle of the imaging unit 101 using the following expressions. These coordinates are used as origin coordinates when the lane recognizing process of step S303 is performed.
FlgAimComplt=1 (3-17)
FOE
—
X_est=FOE—X—e—tmp (3-18)
FOE
—
Y_est=FOE—Y—e—tmp (3-19)
In step S314, a past value used in a filter or the like or a counter value used in a timer or the like is updated and the process is terminated.
The values of FlgAimComplt and SumTotalRow are initialized to “0” before performing the process flow illustrated in
The configuration of the in-vehicle image recognizing device according to this embodiment is the same as that in the second embodiment, except for the termination unit 108.
In the in-vehicle image recognizing device according to this embodiment, when the calculated standard deviation is less than a predetermined value, the termination unit 108 terminates the correcting of the imaging angle.
Accordingly, when it is determined that the deviation between the candidates of the imaging angle of the imaging unit 101 is small, the process of correcting the imaging angle can be terminated and it is thus possible to reduce the processing load of the in-vehicle image recognizing device.
In
According to the results illustrated in
This embodiment has the following effects in addition to the effects of the first embodiment and the second embodiment. (1) When the standard deviation calculated by the standard deviation calculating unit 107 is less than a predetermined value, the termination unit 108 terminates the correcting of the imaging angle.
Accordingly, when it is determined that the deviation between the candidates of the imaging angle of the imaging unit 101 is small, the process of correcting the imaging angle can be terminated and it is thus possible to reduce the processing load of the in-vehicle image recognizing device.
(2) In this embodiment, the behavior of the vehicle 1 recognized by the vehicle behavior recognizing unit 103 is information on the translational behavior in the vehicle width direction of the vehicle 1. The vehicle behavior recognizing unit 103 recognizes the behavior of the vehicle 1 based on the temporal variation in the position in the vehicle width direction or the yaw angle of the vehicle 1 relative to the travel lane recognized by the lane shape recognizing unit 102.
Accordingly, it is possible to enhance accuracy in estimating the imaging angle of the imaging unit 101.
In the above description, the vehicle speed detecting device 20 constitutes the vehicle speed detecting unit. The steering angle detecting device 30 constitutes the steering angle detecting unit. The lane shape recognizing unit 102 constitutes the parameter detecting unit. The vehicle behavior recognizing unit 103, or the vehicle speed detecting device 20, the steering angle detecting device 30, and the steering angle control device 40 constitute the parameter detecting unit. The straight lane determining unit 410 constitutes the intersection bias determining unit and the recognition bias determining unit. The information bias determining unit 105 constitutes the convergence determining unit, the integrating unit, and the straight traveling state determining unit. The imaging angle deriving unit 104 and the imaging angle correcting unit 106 constitutes the aiming execution unit.
Priority is claimed on Japanese Patent Application No. 2011-131222 (filed on Jun. 13, 2011), the content of which is incorporated herein by reference in entirety.
While the present invention has been described with reference to the definite number of embodiments, the scope of the present invention is not limited thereto and improvements and modifications of the embodiments based on the above disclosure are obvious to those skilled in the art.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2011-131222 | Jun 2011 | JP | national |
| Filing Document | Filing Date | Country | Kind | 371c Date |
|---|---|---|---|---|
| PCT/JP2012/001576 | 3/7/2012 | WO | 00 | 12/12/2013 |
