ˇ ´ vysoke ´ uc ˇen´ı technicke ´ v Praze Cesk e ´ Fakulta elektrotechnicka
´ RSK ˇ ´ PRACE ´ BAKALA A V´ yukov´ e materi´ aly pro modelov´ an´ı dynamick´ ych syst´ em˚ u
Praha, 2009
Autor: Richard Bobek
Prohlášení Prohlašuji, že jsem svou diplomovou (bakalárskou) práci vypracoval samostatne a použil jsem pouze podklady (literaturu, projekty, SW atd.) uvedené v priloženém seznamu.
V Praze dne Cf.G.
200q
~
podpis
Podˇ ekov´ an´ı Dˇekuji Jiˇr´ımu Roubalovi za veden´ı bakal´aˇrsk´e pr´ace a ochotu pomoci a poradit bˇehem vypracov´av´an´ı. Dˇekuji m´e rodinˇe a pˇr´atel˚ um, kteˇr´ı mˇe podporovali a pom´ahali mi bˇehem cel´eho studia.
Kl´ıˇ cov´ a slova blokov´a algebra, sch´ema
block algebra, diagram
virtu´aln´ı model spojen´ ych pohon˚ u coupled drives in virtual space ˇr´ızen´ı spojen´ ych pohon˚ u
control of coupled drives
virtu´aln´ı model helikopt´ery
helicopter in virtual space
ˇr´ızen´ı helikopt´ery
control of helicopter
Abstrakt Pˇredkl´adan´a bakal´aˇrsk´a pr´ace je ˇclenˇena do tˇr´ı ˇc´ast´ı. Prvn´ı se t´ yk´a sb´ırky pˇr´ıklad˚ u k v´ yuce pˇredmˇet˚ u Syst´emy a modely a Syst´emy a ˇr´ızen´ı. Do t´eto sb´ırky jsem pˇrispˇel kapitolou ”Blokov´a algebra”. Znalosti blokov´e algebry jsou potˇrebn´e k nalezen´ı popisu sloˇzit´eho syst´emu. Ve druh´e ˇc´asti jsem vytvoˇril virtu´aln´ı model spojen´ ych pohon˚ u. Spojen´e pohony jsou neline´arn´ım MIMO syst´emem. Virtu´aln´ı model pom˚ uˇze student˚ um sezn´amit se s problematikou identifikace a ˇr´ızen´ı tohoto syst´emu a vyzkouˇset si pr´aci s n´ım i mimo laboratoˇr. Posledn´ı ˇc´ast se vˇenuje u ´pravˇe a pˇrid´an´ı nov´ ych funkc´ı virtu´aln´ımu modelu helikopt´ery. Helikopt´era je rovnˇeˇz neline´arn´ı MIMO syst´em, kter´ y nen´ı snadn´e identifikovat a ˇr´ıdit. Studenti se d´ıky virtu´aln´ımu modelu mohou l´epe pˇripravit na pr´aci v laboratoˇri.
Abstract This graduation thesis is divided into three parts. The first one is concerned into the Collection of examples for teaching of the subject Systems and models and Systems and control. I added the chapter ”Block algebra” to this collection. Mastering the knowledge of block algebra is necessary for finding description of a complex system. In the second part I created a virtual model of coupled drives. Coupled drives are a non-linear MIMO system. Virtual model will help students getting informed about the problems of identification and control of this system. They may also try to work with the model even outside the laboratory. The last part relates to the modification and adding new functions to the virtual model of helicopter. Helicopter is as well a non-linear MIMO system. This system is hard to identify and control. Students can thanks to the virtual model be better prepared for the work in laboratory.
"'"1',,:"
Ceské vysoké ucení technické v Praze Fakulta elektrotechnická Katedra rídicí techniky
ZADÁNí BAKALÁRSKÉ PRÁCE Student: Richard Bobek Studijní program: Elektrotechnika a informatika (bakalárský), strukturovaný Obor: Kybernetika a merení Název tématu: Výukové materiály pro modelování dynamických systému
Pokyny pro vypracování: 1. Pripravte sadu rešených a nerešených príkladu, které budou soucástí sbírky príkladu k výuce predmetu Systémy a modely a Systémy a rízení. 2. Namodelujte fyzikální model spojených pohonu v Simulinku. 3. Pripravte k tomuto modelu virtuální realitu. 4. Navrhnete rízení pro tento model. 5. Upravte virtuální model helikoptéry k porovnání chování modelu v laboratori 26.
Seznam odborné literatury: Dodá vedoucí práce
Vedoucf: Ing. Jirí Roubal, Ph.D. Platnost zadání: do konce letního semestru 2008/09
hW
(VT. m-Q~~~
prof. Ing. Michael Šebek, DrSc. vedoucí katedry
doc. Ing. Boris Šimák, CSc. dekan V Praze dne 27.2.2009
Obsah Seznam obr´ azk˚ u
iii
Seznam tabulek
v
´ 1 Uvod
1
2 Blokov´ a algebra
3
2.1
Z´akladn´ı zapojen´ı syst´em˚ u . . . . . . . . . . . . . . . . . . . . . . . . . .
3
2.2
Pˇr´ıklady . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . ´ Ulohy . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
6
2.3
3 Virtu´ aln´ı model Spojen´ e pohony DCE 3.1
12 15
Teoretick´ y popis modelu . . . . . . . . . . . . . . . . . . . . . . . . . . .
16
3.1.1
Tabulka pouˇzit´ ych veliˇcin . . . . . . . . . . . . . . . . . . . . . .
19
3.2
Virtu´aln´ı model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
20
3.3
Virtu´aln´ı svˇet . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
22
3.4
Experimenty s virtu´aln´ım modelem . . . . . . . . . . . . . . . . . . . . . ˇ ızen´ı virtu´aln´ıho modelu Spojen´e pohony . . . . . . . . . . . . . . . . . R´
24
3.5
4 Virtu´ aln´ı model helikopt´ ery 4.1
28 35
Teoretick´ y popis modelu . . . . . . . . . . . . . . . . . . . . . . . . . . .
36
4.1.1
Tabulka pouˇzit´ ych veliˇcin . . . . . . . . . . . . . . . . . . . . . .
37
4.2
Virtu´aln´ı model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
37
4.3
Virtu´aln´ı svˇet . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
39
4.4
Experimenty . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
40
4.4.1
Pracovn´ı bod . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
40
4.4.2 Odezvy na skok . . . . . . . . . . . . . . . . . . . . . . . . . . . . ˇ ızen´ı modelu . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . R´
41
4.5
i
45
5 Z´ avˇ er
49
Literatura
51
6 Obsah pˇ riloˇ zen´ eho CD
53
Seznam obr´ azk˚ u 1.1
Virtu´aln´ı model k laboratorn´ımu modelu . . . . . . . . . . . . . . . . . .
2
2.1
Z´akladn´ı zapojen´ı syst´em˚ u . . . . . . . . . . . . . . . . . . . . . . . . . .
4
2.2
Blokov´e sch´ema sloˇzen´eho syst´emu . . . . . . . . . . . . . . . . . . . . .
7
2.3
Dvˇe moˇzn´e u ´pravy zapojen´ı z obr. 2.2 . . . . . . . . . . . . . . . . . . . .
7
2.5
Odezva syst´emu z obr. 2.4 pro r˚ uzn´e vstupy a r˚ uzn´e poˇca´teˇcn´ı podm´ınky
9
2.4
Simulinkov´e sch´ema zn´azorˇ nuj´ıc´ı s´eriov´e zpojen´ı syst´em˚ u z pˇr´ıkladu 2.3 .
9
2.6
Simulinkov´e sch´ema syst´emu . . . . . . . . . . . . . . . . . . . . . . . . .
10
2.7
Blokov´e sch´ema syst´emu . . . . . . . . . . . . . . . . . . . . . . . . . . .
12
2.8
Blokov´e sch´ema syst´emu . . . . . . . . . . . . . . . . . . . . . . . . . . .
12
2.9
Simulinkov´a sch´emata dvou syst´em˚ u . . . . . . . . . . . . . . . . . . . .
13
3.1
Laboratorn´ı model Spojen´e pohony DCE . . . . . . . . . . . . . . . . . .
15
3.2
Diagram modelu spojen´ ych pohon˚ u . . . . . . . . . . . . . . . . . . . . .
16
3.3
Simulinkov´e sch´ema modelu spojen´ ych pohon˚ u. . . . . . . . . . . . . . .
18
3.4
Porovn´an´ı u ´hl˚ u natoˇcen´ı ϕ1 (t) a ϕ2 (t) obou motor˚ u. . . . . . . . . . . .
20
3.5
Rozd´ıl ot´aˇcek ω1 (t) a ω2 (t) zp˚ usoben´ y prokluzem . . . . . . . . . . . . .
21
3.6
Skuteˇcn´ y prokluz ˇremene a aproximace . . . . . . . . . . . . . . . . . . .
21
3.7
Virtu´aln´ı realita Spojen´ ych pohon˚ u DCE . . . . . . . . . . . . . . . . . .
23
3.8
1. simulace . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
25
3.9
2. simulace . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
26
3.10 3. simulace . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
27
3.11 Simulinkov´e sch´ema modelu spojen´ ych pohon˚ u s ˇr´ızen´ım . . . . . . . . .
27
3.12 1. experiment, neˇr´ızen´ y model a ˇr´ızen´ y model . . . . . . . . . . . . . . .
29
3.13 1. a 2. experiment, porovn´an´ı obou model˚ u . . . . . . . . . . . . . . . . .
30
3.14 2. experiment, neˇr´ızen´ y model a ˇr´ızen´ y model . . . . . . . . . . . . . . .
31
3.15 3. experiment, neˇr´ızen´ y model a ˇr´ızen´ y model . . . . . . . . . . . . . . .
32
3.16 3. experiment, porovn´an´ı obou model˚ u . . . . . . . . . . . . . . . . . . .
33
iii
4.1
Star´ y model helikopt´ery . . . . . . . . . . . . . . . . . . . . . . . . . . .
35
4.2
Nov´ y model helikopt´ery . . . . . . . . . . . . . . . . . . . . . . . . . . .
38
4.3
Virtu´aln´ı realita pro model helikopt´ery . . . . . . . . . . . . . . . . . . .
39
4.4
Pracovn´ı bod . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
40
4.5
Skok napˇet´ı na ocasn´ım motoru, zaaretovan´a elevace . . . . . . . . . . .
41
4.6
Skok napˇet´ı na ocasn´ım motoru, zaaretovan´a elevace . . . . . . . . . . .
41
4.7
Skok napˇet´ı na hlavn´ım motoru, zaaretovan´ y azimut . . . . . . . . . . . .
42
4.8
Skok napˇet´ı na hlavn´ım motoru, zaaretovan´ y azimut . . . . . . . . . . . .
42
4.9
Skok napˇet´ı na ocasn´ım motoru, bez aretac´ı . . . . . . . . . . . . . . . .
43
4.10 Skok napˇet´ı na ocasn´ım motoru, bez aretac´ı . . . . . . . . . . . . . . . .
43
4.11 Skok napˇet´ı na hlavn´ım motoru, bez aretac´ı . . . . . . . . . . . . . . . .
44
4.12 Skok napˇet´ı na hlavn´ım motoru, bez aretac´ı . . . . . . . . . . . . . . . .
44
4.13 Skok napˇet´ı na obou motorech, bez aretac´ı . . . . . . . . . . . . . . . . .
45
4.14 Odezva virtu´aln´ıho modelu v uzavˇren´e regulaˇcn´ı smyˇcce . . . . . . . . . .
46
4.15 Odezva virtu´aln´ıho modelu v uzavˇren´e regulaˇcn´ı smyˇcce . . . . . . . . . .
46
Seznam tabulek 3.1
Tabulka pouˇzit´ ych veliˇcin
. . . . . . . . . . . . . . . . . . . . . . . . . .
19
4.1
Tabulka pouˇzit´ ych veliˇcin
. . . . . . . . . . . . . . . . . . . . . . . . . .
37
v
Kapitola 1 ´ Uvod C´ılem t´eto pr´ace je podpoˇrit v´ yuku modelov´an´ı a ˇr´ızen´ı dynamick´ ych syst´em˚ u. Pr´aci tvoˇr´ı tˇri ˇc´asti. Prvn´ı je studijn´ı materi´al, kter´ y bude zaˇrazen do sb´ırky pˇr´ıklad˚ u postihuj´ıc´ıch t´ematiku modelov´an´ı a ˇr´ızen´ı dynamick´ ych syst´em˚ u (Roubal, J. et al., 2009), kter´a je pro studenty volnˇe dostupn´a na internetu. D´ıky t´eto sb´ırce maj´ı studenti pˇr´ıstup ke komplexn´ımu ˇcesky psan´emu materi´alu vˇenovan´emu ˇr´ıdic´ı technice. Od ostatn´ıch knih vˇenovan´ ych tomuto t´ematu (Chen, C. T., 1998; Dorf, R. C. a Bishop, R. H., 2007; Franklin, G. F. et al., 2005) se liˇs´ı hlavnˇe mnoˇzstv´ım ˇreˇsen´ ych pˇr´ıklad˚ u. Druh´a ˇc´ast je vˇenov´ana virtu´aln´ı realitˇe laboratorn´ıho modelu Spojen´e pohony DCE, kter´ y se nach´az´ı v Laboratoˇri teorie automatick´eho ˇr´ızen´ı (Roubal, J., 2009). V pr´aci je pops´an cel´ y proces, tedy sestaven´ı fyzik´aln´ıho popisu, namodelov´an´ı v Simulinku a vytvoˇren´ı virtu´aln´ı reality. Spr´avn´a funkce virtu´aln´ıho modelu je ovˇeˇrena ˇr´ızen´ım. Posledn´ı ˇc´ast pr´ace popisuje u ´pravu virtu´aln´ıho modelu helikopt´ery, kter´ y se opˇet nach´az´ı v Laboratoˇri teorie automatick´eho ˇr´ızen´ı (Roubal, J., 2009). P˚ uvodn´ı model byl opraven sestaven´ım nov´eho fyzik´aln´ıho popisu a odpov´ıdaj´ıc´ı u ´pravou virtu´aln´ı reality. C´ılem byla vˇetˇs´ı pouˇzitelnost modelu pˇri v´ yuce. Funkˇcnost byla opˇet ovˇeˇrena ˇr´ızen´ım. Virtu´aln´ı model k laboratorn´ımu modelu vych´az´ı z re´aln´e pˇredlohy. Je potˇreba pozorov´an´ım a experimenty nal´ezt odpov´ıdaj´ıc´ı fyzik´aln´ı popis. Tento popis plat´ı s omezen´ım, napˇr´ıklad u helikopt´ery, kter´a se nem˚ uˇze ot´aˇcet volnˇe, ale m´a zar´aˇzky jak pro pohyb v azimutu tak elevaci. U re´aln´eho modelu tak´e nast´avaj´ı jevy, kter´e fyzik´aln´ı model nepopisuje – laboratorn´ı model helikopt´ery se samovolnˇe st´aˇc´ı do jednoho bodu. Doj´ıt m˚ uˇze i ke sloˇzitˇejˇs´ım komplikac´ım – u spojen´ ych pohon˚ u nefunguj´ı sn´ımaˇce polohy kladek. Tyto jevy je potˇreba vhodnˇe zan´est do fyzik´aln´ıho popisu. Typick´ ym pˇr´ıkladem byl prokluz ˇremene u modelu spojen´ ych pohon˚ u. Nebylo moˇzn´e jej popsat diferenci´aln´ı rovnic´ı, byl zjiˇstˇen experiment´alnˇe. 1
´ KAPITOLA 1. UVOD
2
Z´ıskan´ y popis se pak modeluje pomoc´ı Simulinku, do kter´eho je potˇreba doplnit nezn´am´e konstanty z fyzik´aln´ı ˇc´asti. Konstant´am se lze pˇrib´ıˇzit pokusy s laboratorn´ım modelem. Lze tak´e vyuˇz´ıt pˇredpoklady o v´ ysledn´em tvaru poˇzadovan´e veliˇciny, napˇr´ıklad pˇribliˇznou velikost toˇciv´eho momentu modelu helikopt´ery. Simulinkov´e sch´ema se pak m˚ uˇze propojit s virtu´aln´ı realitou. Virtu´aln´ı realita je soubor pˇr´ıkaz˚ u, popisuj´ıc´ıch geometrii objektu a zp˚ usob jejich pohybu. Pro studijn´ı u ´ˇcely vˇetˇsinou staˇc´ı pouˇzit´ı z´akladn´ıch tvar˚ u, nejde n´am o vˇernost modelu ale o funkˇcnost. Cel´ y virtu´aln´ı model je pak zapouzdˇren, aby byl skryt princip jeho fungov´an´ı a studenti neztratili motivaci jej hledat. Ze stejn´ ych d˚ uvod˚ u se liˇs´ı konstanty virtu´aln´ıho modelu od jeho laboratorn´ı verze. Na obr. 1.1 je porovn´an´ı virtu´aln´ıho a re´aln´eho modelu. Pokud m´ame spr´avnˇe pˇripraven´ y virtu´aln´ı model, m˚ uˇzeme podle nˇej navrhnout ˇr´ızen´ı. Pokud tento regul´ator vyzkouˇs´ıme na modelu v laboratoˇri bude fungovat podobnˇe.
(a) skuteˇcn´ y model
(b) virtu´aln´ı model
Obr´azek 1.1: Virtu´aln´ı model k laboratorn´ımu modelu
Kapitola 2 Blokov´ a algebra Tato kapitola byla pouˇzita do sb´ırky pˇr´ıklad˚ u postihuj´ıc´ıch t´ematiku modelov´an´ı a ˇr´ızen´ı dynamick´ ych syst´em˚ u (Roubal, J. et al., 2009). Uvedu ji zde ve znˇen´ı, jak byla uvedna ve sb´ırce. V pˇredchoz´ıch kapitol´ach jsme se dozvˇedˇeli, jak popsat vlastnosti syst´emu vnˇejˇs´ım ˇ ˇci vnitˇrn´ım popisem. Casto se vˇsak setk´ame tak´e s pˇr´ıpadem, kdy potˇrebujeme nal´ezt vlastnosti syst´emu, kter´ y vznikl spojen´ım nˇekolika subsyst´em˚ u. Stejnˇe tak mus´ıme nˇekdy subsyst´emy rozpojovat, nebo mˇenit vazby mezi nimi. Souhrn pravidel pro pr´aci s popisem a vlastnostmi sloˇzen´ ych syst´em˚ u se naz´ yv´a blokov´ a algebra (Chen, C. T., 1998; ˇ Dorf, R. C. a Bishop, R. H., 2007; Stecha, J. a Havlena, V., 1999). V t´eto kapitole si uk´aˇzeme, jak vypad´a stavov´ y a pˇrenosov´ y popis syst´emu vznikl´ y paraleln´ım, s´eriov´ ym a zpˇetnovazebn´ım ˇrazen´ım subsyst´em˚ u. D´ale si uk´aˇzeme na nˇekolika pˇr´ıkladech, jak´ y vliv na dynamick´e vlastnosti maj´ı r˚ uzn´e typy zapojen´ı, kter´e vlastnosti se zachov´avaj´ı a kter´e se naopak mohou ztratit. Na konci kapitoly opˇet naleznete nˇekolik neˇreˇsen´ ych u ´loh.
2.1
Z´ akladn´ı zapojen´ı syst´ em˚ u
Uvaˇzujme syst´emy S1 a S2 , kter´e jsou pops´any n´asleduj´ıc´ımi stavov´ ymi rovnicemi a pˇrenosov´ ymi maticemi. Pro syst´em S1 plat´ı x˙ 1 (t) = A1 x1 (t) + B 1 u1 (t) ,
Y 1 (s) = G1 (s) U1 (s) .
y 1 (t) = C 1 x1 (t) + D 1 u1 (t) , 3
(2.1)
´ ALGEBRA KAPITOLA 2. BLOKOVA
4 Pro syst´em S2 plat´ı x˙ 2 (t) = A2 x2 (t) + B 2 u2 (t) , y 2 (t) = C 2 x2 (t) + D 2 u2 (t) ,
Y 2 (s) = G2 (s) U2 (s) .
(2.2)
Pro n´asleduj´ıc´ı novˇe vznikl´e syst´emy, kter´e jsou naznaˇceny na obr. 2.1, budeme vˇzdy uvaˇzovat stavov´ y vektor sloˇzen´ y ze stavov´ ych vektor˚ u x1 a x2 ve tvaru " # x1 (t) x(t) = . x2 (t)
(a) paraleln´ı zapojen´ı
(b) s´eriov´e zapojen´ı
(2.3)
(c) zpˇetnovazebn´ı zapojen´ı
Obr´azek 2.1: Z´akladn´ı zapojen´ı syst´em˚ u
Paraleln´ı spojen´ı Pro paraleln´ı spojen´ı syst´em˚ u na obr. 2.1(a) mus´ı m´ıt oba syst´emy stejn´ y poˇcet vstup˚ u (dim{u1 } = dim{u2 }) a stejn´ y poˇcet v´ ystup˚ u (dim{y 1 } = dim{y 2 }). V´ ystup paraleln´ıho zapojen´ı y(t) je d´an souˇctem v´ ystup˚ u y 1 (t) a y 2 (t). Stavov´e matice nov´eho syst´emu jsou " # " # h i A1 0 B1 A= , B= , C = C1 C2 , 0 A2 B2
D = [D 1 + D 2 ].
(2.4)
Matice A sloˇzen´eho syst´emu je blokovˇe diagon´aln´ı. Je tedy zˇrejm´e, ˇze charakteristick´ y polynom ∆(s) sloˇzen´eho syst´emu bude roven souˇcinu charakteristick´ ych polynom˚ u jednotliv´ ych subsyst´em˚ u ∆(s) = det(sI − A) = det(sI − A1 ) det(sI − A2 ) = ∆1 (s) ∆2 (s),
(2.5)
kde I jsou jednotkov´e matice pˇr´ısluˇsn´ ych dimenz´ı. Pˇrenosov´a matice syst´emu tvoˇren´eho dvˇema paralelnˇe spojen´ ymi subsyst´emy je G(s) = G1 (s) + G2 (s) .
(2.6)
´ ´I ZAPOJEN´I SYSTEM ´ U ˚ 2.1. ZAKLADN
5
S´ eriov´ e zapojen´ı Pro s´eriov´e spojen´ı syst´em˚ u na obr. 2.1(b) mus´ı b´ yt poˇcet v´ ystup˚ u syst´emu S1 roven poˇctu vstup˚ u syst´emu S2 (dim{y 1 } = dim{u2 }). Stavov´e matice nov´eho syst´emu pak jsou
A=
"
A1
0
B 2 C 1 A2
#
, B=
"
B1 B 2 D1
#
, C=
h
i
D 2 C 1 C 2 , D = [D 2 D 1 ].
(2.7)
Matice A sloˇzen´eho syst´emu je blokovˇe doln´ı troj´ uheln´ıkov´a. Je tedy zˇrejm´e, ˇze charakteristick´ y polynom sloˇzen´eho syst´emu bude roven souˇcinu charakteristick´ ych polynom˚ u jednotliv´ ych subsyst´em˚ u ∆(s) = det(sI − A) = det(sI − A1 ) det(sI − A2 ) = ∆1 (s) ∆2 (s) ,
(2.8)
kde I jsou jednotkov´e matice pˇr´ısluˇsn´ ych dimenz´ı. Pozn´ amka: Vˇsimnˇeme si, ˇze charakteristick´ y polynom dvou subsyst´em˚ u je stejn´ y, at’ je spoj´ıme s´eriovˇe nebo paralelnˇe.
2
Pro v´ ystup y s´eriov´eho zapojen´ı podle obr. 2.1(b) plat´ı Y (s) = G2 (s) U 2 (s) = G2 (s) G1 (s) U (s) = G(s) U (s) . Pˇrenosov´a matice syst´emu tvoˇren´eho dvˇema s´eriovˇe spojen´ ymi subsyst´emy tedy je G(s) = G2 (s) G1 (s) .
(2.9)
Pozn´ amka: Pro syst´emy s v´ıce vstupy a v´ıce v´ ystupy je nutno zachovat poˇrad´ı pˇrenosov´ ych matic G2 (s) G1 (s). Pro syst´emy s jedn´ım vstupem a jedn´ım v´ ystupem na poˇrad´ı v (2.9) nez´aleˇz´ı.
2
Zpˇ etnovazebn´ı zapojen´ı Pro zpˇetnovazebn´e spojen´ı syst´em˚ u na obr. 2.1(c) plat´ı podobn´e podm´ınky pro poˇcty vstup˚ u a poˇcty v´ ystup˚ u jednotliv´ ych subsyst´em˚ u. Napiˇste tyto podm´ınky sami. Stavov´e
´ ALGEBRA KAPITOLA 2. BLOKOVA
6
matice nov´eho syst´emu pro z´apornou zpˇetnou vazbu jsou A=
"
A1 + B 1 D 2 (I + D 1 D 2 )−1 C 1
B 1 C 2 + B 1 D 2 (I + D 1 D 2 )−1 D 1 C 2
B 2 (I + D 1 D 2 )−1 C 1
A2 + B 2 (I + D 1 D 2 )−1 D 1 C 2
B=
"
B 1 + B 1 D 2 (I + D 1 D 2 )−1 D 1
C=
h
B 2 (I + D 1 D 2 )−1 D 1 −1
(I + D 1 D 2 )
C1
#
,
,
−1
(I + D 1 D 2 )
#
i
D1C 2 ,
D = (I + D 1 D 2 )−1 D 1 ,
(2.10)
kde I jsou jednotkov´e matice pˇr´ısluˇsn´ ych dimenz´ı. Pˇrenosov´a matice je G(s) = [I + G1 (s)G2 (s)]−1 G1 (s) = G1 (s) [I + G2 (s)G1 (s)]−1 .
(2.11)
Pozn´ amka: Pro zpˇetnovazebn´e zapojen´ı s kladnou zpˇetnou vazbou, mus´ıme ve stavov´em popisu nahradit ˇclen (I + D 1 D 2 )−1 ˇclenem (I − D 1 D 2 )−1 a v pˇrenosov´em popisu nahradit znam´enko +“ znam´enkem −“ (za jednotkovou matic´ı I ). ” ”
2.2
2
Pˇ r´ıklady
Pˇ r´ıklad 2.1: Pro s´eriov´e zapojen´ı dvou syst´em˚ u (2.1) a (2.2) odvod’te tvar stavov´ ych matic sloˇzen´eho syst´emu a z nich pˇrenosovou matici syst´emu G(s) (poˇc´ateˇcn´ı podm´ınky uvaˇzujte nulov´e). ˇ sen´ı: Pro s´eriov´e zapojen´ı dvou syst´em˚ Reˇ u (2.1) a (2.2) plat´ı rovnice dan´e vazbami y(t) = y 2 (t) ,
u2 (t) = y 1 (t) ,
u1 (t) = u(t) .
Stavov´e rovnice pak jsou x˙ 1 (t) = A1 x1 (t) + B 1 u1 (t) = A1 x1 (t) + B 1 u(t) , x˙ 2 (t) = A2 x2 (t) + B 2 u2 (t) = A2 x2 (t) + B 2 (C 1 x1 (t) + D 1 u(t)) , y(t) = y 2 (t) = C 2 x2 (t) + D 2 u2 (t) = C 2 x2 (t) + D 2 C 1 x1 (t) + D 2 D 1 u(t) . Odtud m˚ uˇzeme ps´at stavov´e matice sloˇzen´eho syst´emu (2.7). Z nich spoˇcteme pˇrenosovou
ˇ ´IKLADY 2.2. PR
7
matici s´eriovˇe zapojen´ ych subsyst´em˚ u G(s) = C (sI − A)−1 B + D = " h i = D2C 1 C 2 sI − =
h
D2 C 1 C 2
" i
A1
0
B 2 C 1 A2
#!−1 "
B1 B 2D1
(sI −A1 )−1
# 0
+ [D 2 D 1 ] = #"
B1
#
(sI −A2 )−1 B 2 C1 (sI −A1 )−1 (sI −A2 )−1 B 2 D 1 = C 2 (sI − A2 )−1 B 2 + D 2 C 1 (sI − A1 )−1 B 1 + D 1 .
+[D 2 D 1 ] =
Odtud vid´ıme
G(s) = G2 (s) G1 (s) . Dospˇeli jsme ke vztahu, kter´ y je stejn´ y jako (2.9). V´ ysledek je tedy spr´avn´ y. Poznamenejme, ˇze je nutn´e zachovat poˇrad´ı n´asoben´ı matic.
X
Pˇ r´ıklad 2.2: Naleznˇete pˇrenos syst´emu sloˇzen´eho ze subsyst´em˚ u (kaˇzd´ y s jedn´ım vstupem a jedn´ım v´ ystupem) podle n´asleduj´ıc´ıho obr´azku.
Obr´azek 2.2: Blokov´e sch´ema sloˇzen´eho syst´emu
ˇ sen´ı: Abychom mohli postupnˇe pouˇz´ıvat pravidla (2.6), (2.9) a (2.11), uprav´ıme si Reˇ zadan´e sch´ema podle obr. 2.3. Takov´eto u ´pravy jsou moˇzn´e, protoˇze pracujeme pouze s pˇrenosy (ne se stavov´ ymi popisy). Uk´aˇzeme si dvˇe moˇzn´e u ´pravy, viz obr. 2.3.
(a) jedna u ´prava
(b) druh´ au ´prava
Obr´azek 2.3: Dvˇe moˇzn´e u ´pravy zapojen´ı z obr. 2.2
´ ALGEBRA KAPITOLA 2. BLOKOVA
8
V prvn´ım pˇr´ıpadˇe jsme na obr. 2.3(a) posunuli vstupn´ı vˇetev bloku s pˇrenosem G4 (s) aˇz za blok s pˇrenosem G2 (s). Celkov´ y pˇrenos podle tohoto obr´azku pak p´ıˇseme G1 (s)G2 (s) G1 (s)G2 (s) 1 + G2 (s)G3 (s) . G(s) = = G1 (s)G2 (s) G4 (s) 1 + G2 (s)G3 (s) + G1 (s)G4 (s) 1+ 1 + G2 (s)G3 (s) G2 (s) Ve druh´em pˇr´ıpadˇe jsme na obr. 2.3(b) posunuli vazbu do bloku s pˇrenosem G4 (s) pˇred sˇc´ıtac´ı ˇclen za bloˇckem s pˇrenosem G1 (s). Celkov´ y pˇrenos podle tohoto obr´azku pak p´ıˇseme G(s) =
G2 (s) G1 (s) G1 (s)G2 (s) = . G1 (s)G4 (s) 1 + G2 (s)G3 (s) 1 + G2 (s)G3 (s) + G1 (s)G4 (s) 1+ 1 + G2 (s)G3 (s)
Udˇelali jsme dvˇe r˚ uzn´e u ´pravy blokov´eho sch´ematu a vid´ıme, ˇze nemaj´ı vliv na v´ ysledn´ y pˇrenos.
X
Pˇ r´ıklad 2.3: Necht’ je syst´em S tvoˇren dvˇema s´eriovˇe zapojen´ ymi subsyst´emy S1 a S2 podle obr. 2.1(b). Matice jednotliv´ ych subsyst´em˚ u jsou A1 = [−2],
B 1 = [ 1 ],
C 1 = [−3],
A2 = [ 1 ],
B 2 = [ 1 ],
C 2 = [ 1 ],
D 1 = [ 1 ], D 2 = [ 0 ].
Urˇcete stavov´e matice a pˇrenosovou matici v´ ysledn´eho syst´emu (poˇc´ateˇcn´ı podm´ınky uvaˇzujte nulov´e). Diskutujte jak´ y je ˇr´ad nov´eho syst´emu a jak´ y je ˇr´ad jeho pˇrenosu. ˇ sen´ı: Podle vztahu (2.7) nalezneme stavov´e matice sloˇzen´eho syst´emu Reˇ " # " # h i −2 0 1 A= , B= , C = 0 1 , D = [ 0 ]. −3 1 1 Z tˇechto matic urˇc´ıme pˇrenos v´ ysledn´eho syst´emu G(s) =
s2
s−1 s−1 1 = = . +s−2 (s − 1)(s + 2) s+2
Pˇrenos spoˇcten´ y ze stavov´eho popisu odpov´ıd´a pˇrenosov´e matici (2.9). Vid´ıme, ˇze aˇckoli jsme s´eriovˇe spojili dva syst´emy 1. ˇr´adu, z´ıskali jsme pˇrenos sloˇzen´eho syst´emu opˇet 1. ˇr´adu. Pouh´ y pˇrenos tedy nepopisuje syst´em pˇresnˇe a je niˇzˇs´ıho ˇr´adu, neˇz uveden´ y stavov´ y popis, kter´ y je ˇr´adu druh´eho.
ˇ ´IKLADY 2.2. PR
9
V pˇrenosu sloˇzen´eho syst´emu se totiˇz vykr´atil ˇclen (s − 1). Tento ˇclen se naz´ yv´a skryt´y m´od . Skryt´e m´ody pozn´ame porovn´an´ım charakteristick´eho polynomu syst´emu a jmenovatele jeho pˇrenosu. V´ıce se o nich dozv´ıte napˇr´ıklad v (Dorf, R. C. a Bisˇ hop, R. H., 2007; Stecha, J. a Havlena, V., 1999). My nyn´ı jen v n´asleduj´ıc´ım pˇr´ıkladˇe provedeme anal´ yzu chov´an´ı takto zapojen´eho syst´emu.
X
Pˇ r´ıklad 2.4: Analyzujte chov´an´ı sloˇzen´eho syst´emu z pˇredchoz´ıho pˇr´ıkladu v ˇcasov´e oblasti pro r˚ uzn´e vstupy u(t) a r˚ uzn´e poˇc´ateˇcn´ı podm´ınky x20 . ˇ sen´ı: V pˇredchoz´ım pˇr´ıpadˇe jsme zjistili, ˇze se ve v´ Reˇ ysledn´em pˇrenosu vykr´at´ı skryt´ y m´od. Nyn´ı budeme analyzovat, jak´e to m´a d˚ usledky v ˇcasov´e oblasti. Pro zkoum´an´ı syst´emu budeme pouˇz´ıvat simulinkov´e sch´ema uveden´e na n´asleduj´ıc´ım obr´azku.
Obr´azek 2.4: Simulinkov´e sch´ema zn´ azorˇ nuj´ıc´ı s´eriov´e zpojen´ı syst´em˚ u z pˇr´ıkladu 2.3
Nejprve nastav´ıme nulov´e poˇc´ateˇcn´ı podm´ınky obou podsyst´em˚ u x10 a x20 a na vstup cel´eho syst´emu u pˇripoj´ıme jednotkov´e skoky v ˇcase t = 1 s o velikostech u = 1 a u = 2. V´ ysledky tˇechto simulac´ı jsou na obr. 2.5(a). Pot´e nastav´ıme vstup u na nulu a provedeme simulace pro poˇc´ateˇcn´ı podm´ınky x20 = {0; 0,1; 0,5} (stav prvn´ıho subsyst´emu ponech´ame nulov´ y x10 = 0). V´ ysledky tˇechto simulac´ı jsou na obr. 2.5(b). Analyzujme nyn´ı v´ ysledky simulac´ı z pˇredchoz´ıch obr´azk˚ u. Sloˇzen´ y syst´em se skl´ad´a ze stabiln´ıho subsyst´emu S1 a nestabiln´ıho subsyst´emu S2 G1 (s) =
s−1 , s+2
G2 (s) =
1 . s−1
Novˇe sloˇzen´ y syst´em je tedy nestabiln´ı. Pokud uvaˇzujeme nulov´e poˇc´ateˇcn´ı podm´ınky, pak odezvy na obr. 2.5(a) konverguj´ı, protoˇze nestabiln´ı m´od s p´olem syst´emu −1 nem˚ uˇze b´ yt vybuzen vstupem syst´emu u (sign´al s touto frekvenc´ı neprojde pˇres nulu −1 prvn´ıho subsyst´emu. Takov´ yto m´od se naz´ yv´a neˇriditeln´y (Chen, C. T., 1998; Dorf, R. C. a ˇ Bishop, R. H., 2007; Stecha, J. a Havlena, V., 1999).
´ ALGEBRA KAPITOLA 2. BLOKOVA
10
5 1
∞
∞
x20 = 0
4.5
x
= 0.1
x
= 0.5
20
4
20
0.8 3.5 3 y [−]
y [−]
0.6
2.5 2
0.4
1.5 0.2
1 0.5 u=1 u=2
0 0
1
2
3 t [s]
4
5
0 6
(a) odezvy na vstup u
0
1
2
3 t [s]
4
5
6
(b) odezvy na poˇc´ateˇcn´ı podm´ınky x0
Obr´azek 2.5: Odezva syst´emu z obr. 2.4 pro r˚ uzn´e vstupy a r˚ uzn´e poˇc´ateˇcn´ı podm´ınky
Naopak pod´ıv´ame-li se na odezvy na nenulov´e poˇc´ateˇcn´ı podm´ınky x20 na obr. 2.5(b), vid´ıme, ˇze se nestabiln´ı skryt´ y m´od uˇz projev´ı. Syst´em je nestabiln´ı a proto i jeho odezva mus´ı divergovat. Probl´em je, ˇze nestabiln´ı neˇriditeln´ y m´od nejde vstupem u = u1 ˇr´ıdit (ovlivˇ novat). Proto nikdy nesm´ıme kr´atit nestabiln´ı p´oly nestabiln´ımi“ nulami, protoˇze ” v re´aln´em svˇetˇe nikdy nebudeme zn´at pˇresnou hodnotu dan´eho p´olu. Kdybychom takkov´ ymto zp˚ usobem chtˇeli nˇejak´ y syst´em ˇr´ıdit, dostali bychom se do probl´em˚ u, ale o tom aˇz pozdˇeji.
X
Pˇ r´ıklad 2.5: Uvaˇzujte syst´em zapojen´ y podle n´asleduj´ıc´ıho obr´azku. Naleznˇete k, pro kter´a m´a syst´em skryt´ y m´od.
Obr´azek 2.6: Simulinkov´e sch´ema syst´emu
ˇ sen´ı: Sch´ema zadan´e pˇrenosy slouˇc´ıme stavovˇe. Nejprve slouˇc´ıme dva paraleln´ı bloky, Reˇ pak pˇrid´ame integr´ator v s´erii. Stavov´e matice jednotliv´ ych subsyst´em˚ u jsou A1 = [ 0 ] ,
B1 = [ 1 ] ,
C1 = [ 1 ] ,
D1 = [ 0 ] ,
ˇ ´IKLADY 2.2. PR
11
A2 = [−2] ,
B2 = [ 1 ] ,
C2 = [ 1 ] ,
D2 = [ 0 ] ,
A3 = [−3] ,
B3 = [ 1 ] ,
C3 = [ k ] ,
D3 = [ 0 ] .
Nyn´ı zavedeme stavov´ y vektor cel´eho syst´emu x = [x1 , x2 , x3 ]. Stavov´e matice cel´eho syst´emu pak jsou 0 0 0 A= 1 −2 0 1 0 −3
,
1
B= 0 , 0
C=
h
0 1 k
i
,
D = [ 0 ].
Ze stavov´eho popisu nalezneme pˇrenos G(s) =
s + 3 + k (s + 2) s(1 + k) + 3 + 2k = . (s + 3)(s + 2)s (s + 3)(s + 2)s
Abychom odhalili skryt´e m´ody, nalezneme takov´a k, pro kter´a doch´az´ı ve v´ yˇse uveden´em pˇrenosu ke kr´acen´ı. Sloˇzen´ y syst´em m´a p´oly p1,2,3 = {0, −2, −3} a nuly z(k) = {s |s(1 + k) + 3 + 2k = 0}. Nyn´ı mus´ıme nal´ezt prvky t´eto mnoˇziny. T´ım nalezneme vˇsechny nuly pˇrenosu parametrizovan´e parametrem k. Z tˇechto nul vybereme ty, kter´e se rovnaj´ı p´ol˚ um syst´emu neboli tˇem, kter´e odpov´ıdaj´ı skryt´ ym m´od˚ um syst´emu na obr. 2.6. Uved’me jeˇstˇe jeden postup jak se dobrat k ˇreˇsen´ı tohoto pˇr´ıkladu pomoc´ı pˇrenos˚ u. Nejprve urˇc´ıme pˇrenos dvou paralelnˇe zapojen´ ych blok˚ u na obr. 2.6 Gpar (s) = G2 (s) + G3 (s) =
(s + 3) + k (s + 2) s(1 + k) + 3 + 2k = (s + 2)(s + 3) (s + 2)(s + 3)
a zjist´ıme, pro kter´a k dojde v tomto pˇrenosu ke kr´acen´ı. V tomto pˇrenosu m˚ uˇze doj´ıt ke kr´acen´ı pokud by tento pˇrenos mˇel nulu s hodnotou jednoho z p´ol˚ u {−2, −3}. To nastane pro k = 0, kde se v tomto pˇrenosu vykr´at´ı ˇclen (s + 3). Protoˇze je konstanta k v matici C 3 , je tento skryt´ y m´od odpov´ıdaj´ıc´ı p´olu −3 nepozorovateln´y (Chen, C. T., ˇ 1998; Dorf, R. C. a Bishop, R. H., 2007; Stecha, J. a Havlena, V., 1999). Pokud by byla konstanta k v matici B 3 , byl by tento skryt´ y m´od odpov´ıdaj´ıc´ı p´olu −3 neˇriditeln´y. Toto je vidˇet na prvn´ı pohled uˇz na obr. 2.6. D´ale pˇrid´ame k pˇrenosu Gpar (s) podle obr. 2.6 integr´ator v s´erii a dostaneme pˇrenos G(s) = Gpar (s) G1 (s) =
s(1 + k) + 3 + 2k 1 . (s + 2)(s + 3) s
Nyn´ı m˚ uˇze v tomto pˇrenosu doj´ıt jeˇstˇe ke kr´acen´ı p´olu v nule. To nastane pro hodnotu y p´ol vykr´acen nulovou nulou, kter´a vznikne v paraleln´ım bloˇcku k = − 23 , kdy bude nulov´
´ ALGEBRA KAPITOLA 2. BLOKOVA
12
pr´avˇe pro k = − 23 . Protoˇze jsou syst´emy ˇrazeny v tomto poˇrad´ı je cel´ y syst´em pro tuto hodnotu k ˇriditeln´ y, ale nepozorovateln´ y (m´od odpov´ıdaj´ıc´ı nulov´emu p´olu neprojde na v´ ystup syst´emu na obr. 2.6, protoˇze je nulov´an nulovou nulou paraleln´ıho bloˇcku). Z´avˇerem tedy m˚ uˇzeme ˇr´ıci, ˇze syst´em m´a skryt´ y m´od pro 3 k ∈ − ,0 . 2 Pro k = − 32 se kr´at´ı ˇclen (s + 3) a pro k = 0 se kr´at´ı ˇclen s. Proved’te sami ˇcasov´e simulace podobnˇe jako v pˇr´ıkladˇe 2.4.
2.3
X
´ Ulohy
Pˇ r´ıklad 2.6: Naleznˇete pˇrenos G(s) syst´emu sloˇzen´eho ze subsyst´em˚ u (kaˇzd´ y s jedn´ım vstupem a jedn´ım v´ ystupem) podle n´asleduj´ıc´ıho obr´azku.
Obr´azek 2.7: Blokov´e sch´ema syst´emu
Pˇ r´ıklad 2.7: Pro syst´emy S1 a S2 odvod’te pˇrenosovou matici G(s). Jsou-li spojeny: a) paralelnˇe, b) zpˇetnovazebnˇe. Pˇ r´ıklad 2.8: Odvod’te tvar stavov´ ych matic a pˇrenosov´e matice pro s´eriov´e spojen´ı syst´em˚ u z obr. 2.1(b) pro pˇr´ıpad, ˇze poˇrad´ı syst´em˚ u je opaˇcn´e neˇz na tomto obr´azku. Plat´ı tedy y(t) = y 1 (t) ,
u1 (t) = y 2 (t) ,
u2 (t) = u(t) .
Pˇ r´ıklad 2.9: Pro syst´em zadan´ y blokov´ ym sch´ematem na obr. 2.8 naleznˇete k, pro kter´a m´a syst´em skryt´ y m´od. Analyzujte vlastnosti syst´emu.
´ 2.3. ULOHY
13
Obr´azek 2.8: Blokov´e sch´ema syst´emu
Pˇ r´ıklad 2.10: Syst´em na obr. 2.9(a) byl nahrazen syst´emem na obr. 2.9(b). Zjistˇete, zda se pˇrenosy obou syst´em˚ u liˇs´ı a zda se liˇs´ı jejich vlastnosti.
(a) p˚ uvodn´ı syst´em
(b) nov´ y syst´em
Obr´azek 2.9: Simulinkov´a sch´emata dvou syst´em˚ u
Pˇ r´ıklad 2.11: Vrat’te se k pˇr´ıkladu (2.3). Jak se zmˇen´ı ˇriditelnost a pozorovatelnost sloˇzen´eho syst´emu, pokud obr´at´ıme poˇrad´ı blok˚ u S1 a S2 ? ˇ sen´ı u Reˇ ´ loh z kapitoly 2 Blokov´ a algebra 2.6: G =
G1 G2 G3 G4 1+G1 G2 G5 +G3 G4 G6 −G2 G3 G7
; 2.7: postup je obdobn´ y jako v pˇr´ıkladˇe 2.1, v´ ysledn´e
pˇrenosov´e matice jsou (2.6) 2.8: y vektor (2.3) jsou stavov´e matice i pro stavov´ i a (2.11); h h B A 1D2 1 B1C 2 , C = [ C 1 D 1 C 2 ], D = [D 1 D 2 ], pˇrenosov´a ma, B= syst´emu A = B2 0 A2 tice je G(s) = G1 (s) G2 (s); 2.9: syst´em je ˇriditeln´ y pro k 6= 1. syst´em je pozorovateln´ y pro k 6= 3; 2.10: pˇrenosy jsou stejn´e, syst´em na obr. 2.9(a) je ˇriditeln´ y a pozorovateln´ y, syst´em na obr. 2.9(b) je ˇriditeln´ y ale nen´ı pozorovateln´ y ; 2.11: syst´em m´a stejn´ y skryt´ y m´od odpov´ıdaj´ıc´ı p´olu p = −1, kter´ y ale tentokr´at nebude pozorovateln´ y, bude ˇriditeln´ y;
14
´ ALGEBRA KAPITOLA 2. BLOKOVA
Kapitola 3 Virtu´ aln´ı model Spojen´ e pohony DCE V t´eto kapitole popisuji, jak jsem sestavil fyzik´aln´ı model spojen´ ych pohon˚ u v Simulinku a pˇripravil k tomuto modelu virtu´aln´ı realitu. Rovnˇeˇz jsem navrhl a vyzkouˇsel ˇr´ızen´ı modelu.
Obr´azek 3.1: Laboratorn´ı model Spojen´e pohony DCE
15
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
16
Laboratorn´ı model spojen´ ych pohon˚ u slouˇz´ı v laboratoˇri teorie automatick´eho ˇr´ızen´ı K26 (Roubal, J., 2009) k v´ yuce modelov´an´ı a ˇr´ızen´ı dynamick´ ych syst´em˚ u. Model simuluje pouˇzit´ı dopravn´ıho p´asu ˇr´ızen´eho dvˇema pohony. Takov´ y p´as se bˇeˇznˇe vyuˇz´ıv´a v pr˚ umyslu. K tomuto laboratorn´ımu modelu vytvoˇr´ım virtu´aln´ı model, d´ıky kter´emu se budou moci studenti pˇripravit na pr´aci v laboratoˇri. Model se skl´ad´a ze dvou stejnosmˇern´ ych motor˚ u, kter´e poh´anˇej´ı pruˇzn´ y dopravn´ı p´as veden´ y pˇres dvˇe dalˇs´ı kladky. Vstupy syst´emu jsou napˇet´ı u1 (t) a u2 (t) na motorech, v´ ystupy syst´emu jsou u ´hly natoˇcen´ı motor˚ u ϕ1 (t) a ϕ2 (t) a polohy kladek x1 (t) a x2 (t) (viz obr. 3.1)
3.1
Teoretick´ y popis modelu
Abych mohl vytvoˇrit virtu´aln´ı model, nalezl jsem nejprve fyzik´aln´ı popis spojen´ ych pohon˚ u. Model jsem si rozkreslil do diagramu, kde jsem zn´azornil potˇrebn´e fyzik´aln´ı veliˇciny. Abych vyj´adˇril pruˇznost p´asu, zaˇradil jsem do nˇej pruˇziny kA , kB , kC a kD . V tabulce 3.1.1 jsem popsal pouˇzit´e veliˇciny.
Obr´azek 3.2: Diagram modelu spojen´ ych pohon˚ u
Fyzik´aln´ı popis jsem zaˇcal popisem motor˚ u M1 a M2. Motory pˇren´aˇsej´ı vstupn´ı napˇet´ı u1 (t) a u2 (t) na ot´aˇcky ω1 (t) a ω2 (t). Na z´akladˇe experiment˚ u na re´aln´em modelu jsem
´ POPIS MODELU 3.1. TEORETICKY
17
zjistil, ˇze kaˇzd´ y z motor˚ u lze popsat pˇrenosem 1. ˇr´adu. G1 (s) =
km1 Ω1 (s ) = , U1 (s ) J1 s + bm1
G2 (s) =
Ω2 (s ) km2 = . U2 (s ) J2 s + bm2
(3.1)
Tˇemto pˇrenos˚ um odpov´ıdaj´ı diferenci´aln´ı rovnice J1 ω˙ 1 (t) + bm1 ω1 (t) = km1 u1 (t) ,
J2 ω˙ 2 (t) + bm2 ω2 (t) = km2 u2 (t) .
(3.2)
Pro u ´hly natoˇcen´ı motor˚ u ϕ1 (t) a ϕ2 (t) plat´ı ϕ˙ 1 (t) = ω1 (t) ,
ϕ˙ 2 (t) = ω2 (t) .
(3.3)
Kladky motoru pˇren´aˇs´ı ot´aˇcky ω1 (t) a ω2 (t) na momenty sil M1 (t) a M2 (t). Protoˇze jsou motory spojen´e ˇremenem, mus´ım rovnice (3.2) upravit. K momentu sil vyvolan´em jedn´ım ˇremenem se pˇriˇc´ıt´a moment sil vyvolan´ y druh´ ym motorem, zmenˇsen´ y o prokluzy ˇ P1 (ω1 , ω2 ) a P2 (ω1 , ω2 ). Cleny (bm2 ω2 (t) + km2 u2 (t)) a (bm1 ω1 (t) + km1 u1 (t)) v rovnic´ıch (3.4) pˇredstavuj´ı moment vyvolan´ y druh´ ym motorem. Prokluz jsem zjistil experiment´alnˇe viz obr. 3.5. J1 ω˙ 1 (t) = −bm1 ω1 (t) + km1 u1 (t) + (−bm2 ω2 (t) + km2 u2 (t)) − P1 (ω1 , ω2 ) , J2 ω˙ 2 (t) = −bm2 ω2 (t) + km2 u2 (t) + (−bm1 ω1 (t) + km1 u1 (t)) − P2 (ω1 , ω2 ) .
(3.4)
Momenty M1 (t) a M2 (t) se rozloˇz´ı na p´asu dle vztah˚ u M1 (t) = F8 (t) r1 − F4 (t) r1 ,
M2 (t) = F3 (t) r2 − F7 (t) r2 .
(3.5)
D´ale jsem zavedl prodlouˇzen´ı xA (t), xB (t), xC (t) a xD (t), coˇz jsou prodlouˇzen´ı p´asu pˇr´ısluˇsn´a k imagin´arn´ım pruˇzin´am. Plat´ı F2 (t) = kA xA (t) = F3 (t) , F1 (t) = kB xB (t) = F4 (t) , F6 (t) = kC xC (t) = F7 (t) , F5 (t) = kD xD (t) = F8 (t) ,
(3.6)
kde kA , kB , kC a kD jsou konstanty tuhosti pruˇzin. P´as pˇri rozp´ın´an´ı nepˇrekon´a mez pruˇznosti a nelze zmˇeˇrit prodlouˇzen´ı x1 (t) a x2 (t) ze kter´ ych by bylo moˇzn´e tuhosti vyj´adˇrit. Diferenci´aln´ı rovnice pro jednotliv´a prodlouˇzen´ı z´avis´ı na rozd´ılu ot´aˇcek ω1 (t) a ω2 (t) a na prokluzu. x˙ A (t) = (ω1 (t) r1 − ω2 (t) r2 ) − kp1 P1 (ω1 , ω2 ) x˙ B (t) = (ω1 (t) r1 − ω2 (t) r2 ) − kp1 P1 (ω1 , ω2 ) x˙ C (t) = (ω2 (t) r2 − ω1 (t) r1 ) − kp2 P2 (ω1 , ω2 ) x˙ D (t) = (ω2 (t) r2 − ω1 (t) r1 ) − kp2 P2 (ω1 , ω2 )
(3.7)
18
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
Na levou kladku p˚ usob´ı s´ıla Fα (t), na pravou kladku s´ıla Fβ (t). Pro tyto s´ıly plat´ı Fα (t) = (F1 (t) + F2 (t)) cosα,
Fβ (t) = (F5 (t) + F6 (t)) cosβ.
(3.8)
Souˇcasnˇe pro s´ıly Fα (t) a Fβ (t) plat´ı Fα (t) = k1 x1 (t) + bα x˙ 1 (t) + m1 x¨1 (t) ,
Fβ (t) = k2 x2 (t) + bβ x˙ 2 (t) + m2 x¨2 (t) . (3.9)
Z pˇredchoz´ıch rovnic jiˇz mohu vyj´adˇrit diferenci´aln´ı rovnice prodlouˇzen´ı x1 (t) a x2 (t) x¨1 (t) =
1 m1
[−bα x˙ 1 − k1 x1 + (F1 + F2 ) cos α] (3.10)
x¨2 (t) =
1 m2
[−bβ x˙ 2 − k2 x2 + (F5 + F6 ) cos β]
Obr´azek 3.3: Simulinkov´e sch´ema modelu spojen´ ych pohon˚ u
´ POPIS MODELU 3.1. TEORETICKY
3.1.1
19
Tabulka pouˇ zit´ ych veliˇ cin Tabulka 3.1: Tabulka pouˇzit´ ych veliˇcin
M1
[N m ]
Toˇciv´ y moment motoru M1
M2
[N m ]
Toˇciv´ y moment motoru M2
2 −1
bm1
[kg m s ]
brzdˇen´ı motoru M1
bm2
[kg m 2 s−1 ]
brzdˇen´ı motoru M2
J1
[kg m 2 ]
moment setrvaˇcnosti motoru M1
J2
[kg m 2 ]
moment setrvaˇcnosti motoru M2
km1 km2
[N m V
−1
]
konstanta motoru M1
[N m V
−1
]
konstanta motoru M2
U1
[V ]
napˇet´ı na motoru M1
U2
[V ]
napˇet´ı na motoru M2
ω1
[s −1 ]
ot´aˇcky motoru M1
−1
ω2
[s
]
ot´aˇcky motoru M2
r1
[m ]
polomˇer kladky poh´anˇen´e motorem M1
r2
[m ]
polomˇer kladky poh´anˇen´e motorem M2
h
[m ]
vzd´alenost mezi osou soumˇernosti a poh´anˇen´e kladky
x0
[m ]
v´ ychylka kladek v pracovn´ım bodˇe
m1
[kg ]
hmotnost p˚ usob´ıc´ı na pruˇzinu k1
m2
[kg ]
hmotnost p˚ usob´ıc´ı na pruˇzinu k2
bα
[kg s −1 ]
brzdˇen´ı lev´e kladky
bβ
[kg s −1 ]
brzdˇen´ı prav´e kladky
α
[◦ ]
u ´hel mezi osou soumˇernosti a spojnic´ı lev´e kladky a motoru
β
[◦ ]
u ´hel mezi osou soumˇernosti a spojnic´ı prav´e kladky a motoru
k1
[N m −1 ]
tuhost pruˇziny k1
k2
[N m −1 ]
tuhost pruˇziny k2
[N m ]
prokluz p´asu
kA , kB , kC , kD
[N m −1 ]
tuhost pruˇzin zn´azorˇ nuj´ıc´ıch elasticitu p´asu
F1 , F2 , F3 , F4 ,
[N ]
s´ıly p˚ usob´ıc´ı po posuvn´em p´asu
P1 , P2
F5 , F6 , F7 , F8
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
20
3.2
Virtu´ aln´ı model
Podle m´eho fyzik´aln´ıho popisu laboratorn´ıho modelu jsem sestavil model v Simulinku. Sch´ema je na obr. 3.3. Pop´ıˇsi, jak jsem model sestavoval. Prvn´ı subsyst´em, Input nonlinearities, upravuje hodnoty vstupn´ıho napˇet´ı. U modelu v laboratoˇri, ovl´adan´em pˇres Matlab, m˚ uˇzeme nastavit vstup −1 aˇz +1 v jedntok´ach, kter´e Matlab pouˇz´ıv´a. U modelu kter´ y jsem vytvoˇril je vstup −10V aˇz +10V. Tak´e jsem zmˇeˇril a nastavil vstupn´ı necitlivost syst´emu. Dalˇs´ı blokem je susyst´em Motors. V tomto subsyst´emu se vstupn´ı napˇet´ı u1 (t) a u2 (t) pˇren´aˇs´ı dle rovnic (3.4) na ot´aˇcky ω1 (t) a ω2 (t). Abych tento blok mohl sestavit, musel jsem z re´aln´eho modelu identifikovat konstanty J1 , J2 , km1 , km2 , bm1 a bm2 a identifikovat prokluz P1 (ω1 , ω2 ) a P2 (ω1 , ω2 ). Experimetny s modelem jsem zjistil, ˇze motory pouˇzit´e v modelu spojen´ ych pohon˚ u se od sebe v´ yraznˇe neliˇs´ı. Z´aroveˇ n nen´ı podstatn´ y rozd´ıl, mezi chody motor˚ u pˇri kladn´em, ˇci z´aporn´em napˇet´ı. Na obr. 3.4 jsem zaznamenal aboslutn´ı hodnotu u ´hl˚ u natoˇcen´ı motor˚ u pro r˚ uzn´a napˇet´ı. Index p oznaˇcuje kladn´e napˇet´ı, index n oznaˇcuje z´aporn´e napˇet´ı. 4
4
5
x 10
2.5
φ
x 10
φ
1p
1p
φ2p
3.5
2
φ1n
3
φ2p φ1n
φ
φ
2n
2n
|φ| [rad]
|φ| [rad]
2.5 2 1.5
1.5
1
1 0.5 0.5 0 0
1
2
3
4
5
0 0
t [s]
1
2
3
4
5
t [s]
(a) u1p = 0.2, u2p = 0.2,u1n = −0.2, u2n =
(b) u1p = 0.9, u2p = 0.9,u1n = −0.9, u2n =
−0.2
−0.9
Obr´azek 3.4: Porovn´an´ı u ´hl˚ u natoˇcen´ı ϕ1 (t) a ϕ2 (t) obou motor˚ u
Momenty setrvaˇcnosti J1 a J2 jsem urˇcil jako momenty setrvaˇcnosti pln´eho v´alce o homtnosti 0,2kg a polomˇeru 0,06m. Konstanty km1 , km2 , bm1 a bm2 jsem identifikoval pomoc´ı pˇrechodov´ ych charakteristik, kter´e jsem namˇeˇril na re´aln´em modelu.
´ ´I MODEL 3.2. VIRTUALN
21
Prokluz ˇremene jsem identifikoval tak, ˇze na prvn´ım motoru jsem nastavoval po skoc´ıch vstup 0 aˇz 1M U a na druh´em motoru jsem nechal nulov´e napˇet´ı. Prokluz ˇremene zp˚ usobil rozd´ıl mezi ot´aˇckami prvn´ıho a druh´eho motoru. 12
45
ω
1
ω
1
40
ω
ω
2
10
2
35 30 −1
ω [s ]
−1
ω [s ]
8
6
4
25 20 15 10
2 5 0 0
2
4
6
8
0 0
10
2
4
t [s]
6
8
10
t [s]
(a) u1 = 0.4, u2 = 0
(b) u1 = 1, u2 = 0
Obr´azek 3.5: Rozd´ıl ot´ aˇcek ω1 (t) a ω2 (t) zp˚ usoben´ y prokluzem
Zaznamenal jsem rozd´ıly mezi ot´aˇckami ω1 (t) a ω2 (t) pro jednotliv´e rozd´ıly napˇet´ı u1 (t) a u2 (t) a zjistil jsem, ˇze prokluz ˇremene pˇri tomto experimentu se d´a aproximovat vztahem |ω1 (t) − ω2 (t)| = 0.02157e6.96025(|u1 (t)−u2 (t)|) .
(3.11)
Z´avislost prokluzu na rozd´ılu napˇet´ı se d´a s dostateˇcnou pˇresnost´ı aproximovat exponenci´alou. Na obr´azku obr. 3.6 je prokluz ot´aˇcek pro u1 = 0. 25
|ω − ω | 1
2
aproximace
15
1
2
|ω − ω | [s−1]
20
10
5
0 −1
−0.5
0 u − u [V] 1
0.5
1
2
Obr´azek 3.6: Skuteˇcn´ y prokluz ˇremene a aproximace
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
22
Protoˇze v modelu uvaˇzuji motory za podobn´e, je stejn´ y rozd´ıl mezi ot´aˇckami pokud je napˇet´ı na druh´em motoru vyˇsˇs´ı, neˇz napˇet´ı na prvn´ım motoru. Sch´ema jsem d´ale upravil, aby prokluz pˇri nulov´ ych napˇet´ı na obou motorech nezp˚ usobil ot´aˇcen´ı kladek. Dalˇs´ım blokem v modelu je subsyst´em Belt, ot´aˇcky ω1 (t) a ω2 (t) se pˇren´aˇs´ı dle rovnic (3.7) na s´ıly F1 (t), F2 (t), F5 (t) a F7 (t). Do vzorce (3.8) potˇrebuji vyj´adˇrit cos α a cos β. h i h −1 cos α = cos tan , x0 +x1 h
cos β = cos tan−1
h x0 +x2
i
(3.12)
.
ystupy syst´emu x1 (t) V subsyst´emech F alpha1 a F beta1 jsem dle rovnice (3.9) vyj´adˇril v´ a x2 (t) a nalezl konstanty k1 , b1 a k2 , b2 tak, aby se virtu´aln´ı model podobal re´aln´emu. Pomoc´ı subsyst´em˚ u To VR world a To VR world1 jsem upravil v´ ystupy virtu´aln´ıho modelu, aby odpov´ıdaly virtu´aln´ımu svˇetu. V´ ystupy x1 (t) a x2 (t) jsem vyn´asobil konstantou 100, aby pohyb ve virtu´aln´ım svˇetˇe odpov´ıdal realitˇe.
3.3
Virtu´ aln´ı svˇ et
M´ ym u ´kolem bylo vytvoˇrit virtu´aln´ı realitu pro v´ yˇse fyzik´alnˇe popsan´ y laboratorn´ı model. Pˇri u ´pravˇe virtu´aln´ıho modelu helikopt´ery jsem pouˇz´ıval pouze editor V-Realm Builder, kter´ y je souˇc´ast´ı Matlabu. Pro tvorbu cel´eho modelu bylo v´ yhodnˇejˇs´ı ps´at k´od v textov´em editoru. Psan´ı k´odu v textov´em editoru bylo pohodlnˇejˇs´ı a pˇrehlednˇejˇs´ı, neˇz ´ , M., 2005; pr´ace s VRML editorem. Popis tˇeles ve VRML je napˇr´ıklad v (Serbusova ˇ ´ , D. et al., 1997). Cernohorsk y Pro model jsem pouˇzil univerz´aln´ı uzel Background, kter´ y je stejn´ y u vˇsech virtu´aln´ıch model˚ u z laboratoˇre K26. D´ale jsem vytvoˇril tˇri uzly Viewpoint, pro pohled zepˇredu, z d´alky a ze strany. Uzel CoupledEngines je box s texturou laboratorn´ıho modelu, ze kter´e jsem vymazal kladky, rotory a p´as, kter´e jsem modeloval pomoc´ı samostatn´ ych uzl˚ u. Pro kladky a rotory jsem pouˇzil vˇzdy stejn´ y postup. Jako pˇr´ıklad uvedu vytvoˇren´ı virtu´aln´ı reality pro horn´ı rotor. Nejprve jsem vytvoˇril uzel Top drive, kter´ y definuje stˇred a rovinu ot´aˇcen´ı rotoru. Protoˇze ve VRML jsou implicitnˇe podstavy v´alc˚ u vodorovn´e, rovinu jsem otoˇcil vektorem rotation [1 0 0 1.5708], tedy ve smˇeru kolm´em na osu
´ ´I SVET ˇ 3.3. VIRTUALN
23
y popisuje samotnou x o 90◦ . Children uzlem tohoto uzlu je uzel Top drive rot, kter´ geometrii v´alce a jeho texturu. Vektor Top drive rot.rotation ot´aˇc´ı rotorem. Popis rotac´ı je napˇr´ıklad v (Perrett, G., 2000-2009). Uvedl jsem zde ˇc´ast k´odu, kter´a popisuje uzel Top drive. DEF Top_drive Transform{ rotation
1 0 0
translation
1.5708
0.2 15 11
children DEF Top_drive_rot Transform { scale
1 1 1
children Shape { appearance
Appearance {
material
Material { transparency
0
} texture
ImageTexture { url
"texture/rotor.jpg"
} } geometry
Cylinder { height
2
radius
1.4
} } } }
Obr´azek 3.7: Virtu´aln´ı realita Spojen´ ych pohon˚ u DCE
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
24
Ve virtu´aln´ı realitˇe jsem p´as neudˇelal pohybliv´ y. Vytvoˇrit p´as, kter´ y by ob´ıhal kolem jednotliv´ ych kladek a rotor˚ u by bylo pˇr´ıliˇs sloˇzit´e a pro studijn´ı u ´ˇcely je to nepotˇrebn´e. P´as jsem rozdˇelil na ˇctyˇri ˇc´asti, kter´e vˇzdy spojuj´ı kladku s motorem. Aby se virtu´aln´ı model podobal realitˇe, sleduj´ı ˇc´asti p´asu pohyb kladek. y pˇredstavuje horn´ı levou ˇctvrtinu p´asu. Jako pˇr´ıklad uvedu uzel Top left belt, kter´ Rozmˇery, natoˇcen´ı a materi´al p´asu popisuje jeho children uzel Top left belt.rot. Pouˇzil jsem standartn´ı materi´al Yellow plastic. Vektorem Top left belt.scale se sleduje pohyb kladky. DEF Top_left_belt Transform{ translation
1 17 11
scale 1 1 1 children DEF Top_left_belt_rot Transform { scale
1 1 1
translation -8.5 -6.5 0 rotation 0 0 1 -2.45 children Shape { appearance
Appearance {
material
Material { ambientIntensity
0.1
diffuseColor
0.8 0.789856 0.00200167
emissiveColor shininess
0 0 0 0.2
specularColor transparency
1 1 1 0
} } geometry
Box { size 18 0.7 0.7 }
} } }
3.4
Experimenty s virtu´ aln´ım modelem
U virtu´aln´ıho modelu jsem z´amˇernˇe zmˇenil tuhosti pruˇzin k1 , k2 a tlumen´ı b1 , b2 tak, aby odpov´ıdaly pˇribliˇznˇe polovinˇe hodnot re´aln´eho modelu. Udˇelal jsem to proto, ˇze u re´aln´eho modelu nedoch´az´ı k v´ yrazn´ ym posun˚ um kladek. Pokud by si student chtˇel tedy napˇr´ıklad navrhnout ˇr´ızen´ı virtu´aln´ıho modelu, bude m´ıt jeho regul´ator znatelnˇejˇs´ı u ´ˇcinek, neˇz u re´aln´eho modelu.
´ ´IM MODELEM 3.4. EXPERIMENTY S VIRTUALN
25
Na nˇekolika simulac´ıch jsem pak vyzkouˇsel chov´an´ı virtu´aln´ıho modelu a porovnal jej s chov´an´ım re´aln´eho modelu. U simulac´ı jsem zaznamenal i ot´aˇcky ω1 (t) a ω2 (t), abych mohl chov´an´ı virtu´aln´ıho modelu l´epe popsat. U modelu dostupn´eho student˚ um budou v´ ystupy modelu pouze x1 (t), x2 (t) a ϕ1 (t), ϕ2 (t). 0.06
9
x
u1
8
1
u
x
0.05
2
2
7
0.04 výchylka [m]
U [V]
6 5 4
0.03 0.02
3
0.01 2
0
1 0 0
5
10
15 t [s]
20
25
30
−0.01 0
(a) Pr˚ ubˇeh napˇet´ı na vstupech modelu
5
10
15 t [s]
20
25
(b) V´ ychylky x1 (t) a x2 (t) 35
900
ω
φ1
800
30
1
φ2
ω
30
2
700
ω [s ]
500
−1
pocet otacek
25 600
400 300
20 15 10
200
5
100 0 0
5
10
15 t [s]
20
25
30
0 0
´ (c) Uhly natoˇcen´ı ϕ1 (t) a ϕ2 (t)
5
10
15 t [s]
20
25
30
(d) Ot´aˇcky motor˚ u
Obr´azek 3.8: 1. simulace
Vid´ıme, ˇze na zaˇc´atku simulace (obr. 3.8) se kladka posune smˇerem doprava, protoˇze motor M1 m´a v´ yraznˇe vˇetˇs´ı vstupn´ı napˇet´ı, neˇz druh´ y motor. Doch´az´ı k prokluzu p´asu a ot´aˇcky obou motor˚ u jsou r˚ uzn´e. Po skoku napˇet´ı u2 (t) se vstupn´ı napˇet´ı obou motor˚ u liˇs´ı jen o 1V, kladky se vr´at´ı do sv´e p˚ uvodn´ı polohy. Ot´aˇcky motoru 1, se zv´ yˇs´ı, d´ıky zv´ yˇsen´ı toˇciv´eho momentu druh´eho motoru. Nedoch´az´ı t´emˇeˇr k ˇz´adn´emu prokluzov´an´ı p´asu, oba motory se ot´aˇcej´ı stejnou rychlost´ı. Chov´an´ı odpov´ıd´a chov´an´ı skuteˇcn´eho modelu.
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
26
−3
10
2
u
x 10
x1
1
u2
x
0
8
2
výchylka [m]
−2
U [V]
6
4
−4 −6 −8
2 −10
0 0
5
10
15 t [s]
20
25
−12 0
30
(a) Pr˚ ubˇeh napˇet´ı na vstupech modelu
5
10
15 t [s]
20
25
(b) V´ ychylky x1 (t) a x2 (t) 30
600
ω
φ
1
1
φ2
ω
2
25
20
400 −1
ω [s ]
pocet otacek
500
30
300
15
200
10
100
5
0 0
5
10
15 t [s]
20
25
30
0 0
´ (c) Uhly natoˇcen´ı ϕ1 (t) a ϕ2 (t)
5
10
15 t [s]
20
25
30
(d) Ot´aˇcky motor˚ u
Obr´azek 3.9: 2. simulace
Provedl jsem dalˇs´ı simulaci (obr. 3.9), pˇri kter´e se kladky nejprve m´ırnˇe posunou doprava, protoˇze vstupn´ı napˇet´ı na motoru 1 je vyˇsˇs´ı, neˇz na druh´em motoru. Po skoku napˇet´ı u2 (t) se kladky vych´ yl´ı na druhou stranu. P´as zaˇcne prokluzovat, protoˇze mezi napˇet´ımi na motorech je velk´ y rozd´ıl. I pˇri t´eto simulaci odpov´ıd´a chov´an´ı modelu skuteˇcnosti. U tˇret´ı simulace (obr. 3.10) je nejprve napˇet´ı na motorech stejn´e. Po prvn´ım skoku napˇet´ı u1 (t) se kladky vych´ yl´ı doleva, protoˇze druh´ y motor m´a vyˇsˇs´ı vstupn´ı napˇet´ı. Po druh´em skoku napˇet´ı u1 (t), je jeho absolutn´ı hodnota vyˇsˇs´ı, neˇz napˇet´ı u2 (t) a motory se zaˇcnou toˇcit na druhou stranu. U vˇsech simulac´ı, kter´e jsem provedl se virtu´aln´ı model choval podobnˇe jako skuteˇcn´ y model a lze jej tedy pouˇz´ıt pro potˇreby v´ yuky.
´ ´IM MODELEM 3.4. EXPERIMENTY S VIRTUALN
27 −3
5 4
u1
0.5
u2
0
x 10
x
1
x2
3 −0.5 výchylka [m]
U [V]
2 1 0 −1
−1 −1.5 −2
−2
−2.5
−3
−3
−4 0
5
10
15 t [s]
20
25
−3.5 0
30
(a) Pr˚ ubˇeh napˇet´ı na vstupech model˚ u
10
15 t [s]
20
25
ω
φ1
1
ω
φ
300
30
(b) V´ ychylky x1 (t) a x2 (t) 20
350
2
2
15
250 200
−1
ω [s ]
pocet otacek
5
150 100
10
5
50 0 0
5
10
15 t [s]
20
25
´ (c) Uhly natoˇcen´ı ϕ1 (t) a ϕ2 (t)
30
0 0
5
10
15 t [s]
20
25
(d) Ot´aˇcky motor˚ u u obou model˚ u
Obr´azek 3.10: 3. simulace
Obr´azek 3.11: Simulinkov´e sch´ema modelu spojen´ ych pohon˚ u s ˇr´ızen´ım
30
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
28
3.5
ˇ ızen´ı virtu´ R´ aln´ıho modelu Spojen´ e pohony
U virtu´aln´ıho modelu spojen´ ych pohon˚ u budu ˇr´ıdit napˇet´ı u1 (t) tak, aby v´ ychylka x1 (t) byla nulov´a. Tedy aby se kladka k1 neh´ ybala, pokud se zmˇen´ı napˇet´ı na motoru M1. Abych mohl ˇr´ızen´ı navrhnout, nalezl jsem pˇrenos G(s) =
x1 (s) u1 (s)
a pro pracovn´ı bod
x0 = [ u1 (t) u2 (t) ] = [ 5 5 ] ⇒ [ ω1 (t) ω2 (t) ] = [ 18ot/s 18ot/s ], [ x10 x20 ] = [ 0 0 ] G(s) =
x1 (s) u1 (s)
=
r1 −r2 s
h r1 (km1 +5km2 ) − sJ1 +bm1 √
r2 (km1 +5km2 ) sJ2 +bm2
2
2(s2 m1 +sb1 +k1 )
i
(3.13)
Pro n´avrh ˇr´ızen´ı jsem vyuˇzil prostˇred´ı Control and Estimation Tool Manager v Matlabu, kde jsem navrhl PIDf regul´ator s pˇrenosem C(s) = 274.4
2.3s2 + 3.25 + 6.1 . s(0.033s + 1)
(3.14)
Regul´ator jsem zapojil podle obr. 3.11. Provedl jsem nˇekolik experiment˚ u, ve kter´ ych jsem porovnal virtu´aln´ı model bez a s regulac´ı. Vˇsechny experimenty jsem prov´adˇel z pracovn´ıho bodu. Zaznamen´aval jsem vstupn´ı napˇet´ı do modelu u1 (t) a u2 (t) a v´ ychlky kladek x1 (t) a x2 (t). Namˇeˇren´e v´ ychylky kladek u obou model˚ u jsem porovnal mezi sebou. Zaznamenal jsem tak´e ot´aˇcky motor˚ u. Ty vˇsak nebudou student˚ um pˇr´ıstupn´e jako v´ ystup modelu (nebudou mˇeˇriteln´e).
1. experiment V prvn´ım experimentu jsem simuloval zmˇenu napˇet´ı u2 (t) z pracovn´ıho bodu. V ˇcase t = 10s se na napˇet´ı u2 (t) objevila porucha ve tvaru 2V vysok´eho pulsu. Chov´an´ı modelu bez ˇr´ızen´ı popisuje obr. 3.12, lev´ y sloupec. Kladky neˇr´ızen´eho modelu se nejprve vych´ yl´ı d´ıky zv´ yˇsen´ı momentu motoru M2 a ust´al´ı se v t´eto poloze. Po skonˇcen´ı poruchy se kladky opˇet vr´at´ı do p˚ uvodn´ı polohy. U modelu s ˇr´ızen´ım (obr. 3.12, prav´ y sloupec) se kladky zaˇcnou vychylovat ve stejn´em smˇeru jako u neˇr´ızen´eho modelu. V´ ychylky jsou vˇsak menˇs´ı a regul´ator ust´al´ı polohu kladek v p˚ uvodn´ı poloze. Po skonˇcen´ı pulsu se kladky znovu vych´ yl´ı a regul´ator je znovu vr´at´ı do pracovn´ıho bodu. Na obr. 3.13 jsem zaznamenal porovn´an´ı v´ ychylek u obou model˚ u.
ˇ ´IZEN´I VIRTUALN ´ ´IHO MODELU SPOJENE ´ POHONY 3.5. R
7
29
7.5 u1
u1
u2
u2 7
6.5
U [V]
U [V]
6.5 6
6 5.5 5.5
5 0
10
20
30
40
5 0
50
10
20
t [s]
30
40
50
t [s]
(a) Pr˚ ubˇeh napˇet´ı na vstupech modelu
(b) Pr˚ ubˇeh napˇet´ı na vstupech modelu
−4
4
x 10
−4
0.5
x1
x1
x
3
2
2
−0.5 výchylka [m]
výchylka [m]
x
0
2 1 0
−1 −1.5
−1
−2
−2
−2.5
−3 0
x 10
10
20
30
40
−3 0
50
10
20
t [s]
30
40
50
t [s]
(c) V´ ychylky x1 (t) a x2 (t) 25
(d) V´ ychylky x1 (t) a x2 (t) 30
ω
ω
1
1
ω
2
20
ω
2
25
−1
ω [s ]
−1
ω [s ]
20 15
15
10 10 5
0 0
5
10
20
30
40
t [s]
(e) Ot´aˇcky motor˚ u ω1 (t) a ω2 (t)
50
0 0
10
20
30
40
t [s]
(f) Ot´aˇcky motor˚ u ω1 (t) a ω2 (t)
Obr´azek 3.12: 1. experiment, neˇr´ızen´ y model a ˇr´ızen´ y model
50
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
30 2. experiment
U druh´eho experimentu se na napˇet´ı u2 (t) objevila porucha v podobˇe dvou skok˚ u o velikostech −1V a −2V. Chov´an´ı modelu bez ˇr´ızen´ı jsem zaznamenal na obr. 3.14, lev´em sloupci. U tohoto modelu se kladky pˇri zmˇenˇe napˇet´ı vych´ yl´ı a ust´al´ı v nov´e poloze. Po odeznˇen´ı poruchy se kladky vr´at´ı do sv´e poˇc´ateˇcn´ı polohy. U modelu s regul´atorem se kladky po prvn´ım skoku napˇet´ı vr´at´ı zpˇet do sv´e p˚ uvodn´ı polohy. Po pˇr´ıchodu druh´eho skoku kladky zakmitaj´ı a opˇet se vr´at´ı zpˇet. Po odeznˇen´ı vˇsech skok˚ u dojde k nejvˇetˇs´ımu z´akmitu, protoˇze zmˇena napˇet´ı u2 (t) je nejvˇetˇs´ı. Na obr. 3.13 jsem zaznamenal porovn´an´ı v´ ychylek u obou model˚ u.
3. experiment U tˇret´ıho experimentu je nejl´epe vidˇet rozd´ıl mezi syst´em s a bez regul´atoru. Pˇri tomto experimentu dojde ke skokov´e zmˇenˇe napˇet´ı u2 (t). Chov´an´ı modelu bez ˇr´ızen´ı je na obr. 3.14, lev´em sloupci. Kladky se vych´ yl´ı a protoˇze se napˇet´ı jiˇz nezmˇen´ı, z˚ ustanou ve vych´ ylen´em stavu. Naproti tomu u modelu s regul´atorem se kladky vr´at´ı do poˇca´teˇcn´ı polohy a setrvaj´ı v n´ı. Model s regul´atorem je na obr. 3.15, prav´em sloupci. Na obr. 3.16 jsem zaznamenal porovn´an´ı v´ ychylek u obou model˚ u. −4
8
−4
x 10
4
x 10
x1riz
x1riz
x2riz
6
x2riz
3
x1neriz
x1neriz 2
x2neriz výchylka [m]
výchylka [m]
4 2 0
1 0
−2
−1
−4
−2
−6 0
10
20
30
40
t [s]
(a) V´ ychylky x1 (t) a x2 (t)
50
x2neriz
−3 0
10
20
30
40
t [s]
(b) V´ ychylky x1 (t) a x2 (t)
Obr´azek 3.13: 1. a 2. experiment, porovn´an´ı obou model˚ u
50
ˇ ´IZEN´I VIRTUALN ´ ´IHO MODELU SPOJENE ´ POHONY 3.5. R
5
31
6 u1
4.5
u1
5.5
u2
u2
5 4.5 U [V]
U [V]
4
3.5
3
4 3.5 3 2.5
2.5 2 2 0
10
20
30
40
1.5 0
50
10
20
t [s]
(a) Pr˚ ubˇeh napˇet´ı na vstupech modelu
40
−4
x 10
4 x1
x 10
x1
3
x
x
2
2
6
2 výchylka [m]
výchylka [m]
50
(b) Pr˚ ubˇeh napˇet´ı na vstupech modelu
−4
8
30 t [s]
4
2
1 0 −1 −2 −3
0
−4 −2 0
10
20
30
40
−5 0
50
10
20
t [s]
30
40
50
t [s]
(c) V´ ychylky x1 (t) a x2 (t) 20
(d) V´ ychylky x1 (t) a x2 (t) 25
ω
ω
1
1
ω
ω
2
2
20
15
−1
ω [s ]
−1
ω [s ]
15
10
10 5 5
0 0
10
20
30
40
t [s]
(e) Ot´aˇcky motor˚ u ω1 (t) a ω2 (t)
50
0 0
10
20
30
40
t [s]
(f) Ot´aˇcky motor˚ u ω1 (t) a ω2 (t)
Obr´azek 3.14: 2. experiment, neˇr´ızen´ y model a ˇr´ızen´ y model
50
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
32
8
9 u1
u1 8.5
u2
7.5
u2
8 7.5 U [V]
U [V]
7
6.5
7 6.5
6
6 5.5
5.5
5 0
10
20 t [s]
30
5 0
40
(a) Pr˚ ubˇeh napˇet´ı na vstupech modelu
20 t [s]
30
40
(b) Pr˚ ubˇeh napˇet´ı na vstupech modelu
−4
1
10
−4
x 10
2
x 10
x1 0
x1
x
2
x
2
1
výchylka [m]
výchylka [m]
−1 −2 −3 −4
0
−1
−2
−5 −3
−6 −7 0
10
20 t [s]
30
−4 0
40
(c) V´ ychylky x1 (t) a x2 (t) 25
10
20 t [s]
30
(d) V´ ychylky x1 (t) a x2 (t) 35
ω
ω
1
1
ω
ω
30
2
20
40
2
−1
ω [s ]
15
−1
ω [s ]
25
10
20 15 10
5 5 0 0
10
20 t [s]
30
(e) Ot´aˇcky motor˚ u ω1 (t) a ω2 (t)
40
0 0
10
20 t [s]
30
(f) Ot´aˇcky motor˚ u ω1 (t) a ω2 (t)
Obr´azek 3.15: 3. experiment, neˇr´ızen´ y model a ˇr´ızen´ y model
40
ˇ ´IZEN´I VIRTUALN ´ ´IHO MODELU SPOJENE ´ POHONY 3.5. R −4
2
x 10
x1riz
1
x2riz x1neriz
výchylka [m]
0
x
2neriz
−1 −2 −3 −4 −5 −6 −7 0
10
20 t [s]
30
40
(a) V´ ychylky x1 (t) a x2 (t)
Obr´azek 3.16: 3. experiment, porovn´an´ı obou model˚ u
33
34
´ ´I MODEL SPOJENE ´ POHONY DCE KAPITOLA 3. VIRTUALN
Kapitola 4 Virtu´ aln´ı model helikopt´ ery V t´eto kapitole jsem popsal u ´prav´ y, kter´e jsem provedl na jiˇz existuj´ıc´ım virtu´aln´ım modelu. P˚ uvodn´ı virtu´aln´ı model k laboratorn´ımu modelu helikopt´ery v laboratoˇri K26 (Roubal, J., 2009) byl vytvoˇren pro n´azorn´e porovn´an´ı identifikovan´eho modelu se skuteˇcn´ ym. Skl´adal se z pˇrenos˚ u napˇet´ı na ot´aˇcky ocasn´ıho a hlavn´ıho motoru, kter´e student s´am zad´aval a mohl tak porovnat, jak jeho identifikace odpov´ıd´a skuteˇcn´emu modelu.
Obr´azek 4.1: Star´ y model helikopt´ery
Pro pˇrizp˚ usoben´ı laboratoˇre zmˇen´am studijn´ıch pl´an˚ u, jsem upravil model tak, aby si na nˇem mohli studenti vyzkouˇset identifikaci syst´emu doma a mohli se tak pˇripravit na 35
´ ´I MODEL HELIKOPTERY ´ KAPITOLA 4. VIRTUALN
36 pr´aci s laboratorn´ım modelem.
Pˇri identifikaci nov´eho virtu´aln´ıho modelu budou muset studenti postupovat stejnˇe jako u re´aln´eho modelu v laboratoˇri a respektovat stejn´a omezen´ı. Virtu´aln´ı model se bude z´amˇernˇe m´ırnˇe odliˇsovat od skuteˇcn´eho, aby studenti neztratili motivaci pracovat se skuteˇcn´ ym modelem. Ze stejn´eho d˚ uvodu nebudu v t´eto pr´aci uv´adˇet vˇsechny pouˇzit´e konstanty a stavov´e rovnice, ˇreˇsen´ı jen nast´ın´ım.
4.1
Teoretick´ y popis modelu
Nejprve jsem popsal fyzik´alnˇe laboratorn´ı model. Zaˇcal jsem se dvˇema motory, kter´e pˇren´aˇsej´ı napˇet´ı na ot´aˇcky (´ uhlovou rychlost). Gm (s) =
km Ωm (s) = , Um (s) Tm s + 1
Gt (s) =
Ωt (s) kt = . Ut (s) Tt s + 1
(4.1)
Pˇrenos˚ um odpov´ıdaj´ı diferenci´aln´ı rovnice Jm ω˙ m (t) + Bm ωm (t) = km um (t) ,
Jt ω˙ t (t) + Bt ωt (t) = kt ut (t) .
(4.2)
Druhou ˇc´ast´ı modelu jsou hlavn´ı a ocasn´ı vrtule, kter´e pˇren´aˇsej´ı ot´aˇcky na moment s´ıly. Charakteristika vrtul´ı je pˇribliˇznˇe parabolick´a 2 Mm (t) = km2 ωm (t) + kt1 ωm (t) ,
Mt (t) = kt2 ωt2 (t) + kt1 ωt (t) .
(4.3)
Tyto momenty jsem rozdˇelil na horizont´aln´ı p˚ usoben´ı 2 Mmh (t) = k2mh ωm (t) + k3mh ωm (t) ,
Mth (t) = k2th ωt2 (t) + k3th ωt (t)
(4.4)
Mtv (t) = k2tv ωt2 (t) + k3tv ωt (t) .
(4.5)
a vertik´aln´ı p˚ usoben´ı 2 Mmv (t) = k2mv ωm (t) + k3mv ωm (t) ,
Pro celkov´ y moment sil modelu helikopt´ery rozloˇzen´ y na vertik´aln´ı a horizont´aln´ı sloˇzku pak plat´ı Mv (t) = Mmv (t) + Mtv (t) ,
Mh (t) = Mmh (t) + Mth (t) .
(4.6)
Momenty vyj´adˇr´ım pomoc´ı vertik´aln´ı a horizont´aln´ı u ´hlov´e rychlosti tˇelesa helikopt´ery. Mh (t) = Jh ω˙ h (t) + Bh ωh (t) ,
Mv (t) = Jv ω˙ v (t) + Bv ωv (t) .
Nyn´ı lze napsat stavov´e rovnice cel´eho syst´emu, kter´e zde vˇsak z´amˇernˇe neuvedu.
(4.7)
´ ´I MODEL 4.2. VIRTUALN
4.1.1
37
Tabulka pouˇ zit´ ych veliˇ cin Tabulka 4.1: Tabulka pouˇzit´ ych veliˇcin
km kt
[N m V
−1
konstanta hlavn´ıho motoru
]
konstanta ocasn´ıho motoru
Tm
[s ]
ˇcasov´a konstanta hlavn´ıho motoru
Tt
[s ]
ˇcasov´a konstanta ocasn´ıho motoru
Um
[V ]
napˇet´ı na hlavn´ım motoru
Ut
[V ]
napˇet´ı na ocasn´ım motoru
2 −1
Bm
[kg m s ]
brzdˇen´ı hlavn´ıho motoru
Bt
[kg m 2 s−1 ]
brzdˇen´ı ocasn´ıho motoru
Bh
[kg m 2 s−1 ]
brzdˇen´ı helikopt´ery v azimutu
Bv
[kg m 2 s−1 ]
brzdˇen´ı helikopt´ery v elevaci
[s
−1
]
ot´aˇcky hlavn´ıho motoru
ωt
[s
−1
]
ot´aˇcky ocasn´ıho motoru
ωh
[s −1 ]
ot´aˇcky helikopt´ery v azimutu
ωv
[s −1 ]
ot´aˇcky helikopt´ery v elevaci
Jm
[kg m 2 ]
moment setrvaˇcnosti hlavn´ıho motoru
ωm
Jt
2
moment setrvaˇcnosti ocasn´ıho motoru
2
[kg m ]
Jh
[kg m ]
moment setrvaˇcnosti helikopt´ery v azimutu
Jv
[kg m 2 ]
moment setrvaˇcnosti helikopt´ery v elevaci
Mm
[N m ]
toˇciv´ y moment hlavn´ıho motoru
Mt
[N m ]
toˇciv´ y moment ocasn´ıho motoru
Mmh
[N m ]
horizont´aln´ı toˇciv´ y moment hlavn´ıho motoru
Mmv
[N m ]
vertik´aln´ı toˇciv´ y moment hlavn´ıho motoru
Mth
[N m ]
horizont´aln´ı toˇciv´ y moment ocasn´ıho motoru
Mtv
[N m ]
vertik´aln´ı toˇciv´ y moment ocasn´ıho motoru
[N m s −4 ]
konstanty pro toˇciv´ y moment v azimutu
k2tv , k2mv k3tv , k3mv
4.2
[N m V −1 ]
[N m s
−3
]
konstanty pro toˇciv´ y moment v azimutu
Virtu´ aln´ı model
Model jsem popsal fyzik´alnˇe, d´ale jsem podle tohoto popisu sestavil model v Simulinku, kter´ y je na n´asleduj´ıc´ım obr´azku.
38
´ ´I MODEL HELIKOPTERY ´ KAPITOLA 4. VIRTUALN
Obr´azek 4.2: Nov´ y model helikopt´ery
Postupnˇe jsem identifikoval jednotliv´e ˇc´asti modelu tak, aby virtu´aln´ı model odpov´ıdal re´aln´emu. Identifikaci jsem provedl na modelu helikopt´ery H3 v laboratoˇri K26. Studenti si vˇsak na virtu´aln´ım modelu vyzkouˇs´ı obecn´ y postup, kter´ y pak mohou pouˇz´ıt i na laboratorn´ı modely H1 a H2, kter´e se m´ırnˇe liˇs´ı. Identifikaci jsem zaˇcal popisem obou motor˚ u. Pouˇzil jsem pˇrenos z projektu, kter´ y ˇ, M., 2008). D´ale jsem zmˇeˇril vstupn´ı nelinearity provedli Michal Hoˇc s ing.Vaˇ nkem (Hoc motor˚ u, tedy rozmez´ı napˇet´ı, pro kter´e plat´ı diferenci´aln´ı rovnice popisuj´ıc´ı motory (4.2). T´ım se napˇr. odliˇsuje model H3 od model˚ u H1 a H2, kde napˇet´ı na hlavn´ım motoru helikopt´ery H3 m˚ uˇze b´ yt kladn´e i z´aporn´e, u model˚ u H1 a H2 pouze kladn´e. Momenty setrvaˇcnosti pro pohyb helikopt´ery v elevaci a azimutu jsem odhadl. Brzdˇen´ı jsem znal opˇet z pr´ace Michala Hoˇce. Konstanty pro toˇciv´ y moment v elevaci a azimutu jsem nastavil tak, aby pohyb ve virtu´aln´ım svˇetˇe pˇribliˇznˇe odpov´ıdal re´aln´emu modelu a z´aroveˇ n tak, aby tyto souˇcty toˇciv´ ych moment˚ u ocasn´ıho a hlavn´ıho motoru nebyly pˇri maxim´aln´ım napˇet´ı na vstupu vˇetˇs´ı neˇz 2N m . D´ale jsem pˇridal blok Moment of gravity, kter´ y pˇredstavuje gravitaˇcn´ı moment p˚ usob´ıc´ı na pohyb helikopt´ery v elevaci. Mezi souˇcty toˇciv´ ych moment˚ u od jednotliv´ ych
´ ´I SVET ˇ 4.3. VIRTUALN
39
motor˚ u a ˇc´ast pˇredstavuj´ıc´ı pˇrenos momentu na elevaci nebo azimut jsem um´ıstil bloky Dead Zone. Pokud by zde tyto bloky nebyly, bylo by nutn´e nal´ezt pracovn´ı bod helikopt´ery velmi pˇresnˇe. D´ıky Dead Zone staˇc´ı pˇresnost v ˇr´adu setin voltu. Jednotky SI se pak v subsyst´emu To VR World pˇrev´ad´ı na jednotky pro virtu´aln´ı realitu. Virtu´aln´ı model nab´ız´ı moˇznosti aretace pohybu v elevaci a azimutu tak, jak to umoˇzn ˇuj´ı i laboratorn´ı modely a nastaven´ı poˇc´ateˇcn´ıch podm´ınek elevace a azimutu
4.3
Virtu´ aln´ı svˇ et
P˚ uvodn´ı virtu´aln´ı model helikopt´ery se pohyboval pouze v azimutu. Upravil jsem jej tak, aby bylo moˇzn´e pozorovat ot´aˇcen´ı vrtul´ı a pohyb i v elevaci.
Obr´azek 4.3: Virtu´aln´ı realita pro model helikopt´ery
P˚ uvodn´ı vrtule jsem nahradil dvˇema hranoly. Jejich ot´aˇcky ˇr´ıd´ım vektory transform uzl˚ u MainMotor a TailMotor. Probl´emem bylo nastaven´ı pohybu virtu´aln´ıho modelu souˇcasnˇe v elevaci i azimutu. Pro rotaˇcn´ı pohyb se pouˇz´ıv´a vektor transform, kter´ y m´a
´ ´I MODEL HELIKOPTERY ´ KAPITOLA 4. VIRTUALN
40
tvar [ x y z r ], kde x, y, z pˇredstavuj´ı osy a r rotaci. Pˇri komunikaci mezi Simulinkem a .wrl souborem vˇsak x, y, z mohou ovlivnit pouze kladn´ y nebo z´aporn´ y smˇer rotace v dan´e ose a r je jedin´e re´aln´e ˇc´ıslo vektoru. Nemohl jsem proto souˇcasnˇe mˇenit elevaci a azimut. Tento probl´em jsem vyˇreˇsil tak, ˇze jsme pˇridal nov´ y uzel Helicopter el, jehoˇz children uˇzeme pomoc´ı Helicopter el.transform uzlem je p˚ uvodn´ı uzel Helicopter az. Takto m˚ ˇr´ıdit elevaci a Helicopter az.transform ˇr´ıdit azimut.
4.4
Experimenty
Na nˇekolika experimentech s virtu´aln´ım modelem jsem ovˇeˇril, zda se chov´a podobnˇe jako model v laboratoˇri. Uvedu simulace nalezen´ı pracovn´ıho bodu a skok˚ u napˇet´ı pˇri i bez zaaretov´an´ı pohybu v elevaci nebo azimutu.
4.4.1
Pracovn´ı bod
Pro nastaven´ı, kdy se helikopt´era mohla volnˇe pohybovat v elevaci i azimutu jsem nalezl pracovn´ı bod napˇet´ı na motorech. V pracon´ım bodˇe se vyrovnaj´ı horizont´aln´ı i vertik´aln´ı momenty sil (4.6) a helikopt´era se neot´aˇc´ı.
0
7
elevace azimut
6
−1
5
−2 výchylka [°]
U [V]
um ut
4
−3
3
−4
2
−5
1 0
5
10
15
−6 0
5
10 t [s]
t [s]
(a) napˇet´ı
(b) azimut a elevace
Obr´azek 4.4: Pracovn´ı bod
15
41
4.4. EXPERIMENTY
4.4.2
Odezvy na skok
D´ale jsem namˇeˇril odezvy virtu´aln´ıho modelu na skok vstupn´ıch veliˇcin za r˚ uzn´ ych podm´ınek, tedy za zaaretovan´eho pohybu v elevaci nebo azimutu a bez aretace. Volil jsem skoky jak z pracovn´ıho bodu, tak z nulov´ ych poˇc´ateˇcn´ıch podm´ınek. Nejprve jsem odsimuloval skok napˇet´ı na ocasn´ım motoru za zaaretovan´eho pohybu v elevaci. 7
120
um ut
azimut 100
6
80 výchylka [°]
U [V]
5
4
60 40
3 20
2
1 0
0
5
10
−20 0
15
5
t [s]
10
15
t [s]
(a) napˇet´ı
(b) azimut
Obr´azek 4.5: Skok napˇet´ı na ocasn´ım motoru, zaaretovan´ a elevace
7
0
um ut
6
azimut −20
5 −40 výchylka [°]
U [V]
4 3 2
−60
−80
1 −100
0 −1 0
5
10 t [s]
(a) napˇet´ı
15
−120 0
5
10 t [s]
(b) azimut
Obr´azek 4.6: Skok napˇet´ı na ocasn´ım motoru, zaaretovan´ a elevace
15
´ ´I MODEL HELIKOPTERY ´ KAPITOLA 4. VIRTUALN
42
Skok vych´ yl´ı helikopt´eru z ust´alen´eho stavu a dle znam´enka skoku se helikopt´era otoˇc´ı do jednoho nebo druh´eho dorazu azimutu. Pˇri vˇetˇs´ım skoku se helikopt´era ot´aˇc´ı rychleji. Virtu´aln´ı model se tedy chov´a stejnˇe jako laboratorn´ı model. D´ale jsem m´ısto elevace zaaretoval azimut a simuloval skok napˇet´ı na hlavn´ım motoru. Vych´azel jsem opˇet z pracovn´ıho bodu. 9
50
um ut
8
elevace 40
7 30 výchylka [°]
U [V]
6 5 4
20
10
3 0
2 1 0
5
10
−10 0
15
5
t [s]
10
15
t [s]
(a) napˇet´ı
(b) elevace
Obr´azek 4.7: Skok napˇet´ı na hlavn´ım motoru, zaaretovan´ y azimut
7
0
um ut
elevace −5
6
−10 −15 výchylka [°]
U [V]
5
4
3
−20 −25 −30 −35
2 −40
1 0
5
10 t [s]
(a) napˇet´ı
15
−45 0
5
10
15
t [s]
(b) elevace
Obr´azek 4.8: Skok napˇet´ı na hlavn´ım motoru, zaaretovan´ y azimut
Stejnˇe jako u azimutu, skok vych´ yl´ı helikopt´eru z rovnov´aˇzn´e polohy a ta dojde na
43
4.4. EXPERIMENTY
jeden nebo druh´ y doraz dle znam´enka skoku s rychlost´ı odpov´ıdaj´ıc´ı velikosti skoku. Model se tedy i pro tento experiment chov´a re´alnˇe. Vˇsechny experimenty, kter´e jsem provedl s aretc´ı jsem d´ale provedl bez aretace. Volil jsem skoky o stejn´ ych velikostech a znam´enk´ach, abych mohl porovnat pˇrechodov´e charakteristiky modelu. 7
120
um ut
100
6
80 výchylka [°]
5 U [V]
elevace azimut
4
60 40
3 20
2
0
1 0
5
10
−20 0
15
5
t [s]
10
15
t [s]
(a) napˇet´ı
(b) azimut a elevace
Obr´azek 4.9: Skok napˇet´ı na ocasn´ım motoru, bez aretac´ı
7
40
um ut
6
0 výchylka [°]
5
U [V]
elevace azimut
20
4 3
−20 −40 −60
2 −80
1 0 0
−100
5
10
15 t [s]
(a) napˇet´ı
20
25
30
−120 0
5
10
15 t [s]
20
25
30
(b) azimut a elevace
Obr´azek 4.10: Skok napˇet´ı na ocasn´ım motoru, bez aretac´ı
V prvn´ım pˇr´ıpadˇe, tedy skoku o +1V je zmˇena vertik´aln´ıho momentu pˇr´ıliˇs mal´a na to, aby vyvedla helikopt´eru z rovnov´aˇzn´e elevace, v druh´em pˇr´ıpadˇe se zaˇcne elevace
´ ´I MODEL HELIKOPTERY ´ KAPITOLA 4. VIRTUALN
44
pomalu mˇenit. Znamen´a to, ˇze ocasn´ı motor nem´a pˇr´ıliˇs velk´ y vliv na celkov´ y vertik´aln´ı toˇciv´ y moment. 7
120
um ut
elevace azimut
100
6
80 60 výchylka [°]
U [V]
5
4
3
40 20 0 −20
2 −40
1 0
5
10
−60 0
15
5
t [s]
10
15
t [s]
(a) napˇet´ı
(b) azimut a elevace
Obr´azek 4.11: Skok napˇet´ı na hlavn´ım motoru, bez aretac´ı
9
60
um ut
8
20
7
0 výchylka [°]
6 U [V]
elevace azimut
40
5 4
−20 −40 −60
3
−80
2 1 0
−100
5
10 t [s]
(a) napˇet´ı
15
−120 0
5
10
15
t [s]
(b) azimut a elevace
Obr´azek 4.12: Skok napˇet´ı na hlavn´ım motoru, bez aretac´ı
V obou pˇr´ıpadech skok˚ u bez zaaretovan´eho azimutu doˇsel azimut helikopt´ery na jeden z doraz˚ u. Znamen´a to, ˇze hlavn´ı motor m´a podstatn´ y vliv na celkov´ y horizont´aln´ı toˇciv´ y moment Na skoc´ıch bez aretace je patrn´e, ˇze vrtule maj´ı vˇzdy na pohyb v jedn´e ose opaˇcn´ y u ´ˇcinek, neˇz na pohyb v druh´e ose. Napˇr´ıklad pokud se vertik´aln´ı toˇciv´ y moment p˚ usoben´ y
ˇ ´IZEN´I MODELU 4.5. R
45
hlavn´ım motorem pˇriˇc´ıt´a do celkov´eho vertik´aln´ıho toˇciv´eho momentu, horizont´aln´ı toˇciv´ y moment p˚ usoben´ y hlavn´ım motorem se od celkov´eho horizont´aln´ıho toˇciv´eho momentu odˇc´ıt´a. Stejnˇe tak je tomu u laboratorn´ıho modelu helikopt´ery H3. Jako posledn´ı simulaci jsem vyzkouˇsel skok napˇet´ı na obou motorech souˇcasnˇe, bez aretace ˇz´adn´eho pohybu. Vych´azel jsem z nulov´ ych poˇc´ateˇcn´ıch podm´ınek. 9
50
um ut
8
elevace azimut
7 0 výchylka [°]
U [V]
6 5 4 3
−50
2 1 0 0
5
10
15
−100 0
5
t [s]
10
15
t [s]
(a) napˇet´ı
(b) azimut a elevace
Obr´azek 4.13: Skok napˇet´ı na obou motorech, bez aretac´ı
Na zaˇc´atku t´eto simulace spadne helikopt´era vlastn´ı vahou na doln´ı doraz elevace. V ˇcase 5s se skokem zmˇen´ı napˇet´ı na hlavn´ım motoru, coˇz helikopt´eru vyt´ahne na horn´ı doraz elevace. U azimutu zp˚ us´ob´ı skok napˇet´ı rovnˇeˇz zmˇenu smˇeru ot´aˇcen´ı helikopt´ery, p˚ usoben´ı hlavn´ıho motoru na azimut nen´ı vˇsak tak podstatn´e jako na elevaci, takˇze se azimut mˇen´ı pomaleji.
4.5
ˇ ızen´ı modelu R´
Abych ovˇeˇril funkˇcnost virtu´aln´ıho modelu, ˇr´ıdil jsem jsem pˇrenos napˇet´ı na ocasn´ım motoru na azimut za zaaretovan´eho pohybu v elevaci. Zpˇetnovazebn´ı regul´ator pro takov´e ˇr´ızen´ı jsem navrhl v ˇr´ızen´ı laboratorn´ıho modelu helikopt´ery H3 v pˇredmˇetu SRI. Pouˇziji PIDf regul´ator, kter´ y jsem navrhl frekvenˇcn´ı metodou podle identifikace modelu z pˇredmˇetu SAM. Pˇrenos regul´atoru je 0.514s2 + 0.546s + 0.05 C(s) = . 0.038s2 + s
´ ´I MODEL HELIKOPTERY ´ KAPITOLA 4. VIRTUALN
46
35
60 azimut reference
50
azimut reference
30 25 výchylka [°]
výchylka [°]
40 30 20 10
15 10 5
0 −10 0
20
0 5
10
15 t [s]
20
25
−5 0
30
5
(a) skok +50◦
10
15 t [s]
20
25
30
(b) skok +30◦
Obr´azek 4.14: Odezva virtu´aln´ıho modelu v uzavˇren´e regulaˇcn´ı smyˇcce
Simuloval jsem skok o 50 a 30 stupˇ n˚ u z pracovn´ıho bodu v ˇcase 10s. Regul´ator jsem navrhoval tak, aby nedoˇslo k pˇrekmitu vˇetˇs´ımu, neˇz 20%. Tato vlastnost z˚ ustala zachov´ana i pro virtu´aln´ı model. 10
5 azimut reference
0
−5 výchylka [°]
výchylka [°]
−10 −20 −30 −40
−10 −15 −20 −25
−50 −60 0
azimut reference
0
−30 5
10
15 t [s]
(a) skok -50◦
20
25
30
−35 0
5
10
15 t [s]
20
25
30
(b) skok -30◦
Obr´azek 4.15: Odezva virtu´aln´ıho modelu v uzavˇren´e regulaˇcn´ı smyˇcce
Vyzkouˇsel jsem rovnˇeˇz z´aporn´e hodnoty skok˚ u z pˇrechoz´ı simulace. Odezvy virtu´aln´ıho modelu pro skoky o stejn´e velikosti ale opaˇcn´em znam´enku jsou symetrick´e dle ˇcasov´e osy. V tomto se virtu´aln´ı model liˇs´ı od laboratorn´ıho modelu, jehoˇz brzdˇen´ı je pro pohyb do r˚ uzn´ ych smˇer˚ u m´ırnˇe odliˇsn´e. Odezvy virtu´aln´ıho modelu na skoky stejn´eho znam´enka
ˇ ´IZEN´I MODELU 4.5. R
47
ale r˚ uzn´e velikosti jsou podobn´e. U laboratorn´ıho modelu se pr˚ ubˇehy v´ıce liˇs´ı, protoˇze u virtu´aln´ıho modelu jsem zanedbal tvar vrtul´ı. Regul´ator, kter´ y jse navrhl v pˇredmˇetu SRI byl pouˇziteln´ y i pro virtu´aln´ı model, kter´ y jsem vytvoˇril.
48
´ ´I MODEL HELIKOPTERY ´ KAPITOLA 4. VIRTUALN
Kapitola 5 Z´ avˇ er V prvn´ı ˇc´asti m´e pr´ace jsem vytvoˇril studijn´ı materi´al, kter´ y byl zaˇrazen do sb´ırky pˇr´ıklad˚ u postihuj´ıc´ıch t´ematiku modelov´an´ı a ˇr´ızen´ı dynamick´ ych syst´em˚ u (Roubal, J. et al., 2009). Popsal jsem z´akladn´ı pravidla blokov´e algebry a sestavil jsem nˇekolik typ˚ u pˇr´ıklad˚ u, kter´e jsem vzorovˇe vyˇreˇsil a d´ale pˇridal nˇekolik typovˇe podobn´ ych neˇreˇsen´ ych u ´loh. Pˇri tvorbˇe pˇr´ıklad˚ u jsem se snaˇzil obs´ahnout d˚ uleˇzitou ˇc´ast problematiky blokov´e algebry a upozornit na nejˇcastˇejˇs´ı probl´emy a uk´azat jejich ˇreˇsen´ı. Dodrˇzel jsem myˇslenku sb´ırky vysvˇetlovat dan´e t´ema na konkr´etn´ıch aplikac´ıch potˇrebn´ ych znalost´ı. Vytvoˇril jsem virtu´aln´ı model laboratorn´ıho modelu Spojen´e pohony. Na nˇekolika experimentech jsem ovˇeˇril, ˇze se virtu´aln´ı model chov´a stejnˇe jako laboratorn´ı a lze jej tedy vyuˇz´ıt k v´ yuce modelov´an´ı dynamick´ ych syst´em˚ u. K modelu jsem sestavil virtu´aln´ı svˇet, kter´ y slouˇz´ı k n´azorn´e uk´azce funkˇcnosti modelu. Navrhl jsem ˇr´ızen´ı a provedl nˇekolik experiment˚ u, na kter´ ych jsem pˇredvedl chov´an´ı modelu se zpˇetnovazebn´ ym regul´atorem. V souˇcasn´e dobˇe je jiˇz model um´ıstnˇen na webov´ ych str´ank´ach Laboratoˇre teorie automatick´eho ˇr´ızen´ı K26 (Roubal, J., 2009), kde je pro studenty volnˇe dostupn´ y. Nakonec jsem upravil p˚ uvodn´ı virtu´aln´ı model helikopt´ery, aby odpov´ıdal poˇzadavk˚ um na virtu´aln´ı modely k podpoˇre v´ yuky dynamick´ ych syst´emu. Sestavil jsem pro model nov´ y fyzik´aln´ı popis a idintifikoval jej, aby pˇribliˇznˇe odpov´ıdal laboratorn´ımu modelu. Pˇridal jsem nov´e funkce do virtu´aln´ıho svˇeta p˚ uvodn´ıho modelu. Svoj´ı pr´aci jsem ovˇeˇril na nˇekolika experimentech. Na z´avˇer jsem zkusil virtu´aln´ı model ˇr´ıdit zpˇetnovazebn´ ym regul´atorem, kter´ y jsem navrhl v pˇredmˇetu SRI – Syst´emy a ˇr´ızen´ı. Regul´ator fungoval spr´avnˇe a poˇzadavky, dle kter´ ych jsem jej navrhoval pro ˇr´ızen´ı modelu identifikovan´eho v pˇredmˇetu SAM – Syst´emy a modely, splˇ noval i pro ˇr´ızen´ı virtu´aln´ıho modelu. Virtu´aln´ı model je tak´e dostupn´ y na webov´ ych str´ank´ach Laboratoˇre teorie automatick´eho ˇr´ızen´ı K26 (Roubal, J., 2009). 49
50
´ ER ˇ KAPITOLA 5. ZAV
Literatura Chen, C. T. (1998), Linear System Theory and Design, 3rd edn, Oxford University Press. ISBN 0-195-11777-8. Dorf, R. C. a Bishop, R. H. (2007), Modern Control Systems, 11th edn, Prentice-Hall. ISBN 0132270285. ˇ ´, Cernohorsk y V´ yukov´e
D., p´asmo
Kubec, VRML
M. [online].
a
ˇa ´ ra, Z [cit.
J.
(1997), 2009-06-09],
hhttp://www.cgg.cvut.cz/members/zara/vyuka/vrml/tutorial/pasmo/vrml97.htmli. Franklin, G. F., Powell, J. D. a Emami-Naeini, A. (2005), Feedback Control of Dynamic Systems, 5th edn, Prentice-Hall. ISBN 0-13-149930-0. ˇ, M. (2008), Helicopter in Virtual Space, PhD thesis, Lulea University of Technology. Hoc Perrett, G. (2000-2009), Understanding VRML rotations [online]. [cit. 2009-06-09], hhttp://www.seamless3d.com/tut/vrml rotations/index.html/i. Roubal, J. (2009), Laboratoˇr teorie automatick´eho ˇr´ızen´ı [online]. [cit. 2009-06-09], hhttp://support.dce.felk.cvut.cz/lab26/i. Roubal, J., Huˇ sek, P. a spol. (2009), Z´aklady regulaˇcn´ı techniky v pˇr´ıkladech. hhttp://support.dce.felk.cvut.cz/pub/roubalj/i. ´ , M. (2005), Jazyk VRML 2.0, (Bakal´aˇrsk´a pr´ace), Jihoˇcesk´a Univerzita v Serbusova ˇ ych Budˇejovic´ıch. Cesk´ ˇ Stecha, J. a Havlena, V. (1999), Teorie dynamick´ych syst´em˚ u, Praha: Vydavatelstv´ı ˇ CVUT. ISBN 80-01-01971-3.
51
52
LITERATURA
Kapitola 6 Obsah pˇ riloˇ zen´ eho CD K t´eto pr´aci je pˇriloˇzeno CD, na kter´em jsou uloˇzeny zdrojov´e k´ody.
• Adres´aˇr BP2009: Vlastn´ı text bakal´aˇrsk´e pr´ace ve form´atu pdf ych pohon˚ u • Adres´aˇr Coupled drives DCE: Virtu´aln´ı model spojen´ • Adres´aˇr Helicopter: Virtu´aln´ı model helikopt´ery
53