Difference between revisions of "Cruise control"

From FBSwiki
Jump to navigation Jump to search
Line 11: Line 11:
 
== Dynamic model ==
 
== Dynamic model ==
  
To develop a mathematical model we start with a force balance for
+
To develop a mathematical model we start with a force balance for the car body. Let <math>v</math> be the speed of the car, <math>m</math> the total mass (including passengers), <math>F</math> the force generated by the contact of the wheels with the road, and <math>F_\text{d}</math> the disturbance force due to gravity, friction and aerodynamic drag. The equation of motion of the car is simply  
the car body. Let <amsmath>v</amsmath> be the speed of the car,
 
<amsmath>m</amsmath> the total mass (including passengers),
 
<amsmath>F</amsmath> the force generated by the contact of the wheels
 
with the road, and <amsmath>F_d</amsmath> the disturbance force due to
 
gravity, friction and aerodynamic drag. The equation of motion of
 
the car is simply  
 
 
<center><math>  
 
<center><math>  
   m \frac{dv}{dt} = F - F_d.
+
   m \frac{dv}{dt} = F - F_\text{d}.
 
</math></center>
 
</math></center>
  
The force <amsmath>F</amsmath> is generated by the engine, whose torque
+
The force <math>F</math> is generated by the engine, whose torque is proportional to the rate of fuel injection, which is itself proportional to a control signal <math>0 \leq u \leq 1</math> that controls the throttle position. The torque also depends on engine speed <math>\omega</math>. A simple representation of the torque at full throttle is given by the torque curve  
is proportional to the rate of fuel injection, which is itself
+
<center><math>
proportional to a control signal <amsmath>0 \leq u \leq 1</amsmath>
+
   T(\omega) = T_\text{m} \left(1 - \beta \biggl(\frac{\omega}{\omega_\text{m}} - 1\biggr)^2
that controls the throttle position. The torque also depends on
 
engine speed <amsmath>\omega</amsmath>. A simple representation of the
 
torque at full throttle is given by the torque curve
 
<center><amsmath>
 
   T(\omega) = T_m \left(1 - \beta \biggl(\frac{\omega}{\omega_m} - 1\biggr)^2
 
 
   \right),
 
   \right),
  \label{eq:cruise:torque}
+
</math></center>
</amsmath></center>
+
where the maximum torque <math>T_\text{m}</math> is obtained at engine speed <math>\omega_\text{m}</math>.  Typical parameters are <math>T_m = 190</math> Nm, <math>\omega_m</math> = 420 rad/s (about 4000 RPM) and <math>\beta = 0.4</math>.
where the maximum torque <amsmath>T_m</amsmath> is obtained at engine
 
speed <amsmath>\omega_m</amsmath>.  Typical parameters are <amsmath>T_m =
 
190</amsmath> Nm, <amsmath>\omega_m</amsmath> = 420 rad/s (about 4000 RPM)
 
and <amsmath>\beta = 0.4</amsmath>.
 
  
Let <amsmath>n</amsmath> be the gear ratio and <amsmath>r</amsmath> the wheel
+
Let <math>n</math> be the gear ratio and <math>r</math> the wheel radius. The engine speed is related to the velocity through the expression
radius. The engine speed is related to the velocity through the
+
<center><math>
expression
 
<center><amsmath>
 
 
   \omega = \frac{n}{r} v =: \alpha_n v,
 
   \omega = \frac{n}{r} v =: \alpha_n v,
</amsmath></center>
+
</math></center>
 
and the driving force can be written as
 
and the driving force can be written as
<center><amsmath>
+
<center><math>
 
   F = \frac{nu}{r} T(\omega) = \alpha_n u T(\alpha_n v).
 
   F = \frac{nu}{r} T(\omega) = \alpha_n u T(\alpha_n v).
</amsmath></center>
+
</math></center>
 
[[Image:cruise-gearcurves.png|right]]
 
[[Image:cruise-gearcurves.png|right]]
Typical values of <amsmath>\alpha_n</amsmath> for gears 1 through 5 are <amsmath>\alpha_1 = 40</amsmath>, <amsmath>\alpha_2 = 25</amsmath>, <amsmath>\alpha_3 = 16</amsmath>, <amsmath>\alpha_4 = 12</amsmath> and <amsmath>\alpha_5 = 10</amsmath>. The inverse of <amsmath>\alpha_n</amsmath> has a physical interpretation as the effective wheel radius.  The figure to the right shows the torque as a function of vehicle speed. The figure shows that the effect of the gear is to "flatten" the torque curve so that an almost full torque can be obtained almost over the whole speed range.
+
Typical values of <math>\alpha_n</math> for gears 1 through 5 are <math>\alpha_1 = 40</math>, <math>\alpha_2 = 25</math>, <math>\alpha_3 = 16</math>, <math>\alpha_4 = 12</math> and <math>\alpha_5 = 10</math>. The inverse of <math>\alpha_n</math> has a physical interpretation as the effective wheel radius.  The figure to the right shows the torque as a function of vehicle speed. The figure shows that the effect of the gear is to "flatten" the torque curve so that an almost full torque can be obtained almost over the whole speed range.
 
 
The disturbance force <amsmath>F_d</amsmath> has three major components: <amsmath>F_g</amsmath>, the forces due to gravity; <amsmath>F_r</amsmath>, the forces due to rolling friction; and <amsmath>F_a</amsmath>, the aerodynamic drag.  Letting the slope of the
 
road be <amsmath>\theta</amsmath>, gravity gives the force <amsmath>F_g = m g \sin\theta</amsmath>, where <amsmath>g = 9.8\,
 
\text{m}/\text{s}^2</amsmath> is the gravitational constant.  A simple model of rolling friction is
 
<center><amsmath>
 
  F_r = m g C_r\, \text{sgn}(v),
 
</amsmath></center>
 
where <amsmath>C_r</amsmath> is the coefficient of rolling friction and sgn(<amsmath>v</amsmath>) is the sign of <amsmath>v</amsmath> or zero if <amsmath>v = 0</amsmath>.  A typical value for the coefficient of rolling friction is <amsmath>C_r = 0.01</amsmath>.  Finally, the aerodynamic drag is proportional to the square of the speed:
 
<center><amsmath>
 
  F_a = \frac{1}{2} \rho C_d A v^2,
 
</amsmath></center>
 
where <amsmath>\rho</amsmath> is the density of air, <amsmath>C_d</amsmath> is the shape-dependent aerodynamic drag coefficient and
 
<amsmath>A</amsmath> is the frontal area of the car.  Typical parameters are <amsmath>\rho = </amsmath> 1.3 k/m<amsmath>{}^3</amsmath>, <amsmath>C_d = 0.32</amsmath> and <amsmath>A =</amsmath> 2.4 m<amsmath>{}^2</amsmath>.
 
  
 +
The disturbance force <math>F_\text{d}</math> has three major components: <math>F_\text{g}</math>, the forces due to gravity; <math>F_\text{r}</math>, the forces due to rolling friction; and <math>F_\text{a}</math>, the aerodynamic drag.  Letting the slope of the
 +
road be <math>\theta</math>, gravity gives the force <math>F_\text{g} = m g \sin\theta</math>, where <math>g = 9.8\,
 +
\text{m}/\text{s}^2</math> is the gravitational constant.  A simple model of rolling friction is
 +
<center><math>
 +
  F_\text{r} = m g C_\text{r}\, \text{sgn}(v),
 +
</math></center>
 +
where <math>C_\text{r}</math> is the coefficient of rolling friction and sgn(<math>v</math>) is the sign of <math>v</math> or zero if <math>v = 0</math>.  A typical value for the coefficient of rolling friction is <math>C_\text{r} = 0.01</math>.  Finally, the aerodynamic drag is proportional to the square of the speed:
 +
<center><math>
 +
  F_\text{a} = \frac{1}{2} \rho C_\text{d} A v^2,
 +
</math></center>
 +
where <math>\rho</math> is the density of air, <math>C_d</math> is the shape-dependent aerodynamic drag coefficient and <math>A</math> is the frontal area of the car.  Typical parameters are <math>\rho = </math> 1.3 k/m<math>{}^3</math>, <math>C_\text{d} = 0.32</math> and <math>A =</math> 2.4 m<math>{}^2</math>.
  
=== SIMULINK model ===
 
The file {{matlabfile|.|cruise_ctrl.mdl}} contains a nonlinear model of a cruise controller for a car, depicted below.
 
<center>[[Image:cruise_ctrl.png|500px]]</center>
 
The model contains all of the dynamics described in [[Examples|Section 3.1]].
 
  
=== MATLAB model ===
+
=== Python model ===
An alternative model for the system is a MATLAB model suitable for use with the 'ode45' function.  The file {{matlabfile|cruisedyn.m}} contains a nonlinear model of the car dynamics consistent with the description given in [[Examples|Section 3.1]].
 
  
 
== MATLAB files ==
 
== MATLAB files ==

Revision as of 03:31, 29 December 2020

This page documents the cruise control system that is used as a running example throughout the text. A detailed description of the dynamics of this system are presented in Chapter 4 - Examples. This page contains a description of the system, including the models and commands used to generate some of the plots in the text.

Introduction

Cruise-block.png

Cruise control is the term used to describe a control system that regulates the speed of an automobile. Cruise control was commercially introduced in 1958 as an option on the Chrysler Imperial. The basic operation of a cruise controller is to sense the speed of the vehicle, compare this speed to a desired reference, and then accelerate or decelerate the car as required. The figure to the right shows a block diagram of this feedback system.

A simple control algorithm for controlling the speed is to use a "proportional plus integral" feedback. In this algorithm, we choose the amount of gas flowing to the engine based on both the error between the current and desired speed, and the integral of that error. The plot on the right shows the results of this feedback for a step change in the desired speed and a variety of different masses for the car (which might result from having a different number of passengers or towing a trailer). Notice that independent of the mass (which varies by 25% of the total weight of the car), the steady state speed of the vehicle always approaches the desired speed and achieves that speed within approximately 10-15 seconds. Thus the performance of the system is robust with respect to this uncertainty.

Dynamic model

To develop a mathematical model we start with a force balance for the car body. Let be the speed of the car, the total mass (including passengers), the force generated by the contact of the wheels with the road, and the disturbance force due to gravity, friction and aerodynamic drag. The equation of motion of the car is simply

The force is generated by the engine, whose torque is proportional to the rate of fuel injection, which is itself proportional to a control signal that controls the throttle position. The torque also depends on engine speed . A simple representation of the torque at full throttle is given by the torque curve

where the maximum torque is obtained at engine speed . Typical parameters are Nm, = 420 rad/s (about 4000 RPM) and .

Let be the gear ratio and the wheel radius. The engine speed is related to the velocity through the expression

and the driving force can be written as

Cruise-gearcurves.png

Typical values of for gears 1 through 5 are , , , and . The inverse of has a physical interpretation as the effective wheel radius. The figure to the right shows the torque as a function of vehicle speed. The figure shows that the effect of the gear is to "flatten" the torque curve so that an almost full torque can be obtained almost over the whole speed range.

The disturbance force has three major components: , the forces due to gravity; , the forces due to rolling friction; and , the aerodynamic drag. Letting the slope of the road be , gravity gives the force , where is the gravitational constant. A simple model of rolling friction is

where is the coefficient of rolling friction and sgn() is the sign of or zero if . A typical value for the coefficient of rolling friction is . Finally, the aerodynamic drag is proportional to the square of the speed:

where is the density of air, is the shape-dependent aerodynamic drag coefficient and is the frontal area of the car. Typical parameters are 1.3 k/m, and 2.4 m.


Python model

MATLAB files

A number of MATLAB files are available that correspond to examples in the printed text. This section contains links to the various files that are available. Note that you will also need some of the MATLAB tools.

Standalone versions of the model:

Linearized models (all files required):

Controller designs (require linearized models):

Exercises

The following exercises make use of the cruise control model described here:

Further Reading