Академический Документы
Профессиональный Документы
Культура Документы
Objective: This lab is to design and implement lead compensators for Position control of DC
motor available in the laboratory. Aim is to use both root locus and bode plot to design the lead
compensator.
List of Equipment/Software
Deliverables
where is back emf constant. From now on we omit the subscript in the armature
inductance and resistance. It is left to the reader to verify that, in Laplace domain, the joint
dynamics in Figure 1 can be described by:
F
igur
e3
bloc
k
diag
ram of the robot joint dynamics in Figure 1
To simplify the equation further, we can assume that the electrical constant is much smaller
than the mechanical constant . So the transfer functions in (5) and (6) reduce to:
respectively. These two equations correspond to second order differential equation in time
domain
So, the transfer function for a robot joint driven by DC motor is in the form:
Name: Course and Year:
EE 179.1 Section: Laboratory Schedule:
Where and T are determined from the angle deficiency. c k is determined from the requirement
of the open-loop gain.
Define:
kcα = k
then
Gc(s) = K * ((T1+1) /(αT1+1))
where:
and:
G(s)=
Output:
General code:
s = poly(0,'s');
G = syslin('c',1,s^2) ;
H = syslin('c',1 ,0.1*s + 1);
SCILAB code:
scf(1);clf;
bode(G*H,fmin,fmax); //Plots frequency response in Bode diagram
SCILAB code:
R = [-1 -1];
I = [1.73205 -1.73205];
dp = R(1) + %i*I(1);
subplot(1,2,1);
rootl(G*H ,[-15 -15; 5 15],'Root locus plot for uncompensated system ' );
plot(R,I, 'x' );
angdef = 180 - phasemag(horner(G*H,dp));
disp(angdef,' angle deficiency =' );
//z = 1; // z e r o at -1;
z = 3 // zero at -3
//p = 1.73205 / tand(90 - angdef ) + 1 ;
p = 1.73205/tand(40.89334 - angdef/2)+1;
disp(p,'p =');
Gc = ((s + z) / (s + p))^2; //lead compensator
disp(Gc,' lead compensator =' );
subplot(1,2,2);
rootl(O,[ -15 -15; 5 15],'Root locus plot for compensated system ' );
Name: Course and Year:
EE 179.1 Section: Laboratory Schedule:
plot(R,I,'x');
scf();
t = 0:0.05:10;
u = ones(1,length(t)); // step response
plotresp(u,t,C,' Unit step response ' );
xstring (1 ,0.95 ,' compensated system ' );
function rootl(G,box,text)
evans(G);
xgrid();
a = gca();
if box ~= 0 then
a.box = " on";
a.data_bounds = box;
end
a.children(1).visible = 'off' ;
block
xtitle(text);
endfunction
Figure 4
Figure 5
Name: Course and Year:
EE 179.1 Section: Laboratory Schedule:
Figure 6
Root Locus of
Original System
Figure 7
Name: Course and Year:
EE 179.1 Section: Laboratory Schedule:
Figure 8
U
nit
Ste
p
Res
pon
se
of the Compensated System
Name: Course and Year:
EE 179.1 Section: Laboratory Schedule: