ea722 - laboratório de controle e servomecanismos controle...

23
Experiˆ encia 6 EA722 - Laborat´ orio de Controle e Servomecanismos Controle N˜ ao Colocado Faculdade de Engenharia El´ etrica e de Computa¸ ao Universidade Estadual de Campinas 2 o Semestre 2017 Experiˆ encia 6 EA722 - Laborat´ orio de Controle e Servomecanismos 1/23

Upload: others

Post on 25-Apr-2020

10 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Experiencia 6

EA722 - Laboratorio de Controle e

Servomecanismos

Controle Nao Colocado

Faculdade de Engenharia Eletrica e de ComputacaoUniversidade Estadual de Campinas

2o Semestre 2017

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 1/23

Page 2: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Controle nao-colocado

� Da experiencia 4 para os sistemas retilıneo e torcional:

o controle colocado e efetivo no controle da posicao do primeiro elemento(carro #1 (x1) ou disco #1 (θ1)),

do ponto de vista do controle do segundo elemento (carro #2 (x2) ou disco#2 (θ2)), a estrategia de alto ganho mostrou-se inadequada,

o controle da posicao do elemento #2 atraves apenas da realimentacao dex1 (ou θ1) leva a uma estrategia de baixos ganhos.

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 2/23

Page 3: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Controle nao-colocado

� Proposta a ser estudada controle nao-colocado

+ ++

− −−x1 x2r

kp

kv skd s

Nn(s)

Dn(s)khw

N1(s)

D(s)

N2(s)

N1(s)

FiltroNotch

P&D

r∗

G ∗(s) =khwN2(s)

D∗(s)

Figura: Diagrama para controle nao-colocado.

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 3/23

Page 4: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Configuracoes adotadas – Emulador I

� Emulador: dois discos, de tracao e de carga, conectados atraves da correiaflexıvel:

θp

θ2

ck

Funcoes de transferencia em malha aberta:

θ1(s)

T (s)= khw

N1(s)

D(s),

θ2(s)

T (s)= khw

N2(s)

N1(s),

N1(s) = Jℓs2+ c2s+k , N2(s) = khwk/gr

D(s) = J∗dJℓs4+(c2J

∗d + c1Jℓ)s

3+[(J∗d +Jℓg−2r )k+ c1c2]s

2

+(c1+ c2g−2r )ks

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 4/23

Page 5: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Configuracoes adotadas – Emulador II

Onde,Jℓ inercia total no disco de cargaJp inercia do pino SRgr = 4, g ′

r = 2 relacao de velocidades 4 : 1k constante elastica da correia flexıvelkhw ganho de hardwarec1, c2 coeficientes de atrito viscoso nos discosJ∗d = Jd +Jp(g

′r )

−2 inercia total no disco de atuacao

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 5/23

Page 6: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Configuracoes adotadas – Retilıneo

� Retilınio: dois carros conectados por uma mola de dureza media:

F

x1 x2

k2m1 m2

c1 c2

Funcoes de transferencia de malha aberta:

X1(s)

T (s)=

N1(s)

D(s),

X2(s)

T (s)=

N2(s)

D(s)

N1(s) =m2s2+ c2s+k2, N2(s) = khwk2

D(s) =m1m2s4+(c1m2+ c2m1)s

3+[(m1+m2)k2+ c1c2]s2+

+(c1+ c2)k2s

onde,m1, m2 massa dos carrosc1, cm2 coeficientes de atrito dos carrosk constante de molakhw ganho de hardware

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 6/23

Page 7: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Configuracoes adotadas – Torsional I

� Torsional: dois discos conectados pela mola torcional, com pesos adicionais:

T

J1,c1

J2,c2

θ1

θ2

k1

Funcoes de transferencia de malha aberta:

θ1(s)

T (s)=

N1(s)

D(s),

θ2(s)

T (s)=

N2(s)

D(s)

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 7/23

Page 8: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Configuracoes adotadas – Torsional II

N1(s) = J2s2+ c2s+k1, N2(s) = khwk1

D(s) = J1J2s4+(c1J2+ c2J1)s

3+[(J1+J2)k1+ c1c2]s2+

+(c1+ c2)k1s

ondeJ1, J2 momento de inercia total nos discos 1 e 2c1, c2 coeficientes de atrito viscoso dos discosk1 constante torcional da molakhw ganho de hardware

−→ os tres sistemas sao analogos

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 8/23

Page 9: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle I

Reescrevendo a f.t. entre x2 e a forca f na forma

X2(s)

F (s)=

N1(s)

D(s)

N2(s)

N1(s),

� Malha Interna: responsavel pelo controle da variavel x1 (ou θ1) e o ajuste doamortecimento

++ +

−− −x1 x2r

kp

kv skds

Nn(s)

Dn(s)khw

N1(s)

D(s)

N2(s)

N1(s)

FiltroNotch

P&D

r∗

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 9/23

Page 10: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle II

� Passo 1: Calcula-se o ganho kν atraves do lugar das raızes da malha interna, demodo que o amortecimento dos polos em malha fechada de X1(s)/R

∗(s) seja omaior possıvel

−4 −3.5 −3 −2.5 −2 −1.5 −1 −0.5 0 0.5 1−20

−15

−10

−5

0

5

10

15

20

Real Axis

Imag A

xis

Ajuste do ganho kv

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 10/23

Page 11: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle III

Obtem-se a funcao de transferencia G ∗(s):

G ∗(s) = khwN1(s)

D∗(s)N2(s)

N1(s)= khw

N1(s)

D∗(s)

� Passo 2: Calculam-se os parametros do filtro notch Nn(s)/Dn(s) de modo que:

1 os dois zeros do filtro cancelem dois polos de G ∗(s) (tipicamente polospouco amortecidos),

2 o filtro possua dois pares de polos complexos de frequencia natural dadas eξ =

√2/2 para ambos,

3 o coeficiente do termo de maior grau do polinomio Dn(s) deve ser 1(polinomio monico) e o ganho estatico (DC) da f.t. do filtro deve serunitario.

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 11/23

Page 12: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle IV

++

− −x2r

kp

kd s

Nn(s)

Dn(s)

FiltroNotch

P&D

r∗G ∗(s)

� Passo 3: Os parametros do controlador P&D sao obtidos atraves do diagramado lugar das raızesAjuste do ganho kd : maximo amortecimento para os polos dominantes em malhafechada

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 12/23

Page 13: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle V

++

−−

x2rkp

kd s

Nn(s)

Dn(s)G ∗(s)

P&D

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 13/23

Page 14: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle VI

−45 −40 −35 −30 −25 −20 −15 −10 −5 0 5 10−80

−60

−40

−20

0

20

40

60

80

Real Axis

Imag A

xis

Ajuste do ganho kd

Ajuste do ganho kp: mesmo criterio de maximo amortecimento para os polosdominantes em malha fechada

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 14/23

Page 15: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle VII

+

x2rkp

Nn(s)G∗(s)

Dn(s)+ kv sNn(s)G ∗(s)

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 15/23

Page 16: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle VIII

−45 −40 −35 −30 −25 −20 −15 −10 −5 0 5 10−100

−80

−60

−40

−20

0

20

40

60

80

100

Real Axis

Ima

g A

xis

Ajuste do ganho kp

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 16/23

Page 17: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle IX

� Passo 4: Implementacao no software ECP

+

−G ∗(s)

(kp+ kds)Gnotch(s)

kpGnotch(s)x2

Representacao do filtro notch + P&D no ECP� O bloco kpGnotch(s) e implementado atraves dos polinomios t(s) (numerador) er(s) (denominador).� O bloco (kp+kd s)Gnotch(s) e implementado atraves dos polinomios s(s)(numerador) e r(s) (denominador).

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 17/23

Page 18: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Projeto de Controle X

Para o filtro notch sejam Nn(s) = n2s2+n1s+n0 e

Dn(s) = s4+d3s3+d2s

2+d1s+d0. A relacao entre os polinomios Nn,Dn e t, r ,se

t0 = n0kp s0 = n0kp r0 = d0

t1 = n1kp s1 = n0kd +n1kp r1 = d1

t2 = n2kp s2 = n1kd +n2kp r2 = d2

s3 = n2kd r3 = d3

r4 = 1

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 18/23

Page 19: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Observando o fator de amortecimento no Matlab

� Usando os comandos rlocus e grid no Matlab, e possıvel computar um ganhode modo que o fator de amortecimento resultante associado a um polo possa serfacilmente identificado graficamente (linhas radiais), como ilustra a figuraapresentada a seguir

−2.5 −2 −1.5 −1 −0.5 0−1

−0.8

−0.6

−0.4

−0.2

0

0.2

0.4

0.6

0.8

10.20.40.580.720.830.91

0.96

0.99

0.20.40.580.720.830.91

0.96

0.99

0.511.522.5

Re(s)

menos amortecido

mais amortecido

Imag(s)

Lugar das raızes

Lugar das raızes com grid

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 19/23

Page 20: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Tempo de estabelecimento

� Considere a resposta ao de-grau de uma funcao de transfe-rencia sem zeros e cujos os po-los sao: p1 =−5, p2 =−h+2h,p3 = −h − 2h. A figura mos-trada a seguir mostra os casosh ∈ {−1,−3,−7,−9}. Quandoh=−1, os polos complexos con-jugados dominam (mais a di-reita), gerando uma resposta os-cilatoria e que demora mais paraacomodar (tempo de estabeleci-mento longo). Por outro lado,quando h = −9, o polo real do-mina, produzindo uma respostaamortecida e com tempo de es-tabelecimento menor.

0 1 2 3 4 5 60

0.2

0.4

0.6

0.8

1

1.2Step Response

Time (seconds)

Am

plit

ude

h=−1h=−3h=−7h=−9

Resposta ao degrau deG(s) = 1/poly[-5 h-2hj h+2hj]

para h ∈ {−1,−3,−7,−9}

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 20/23

Page 21: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Implementacao dos ganhos de controle I

Tela de configuracao do controlador generico

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 21/23

Page 22: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Implementacao dos ganhos de controle II

Dicas Gerais:

Retilıneo – atencao as malhas de realimentacao: Loop 3 → encoder 1(posicao do carro 1), Loop 1 → encoder 2 (posicao do carro 2).

Torcional – atencao as malhas de realimentacao: Loop 3 → encoder 1(posicao do disco 1), Loop 1 → encoder 3 (posicao do disco 3).

Emulador – atencao as malhas de realimentacao: Loop 3 → encoder 1(posicao do disco de atuacao), Loop 1 → encoder 2 (posicao do disco decarga).

Atencao a malha de realimentacao Loop 2: a mesma nao esta sendoutilizada, portanto i0 = 0

Atencao aos denominadores de g(s) e j(s): fazer g0 = j0 = 1 para nao terdivisao por zero.

Atencao aos numeradores de h(s) e e(s): fazer h0 = e0 = 1 para nao“abrir”a malha (nao passa sinal).

Atencao a implementacao do ganho kv : o mesmo deve ser implementadoem f1.

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 22/23

Page 23: EA722 - Laboratório de Controle e Servomecanismos Controle ...ricfow/EA722/EA722_slides_exp6.pdf · Servomecanismos ControleN˜aoColocado Faculdade de Engenharia El´etrica e de

Referencias Biblograficas

P. A. V. Ferreira. Introducao aos sistemas de controle. Notas de aula doProf. Paulo Valente, FEEC-UNICAMP, 1999,http://www.dt.fee.unicamp.br/~jbosco/ea722/rotaula0.pdf .

G. F. Franklin, J. D. Powell, and A. Emami-Naeini. Feedback Control ofDynamic Systems. Pearson, Upper Saddle River, NJ, 6 edition, 2009.

J. C. Geromel and A. G. B. Palhares. Analise Linear de Sistemas Dinamicos:Teoria, Ensaios Praticos e Exercıcios. Blucher, Sao Paulo, SP, 2004.

K. Ogata. Engenharia de Controle Moderno. Prentice-Hall do Brasil, Rio deJaneiro, RJ, 3 edition, 1998.

Experiencia 6 EA722 - Laboratorio de Controle e Servomecanismos 23/23