Control System for unmanned automotive vehicle
First Claim
1. In a method of controlling an unmanned vehicle, the steps of:
- observing a road using camera means;
producing an image of the road based on the output of the camera means;
rectifying the image in a manner which depicts the left and right hand edges of the lane n which the vehicle is running and which enables data to be read therefrom;
determining the curvature of the road and the direction in which it is curving;
determining the attitude of the vehicle on the road by determining the angle between the longitudinal axis and an imaginary line which runs along the middle of the lane depicted in the rectified image;
determining the vehicle speed;
determining a variable which varies as a function of the road curvature, the distance of the center of the vehicle from a side of the lane on which the vehicle is running and the vehicle speed;
performing a table look-up on a selected map using the attitude angle and the variable, to derive a steering angle; and
controlling the angle of the steering wheels of the vehicle with respect to the longitudinal axis of the vehicle to the derived steering angle.
1 Assignment
0 Petitions
Accused Products
Abstract
Stereo image data depicting the lane on which the vehicle is running is rectified into a planar image on which one or more level lines can be generated in a manner to intersect one or both of the edges of the lane. Angles are measured between lines which extend from these the points if intersection in directions normal to the level line or lines and lines which extend tangentially to any curvature which occurs in the road edges at the point of intersection. These angles are recorded, the difference therebetween determined and compared in a manner which determines the attitude of the vehicle on the road. The curvature of the road and the vehicle speed are determined and the best steering angle for the road wheels determined in accordance With a schedule which is recorded in terms of attitude and a parameter variable with the vehicle speed and road curvature.
183 Citations
38 Claims
-
1. In a method of controlling an unmanned vehicle, the steps of:
-
observing a road using camera means; producing an image of the road based on the output of the camera means; rectifying the image in a manner which depicts the left and right hand edges of the lane n which the vehicle is running and which enables data to be read therefrom; determining the curvature of the road and the direction in which it is curving; determining the attitude of the vehicle on the road by determining the angle between the longitudinal axis and an imaginary line which runs along the middle of the lane depicted in the rectified image; determining the vehicle speed; determining a variable which varies as a function of the road curvature, the distance of the center of the vehicle from a side of the lane on which the vehicle is running and the vehicle speed; performing a table look-up on a selected map using the attitude angle and the variable, to derive a steering angle; and controlling the angle of the steering wheels of the vehicle with respect to the longitudinal axis of the vehicle to the derived steering angle. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10)
-
-
11. In an unmanned vehicle travelling on a lane of a road,
camera means for observing the road; -
second means responsive to said camera means for; producing an image of the rod; rectifying the image in a manner which depicts a left hand and right hand edge of the lane on which the vehicle is running and which enables data to be read therefrom; determining any curvature of the road and the direction in which it is curving; determining the attitude of the vehicle on the road by determining the angle between the longitudinal axis and an imaginary line which runs along the middle of the lane depicted in the rectified image; determining the vehicle speed; determining a variable which varies as a function of road curvature, the distance of the enter of the vehicle from a side of the lane on which the vehicle is running and vehicle speed; performing a table look-up on a selected map using the attitude angle and the variable, to derive a steering angle; and means or controlling the range of the steering wheels of the vehicle in accordance with the output of the second means with respect to the longitudinal axis of the vehicle to the derived steering angle. - View Dependent Claims (12, 13, 14, 15, 16, 17, 18, 19, 20)
-
-
21. In an unmanned vehicle
a system for controlling said vehicle, comprising: -
first and second cameras for observing the road on which the vehicle is running; a wheel speed sensor arrangement, said wheel speed sensor arrangement producing a signal indicative of the rotational speed of first and second road wheels and from which the vehicle speed can be derived; a time computing section operatively connected to said first and second cameras, said image computing section including means for; producing an image of the road; rectifying the image in a manner which depicts left and right hand edges of the land on which the vehicle is running; and determining the curvature of the road and the directions in which it is curving; a steering control control section operatively connected with said image computing section, said steering control section including means for; determining the attitude of the vehicle on the road by determining the angle between the longitudinal axis and an imaginary line which runs along the middle of the lane depicted in the rectified image; determining a variable which carries as a function of road curvature, the distance of the center of the vehicle from a side of the lane on which the vehicle is running and the vehicle speed; and using the attitude angle and the available to derive a steering angle; a steering control actuator, said steering control actuator being operatively connected with the steerable wheels of the vehicle; an actuator control section;
said actuator control section being operatively interposed between said steering control section and said steering control actuator;
said actuator control section controlling the angle of the sterring wheels of the vehicle with respect to the longitudinal axis of the vehicle to the derived steering angle.
-
-
22. In an unmanned vehicle, a system for controlling said vehicle, said system comprising:
-
electronic stereo image data means for depicting the lane in which the vehicle is running; rectifying means or converting the stereo image data into a planer image on which one or more level lines can be generated, these generated lines intersecting one or both of the edges of the lane in which the vehicle is running; angle measuring means for measuring the angles between lines which extend from these points of intersection in a direction normal to the level line or liens and which extend tangentially to any curvature which occurs in the road edges at the point of intersection; and means for recording these angles and computing the difference therebetween, said difference therebetween indicating a best steering angel of the vehicle in accordance with a look-up performed on a selected map using an attitude angle and a variable.
-
-
23. A method of controlling a vehicle traveling along a road, comprising the steps of:
-
producing an image of the road by means of a camera; rectifying the image into a planar two dimensional image and a three dimensional image of the lane from images which the curvature of the lane, the width of the lane, the distance of the center of the vehicle form a side of the lane, and the attitude of the vehicle on the lane, can be determined, said step of determining the attitude of the vehicle on the lane being achieved by drawing a line along the middle of the lane depicted n the rectified image and determining the angle between the longitudinal axis of the vehicle and the line; determining vehicle speed by reading the output of a vehicle speed sensor; deriving a control parameter value which varies with the product of (a) the difference between the width of the lane and the distance of ht center of the vehicle from a side of the lane, and (b) the curvature of the lane, the product being divided by the vehicle speed; selecting for the control value and attitude one of a plurality of pre-recorded maps from which the most appropriate steering angle can be looked up; looking-up a steering angle for the selected map; and steering the vehicle in accordance with the steering angle so derived.
-
-
24. A control system for a vehicle, comprising:
-
a camera for producing an image of the road on which the vehicle is running; means for rectifying the image into a planar two dimensional image and a three dimensional image of the lane; means for extracting data, including the curvature of the lane, the width of the lane, the distance of the center of the vehicle from a side of the lane, and the attitude of the vehicle on the lane, from the rectified image, said data extracting means determining the attitude of the vehicle in the lane by drawing a line along the middle of the lane depicted in the rectified image and determining the angel between the longitudinal axis of the vehicle and the line; means for determining vehicle speed by reading the output of a vehicle speed sensor; means for deriving a control value which varies with the product of (a) the difference between the width of the lane and the distance of the center of the vehicle from a side of the lane, and (b) the curvature of the lane, the product being divided by the vehicle speed; means for applying the control value and attitude of the vehicle on the lane to select one a plurality of pre-recorded maps from which the most appropriate steering angel can be looked up; and means for looking up a steering angel from the selected map and steering the vehicle in accordance with the steering angel derived by look-up.
-
-
25. In a method of controlling a vehicle, the steps of:
-
observing the road; producing an image of the road; rectifying the image in a manner which depicts the left and right a hand edges of the lane on which the vehicle is running and which enables data to be read therefrom; determining the curvature of the road and the direction in which it is curving; determining the attitude of the vehicle on the road by determining the angle between the longitudinal axis and an imaginary line which runs along the middle of the lane depicted in the rectified image; determining the vehicle speed; determining a variable which varies as a function of the road curvature, the distance of the center of the vehicle from a side of the lane on which the vehicle is running and the vehicle speed; using the attitude angle and the variable to derive a steering angle; and controlling the angle of the steering wheels of the vehicle with respect to the longitudinal axis of the vehicle to the derived steering angle; wherein said step of curvature determination comprises; establishing a measurement level line on the rectified image at a location representative of a predetermined distance ahead of said vehicle; determining first and second points at the locations where said level lines intersect the left and right hand edges of the lane, respectively; determining the distance form the point that the longitudinal axis of the vehicle intersects said level line to the left hand edge of the lane; determining the distance from the point that the longitudinal axis of the vehicle intersects said level line of the left hand edge of the lane; generating first and second lines which pass through said point and which extend parallel to the longitudinal axis of the vehicle and normal to said level; and generating third and fourth lines which pass through said first and second points and which extend tangentially with respect to any curvature which exists in the left and the road lane edges at said first and second points, repressively; and measuring first and second angles, said first angle being defined between said first and third lines and said second angle being defined between said second and fourth lines. - View Dependent Claims (26, 27, 28, 29, 30, 31)
-
-
32. In a vehicle travelling in the lane of a road,
first means for observing the road; - second means responsive to said observing means for;
producing an image of the rod; rectifying the image in a manner which depicts a left hand and right hand edge of the lane on which the vehicle is running and which enables data to be read therefrom; determining any curvature of the road and the direction in which it is curving; determining the attitude of the vehicle on the road by determining the angle between the longitudinal axis and an imaginary line which runs along the middle of the lane depicted in the rectified image; determining the vehicle speed; determining a variable which aries as a function of road curvature, the distance of the center of the vehicle from a side of the lane on which the vehicle is running and vehicle speed; and using the attitude angle and the variable to derive a steering angle; and controlling the angle of the steering wheels of the vehicle in accordance with the output of the second means with respect to the longitudinal axis of the vehicle to the derived steering angle; wherein; said second means establishes a measurement level line of the rectified image at a location representative of a predetermined distance ahead of said vehicle; determines first and second points at the locations where said level lines intersect the left and right hand edges of the lane, respectively; determines the distance from the point that the longitudinal axis of the vehicle intersects said level line to the left hand edge of the lane; determines the distance form the point that the longitudinal axis of the vehicle intersects said level line to the left hand edge of the lane; generates first and second lines which pass through said point and which extend parallel with the longitudinal axis of the vehicle and normal to said level; generates third and fourth lines which pass through said first and second points and which extend tangentially with respect to any curvature which exits in the left and the road lane edges at said first and second points, respectively; and measures first and second angels, said first angle being defined between said firs and third lines and said second angle being defined between said second and fourth lines. - View Dependent Claims (33, 34, 35, 36, 37, 38)
- second means responsive to said observing means for;
Specification