sf-mx/PBSwissMX
0
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

first optimized parameters with pole pülacement: TODO: check for resonance compensator

Browse Source
This commit is contained in:
zamofing_t
2019-03-01 16:56:55 +01:00
parent 842dc87860
commit cb4e0eea01
4 changed files with 127 additions and 60 deletions
Download Patch File Download Diff File Expand all files Collapse all files

120
matlab/DeltaTauParam.m
View File

@@ -36,38 +36,22 @@ function [pb]=DeltaTauParam(mot,mdl,param)
pb.ss_plt=mot.ss_dq;desc=desc+"dq"; pb.sel={3,[3]};
end
desc=desc+" param:";
curr2acc=mot.mdl.numq; %curr2acc curr_bit to acceleration: zero dB of simplified motion
pb.curr2acc=curr2acc;
if mot.id==1
%!motor_servo(mot=1,ctrl='ServoCtrl',Kp=25,Kvfb=400,Ki=0.02,Kvff=350,Kaff=5000,MaxInt=1000)
%!motor(mot=1,dirCur=0,contCur=800,peakCur=2400,timeAtPeak=1,IiGain=5,IpfGain=8,IpbGain=8,JogSpeed=10.,numPhase=3,invDir=True,servo=None,PhasePosSf=1./81250,PhaseFindingDac=100,PhaseFindingTime=50,SlipGain=0,AdvGain=0,PwmSf=10000,FatalFeLimit=200,WarnFeLimit=100,InPosBand=2,homing='enc-index')
switch param
case 0 %scratch
desc=desc+"scratch";
pl=[-300+550i -300-550i -2513];
[Am,Bm,Cm,Dm]=ssdata(mot.ss_dq);
K = place(Am,Bm,pl);
V=-1./(Cm*(Am-Bm*K)^-1*Bm); %(from Lineare Regelsysteme2 (Glattfelder) page:173 )
V=V(end);
Kfb=K*(Cm^-1);
pb.V=V;
pb.Kfb=Kfb;
pb.Kp=V;
pb.B=Kfb(3)/V;
pb.Kvfb=Kfb(2)/pb.Ts;
fprintf('Kp:%f B:%f Kvfb:%f Kafb:%f\n',pb.Kp,pb.B,pb.Kvfb,pb.Kafb);
pb.Kvff=1*pb.Kvfb;
pb.Kafb=0;%Kfb(1)/(pb.Ts^2);
pb.Kaff=1*1/(1.548e04*(pb.Ts^2));
pb.Ki=0.02;
pb.MaxInt=1000;
case 1 %origin parameters
desc=desc+"orig";
pb.Kp=25;pb.Kvfb=400;pb.Ki=0.02;pb.Kvff=350;pb.Kaff=5000;pb.MaxInt=1000;
case 2%enhances first step
desc=desc+"2";
pb.Kp=25;pb.Kvfb=350;pb.Ki=0.02;pb.Kvff=350;pb.Kaff=1/(1.548e04*(pb.Ts^2));pb.MaxInt=1000;
case 3%pole placement on simplified motion tf
desc=desc+"opt1";
pb.Kp=25;pb.Kvfb=350;pb.Ki=0.02;pb.Kvff=350;pb.Kaff=1/(curr2acc*(pb.Ts^2));pb.MaxInt=1000;
case 3 %pole placement on ss_dq (simplified motion, no current loop)
desc=desc+"pp ss\_q";
pl=[-1400 -1440];
pl=[-300+350i -300-350i];
[Am,Bm,Cm,Dm]=ssdata(mot.ss_q);
@@ -81,13 +65,31 @@ function [pb]=DeltaTauParam(mot,mdl,param)
pb.Kp=V;
pb.B=Kfb(2)/V;
pb.Kvfb=Kfb(1)/pb.Ts;
fprintf('Kp:%f B:%f Kvfb:%f\n',pb.Kp,pb.B,pb.Kvfb);
pb.Kvff=pb.Kvfb;
pb.Kafb=0;
pb.Kaff=1/(1.548e04*(pb.Ts^2));
pb.Kaff=1/(curr2acc*(pb.Ts^2));
pb.Ki=0.01; % lower
pb.MaxInt=1000;
fprintf('Kp:%f B:%f Kvfb:%f\n',pb.Kp,pb.B,pb.Kvfb);
case 4 %pole placement on ss_dq (simplified motion, simplified current loop)
desc=desc+"pp ss\_dq";
pl=[-300+350i -300-350i -2513];
[Am,Bm,Cm,Dm]=ssdata(mot.ss_dq);
K = place(Am,Bm,pl);
V=-1./(Cm*(Am-Bm*K)^-1*Bm); %(from Lineare Regelsysteme2 (Glattfelder) page:173 )
V=V(end);
Kfb=K*(Cm^-1);
pb.V=V;
pb.Kfb=Kfb;
pb.Kp=V;
pb.B=Kfb(3)/V;
pb.Kvfb=Kfb(2)/pb.Ts;
pb.Kvff=1*pb.Kvfb;
pb.Kafb=Kfb(1)/(curr2acc*(pb.Ts^2));
pb.Kaff=1*1/(curr2acc*(pb.Ts^2))+pb.Kafb;
pb.Ki=0.01;
pb.MaxInt=1000;
fprintf('Kp:%f B:%f Kvfb:%f Kafb:%f\n',pb.Kp,pb.B,pb.Kvfb,pb.Kafb);
end
%pb.Kp=0.1;pb.Kvfb=0;pb.Ki=0.00;pb.Kvff=0;pb.Kaff=1/(1.548e04*(pb.Ts^2));pb.MaxInt=1000;
%filter [z^0 z^-1 ... z^-n];
@@ -100,14 +102,76 @@ function [pb]=DeltaTauParam(mot,mdl,param)
switch param
case 0 %scratch
desc=desc+"scratch";
pb.Kp=22;pb.Kvfb=450;pb.Ki=0.02;pb.Kvff=450;pb.Kaff=4517;pb.MaxInt=1000;
pb.Kp=20.3255;
pb.Kvfb=582.4551;pb.Kvff=582.4551;
pb.Kaff=5595.2;pb.Kafb=1077.9;
pb.Ki=0.01;pb.MaxInt=1000;
% Ts=pb.Ts;
% frq=75;d=.6;
% w0=frq*2*pi;
% tfs=tf([w0^2],[1 2*d*w0 w0^2 ])
% global currTf
% frq0=55;d0=.5;
% frq1=85;d1=.5;
% w0=frq0*2*pi;
% w1=frq1*2*pi;
% tf0=tf([w0^2],[1 2*d0*w0 w0^2 ])
% tf1=tf([1 2*d1*w1 w1^2 ],[w1^2])
% tfs=tf0*tf1
% tfz=c2d(tfs,Ts)
% h=bodeplot(tfz,tfs);setoptions(h,'FreqUnits','Hz','Grid','on');
% pb.C=tfz.Numerator{1};
% pb.D=tfz.Denominator{1};
% currTf=tfz
case 1 %origin parameters
desc=desc+"orig";
pb.Kp=22;pb.Kvfb=350;pb.Ki=0.02;pb.Kvff=240;pb.Kaff=1500;pb.MaxInt=1000;
case 2%enhances first step
desc=desc+"2";
desc=desc+"opt1";
pb.Kp=22;pb.Kvfb=450;pb.Ki=0.02;pb.Kvff=450;pb.Kaff=4517;pb.MaxInt=1000;
%pb.Kp=22;pb.Kvfb=350;pb.Ki=0.02;pb.Kvff=240;pb.Kaff=3500;pb.MaxInt=1000;
case 3 %pole placement on ss_dq (simplified motion, no current loop)
desc=desc+"pp ss\_q";
pl=[-300+100i -300-100i];
[Am,Bm,Cm,Dm]=ssdata(mot.ss_q);
K = place(Am,Bm,pl);
V=-1./(Cm*(Am-Bm*K)^-1*Bm); %(from Lineare Regelsysteme2 (Glattfelder) page:173 )
V=V(end);
Kfb=K*(Cm^-1);
pb.V=V;
pb.Kfb=Kfb;
pb.Kp=V;
pb.B=Kfb(2)/V;
pb.Kvfb=Kfb(1)/pb.Ts;
pb.Kvff=pb.Kvfb;
pb.Kaff=1/(curr2acc*(pb.Ts^2));
pb.Ki=0.01; % lower
pb.MaxInt=1000;
fprintf('Kp:%f B:%f Kvfb:%f\n',pb.Kp,pb.B,pb.Kvfb);
case 4 %pole placement on ss_dq (simplified motion, simplified current loop)
desc=desc+"pp ss\_dq";
%pole(mot.ss_dq)
pl=[-300+150i -300-150i -2513];
[Am,Bm,Cm,Dm]=ssdata(mot.ss_dq);
K = place(Am,Bm,pl);
V=-1./(Cm*(Am-Bm*K)^-1*Bm); %(from Lineare Regelsysteme2 (Glattfelder) page:173 )
V=V(end);
Kfb=K*(Cm^-1);
pb.V=V;
pb.Kfb=Kfb;
pb.Kp=V;
pb.B=Kfb(3)/V;
pb.Kvfb=Kfb(2)/pb.Ts;
pb.Kvff=1*pb.Kvfb;
pb.Kafb=Kfb(1)/(curr2acc*(pb.Ts^2));
pb.Kaff=1*1/(curr2acc*(pb.Ts^2))+pb.Kafb;
pb.Ki=0.01;
pb.MaxInt=1000;
fprintf('Kp:%f B:%f Kvfb:%f Kafb:%f\n',pb.Kp,pb.B,pb.Kvfb,pb.Kafb);
end
%11.84Hz 0dB K=(11.84*2*np.pi)**2=5534.3 Ts=5kHz=.2ms
%Kaff = 1/(Ts*Ts*K) = 1/((11.84*2*np.pi)**2/5000**2) = 4517.278506241803