The present invention will become fully understood from the detailed description given herein below and the accompanying drawings, which are given by way of illustration and example only and thus not limitative of the present invention:
a (prior art) illustrate the focus of expansion phenomenon;
b (prior art) graphically defines epipolar geometry;
a is a side view illustration of an embodiment of a vehicle warning system according to the present invention;
b is atop view illustration of the embodiment of
a exemplifies a situation where a pedestrian is on the side-walk, which is not on the ground plane of the host vehicle; and
b depicts an example of severe curves in road that place the feet of the pedestrian below the road plane as defined by the host vehicle wheels;
a is flow diagram which illustrates algorithm steps for vehicle control, in accordance with embodiments of the present invention; and
b is flow diagram which illustrates algorithm steps for verifying human body temperature, in accordance with embodiments of the present invention.
The present invention is of a system and method of processing image frames of an obstacle as viewed in real time from two cameras mounted in a vehicle: a visible light (VIS) camera and a FIR camera, whereas the VIS camera is mounted inside the cabin behind the windshield and the FIR camera is mounted in front of the engine, so that the image is not masked by the engine heat. Specifically, at night scenes, the system and method processes images of both cameras simultaneously, whereas the FIR images typically dominate detection and distance measurements in distances over 25 meters, the VIS images typically dominate detection and distance measurements in distances below 10 meters, and in the range of 10-25 meters, stereo processing of VIS images and corresponding FIR images is taking place.
Before explaining embodiments of the invention in detail, it is to be understood that the invention is not limited in its application to the details of design and the arrangement of the components set forth in the following description or illustrated in the drawings. The invention is capable of other embodiments or of being practiced or carried out in various ways. Also, it is to be understood that the phraseology and terminology employed herein is for the purpose of description and should not be regarded as limiting.
Embodiments of the present invention are preferably implemented using instrumentation well known in the art of image capture and processing, typically including an image capturing devices, e.g. VIS camera 110, FIR camera 120 and an image processor 130, capable of buffering and processing images in real time. A VIS camera typically has a wider FOV of 3520 -50° (angular) which corresponds to a focal length of 8 mm-6mm (assuming the Micron MT9V022, a VGA sensor with a square pixel size of 6 um), and that enables obstacle detection in the range of 90-50 meters. VIS camera 110 preferably has a wide angle of 42°, f/n. A FIR camera typically has a narrower FOV of 15°-25°, and that enables obstacle detection in the range above 100 meters. FIR camera 120 preferably has a narrow angle of 15°, f/n
Moreover, according to actual instrumentation and equipment of preferred embodiments of the method and system of the present invention, several selected steps could be implemented by hardware, firmware or by software on any operating system or a combination thereof. For example, as hardware, selected steps of the invention could be implemented as a chip or a circuit. As software, selected steps of the invention could be implemented as a plurality of software instructions being executed by a computer using any suitable operating system. In any case, selected steps of the method and system of the invention could be described as being performed by a processor, such as a computing platform for executing a plurality of instructions.
Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs. The methods, and examples provided herein are illustrative only and not intended to be limiting.
By way of introduction the present invention intends to provide in a vehicle tracking or control system which adequately detects obstacles in ranges of zero and up to and more than 100 meters from the front of the host vehicle. The system detects obstacles in day scenes, lit and unlit night scenes and at different weather conditions. The system includes a computerized processing unit and two cameras mounted in a vehicle: a visible light (VIS) camera and a FIR camera, whereas the VIS camera is mounted inside the cabin behind the windshield and the FIR camera is mounted in front of the engine and detects heat emitting objects. The cameras are mounted such that there is a wide baseline for stereo analysis of corresponding VIS images and FIR images.
It should be noted, that although the discussion herein relates to a forward moving vehicle equipped with VIS camera and FIR camera pointing forward in the direction of motion of host vehicle moving forward, the present invention may, by non-limiting example, alternatively be configured as well using VIS camera and FIR camera pointing backward in the direction of motion of host vehicle moving forward, and equivalently detecting objects and measure the range therefrom.
It should be further noted that lie principles of the present invention are applicable in Collision Warning Systems, such as Forward Collision Warning (FCW) systems based on scale change computations, and other applications such as headway monitoring and Adaptive Cruise Control (ACC) which require knowing the actual distance to the vehicle ahead. Another application is Lane Change Assist (LCA), where VIS camera is attached to or integrated into the side mirror, facing backwards. In the LCA application, a following vehicle is detected when entering a zone at specific distance (e.g. 17 meters), and thus a decision is made if it is safe to change lanes.
Object detecting system 100 of the present invention combines two commonly used object detecting system: a VIS camera based system a FIR camera based system. No adjustment to the mounting location of the two sensors 110 and 120 is required, compared with the prior art location. The added boost in performance of the object detecting system 100 of the present invention, benefits by combining existing outputs of the two sensors 110 and 120 with computation and algorithms, according to different embodiments of the present invention. Reference is now made to
The present invention combines the output from a visible light sensor 110 and a FIR sensor 120. Each sensor performs an important application independent of the other sensor, and each sensor is positioned in the vehicle 50 to perform the sensor own function optimally. The relative positioning of the two sensors 110 and 120 has been determined to be suitable for fusing together the information from both sensors and getting a significant boost in performance:
An aspect of the present invention is to enhance range estimates to detected objects 10.
The computation of the pedestrian 10 distance D using the ground plane assumption uses equation 1, where f is the focal length of camera used (for example, 500 pixels for FOV=36° of a VIS camera 110), y=ybot (shown in
Typically, in FIR images, the head and feet of a pedestrian 10 can be accurately located in the image frame acquired (within 1 pixel). The height of pedestrian 10 is assumed to be known (for example, 1.7 m) and thus, a range estimate can be computed:
where h is the height of pedestrian 10 in the image and f is the focal length of the camera.
A second feature that can be used is the change of image size of the target due to the change in distance of the camera from the object, which is herein referred to as “scale change”.
Two assumptions are made here:
It can be shown that:
or range D is related to scale change by:
where v is the vehicle speed and αt is the time difference between the two consecutive images.
The estimation of range D becomes more accurate as host vehicle 50 is closing in on pedestrian 10 rapidly and the closer host vehicle 50 is to pedestrian 10 the more important is range measurement accuracy. The estimation of range D using the scale change method is less accurate for far objects, as the scale change is small, approaching the measurement error. However, measurements of scale change may be made using frames that are more spaced out over time.
For stationary pedestrians or objects 10 not in the path of vehicle 50 (for example pedestrians 10 standing on the sidewalk waiting to cross), the motion of the centroid of object 10 can be used. Equation 5 is used, but the “scale change” s is now the relative change in the lateral position in the FIR image frame of object 10 relative to the focus of expansion (FOE) 90 (see
The range D estimates are combined using known height and scale change. Weighting is based on observed vehicle 50 speed. One possible configuration of an object detecting system 100, according to the present invention, is shown in
The world coordinate system of a camera is illustrated in
The coordinate of optical center 126 of FIR camera 120 Pf is thus:
In one particular example the values can be:
Xv=−0.2 meter (8)
Yv=(1.2−0.5)=0.7 meter (9)
Zf=−1.5 meter (10)
In other words, in the above example, VIS camera 110 is mounted near the rearview mirror, 1.5 meter behind FIR camera 120, 0.7 meter above FIR camera 120 a and 0.2 meter off to the right of optical center 126 of FIR camera 120. The optical axes of the two cameras 110 and 120 are assumed to be aligned (In practice, one could do rectification to ensure this alignment).
The image coordinates, in FIR camera 120, of a point P=(X, Y, Z)T in world coordinates is given by the equations:
where f1 is the focal length of FIR camera 120 in pixels.
In practice, for example, the focal length could be f1=2000.
The image coordinates, in VIS camera 110, of the same point P is given by the equations:
where f2 is the focal length of VIS camera 110 in pixels.
In practice, for example, the focal length could be f2=800, indicating a wider field of view.
Next, for each point in the FIR image, processor 130 finds where a given point might fall in the VIS image. Equation 11 is inverted:
The values for X and Y are inserted into equation 12. For each distance D a point pv is obtained. As V varies, p, draws a line called the epipolar line.
A way to project points from the FIR image to the VIS image, as a function of distance D, is now established. For example, given a rectangle around a candidate pedestrian in the FIR image, the location of that rectangle can be projected onto the VIS image, as a function of the distance D. The rectangle will project to a rectangle wit the same aspect ratio. Since the two cameras 110 and 120 are not on the same plane (i.e. Xf≠0) the rectangle size will vary slightly from the ratio
In order to compute the alignment between patches in the FIR and visible light images, a suitable metric must be defined. Due to very different characteristics of the two images, it is not possible to use simple correlation or sum square differences (SSD) as is typically used for stereo alignment.
A target candidate is detected in the FIR image and is defined by an enclosing rectangle. The rectangle is projected onto the visible image and test for alignment. The following three methods can be used to compute an alignment score. The method using Mutual Information can be used for matching pedestrians detected in the FIR to regions in the visible light image. The other two methods can also be used for matching targets detected in the visible light image to regions in the FIR image. They are also more suitable for vehicle targets.
Alignment using Mutual Information: since a FIR image of the pedestrian 10 is typically much brighter than the background, it is possible to apply a threshold to the pixels inside the surrounding rectangle. The binary image will define foreground pixels belonging to the pedestrian 10 and background pixels. Each possible alignment divides the pixels in the visible light image into two groups: those that are overlaid with ones from the binary and those that are overlaid with the zeros.
Histograms of the gray level values for each of the two groups can be computed. Mutual information can be used to measure the similarity between two distributions or histograms. An alignment which produces histograms which are the least similar are selected as best alignment, In addition to using histograms of gray levels, histograms of texture features such as gradient directions or local spatial frequencies such as the response to a series of Gabor filters and so forth, can be used.
Alignment using Sub-patch Correlation: a method for determining the optimal alignment based on the fact that even though the image quality is very different, there are many edge features that appear in both images. The method steps are as follows:
c) The patch is scaled according to the ratio
The location of the center of the patch along the epipolar line is computed in the visible image as a function of the distance D.
For each location of the center of the patch along the epipolar line, the absolute value of the normalized correlation is computed.
Local maxima points are determined.
Being able to align and match FIR images and corresponding visible light images, the following advantages of the fusion of the two sensors, can be rendered as follows:
Due to the location restrictions in mounting FIR camera 120 there is a significant height disparity between FIR camera 120 and VIS camera 110. Thus, The two sensors can be used as a stereo pair with a wide baseline giving accurate depth estimates.
One embodiment of the invention is particularly applicable to nighttime and is illustrated in tie flow chart of
The accurate range estimates can be used for applications such as driver warning system, active braking and/or speed control. The driver warning system can perform application selected from the group of applications consisting of: detecting lane markings in a road, detecting pedestrians, detecting vehicles, detecting obstacles, detecting road signs, lane keeping, lane change assist, headway keeping and headlights control.
In order to provide good visibility of pedestrians 10 at a far distance (typically over 50 meters), FIR camera 120 has a narrow FOV. One drawback of a narrow FOV is that when a vehicle 50 approaches a pedestrian 10 which is in the vehicle 50 path but not imaged at the center of the FIR image, the pedestrian 10 leaves the FIR camera FOV. Thus, in the range of 0-10 meters, where human response time is too long and automatic intervention is required, the target 10 is often not visible by FIR camera 120 and therefore automatic intervention such as braking cannot be applied.
The FOV of VIS camera 110 is often much wider. Furthermore, the VIS camera 110 is mounted inside the cabin, typically 1.5 meter to 2 meters to the rear of FIR camera 120. Thus, the full vehicle width is often visible from a distance of zero in front of the vehicle 50.
Visible light cameras 110 give good vehicle detection capability in both day and night. This has been shown to provide a good enough quality signal for Adaptive Cruise Control (ACC), for example. However, mistakes do happen. A particular configuration of unrelated features in the scene can appear as a vehicle. The solution is often to track the candidate vehicle over time and verify that the candidate vehicle appearance and motion is consistent with a typical vehicle. Tracking a candidate vehicle over time, delays the response time of the system. The possibility of a mistake, however rare, also reduces the possibility of using a vision based system for safety critical tasks such as collision avoidance by active braking.
In a fourth embodiment of the present invention, a vehicle target, whose distance has been roughly determined from VIS camera 110, is matched to a patch in the FIR image. The patch is then aligned. The aligned patch in the FIR image is then searched for the telltale features of a vehicle such as the hot tires and exhaust. If features are found the vehicle target is approved and appropriate action can be performed sooner, in step 262.
In a fifth embodiment of tee invention, a pedestrian target 10 is detected by VIS camera 110 in a well illuminated scene. A range D estimate is obtained using triangulation with the ground plane 20 and other techniques (described above). Using the epipolar geometry (defined above), the target range and angle (i.e. image coordinates) provide a likely target location in the FIR image. Further alignment between the two images is performed if required. The image brightness in the FIR image is then used to verify that the temperature of the target matches that of a human, in step 264. This provides for higher reliability detection of more difficult targets.
In certain lighting conditions VIS camera 110 cannot achieve good contrast in all parts of the image. VIS camera 110 must then make compromises and tries and optimize the gain and exposure for certain regions of the interest. For example, in bright sunlit days, it might be hard to detect pedestrians in the shadow, especially if the pedestrians are dressed in dark clothes.
Hence, in a sixth embodiment of the invention, a pedestrian target 10 candidate is detected in the FIR image. Information about target angle and rough range is transferred to the visible light system. In stop 244 of algorithm 200 shown in
In another embodiment of the present invention, a Near Infra Red (NIR) camera is used instead of a visible light camera. Since the NIR camera is often located inside the cabin, typically near the rearview mirror, the fusion discussed between visible light cameras and FIR also work between NIR and FIR. The range of the fusion region will of course be larger due to extended night time performance of the NIR camera.
Therefore, the foregoing is considered as illustrative only of the principles of the invention. Further, since numerous modifications and changes will readily occur to those skilled in the art, it is not desired to limit the invention to the exact design and operation shown and described, and accordingly, all suitable modifications and equivalents may be resorted to, falling within the scope of the invention.
While the invention has been described with respect to a limited number of embodiments, it will be appreciated that many variations, modifications and other applications of the invention may be made.
The present application claims the benefit under 35 USC 119(e) of U.S. provisional application 60/80,356 filed on May 31, 2006 by the present inventors, the disclosure of which is incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
60809356 | May 2006 | US |