Speed control method for vehicle approaching and traveling on a curve

A vehicle curve speed control system (10) adapted for use with a vehicle (12) having an operator (14), includes a map database (16) representing a current vehicle path, and a locator device (20) communicatively coupled to the database (16) and configured to determine the location of the vehicle (12) on the path. The system (10) further includes a controller (36) configured to identify approaching curve points of a curve (18a) in terms of curvature or radius, and determine a desired speed profile based on operator preference and/or vehicle characteristic input. An acceleration profile is determined, based on the current vehicle speed, and desired speed profile. An acceleration/deceleration command at the present control loop is modified towards achieving an optimal curve speed, and is delivered to either a brake or acceleration module (40,42) to automatically accelerate or decelerate the vehicle (12) accordingly.

BACKGROUND OF THE INVENTION

1. Technical Field

The present invention relates to curve speed control systems, and more particularly to a speed control system configured to facilitate proper operator management of the curve by accelerating or decelerating the vehicle automatically.

2. Background Art

Particularly with respect to automobiles, operator mismanagement of a curve is one of the most prevalent factors contributing to accidents. In these accidents, it is appreciated that excessive lateral forces result when the rate of speed of the vehicle exceeds the rate of speed at which the vehicle could safely or comfortably manage the curve. It is further appreciated that when approaching a curve at excessive speeds the operator typically begins a precarious cycle of excessive braking and steering to resolve the cornering difficulties.

Historically, licensed civil engineers have designed thoroughfare curves by selecting one of a plurality of curve templates, i.e. circular, spiral, and more likely a combination of both, that best fits existing terrain and avoids obstructions for which removal is deemed too costly. The beginning of the curve is typically set at a given station and further indicia, such as the curve beginning and ending radius, is also typically noted on the plans. Computer aided design techniques and software provide cross-sections at typical station offsets, wherein elevation points and bank angles for the curve are represented. These plans are precisely staked and constructed in the field by survey and construction crews. Finally, the thoroughfare speed limit is determined, such that a typical driver and vehicle combination producing a minimal normal force, and lateral coefficient of friction with the surface, is capable of withstanding the lateral acceleration caused by centrifugal force acting upon the vehicle.

More particularly, centrifugal force, Fc(=mac=mv2/R), acts upon the vehicle during curve management to effect a laterally outward acceleration. To maintain the curve, i.e. constant radius, of the vehicle path, this force must be directly proportional to an equal and opposite centripetal force. With respect to automobile travel, the force of friction between the tires and the road surface provides centripetal force. To accommodate for conditions where friction is insufficient (e.g., on wet roads, ice, oil, etc.), the curve is preferably banked at an angle, θ, so that at least a portion of the centripetal force is provided instead by a normal force, FN(=mg). Equating Fcand FNon a normal road condition where friction is assumed to be 1, the maximum allowable velocity is related to gravity by: v2=g R tan θ, where g is the acceleration due to gravity, and R is the radius of curvature.

Thus, when a vehicle is speeding and friction is insufficient, it is often difficult for an operator to safely maneuver around a curve. To address curve mismanagement, systems have been developed to either identify an approaching curve or modify some aspect of the vehicle performance during or approaching the curve. Some of these systems present mechanisms and control logic for selecting and achieving an optimal transmission gear during curve management, and defining and estimating an approaching curve. Other systems determine stable running speeds for detected nodes and decelerate or accelerate the vehicle, so as to achieve the stable speed at a given point.

These conventional systems, however, are rigid one-size-fits-all models that do not enable modifications due to operator preference or vehicle characteristics. These systems also do not provide means for properly addressing special conditions that may modify an allowable curve speed profile where desired. Of yet further concern, these systems do not accommodate an instantaneous change in curvature radius that may occur at a circular curve termination point, nor provide feedback to enable the optimization of performance, and therefore may result in errors or rapid acceleration when exiting a curve.

DISCLOSURE OF INVENTION

Responsive to these and other concerns caused by conventional curve speed control systems, the present invention concerns an improved curve speed control system that utilizes refining factors to improve operator curve management. Among other things, the system reduces the vehicle speed when approaching a curve if necessary, which will eliminate excessive braking by the operator on the curve and thereby reduces steering effort and the risk of accident. The inventive system is also smart enough to accelerate toward the end of the curve so that cornering performance is improved.

A first aspect of the present invention concerns a speed control system adapted for use with a vehicle having a steering wheel and an operator. The system includes a map database having at least one record, wherein the record presents at least one path. The path presents a plurality of position points, wherein a portion of the points present adjacent curve points that define a curve. A locator device is communicatively coupled to the database, and configured to determine the location of the vehicle and match the location with a first of said points on the path. The system further includes a controller communicatively coupled to the device and database. The controller is configured to identify an approaching curve point and determine an allowable curve point management speed. Finally, the controller is further configured to determine a desired curve point management speed based in part on the allowable curve point management speed and an operator preference and/or vehicle characteristic input.

A second aspect of the present invention concerns a method of vehicular curve management by a controller, wherein the vehicle includes a navigation system having a map database. The method includes accessing and locating the current position of the vehicle upon a path in the database. An approaching curve point of a curve on the path is identified. A curve point radius and an allowable curve point management speed are determined. An input relating to an operator preference or vehicle characteristic is received. Finally, a desired curve point management speed based on the allowable curve point management speed and input is determined. More preferably, the system further produces an acceleration or deceleration command based on a pre-determined acceleration profile, and provides constant feedback under a control loop, so as to optimize the command.

It will be understood and appreciated that the present invention provides a number of advantages over the prior art, including, for example, providing a more flexible user-specified system. The system is configured to achieve an optimal curve speed following based on accurate road sensing capability, desired speed computation, and control strategy. The system is communicatively coupled to the vehicle, so as to continuously receive sensory feedback, and facilitate automatic curve speed control by the vehicle.

MODES FOR CARRYING OUT THE INVENTION

As shown inFIG. 1, the present invention concerns an improved curve speed control system10adapted for use with a vehicle12and by an operator14. The system10is configured to identify a plurality of curve points (i.e., nodes), each preferably equidistance from the edge of pavement, of an approaching curve. As further described herein, the system10is configured to determine an allowable (i.e., critical or maximum range) curve speed profile, determine a vehicle condition, such as yaw rate, speed and geographic location, and determine a desired curve speed profile based on the allowable curve speed profile and an operator preference or vehicle characteristic input. The system10is illustrated and described herein with respect to vehicles such as cars, SUV's, trucks, etc. However, it may also be utilized with airborne and watercraft machines, or whenever navigation and curve management are desired.

A preferred embodiment of the system10includes a database16having at least one map record16aconsisting of a plurality of position points, wherein each point corresponds to a location upon the earth or other planetary body (seeFIGS. 2 and 3). More preferably, the database16includes a plurality of Enhanced Digital (ED) maps using GPS data. The points preferably present a plurality of paths18, so as to form a road map. At least a portion of the points preferably include ID links that enable correlation between a given point and indicia data corresponding to an actual condition at the corresponding location. More preferably, the indicia data may be inputted, or modified by the operator14or a third party. Finally, the database16may be stored in the system10by conventional storage means, such as a CD-ROM, internal hard disk, or removable memory card.

The system10includes a locator device20configured to determine the geographic location of the vehicle preferably under a three-dimensional coordinate system. As shown inFIG. 1, a preferred locator20determines the longitude, latitude and height coordinates of the vehicle using GPS, and as such, further includes a GPS receiver22positioned within the vehicle12, and at least four mapped satellites24,26,28,30communicatively coupled to the receiver22at all times. Alternatively, other signal sources located at control points could be communicatively coupled to the receiver22, and other coordinate systems based on a variety of geodetic datums, units, projections, and references, such as Military Grid Reference System (MGRS) or ECEF X,Y,Z could be utilized in accordance with the present invention. Finally, the locator device20is communicatively coupled to the database16, and the two are cooperatively configured to correlate the actual location of the vehicle12to a first position point32upon the map record16aover time. As shown inFIG. 3, the preferred system10further includes a monitor34that is configured to display the map record16aand vehicle location to the operator14.

The system10further includes an inventive controller36configured to identify an approaching curve18awithin a vehicle path18, when the vehicle12is located a minimum distance from and is traveling towards a first of a plurality of curve points38. Each curve point38is preferably identifiable by indicia data attributed thereto that indicate the design radius of curvature. The beginning of a set of adjacent curve points may be identified according to corresponding station offsets as designed. As shown inFIGS. 4 and 5, the curve18amay present a circular, non-circular (e.g. spiral), or combination curve. Thus, the preferred system10is configured to read the future road geometry information directly from the ED maps.

Alternatively, one of a plurality of methods described by the aforementioned prior art systems, may be utilized to identify a curve point38. For instance, a curve point38may be identified by triangulation of preceding and succeeding points, and by comparing an angle defined by the points with a threshold value. Thus, in this configuration, the controller36is configured to initially perform a curve point identification algorithm. It is appreciated, however, that where each positional point along the path is associated with a radius of curvature value, the controller36need not be configured to initially identify a particular curve point.

Once a curve point38is identified, the controller36is further configured to facilitate the proper management of the curve by the vehicle. The controller36is configured to determine the current speed, Vx, and, more preferably, is communicatively coupled to the speedometer40or configured to calculate the speed based on GPS data. The controller36is further configured to directly calculate, or retrieve from a table of off-line computations, the desired curve speed profile at the location. Based on the current speed and desired curve speed profile, the controller36determines an acceleration profile, and generates an acceleration or deceleration command. Finally, the controller36is configured to then receive actual speed feedback, and modify the command accordingly, so as to present a closed loop system that approaches an optimal curve speed.

To autonomously control the curve speed, the preferred controller36is communicatively coupled to a brake module42, and an acceleration module44of the vehicle, so as to be able to cause the vehicle12to accelerate or decelerate (seeFIG. 6). The brake module42is preferably configured to receive an electric deceleration command from the controller36and mechanically decelerate the vehicle12, when the current vehicle speed is deemed to be greater than the desired curve point management speed of a curve point. A preferred embodiment of the brake module42includes at least one electromechanical valve (not shown) intercoupled with the hydraulic lines of the brakes. In another embodiment, the brake module42is configured to bypass or dampen at least a portion of the acceleration components of the vehicle12, such as the gas pedal, so as to allow wind and engine drag to slow the vehicle12.

Conversely, the acceleration module44is preferably configured to receive an electric acceleration command from the controller36and mechanically control at least a portion of the acceleration components of the vehicle12, when the current vehicle speed is deemed to be less than or equal to the desired curve point management speed. For example, the acceleration module44may be interconnected to and configured to modify the performance of an internal combustion engine. More particularly, the acceleration module44may be configured to modify the quantity or constituency of the fuel/air mixture. In an electrically driven vehicle, the acceleration module44may be configured to regulate the current delivered to the motor.

A preferred embodiment of the inventive algorithms and function of the controller36to accomplish these tasks is more particularly described as follows:

I. Allowable Curve Speed Profile

For a plurality of curve points an allowable curve speed profile is initially determined, wherein the controller36calculates an allowable or maximum curve point speed, or critical speed, Vx—criticalfor each point, according to the following formula:

Vx_critical=Rg⁡(sin⁢⁢θ+μ⁢⁢cos⁢⁢θ)cos⁢⁢θ-μ⁢⁢sin⁢⁢θ,(1)
and, θ is the bank angle of the curve at the curve point, g is the acceleration due to gravity (9.81 m/s2), R is the radius of curvature of the curve at the curve point, and u is the coefficient of friction between the surface and vehicle at the curve point.

Alternatively, the controller36may compute a curvature profile for the approaching curve18aand use a critical speed database, generated off-line, to obtain the allowable curve speed profile. In this configuration, the controller36may retrieve the allowable curve speed profile data from the table, or from previously stored indicia associated with the curve point directly in the map record16a.

II. Desired Curve Speed Profile

As previously described, an inventive aspect of the present invention is to modify the allowable curve speed profile to determine a desired curve speed profile, based on operator preference and/or vehicular characteristic input. Where the allowable curve point management speed is calculated by equation (1), the input may be represented by at least one variable factor, and more preferably, by the product of an operator (or driver) factor, Kd, and a separate vehicular factor, Kv. Among other things, the Kdfactor may be influenced by the age, vision, comfort level, or otherwise driving style and ability of the driver, as well as the passenger(s) and load weight the vehicle is carrying. The Kvfactor may be influenced, among other things, by the center of gravity height, track width, vehicle roll characteristics, composition and configuration of the tires, thoroughfare surface and condition, the posted speed limit, and/or the weight of the vehicle. It is appreciated that these coefficients may be adjusted experimentally based on the driver's acceptance level. Finally, the desired curve point management speed, or comfort speed, is further achieved by replacing the acceleration due to gravity constant with a reduced maximum lateral acceleration factor, Ay(i.e. 0.3 g, for example), so that

Vx_comfort=Kv⁢Kd⁢RAy⁡(sin⁢⁢θ+μ⁢⁢cos⁢⁢θ)cos⁢⁢θ-μ⁢⁢sin⁢⁢θ(2)
In more general terms, the desired curve speed can be a function of the following parameters; bank angle, road friction coefficient, road curve radius, vehicle factor and driver factor as shown in the following equation.
Vz—comfort=F(R,θ,μ,Kv,Kd)  (2A)

This calculation is performed for each curve point to determine the desired curve speed profile, wherein said profile is denoted by the matrix:
{circumflex over (V)}x—desired=[{circumflex over (V)}x(0){circumflex over (V)}x(1) . . .{circumflex over (V)}x(N)]  (3)
It is appreciated that where the curve18ais circular, as shown inFIG. 4, and all curve points present equal radii, the desired curve speed profile is constant, and the desired curve point management speed calculated for the first curve point can be utilized for the entire curve.

Where the curve18ais noncircular (seeFIG. 5), the controller36determines a separate desired curve point management speed for each of the plurality of curve points, to generate the desired curve speed profile. Curve point sampling is preferably performed at a predetermined interval, such as 150 m, that depends in part upon the length of the curve18a. More preferably, the interval is modifiable by the operator14, so as to increase accuracy or decrease involvement where desired. Finally, similarly to the allowable curve point management speed, the desired curve point management speed for a given point may be retrieved from a pre-generated table of computed values.

III. Vehicle Position Determination

It is appreciated that accurate vehicle positioning is necessary to effect the proper function of the system10. Using equation (2) or a desired curve point management speed lookup table to determine speed, and the current vehicle position in the global coordinate, the preferred controller36is configured to generate a desired position profile over time, as follows:
ddesired=[d(0)d(1) . . .d(N)]=[0d . . . Nd](4)
The desired position profile corresponds to the curve speed profile point in Equation (3), wherein d is the step for each equidistance curve point. However, it is appreciated that the controller36will function correctly even for non-equidistant points. Where GPS information becomes unreliable, however, i.e. amongst tall bridges, buildings or other obstacles, the system10preferably includes an estimation module later described in part (VI).
IV. Acceleration Profile

The acceleration or deceleration command is generated based on the current vehicle speed, Vx, and the desired curve speed profile. For the profiles of desired speed as shown in Equation (3) and vehicle position shown in Equation (4), the acceleration profile in the vehicle fixed coordinate can be computed for a given curve point, i, according to the following formula:

a^x⁡(i)=V^x⁡(i)2-Vx22⁢d⁡(i)(5)
where d(i)=(i−1)d is the distance to the desired velocity point of the curve from the current position. Thus, for a given plurality of curve points, the desired curve speed profile, current vehicle speed and sampling distance is utilized to determine the acceleration profile:
Âx—desired=[âx(0)âx(1) . . .âx(N)],  (6)
V. Curve Speed Command

As shown inFIG. 7, an optimal curve speed (i.e. Vxcmd, Dcmd, Axcmd) is achieved by applying either a minimum speed difference (at anticipated conventional vehicle speeds), or a minimum acceleration/deceleration rate (where the vehicle is incapable of effecting the speed differences over the given distance between curve points) control, wherein the minimum speed difference is the difference between the desired curve point management speed and an estimated optimal speed for a given curve point. The acceleration command is selected for the minimum value from the desired acceleration profile (6). In other embodiment, the difference is used, along with a carefully tuned weighting factor, to modify the command. More preferably, the acceleration command is determined from the minimum difference, according to the following formula and algorithms:

Formula (7) provides a preferred method of determining the estimated speed with acceleration Axover a measure of time. Matrix (8) provides a congruent weight vector for use in calculations. Formula (9) provides a preferred method of determining a performance index for each curve point, i, from 1 to N, based on the difference between the desired (i.e. target) speed and the estimated speed, multiplied by the weighting factor at the given point. Finally, by partial differentiating formula (9) with respect to Ax, the optimal command can be generated from formula (10). Formula (10) provides a preferred method of determining the optimal acceleration rate, Ax, such that the change of the performance index over the change in optimal acceleration rate is zero.

It is appreciated that using a control loop towards achieving an optimal curve speed profile, as opposed to an individual curve point analysis, provides significant improvements to operator comfort and safety by reducing abrupt braking and rapid acceleration from point to point. Where large differences in adjacent curvature radii exist, as commonly found at curve termination points, the optimal acceleration profile may further reduce the likelihood of errors, failures, and/or accidents.

Alternatively, the desired curve speed profile, command, and optimal speed profile may be generated directly from the allowable curve speed profile, where other operator-controlled means are provided for damping the command signal. For example, a control dial46, as shown inFIG. 3, may be provided for reducing the amplitude, but not the period or cycle of the generated acceleration/deceleration command prior to receipt by the modules42,44. As the dial46is turned towards the least responsive setting, the system10effects a lower speed at the curve points, while maintaining proper positioning.

VI. Positioning Estimation Module

In another aspect of the system10, the controller36preferably includes an estimation module48that enables the vehicle12to estimate a future location and vehicle speed, based on a current condition of the vehicle12, such as the current vehicle speed, steering angle, yaw rate, or a combination thereof. In the illustrated embodiment, the system10includes a yaw rate sensor50connected to the vehicle12and operable to sense the yaw rate, i.e. rate of rotation, of the vehicle, and a steering angle module52having a sensor (seeFIG. 1). The steering angle module52is configured to detect and communicate to the controller36the current degree of clockwise rotation of the steering wheel54(seeFIG. 3), wherein zero degrees represents and may be calibrated by the steering wheel position during travel upon a generally straight portion of the path18.

More preferably, and as shown inFIG. 8, the current velocity, Vx, and steering angle, δf, are recognized by the controller36and used to determine a future location, Y(n), of the vehicle12at a time, n. At time n, the sensors50,52and the locator device20provide the actual location of the vehicle Yx. The difference between actual and estimated locations of the vehicle12provides a measure of error, ΔY(=Y(n)−Yx), which is compared to a threshold control value in an RLS-based parameter estimation sub-module56routine.

VII. System Feedback and Control

Where the difference ΔY exceeds the threshold, the estimation module46is modified, so as to provide a close-looped feedback control system. Where the difference ΔY is within threshold values, the module46provides accurate means for predicting vehicle positioning in a kinematical model. The controller36and sensors.50,52are also configured to provide constant vehicle speed feedback in modifying the command to achieve the optimal curve speed. In other words, the preferred controller36is configured to compare the actual vehicle speed at the curve point38to the previously determined desired curve point speed, and modify the acceleration/deceleration command based on the revised current speed for the given curve point.

Another usage of the sensor information is to activate and deactivate system performance without interfering with the control of the vehicle by the operator14. In a preferred embodiment, when the vehicle12is within a predetermined period (for the current vehicle speed) from the first curve point38of an approaching curve18a, the system10is automatically activated. The system10may also be configured to operate upon demand either through visual, audio or haptic means (such as accelerator pedal force feedback). For example, a voice request/voice response or button press/voice response mechanism may be actuated by the operator14, when curve management assistance is desired. The preferred acceleration and deceleration rates can either be programmed into the system10as a calibration constant off-line, or more preferably, inputted and modified by the operator14.

Thus, a preferred method of curve management by a vehicle including a navigation system having a map database, performed by a controller, includes at a first step100positioning the vehicle in the database (seeFIG. 9) ahead of an approaching curve18a. At a second step102, the current vehicle speed is determined and a first approaching curve point of the curve is identified. At a third step104, a curve point radius and an allowable curve point management speed are determined for the approaching curve point. Once the allowable curve point management speed is determined, and at a step106, an operator preference or vehicle characteristic input is further received to determine a desired curve point management speed.

At a step108, the desired curve point management speed is stored for a sufficient period, and steps102through106are repeated for a plurality of succeeding curve points, so as to determine a desired curve speed profile for the curve18a. At a step110, an acceleration profile is determined based on the desired curve speed profile and the current speed of the vehicle. At a step112, an acceleration command is generated, and delivered to either a brake or acceleration module. At a step114, the actually achieved vehicle speed at a curve point is fed back to the controller, and a minimum difference or minimum acceleration control, along with tuned weighting factors are used to continuously update the acceleration/deceleration command, in order to achieve an optimal curve speed. Finally, at a step116, the method repeats from step110at a succeeding curve point, until the method terminates by exiting the curve18a.

The preferred forms of the invention described above are to be used as illustration only, and should not be utilized in a limiting sense in interpreting the scope of the present invention. Obvious modifications to the exemplary embodiments and methods of operation, as set forth herein, could be readily made by those skilled in the art without departing from the spirit of the present invention. The inventors hereby state their intent to rely on the Doctrine of Equivalents to determine and assess the reasonably fair scope of the present invention as pertains to any system or method not materially departing from but outside the literal scope of the invention as set forth in the following claims.