Background of the Invention
(1) Field of the Invention
The present invention relates generally to an vehicle which runs autonomously on a route of travel toward a destination using a fuzzy control method.
(2) Background Art
Japanese Patent Application First Publication (JP-Al) Showa 62-162113 published on July 18, 1987 and Japanese Utility Model Registration Application First Publication (JP-Al) Heisei 1-15510 published on Oct. 25, 1989 exemplify a previously proposed autonomous vehicle running on a set route of travel.
A U.S. patent application Ser. No. 337,707 filed on Apr. 13, 1989 also exemplifies the previously proposed autonomous vehicle described above.
In Japanese Utility Model Application First Publication No. Heisei 1-15510, a camera which forms an image of the running route of the vehicle is installed on the vehicle to run the vehicle autonomously along a guide line, e.g., a white line on the route of travel.
In addition, in another previously proposed autonomous vehicle, a camera is used to observe left and right guide lines located in front of the vehicle at a constant distance and the steering wheel is driven so as to guide the vehicle between these guide lines.
Furthermore, the distance L at which the guidelines are observed is changed according to the vehicle speed V in the following way:
L.sub.o, .alpha. denote constants.
However, although points to be visually observed can be changed according to vehicle speed in the previously proposed autonomous vehicle, only one visual point is scanned at one time, areas in front thereof being ignored. Therefore, the autonomous vehicle cannot remain in a centered position when running on a curved road or an S-shaped road. In addition, during operations such as driving on curved roads, the vehicle speed must be considerably reduced. Consequently, the running stability of the autonomous vehicle becomes reduced.
Summary of the Invention
It is an object of the present invention to provide an autonomous vehicle which can run at a desired position on a curved road such as an S-shaped road and, which need not decelerate unnecessarily so as to maintain a good running stability.
It is another object of the present invention to provide a method for running such an autonomous vehicle.
An autonomous vehicle according to one form of the present invention comprises a) first means for forming an image of guide lines on a road on which the vehicle is to run and generating an imaging signal representative of the image; b) second means for receiving the imaging signal and setting a plurality of visual (image data) points, and for each visual point calculating the deviation of a reference point on the road from the direction toward which the vehicle is running; c) third means for storing a membership function on a degree of importance for each visual point with respect to vehicle speed; d) fourth means for multiplying the deviation for each visual point by the degree of importance for each visual point and deriving a total deviation for all visual points; and e) fifth means for carrying out steering control of the vehicle on the basis of the total deviation calculated by the fourth means.
An autonomous vehicle according to another form of the present invention comprises a) an imaging portion having a camera that forms an image of guide lines on a road on which the vehicle is running; b) an image processing portion processing an imaging signal derived from the camera; c) a map information storing portion storing map data and other map information for a route of travel on which the vehicle is to run; d) a general running control portion referring to map information derived from the map information portion and setting a basic controlled variable as a basic steering displacement instruction .DELTA.S.sub.T on the basis of route data derived from map information; e) a steering control portion using various membership functions stored in a membership function storing portion, deriving a steering displacement instruction .DELTA.S.sub.g which is different from the basic steering displacement instruction .DELTA.S.sub.T set by the general running control portion via a fuzzy control program, and outputting the sum of the steering displacement instructions .DELTA.S.sub.T +.DELTA.S.sub.g ; f) a steering drive portion for driving the steering wheel of the vehicle to a position determined using the steering displacement instruction output by the steering control portion; and g) a membership function storing portion storing a single visual point membership function for the fuzzy control program and multi-visual point membership functions for the fuzzy control program.
A method for autonomously running a vehicle, according to the present invention comprises forming an image of the steps of guide lines on a road on which the vehicle is running using a camera installed on the vehicle and outputting an imaging signal representative of the image; b) receiving the imaging signal and setting a plurality of visual (image data) points, and at each visual point calculating the deviation of a reference point on the road from the direction toward which the vehicle is running; c) storing a membership function on a degree of importance for each visual point with respect to vehicle speed; d) multiplying the deviation for each visual point by the degree of importance for each visual point and deriving a total deviation for all visual points; and e) carrying out steering control of the vehicle on the basis of the total deviation calculated by the fourth means.
Brief Description of the Drawings
FIG. 1 is a shematic view of an autonomously running vehicle in a preferred embodiment according to the present invention.
FIG. 2 is a functional block diagram of a control device for an autonomous vehicle in the preferred embodiment according to the present invention.
FIG. 3 is an operational flowchart of a steering control method utilizing a plurality of visual points.
FIG. 4 is an explanatory view of imaging data.
FIG. 5 is an explanatory view of a membership function used in a multi-visual point control operation.
FIG. 6 is an explanatory view of a modified algorithm of the membership function.
FIG. 7 is an explanatory view of the membership function expressed as dispersion data.
FIG. 8 is an explanatory view of imaging data when the autonomous vehicle runs on an S-shaped road.
Detailed Description of the Preferred Embodiment
Reference will hereinafter be made to the drawings in order to facilitate a better understanding of the present invention.
FIG. 1 shows the outer appearance of an autonomous vehicle in a preferred embodiment of to the present invention.
In FIG. 1, a camera 9 is installed on a vehicle body 6 for forming an image of guide lines 8 such as a road edge or white lines provided on a road 7.
FIG. 2 shows a control device which is arranged in the autonomous vehicle body 6.
The control device includes an imaging portion 10 including the camera 9, an image processing portion 11 which processes the image from the imaging signal derived by the camera 9, a general running controller 13 connected to a map information portion 12, a steering control portion 15 connected to a membership function storing portion 14, and a steering drive portion 16.
The map information storing portion 12 stores map data on a route of travel as well as other information on the route of travel.
The general running control portion 13 refers to the map information derived from the map information storing portion and sets a basic controlled variable for steering on the basis of route data such as road contour and for the presence of different types of guide lines such as curbs or white lines.
Namely, the general running control portion 13 defines a start point and end point of a running interval on a relatively simple route such as a straight road or a simple circular curved road and sets a steering displacement instruction .DELTA.S.sub.T (a function of distance) in this interval as a basic controlled steering variable.
The steering control portion 15 uses various kinds of membership functions stored in the membership function storing portion 14 and derives a steering displacement instruction .DELTA.S.sub.g, which is different from the steering displacement instruction .DELTA.S.sub.T set in the general running control portion 13, via a fuzzy control program. The sum of both steering displacement instructions .DELTA.S.sub.T and .DELTA.S.sub.g (.DELTA.S.sub.T +.DELTA.S.sub.g) is supplied to the steering drive portion 16.
The membership function storing portion 14 may store a membership function from the fuzzy control program for a single visual point or multiple membership functions from the fuzzy control program for a plurality of visual points as required by the complexity of the route of travel.
The fuzzy control program in the single visual point mode is applied to, e.g., a plurality of control rules with respect to all deviation quantities .DELTA.X, .DELTA..theta. indicated by:
if .DELTA.X is X and .DELTA..theta. is .theta. then .DELTA.S=A (.DELTA.X, .DELTA..theta.), wherein .DELTA.X denotes the position deviation in the lateral direction and .DELTA..theta. denotes the angular deviation in the forward lateral direction L.sub.m. Then, the fuzzy control program derives a degree of importance for each rule with respect to the magnitudes of actual deviations .DELTA.X and .DELTA..theta. by a membership value of the membership function set for each deviation and calculates a steering displacement instruction .DELTA.S.sub.g from a weighted mean of all rules. Since fuzzy control from a single visual point is well known in the art, a detailed explanation of the fuzzy control program in the single visual point mode will be omitted here.
The steering control portion 15 switches the control method in such a way that during running on a straight road the single view-point method is used and during running on a curved road, the multi-visual point method is used, the method being selected according to road conditions on the road 7 as derived from the image processing portion 11 or according to instructions from the general running control portion 13.
The steering drive portion 16 drives the steering wheel of the vehicle in response to the steering displacement instruction .DELTA.S output by the steering control portion 15 in accordance with the magnitude .DELTA.S of the instruction.
FIG. 3 shows a flowchart indicating the steering control method in the multi-visual point mode.
In the preferred embodiment, four visual points in front of the vehicle separated by a constant interval of yi (i=0, 1, 2, 3) meters are monitored with respect to the instantaneous position of the vehicle 6. In other words, the distance interval yi between the vehicle 6 and the first visual point is substantially equal to the distance interval yi between the first visual point and the second visual point, etc. up to a maximum of four visual points for example.
In step 401, the control device inputs imaging data on left and right guide lines 8.sub.L and 8.sub.R as shown in FIG. 4.
In step 402, the control device derives the deviation (positional deviation) dxi (i=0, 1, 2, 3) between a reference point Pi (i=0, 1, 2, 3) at the center of the road at each visual point and a reference line STD indicating the forward direction of the vehicle and compares each deviation dxi with that of the previous control period so as to derive the rate of change dxi (dx/dt i) with respect to time (i=0, 1, 2, 3). The rate of change with respect to time denotes the difference between the present deviation and that at the previous control period, indicating the change in the radius of curvature of the road.
In step 403, the membership functions shown in FIG. 5 are modified by the procedure shown in FIG. 6 according to the rate of change dxi of each deviation dxi.
Namely, the membership functions shown in FIG. 5 are stored in the membership function storing portion 14 and distinguished from the single membership function utilized for a straight road. The degree of importance of each visual point yi at a vehicle speed V is indicated by a membership value .mu..sub.i (i=0, 1, 2, 3).
In addition, the width .vertline.r j.vertline. between the visual points is caused to change by a quantity .vertline.ri.times.dx.sub.i .vertline. which is the product of the width .vertline.rj.vertline. of each membership function DX.sub.i and a corresponding time rate of change dxi.
Hence, in step 403, the membership functions DX.sub.i shown in FIG. 5 are modified according to the rate of change dxi indicating the change in the radius curvature of a curved road. Then, calculation of the degree of importance of the visual points by a membership value .mu.i is completed. For example, if the present vehicle speed is V.sub.1 as shown in FIG. 5, the membership value .mu..sub.1 indicating the degree of importance of the deviation quantity dx.sub.1 at y.sub.1 is 0. 2. This corresponds to visual point y.sub.1 of FIG. 4. The membership value .mu..sub.2 indicating the degree of importance of the deviation quantity dx.sub.2 at y.sub.2 is 0. 8. This corresponds to visual point y.sub.2 of FIG. 4. (It is noted that the degrees of importance for the deviations dx.sub.o and dx.sub.3 are zeroe in the case shown in FIGS. 4 and 5.)
In addition, in a case where modification is made to the membership function DX.sub.1, as shown in FIG. 6, the degree of importance of visual point y.sub.1 is changed from 0.2 to 0.3 in the case shown in FIG. 7 (since the rate of change of the deviation becomes larger).
The membership functions may be calculated as a form of dispersion data as shown in FIG. 7.
Namely, the calculation of the dispersion data may be modified by changing its maximum value by.+-.r m. Then, various types of calculations may easily be carried out.
Next, in step 404, a total Dx of each deviation dxi is calculated by the following equation:
Next, in step 405, a constant K is multiplied by the total sum Dx.
In step 405, the product K.times.D.sub.x is set as a steering displacement instruction .DELTA.S.sub.g. In step 406, the steering is driven in response to the final instruction .DELTA. S which is derived from the steering instruction .DELTA.S.sub.g.
Namely, .DELTA.S=.DELTA.S.sub.g when .DELTA.S.sub.T =0
As described above, at visual point y.sub.1, appropriate steering control can be carried out with the deviation Dx totally derived from a plurality of visual points, even if the vehicle runs on an S-shaped road as shown in FIG. 8.
Since the degree of importance of visual points at a curved portion having a large radius of curvature is increased, the vehicle can autonomously run with stability along S-shaped roads.
The degree of importance of the visual points is changed according to the instantaneous vehicle speed as shown in FIG. 5 so that there is no need to reduce vehicle speed even if the vehicle runs on a curved road.
In the preferred embodiment, although the steering controlled variable .DELTA.S is set only by the value of the product K.times.Dx, the steering variable may be determined by both Dx and the basic steering instruction .DELTA.S.sub.T input from the general running control portion 13.
In addition, although the steering displacement instruction .DELTA.S.sub.g is derived from fuzzy calculation, the total D.sub..theta. of the steering angle deviations d.theta. at the plurality of visual points yi may be derived in the same way that the total Dx of the positional deviations is derived as the other variable, a control rule in the form of "if Dx is X and D.sub..theta. is .theta. then A (X, .theta.) may be applied, and the displacement instruction .DELTA.S.sub.g may be derived by means of hierarchal fuzzy calculation.
As described hereinabove, since in the autonomous vehicle according to the present invention, steering control can be carried out according to the radius of curvature of any curved road on which the vehicle runs, stable running characteristics can be achieved on both curved and straight roads without the need to reduce vehicle speed.
It will fully be appreciated by those skilled in the art that the foregoing description has been made in terms of the preferred embodiment and various changes and modifications may be made without departing from the present invention which is defined by the appended claims.