%máquina trifásica

clear
clc
%parâmetros da máquina
ls=0.386;
lr=0.386;
rs=5.793;
lm=0.363;
rr=3.421;
Polo=4.0;
Fm=0.0297;
Jm=0.0267;
%parâmetros odq
lg=0;
wg=0;
Ps=sqrt(2/3)*[1/sqrt(2) cos(lg) -sin(lg);1/sqrt(2) cos(lg-2*pi/3)
-sin(lg2*pi/3);1/sqrt(2) cos(lg-4*pi/3) -sin(lg-4*pi/3)];
Psinv=Ps^-1;
%parâmetros da iteração
wr(1)=0;
h=1e-4;
t(1)=0;
lso(1)=0;
lsd(1)=0;
lsq(1)=0;
lro(1)=0;
lrd(1)=0;
lrq(1)=0;
iso(1)=0;
isd(1)=0;
isq(1)=0;
iro(1)=0;
ird(1)=0;
irq(1)=0;
ce(1)=0;
fele=60;
tmax=4;
i=2;
v1=220*(cos(2*pi*fele*t(i-1))+0.0049*cos(2*pi*3*fele*t(i1))
+0.0044*cos(2*pi*5*fele*t(i-1)))+0.0007*cos(2*pi*7*fele*t(i-1));
v2=220*(cos(2*pi*fele*t(i-1)-2*pi/3)+0.0049*cos(2*pi*3*fele*t(i-1)-
2*pi/3)+0.0044*cos(2*pi*5*fele*t(i-1)-2*pi/3)+0.0007*cos(2*pi*7*fele*t(i-1)-
2*pi/3));
v3=220*(cos(2*pi*fele*t(i-1)-4*pi/3)+0.0049*cos(2*pi*3*fele*t(i-1)-
4*pi/3)+0.0044*cos(2*pi*5*fele*t(i-1)-4*pi/3)+0.0007*cos(2*pi*7*fele*t(i-1)-
4*pi/3));
vso(1)=(Psinv(1,:))*[v1;v2;v3];
vsd(1)=(Psinv(2,:))*[v1;v2;v3];
vsq(1)=(Psinv(3,:))*[v1;v2;v3];
while t(i-1)<=tmax
%tensões trifásicas sem harmonicos
%equilibradas
% v1=220*sin(2*pi*fele*t(i-1));
% v2=220*sin(2*pi*fele*t(i-1)-2*pi/3);
% v3=220*sin(2*pi*fele*t(i-1)-4*pi/3);
%com harmonicas
v1=220*sin(2*pi*fele*t(i-1))+220*0.0049*sin(2*pi*3*fele*t(i1))
+220*0.0044*sin(2*pi*5*fele*t(i-1))+220*0.0007*sin(2*pi*7*fele*t(i-1));
v2=220*sin(2*pi*fele*t(i-1)-2*pi/3)+220*0.0049*sin(2*pi*3*fele*t(i-1)-
2*pi/3)+220*0.0044*sin(2*pi*5*fele*t(i-1)-2*pi/3)+220*0.0007*sin(2*pi*7*fele*t(i1)-
2*pi/3);
v3=220*sin(2*pi*fele*t(i-1)-4*pi/3)+220*0.0049*sin(2*pi*3*fele*t(i-1)-
4*pi/3)+220*0.0044*sin(2*pi*5*fele*t(i-1)-4*pi/3)+220*0.0007*sin(2*pi*7*fele*t(i1)-
4*pi/3);
%transformação odq
vso(i)=(Psinv(1,:))*[v1;v2;v3];
vsd(i)=(Psinv(2,:))*[v1;v2;v3];
vsq(i)=(Psinv(3,:))*[v1;v2;v3];
%cálculo dos fluxos
%estator
lso(i)=lso(i-1)+h*(vso(i-1)-rs*iso(i-1));
lsd(i)=lsd(i-1)+h*(vsd(i-1)-rs*isd(i-1)+wg*lsq(i-1));
lsq(i)=lsq(i-1)+h*(vsq(i-1)-rs*isq(i-1)-wg*lsd(i-1));
%rotor
lro(i)=lro(i-1)+h*(-rr*iro(i-1));
lrd(i)=lrd(i-1)+h*(-rr*ird(i-1)+(wg-wr(i-1))*lrq(i-1));
lrq(i)=lrq(i-1)+h*(-rr*irq(i-1)-(wg-wr(i-1))*lrd(i-1));
%cálculo das correntes
%estator
iso(i)=(-lso(i)*lr+lm*lro(i))/((lm^2)-ls*lr);
isd(i)=(-lsd(i)*lr+lm*lrd(i))/((lm^2)-ls*lr);
isq(i)=(-lsq(i)*lr+lm*lrq(i))/((lm^2)-ls*lr);
%rotor
iro(i)=(lso(i)*lm-ls*lro(i))/((lm^2)-ls*lr);
ird(i)=(lsd(i)*lm-ls*lrd(i))/((lm^2)-ls*lr);
irq(i)=(lsq(i)*lm-ls*lrq(i))/((lm^2)-ls*lr);
%cálculo do conjugado elétrico
ce(i)=Polo*lm*(isq(i)*ird(i)-isd(i)*irq(i));
cm=0;
%velocidade
wr(i)=wr(i-1)+h*(ce(i)-cm-Fm*wr(i-1))/Jm;
t(i)=t(i-1)+h;
i=i+1;
end
%correntes fases RST
irst=Ps*[iso;isd;isq];
tamanho=size(irst);
n=tamanho(2);
k=n-(n/2);
%correntes de fase
figure,
plot(t(k:n),irst(1,k:n),'b',t(k:n),irst(2,k:n),'r',t(k:n),irst(3,k:n),'black')
xlabel('tempo(s)')
ylabel('Correntes (A)')
%Curva do vetor de park
figure,
plot(isd(39800:40001),isq(39800:40001))
xlabel('Id')
ylabel('Iq')
%Gerando o espectro de frequencia da corrente fase R MSCA
Nirst=irst(1,k:n);
tamanho2=size(Nirst);
L=tamanho2(2);
Fs=1/h;
NFFT = 2^nextpow2(L);
Y = fft(Nirst,NFFT)/L;
f = Fs/2*linspace(0,1,NFFT/2+1);
tamanho3=size(f);
naux=tamanho3(2);
%localização do módulo da harmonica principal
max=0;
for i=1:naux
if abs(Y(i))>max
max=abs(Y(i));
end