robust control of active suspension -凯发k8网页登录
this example shows how to use robust control toolbox™ to design a robust controller for an active suspension system. the example describes the quarter-car suspension model. then, it computes an controller for the nominal system using the hinfsyn
command. finally, the example shows how to use μ-synthesis to design a robust controller for the full uncertain system.
video walkthrough
for a visual walkthrough of this example, watch the video.
quarter-car suspension model
conventional passive suspensions use a spring and damper between the car body and wheel assembly. the spring-damper characteristics are selected to emphasize one of several conflicting objectives such as passenger comfort, road handling, and suspension deflection. active suspensions allow the designer to balance these objectives using a feedback-controller hydraulic actuator between the chassis and wheel assembly.
this example uses a quarter-car model of the active suspension system (see figure 1). the mass (in kilograms) represents the car chassis (body) and the mass (in kilograms) represents the wheel assembly. the spring and damper represent the passive spring and shock absorber placed between the car body and the wheel assembly. the spring models the compressibility of the pneumatic tire. the variables , , and (all in meters) are the body travel, wheel travel, and road disturbance, respectively. the force (in kilonewtons) applied between the body and wheel assembly is controlled by feedback and represents the active component of the suspension system.
figure 1: quarter-car model of active suspension.
with the notation , the linearized state-space equations for the quarter-car model are:
construct a state-space model qcar
representing these equations.
% physical parameters mb = 300; % kg mw = 60; % kg bs = 1000; % n/m/s ks = 16000 ; % n/m kt = 190000; % n/m % state matrices a = [ 0 1 0 0; [-ks -bs ks bs]/mb ; ... 0 0 0 1; [ks bs -ks-kt -bs]/mw]; b = [ 0 0; 0 1e3/mb ; 0 0 ; [kt -1e3]/mw]; c = [1 0 0 0; 1 0 -1 0; a(2,:)]; d = [0 0; 0 0; b(2,:)]; qcar = ss(a,b,c,d); qcar.statename = {'body travel (m)';'body vel (m/s)';... 'wheel travel (m)';'wheel vel (m/s)'}; qcar.inputname = {'r';'fs'}; qcar.outputname = {'xb';'sd';'ab'};
the transfer function from actuator to body travel and acceleration has an imaginary-axis zero with natural frequency 56.27 rad/s. this is called the tire-hop frequency.
tzero(qcar({'xb','ab'},'fs'))
ans = 2×1 complex
-0.0000 56.2731i
-0.0000 -56.2731i
similarly, the transfer function from actuator to suspension deflection has an imaginary-axis zero with natural frequency 22.97 rad/s. this is called the rattlespace frequency.
zero(qcar('sd','fs'))
ans = 2×1 complex
0.0000 22.9734i
0.0000 -22.9734i
road disturbances influence the motion of the car and suspension. passenger comfort is associated with small body acceleration. the allowable suspension travel is constrained by limits on the actuator displacement. plot the open-loop gain from road disturbance and actuator force to body acceleration and suspension displacement.
bodemag(qcar({'ab','sd'},'r'),'b',qcar({'ab','sd'},'fs'),'r',{1 100}); legend('road disturbance (r)','actuator force (fs)','location','southwest') title({'gain from road dist (r) and actuator force (fs) '; 'to body accel (ab) and suspension travel (sd)'})
because of the imaginary-axis zeros, feedback control cannot improve the response from road disturbance to body acceleration at the tire-hop frequency, and from to suspension deflection at the rattlespace frequency. moreover, because of the relationship and the fact that the wheel position roughly follows at low frequency (less than 5 rad/s), there is an inherent trade-off between passenger comfort and suspension deflection: any reduction of body travel at low frequency will result in an increase of suspension deflection.
uncertain actuator model
the hydraulic actuator used for active suspension control is connected between the body mass and the wheel assembly mass . the nominal actuator dynamics are represented by the first-order transfer function with a maximum displacement of 0.05 m.
actnom = tf(1,[1/60 1]);
this nominal model only approximates the physical actuator dynamics. we can use a family of actuator models to account for modeling errors and variability in the actuator and quarter-car models. this family consists of a nominal model with a frequency-dependent amount of uncertainty. at low frequency, below 3 rad/s, the model can vary up to 40% from its nominal value. around 3 rad/s, the percentage variation starts to increase. the uncertainty crosses 100% at 15 rad/s and reaches 2000% at approximately 1000 rad/s. the weighting function is used to modulate the amount of uncertainty with frequency.
wunc = makeweight(0.40,15,3); unc = ultidyn('unc',[1 1],'samplestatedim',5); act = actnom*(1 wunc*unc); act.inputname = 'u'; act.outputname = 'fs';
the result act
is an uncertain state-space model of the actuator. plot the bode response of 20 sample values of act
and compare with the nominal value.
rng('default') bode(act,'b',act.nominalvalue,'r ',logspace(-1,3,120))
design setup
the main control objectives are formulated in terms of passenger comfort and road handling, which relate to body acceleration and suspension travel . other factors that influence the control design include the characteristics of the road disturbance, the quality of the sensor measurements for feedback, and the limits on the available control force. to use synthesis algorithms, we must express these objectives as a single cost function to be minimized. this can be done as indicated figure 2.
figure 2: disturbance rejection formulation.
the feedback controller uses measurements of the suspension travel and body acceleration to compute the control signal driving the hydraulic actuator. there are three external sources of disturbance:
the road disturbance , modeled as a normalized signal shaped by a weighting function . to model broadband road deflections of magnitude seven centimeters, we use the constant weight
sensor noise on both measurements, modeled as normalized signals and shaped by weighting functions and . we use and to model broadband sensor noise of intensity 0.01 and 0.5, respectively. in a more realistic design, these weights would be frequency dependent to model the noise spectrum of the displacement and acceleration sensors.
the control objectives can be reinterpreted as a disturbance rejection goal: minimize the impact of the disturbances on a weighted combination of control effort , suspension travel , and body acceleration . when using the norm (peak gain) to measure "impact", this amounts to designing a controller that minimizes the norm from disturbance inputs to error signals .
create the weighting functions of figure 2 and label their i/o channels to facilitate interconnection. use a high-pass filter for to penalize high-frequency content of the control signal and thus limit the control bandwidth.
wroad = ss(0.07); wroad.u = 'd1'; wroad.y = 'r'; wact = 0.8*tf([1 50],[1 500]); wact.u = 'u'; wact.y = 'e1'; wd2 = ss(0.01); wd2.u = 'd2'; wd2.y = 'wd2'; wd3 = ss(0.5); wd3.u = 'd3'; wd3.y = 'wd3';
specify closed-loop targets for the gain from road disturbance to suspension deflection (handling) and body acceleration (comfort). because of the actuator uncertainty and imaginary-axis zeros, only seek to attenuate disturbances below 10 rad/s.
handlingtarget = 0.04 * tf([1/8 1],[1/80 1]); comforttarget = 0.4 * tf([1/0.45 1],[1/150 1]); targets = [handlingtarget ; comforttarget]; bodemag(qcar({'sd','ab'},'r')*wroad,'b',targets,'r--',{1,1000}), grid title('response to road disturbance') legend('open-loop','closed-loop target')
the corresponding performance weights are the reciprocals of these comfort and handling targets. to investigate the trade-off between passenger comfort and road handling, construct three sets of weights corresponding to three different trade-offs: comfort (), balanced (), and handling ().
% three design points beta = reshape([0.01 0.5 0.99],[1 1 3]); wsd = beta / handlingtarget; wsd.u = 'sd'; wsd.y = 'e3'; wab = (1-beta) / comforttarget; wab.u = 'ab'; wab.y = 'e2';
finally, use connect
to construct a model qcaric
of the block diagram of figure 2. note that qcaric
is an array of three models, one for each design point . also, qcaric
is an uncertain model since it contains the uncertain actuator model act
.
sdmeas = sumblk('y1 = sd wd2'); abmeas = sumblk('y2 = ab wd3'); icinputs = {'d1';'d2';'d3';'u'}; icoutputs = {'e1';'e2';'e3';'y1';'y2'}; qcaric = connect(qcar(2:3,:),act,wroad,wact,wab,wsd,wd2,wd3,... sdmeas,abmeas,icinputs,icoutputs)
3x1 array of uncertain continuous-time state-space models. each model has 5 outputs, 4 inputs, 9 states, and the following uncertain blocks: unc: uncertain 1x1 lti, peak gain = 1, 1 occurrences type "qcaric.nominalvalue" to see the nominal value and "qcaric.uncertainty" to interact with the uncertain elements.
nominal h-infinity design
use hinfsyn
to compute an controller for each value of the blending factor .
ncont = 1; % one control signal, u nmeas = 2; % two measurement signals, sd and ab k = ss(zeros(ncont,nmeas,3)); gamma = zeros(3,1); for i=1:3 [k(:,:,i),~,gamma(i)] = hinfsyn(qcaric(:,:,i),nmeas,ncont); end gamma
gamma = 3×1
0.9405
0.6727
0.8892
the three controllers achieve closed-loop norms of 0.94, 0.67 and 0.89, respectively. construct the corresponding closed-loop models and compare the gains from road disturbance to for the passive and active suspensions. observe that all three controllers reduce suspension deflection and body acceleration below the rattlespace frequency (23 rad/s).
% closed-loop models k.u = {'sd','ab'}; k.y = 'u'; cl = connect(qcar,act.nominal,k,'r',{'xb';'sd';'ab'}); bodemag(qcar(:,'r'),'b', cl(:,:,1),'r-.', ... cl(:,:,2),'m-.', cl(:,:,3),'k-.',{1,140}), grid legend('open-loop','comfort','balanced','handling','location','southeast') title('body travel, suspension deflection, and body acceleration due to road')
time-domain evaluation
to further evaluate the three designs, perform time-domain simulations using a road disturbance signal representing a road bump of height 5 cm.
% road disturbance t = 0:0.0025:1; roaddist = zeros(size(t)); roaddist(1:101) = 0.025*(1-cos(8*pi*t(1:101))); % closed-loop model simk = connect(qcar,act.nominal,k,'r',{'xb';'sd';'ab';'fs'}); % simulate p1 = lsim(qcar(:,1),roaddist,t); y1 = lsim(simk(1:4,1,1),roaddist,t); y2 = lsim(simk(1:4,1,2),roaddist,t); y3 = lsim(simk(1:4,1,3),roaddist,t); % plot results subplot(211) plot(t,p1(:,1),'b',t,y1(:,1),'r.',t,y2(:,1),'m.',t,y3(:,1),'k.',t,roaddist,'g') title('body travel'), ylabel('x_b (m)') subplot(212) plot(t,p1(:,3),'b',t,y1(:,3),'r.',t,y2(:,3),'m.',t,y3(:,3),'k.',t,roaddist,'g') title('body acceleration'), ylabel('a_b (m/s^2)')
subplot(211) plot(t,p1(:,2),'b',t,y1(:,2),'r.',t,y2(:,2),'m.',t,y3(:,2),'k.',t,roaddist,'g') title('suspension deflection'), xlabel('time (s)'), ylabel('s_d (m)') subplot(212) plot(t,zeros(size(t)),'b',t,y1(:,4),'r.',t,y2(:,4),'m.',t,y3(:,4),'k.',t,roaddist,'g') title('control force'), xlabel('time (s)'), ylabel('f_s (kn)') legend('open-loop','comfort','balanced','handling','road disturbance','location','southeast')
observe that the body acceleration is smallest for the controller emphasizing passenger comfort and largest for the controller emphasizing suspension deflection. the "balanced" design achieves a good compromise between body acceleration and suspension deflection.
robust mu design
so far you have designed controllers that meet the performance objectives for the nominal actuator model. as discussed earlier, this model is only an approximation of the true actuator and you need to make sure that the controller performance is maintained in the face of model errors and uncertainty. this is called robust performance.
next use -synthesis to design a controller that achieves robust performance for the entire family of actuator models. the robust controller is synthesized with the musyn function using the uncertain model qcaric(:,:,2)
corresponding to "balanced" performance ().
[krob,rpmu] = musyn(qcaric(:,:,2),nmeas,ncont);
d-k iteration summary: ----------------------------------------------------------------- robust performance fit order ----------------------------------------------------------------- iter k step peak mu d fit d 1 1.193 1.125 1.139 4 2 1.091 1.025 1.033 4 3 0.9991 0.946 0.9559 4 4 0.9358 0.932 0.9348 4 5 0.9096 0.9057 0.9114 8 6 0.9103 0.907 0.9096 8 7 0.9091 0.9066 0.9094 6 best achieved robust performance: 0.906
simulate the nominal response to a road bump with the robust controller krob
. the responses are similar to those obtained with the "balanced" controller.
% closed-loop model (nominal) krob.u = {'sd','ab'}; krob.y = 'u'; simkrob = connect(qcar,act.nominal,krob,'r',{'xb';'sd';'ab';'fs'}); % simulate p1 = lsim(qcar(:,1),roaddist,t); y1 = lsim(simkrob(1:4,1),roaddist,t); % plot results clf, subplot(221) plot(t,p1(:,1),'b',t,y1(:,1),'r',t,roaddist,'g') title('body travel'), ylabel('x_b (m)') subplot(222) plot(t,p1(:,3),'b',t,y1(:,3),'r') title('body acceleration'), ylabel('a_b (m/s^2)') subplot(223) plot(t,p1(:,2),'b',t,y1(:,2),'r') title('suspension deflection'), xlabel('time (s)'), ylabel('s_d (m)') subplot(224) plot(t,zeros(size(t)),'b',t,y1(:,4),'r') title('control force'), xlabel('time (s)'), ylabel('f_s (kn)') legend('open-loop','robust design','location','southeast')
next simulate the response to a road bump for 100 actuator models randomly selected from the uncertain model set act
.
rng('default'), nsamp = 100; clf % uncertain closed-loop model with balanced h-infinity controller clu = connect(qcar,act,k(:,:,2),'r',{'xb','sd','ab'}); lsim(usample(clu,nsamp),'b',clu.nominal,'r',roaddist,t) title('nominal "balanced" design') legend('perturbed','nominal','location','southeast')
% uncertain closed-loop model with balanced robust controller clu = connect(qcar,act,krob,'r',{'xb','sd','ab'}); lsim(usample(clu,nsamp),'b',clu.nominal,'r',roaddist,t) title('robust "balanced" design') legend('perturbed','nominal','location','southeast')
the robust controller krob
reduces variability due to model uncertainty and delivers more consistent performance.
controller simplification: order reduction
the robust controller krob
has relatively high order compared to the plant. you can use the model reduction functions to find a lower-order controller that achieves the same level of robust performance. use reduce
to generate approximations of various orders.
% create array of reduced-order controllers
ns = order(krob);
stateorders = 1:ns;
kred = reduce(krob,stateorders);
next use robgain
to compute the robust performance margin for each reduced-order approximation. the performance goals are met when the closed-loop gain is less than . the robust performance margin measures how much uncertainty can be sustained without degrading performance (exceeding ). a margin of 1 or more indicates that we can sustain 100% of the specified uncertainty.
% compute robust performance margin for each reduced controller gamma = 1; clp = lft(qcaric(:,:,2),kred); for k=1:ns pm(k) = robgain(clp(:,:,k),gamma); end % compare robust performance of reduced- and full-order controllers pmfull = pm(end).lowerbound; plot(stateorders,[pm.lowerbound],'b-o',... stateorders,repmat(pmfull,[1 ns]),'r'); grid title('robust performance margin as a function of controller order') legend('reduced order','full order','location','southeast')
you can use the smallest controller order for which the robust performance is above 1.
controller simplification: fixed-order tuning
alternatively, you can use musyn
to directly tune low-order controllers. this is often more effective than a-posteriori reduction of the full-order controller krob
. for example, tune a third-order controller to optimize its robust performance.
% create tunable 3rd-order controller k = tunabless('k',3,ncont,nmeas); % tune robust performance of closed-loop system cl cl0 = lft(qcaric(:,:,2),k); [cl,rp] = musyn(cl0);
d-k iteration summary: ----------------------------------------------------------------- robust performance fit order ----------------------------------------------------------------- iter k step peak mu d fit d 1 1.189 1.104 1.12 10 2 1.076 1.062 1.073 10 3 0.9899 0.9822 0.9985 10 4 0.9229 0.9225 0.9315 10 5 0.9191 0.9175 0.9241 10 6 0.92 0.9163 0.929 10 best achieved robust performance: 0.916
the tuned controller has performance rp=0.92
, very close to that of krob
. you can see its bode response using
k3 = getblockvalue(cl,'k');
bode(k3)
see also
|