Claims
- 1. In a method for avoiding collision between a human driven motor vehicle and at least one obstacle comprising the stages of: searching for at least one obstacle (120) in an environment in front of the motor vehicle (100) along a presumed path (119) for the motor vehicle, calculating the distance (d.sub.obst) and the relative speed (V.sub.obst) of the obstacle, and indicating the obstacle with an indication of its hazard level, these stages being repeated cyclicly, the improvement in that the stage of searching for the obstacle comprises:
- generating a map (115) of the environment in front of the motor vehicle (100) by scanning the environment;
- reconstructing the geometry of a road (116) on the basis of the map (115);
- reconstructing the presumed path (119) of the motor vehicle on the basis of the reconstructed geometry of the road; and
- searching for the obstacle (120) within the reconstructed presumed path.
- 2. A method according to claim 1, characterised in that it also includes the stages of detecting the manoeuvre being performed by the motor vehicle (100) with respect to the road (116), and of amending the presumed path (119) of the motor vehicle on the basis of the manoeuvre detected.
- 3. A method according to claim 1, characterised in that the said scanning is performed by means of a microwave radar.
- 4. A method according to claim 1, characterised in that the said stage of generating a map (115) comprises scanning of the environment in front of the motor vehicle (100) within a predetermined scanning angle centred on the longitudinal axis of the vehicle (100), with subdivision of the environment in front of the vehicle into a plurality of sectors, and storing a matrix which includes the findings calculated on the basis of the corresponding sector and the distance found.
- 5. A method according to claim 1, characterised in that it includes the stages of measuring the angle (.theta.) of the steering wheel of the motor vehicle (100), measuring the speed (v) of the vehicle and determining the condition, wet or dry, of the road surface.
- 6. A method according to claim 5, characterised in that the radius (R.sub.V) and the curvature (C.sub.0V =l/R.sub.V) of the path travelled by the vehicle (100) at that instant is calculated on the basis of the said steering wheel angle (.theta.) and the safe distance (dds) of the motor vehicle is calculated on the basis of the formula:
- dds=v*Tr+v.sup.2 /(2*A.sub.max)
- where Tr is a fixed value and A.sub.max represents the maximum deceleration by sharp braking and is stored in the memory as a function of the speed of the vehicle and the road condition.
- 7. A method according to claim 1, characterised in that the said stage of reconstructing the road geometry includes calculation of the following parameters: the heading angle (.PHI.) of the motor vehicle (100) and its distance from the edges of the road (L.sub.s, L.sub.d), and the curvature (C.sub.0s) and spatial derivative (C.sub.1s) of the road curvature (116).
- 8. A method according to claim 7, characterised in that values of the said parameters (.PHI., L.sub.s, L.sub.d, C.sub.0s and C.sub.1s) which maximise the value F in the function ##EQU4## where i=1 . . . n, where n is equal to the number of obstacles found in the map, d is the geometrical distance between an obstacle having the coordinates (x.sub.i, y.sub.i) and the edge of the road, identified from the abovementioned five parameters, and .alpha. is a multiplying coefficient of a predetermined value, are sought.
- 9. A method according to claim 8, characterised in that the value F of the said function is compared with a reference threshold (F.sub.0) and when it is less than the said threshold the curvature (C.sub.1) of the presumed path (119) is determined on the basis of the angle (.theta.) of the steering wheel, and if this is not the case the manoeuvre being performed by the motor vehicle (100) is determined.
- 10. A method according to claim 8, characterised in that the said stage of detecting the manoeuvre being performed includes calculation of the manoeuvre necessary to return the motor vehicle (100) to axial alignment with the road (116) at a predetermined distance (D).
- 11. A method according to claim 10, characterised in that calculation of the necessary manoeuvre includes calculation of the alignment manoeuvre (C.sub.1a) in accordance with the relationship:
- C.sub.1a =C.sub.1V =C.sub.1s +2*(C.sub.0s -C.sub.0V)/D-2*.PHI./D.sup.2
- where C.sub.1V represents the derivative of the spatial curvature of the path (119) of the motor vehicle (100), C.sub.1s is the derivative of the spatial curvature of the road, C.sub.0s is the spatial curvature of the road, C.sub.0V is the spatial curvature of the vehicle's path, .PHI. is the heading angle and D represents the said predetermined distance.
- 12. A method according to claim 11, characterised in that the calculated value of the aligning manoeuvre (C.sub.1a) is compared with a limit value (C.sub.1amax) to determine whether the motor vehicle (100) is performing a manoeuvre aligning it with the road profile (119) or is performing a special manoeuvre.
- 13. A method according to claim 12, characterised in that when the value of the aligning manoeuvre (C.sub.1a) lies below the said limit value (C.sub.1amax) the spatial derivative (C.sub.1) of the curvature of the presumed path (119) is determined on the basis of the said value of the aligning manoeuvre (C.sub.1a), otherwise the spatial derivative (C.sub.1) of the curvature of the presumed path (119) is calculated on the basis of the special manoeuvre being performed on the basis of the equation: ##EQU5## where C.sub.0V (t) and C.sub.0V (t-1) are the curvature of the vehicle's path (100) at the instants when the present map (115) and the previous map respectively was determined, v is the speed of the motor vehicle (100) and t is the time between two successive detection cycles.
- 14. A method according to claim 1, characterised in that the said stage of searching for possible objects within the presumed path includes searching for obstacles (120) within a travel corridor (119) having a width equal to the width of the motor vehicle, a curvature equal to C.sub.0s and a derivative of the curvature equal to C.sub.1.
- 15. A method according to claim 14, characterised in that when the said stage of searching for obstacles (120) has a negative outcome a representation of the map (115) of the road situation is displayed.
- 16. A method according to claim 14, characterised in that when the said stage of searching for obstacles (120) has a positive outcome the identification of an obstacle (120) in the previous map (115) is verified.
- 17. A method according to claim 16, characterised in that when no obstacle is identified in the previous map (115) a representation of the map (115) of the road situation is displayed, and if this is not the case the relative speed (V.sub.obst) of the obstacle found is calculated, the distance (d.sub.obst) of the obstacle is compared with the safe distance (dds), when the relative speed (V.sub.obst) of the obstacle is negative and the distance to the obstacle (dds) is less than the safe distance a serious alarm condition is generated, when the relative speed of the obstacle is positive and the distance to the obstacle is less than the safe distance an alarm condition is generated, and when the relative speed is negative and the distance to the obstacle is greater than the safe distance a prealarm condition is generated.
- 18. A method according to claim 1, characterised by the generation of a perspective representation of the map (115) of the environment in front of the motor vehicle showing the edges (124) of the road (116), the presumed path (119) of the motor vehicle (100) and objects (125, 126) located on the road, with a different identification according to hazard level.
- 19. In a system for avoiding collision between a human driven motor vehicle and at least one object, the system including a sensor (22) for monitoring an environment in front of the motor vehicle (100) to detect the presence of the object, means (47, 49) for calculating the distance (d.sub.obst) and the relative speed (V.sub.obst) of the object, and means (32, 34) for indicating the presence of the object with an indication of its hazard level, the improvement in that the sensor (22) is a scanning sensor for generating a map (115) of the environment in front of the motor vehicle (100) comprising means (39) for reconstructing the geometry of a road (116) on the basis of the map, means (15) for reconstructing a presumed path (119) for the motor vehicle on the basis of the reconstructed geometry of the road, and means (46) for searching for the object within the presumed path.
- 20. A system according to claim 19, characterised in that the said sensor (22) is a microwave radar.
- 21. A system according to claim 19, characterised in that it includes means (43) for detecting the manoeuvre being performed by the motor vehicle (100) with respect to the road (116) and means (45) for altering the presumed path (119) of the motor vehicle (100) on the basis of the manoeuvre found.
- 22. A system according to claim 19, characterised in that it includes means (17) for counting the positive findings obtained for a given distance within a plurality of sectors of predetermined angular size constituting the map (115) and means (18) for storing a matrix recording the number of findings calculated in relation to the corresponding sector and the distance found.
Priority Claims (1)
Number |
Date |
Country |
Kind |
67499-A/90 |
Jul 1990 |
ITX |
|
Parent Case Info
This is a continuation of copending application Ser. No. 07/725,014 filed on Jul. 3, 1991 now abandoned.
US Referenced Citations (23)
Foreign Referenced Citations (1)
Number |
Date |
Country |
353200 |
Jan 1990 |
EPX |
Continuations (1)
|
Number |
Date |
Country |
Parent |
725014 |
Jul 1991 |
|