SADRŽAJ: 6. UPRAVLJANJE KRETANJEM 6.1 Problem upravljanja 6.2 Upravljanje u prostoru zglobova 6.3 Tehnika neovisnog upravljanja zglobovima 6.3.1 Upravljanje sa povratnom spregom 6.3.2 Decentralizovana kompenzacija direktne veze 6.4 Upravljanje u zatvorenoj povratnoj petlji sa momentom kao vektorom upravljanja 6.5 Centralizovano upravljanje 6.5.1 PD upravljanje sa gravitacijskom kompenzacijom 6.5.2 Inverzno dinami ko upravljanje 6.5.3 Robusno upravljanje 6.5.4. Adaptivno upravljanje 6.6 Upravljanje u radnom prostoru 6.6.1 Generalne šeme 6.6.2 PD kontrola sa kompenzacijom gravitacije 6.6.3 Inverzna dinami ka kontrola 6.7 Pore enje izme u razli itih upravlja kih šema Dodatak 3 3 5 8 9 20 24 27 29 32 35 42 47 48 49 51 53 63 6. UPRAVLJANJE KRETANJEM U prethodnom poglavlju su prezentirane tehnike planiranja trajektorije koje dozvoljavaju generisanje referentnih ulaza u upravalj ki sistem kretanja. U opštem slu aju, problem upravljanja manipulatora se svodi na odre ivanje vremenske promjene generaliziranih sila (sila ili obrtnih momenata) koje moraju posti i aktuatori zglobova, kako bi se izvršio komandni zadatak uz zadovoljavanje zadatih zahtijeva tranzijentnog i stacionarnog stanja. Zadatak se može odnositi na izvršavanje specifi nog kretanja za manipulator u slobodnom operacijskom prostoru ili izvo enje specifi nog kretanja za manipulator pred koga se postavljaju zahtjevi o iznosu kontaktne sile dodira kojom prihvatnica djeluje na okolinu. Zbog kompleksnosti problema, bit e posebno razmatrana dva aspekta; prvo, upravljanje kretanjem u slobodnom prostoru, te zatim upravljanje interakcijom u prostoru uz postavljena ograni enja. Tema ovog poglavlja je problem upravljanja kretanjem manipulatora. Predstavljene su brojne tehnike upravljanja u prostoru zglobova. Ove tehnike se mogu podijeliti u dvije kategorije: decentralizovane šeme upravljanja, na primjer, kada se upravlja jednim zglobom manipulatora nezavisno od ostalih, te centralizovane šeme upravljanja, na primjer, kada se uzimaju u obzir efekti dinami ke interakcije izme u zglobova. Najzad, ilustrovane su osnovne karakteristike šema upravljanja u radnom prostoru kao premisa na problem upravljanja interakcijom. 6.1 Problem upravljanja Prilikom upravljanja manipulatorom može se koristiti nekoliko tehnika. Tehnika koja slijedi, kao i na in na koji je implementirana, može imati zna ajan uticaj na performanse manipulatora, te zbog toga i na mogu i opseg aplikacija. Na primjer, potreba za kontrolom pra enja trajektorije u operacijskom prostoru može voditi do hardverskih/softverskih implemantacija koje se razlikuju od onih koje omogu avaju upravljanje od ta ke do ta ke gdje je jedino od interesa dostizanje kona ne pozicije. S druge strane, mehani ki dizajn manipulatora ima uticaj na vrstu iskorištene upravlja ke šeme. Na primjer, problem upravljanja Kartezijevog manipulatora je suštinski razli it u odnosu na antropomorfisti ki manipulator. Pokretni sistem zglobova ima, tako e, uticaj na tip korištene strategije upravljanja. Primjena elektri nih motora sa visokim redukcionim faktorima za pokretanje zglobova robota, te prisustvo zup anika, omogu uju linearizaciju dinami kog sistema, odnosno dekuplovanje zglobova u pogledu redukcije nelinearnih efekata. Me utim, s druge strane, prisustvo trenja u zglobovima, elasti nosti i zazora mogu umanjiti performanse sistema i dovesti do Coriolis-ovih sila, konfiguracijski ovisnih inercijalnih efekata, i sl. S druge strane, direktno osnaživanje robota bez prenosnika eliminira elasti nost, zazor i trenje, ali i nelinearnost, te sprezanje me u zglobovima postaju relevantno. Posljedica toga je 2 nužnost razmatranja razli itih strategija upravljanja u cilju postizanja visokih performansi robotskih sistema. Slika 6.1 Opšta šema upravljanja u prostoru zglobova Bez ikakvog razmatranja specifi nih tipova mehani kih manipulatora, vrijedno je pomenuti da se specifikacija zadatka (kretanja prihvatnice i sila) obi no vrši u operacionom prostoru, pošto se upravlja ke akcije (zglobni aktuator generaliziranih sila) izvode u prostoru zgloba. Ova injenica vodi do razmatranja dva tipa opštih upravlja kih strategija: upravljanje u prostoru zgloba (Slika 6.1) i upravljanje u radnom prostoru (Slika 6.2). U objema strategijama, upravlja ka struktura ima zatvorenu petlju da bi iskoristila dobre karakteristike povratne sprege, na primjer, robusnost prema modeliranju neta nosti i reduciranje efekata smetnji. U opštem slu aju, provest e se sljede a razmatranja. Problem upravljanja prostora zglobova se izražava preko dva podproblema. Prvi, inverzna kinematika manipulatora se rješava transformisanjem zahtijeva kretanja iz radnog prostora u prostor zgloba. Potom se dizajnira šema za upravljanje u prostoru zglobova koja omogu ava pra enje referentnih ulaza. Me utim, ovo rješenje ima nedostatak, jer šema upravljanja u prostoru zglobova ne uti e na varijable u prostoru zadatka koje se upravljaju u otvorenoj petlji mehani ke strukture manipulatora. Tada je jasno da sve neta nosti strukture (tolerancija konstrukcije, nedostatak kalibrisanja, zazor kod zup anika, trenje) ili bilo kakva nepreciznost pozicije prihvatnice koja se odnosi na objekat koji se manipuliše izaziva gubitak ta nosti varijabli u radnom prostoru. Problem upravljanja u radnom prostoru slijedi globalni pristup koji zahtijeva izvo enje aritmeti ki kompleksnijih operacija; treba uo iti da je inverzna kinematika ugra ena u povratnu spregu. Konceptualna prednost ovog pristupa odnosi se na mogu nost pra enja varijabli operacijskog prostora; ovo je samo potencijalna prednost, jer se mjerenje varijabli operacionog prostora esto ne izvodi direktno, ve kroz procjenu funkcija direktne kinematike po evši od mjerenja varijabli prostora zglobova. 3 Slika 6.2 Opšta šema upravljanja u radnom prostoru Na osnovu gornjih premisa, prvo su prezentovane šeme upravljanje u prostoru zglobova za kretanje manipulatora u slobodnom prostoru. U nastavku e biti ilustrovane šeme za upravljanje u radnom prostoru koje su logi ka osnova upravljanja interakcijom ograni enog kretanja manipulatora. 6.2 Upravljanje u prostoru zglobova U Poglavlju 4 prikazano je da se jedna ine kretanja manipulatora u odsustvu vanjskih sila prihvatnice i stati kog trenja (teško je precizno modelovati) mogu opisati sa: .. . . . B(q ) q + C (q, q ) q + Fv q + g (q) = τ , (6.1) sa jasnim zna enjem simbola. Upravljanje kretanjem manipulatora u slobodnom prostoru svodi se na odre ivanje n komponenti generaliziranih sila – momenata za rotacione zglobove, sila za translacijske zglobove – koje omogu avaju izvršavanje kretanja q(t) tako da vrijedi da je q(t ) = q d (t ) , gdje q d (t ) ozna ava vektor varijabli željene trajektorije zgloba. Aktuatori obezbje uju generalizirane sile preko odgovaraju ih prenosnika u cilju transformisanja karakteristika kretanja. Neka qm ozna ava vektor pomjeranja zglobnog aktuatora; uz pretpostavku da u prenosnicima nema mrtve zone i uz zanemarivanje elasti nosti, vrijedi jedna ina: K r q = qm , (6.2) gdje je Kr (n×n) dimneziona matrica redukcionih koeficjenata prenosnika kretanja. 4 Naj eš e je to dijagonalna matrica, uz pretpostavku da nema induciranih kretanja, iji su elementi mnogo ve i od jedan. Imaju i u vidu (6.2), vektor momenata kojeg na izlaznim osovinama razvijaju motori može biti prikazan jedna inom: τ m = K r−1τ . (6.3) Slika 6.3 Blok šema upravljanja manipulatora sa motorima Uo avaju i da se dijagonalni elementi matrice inercije B(q) sastoje iz konstantnih i konfiguracijski zavisnih izraza (sinusne i kosinusne funkcije za rotacijske zglobove), to se matrica inercije može prikazati sumom dviju matrica: B ( q ) = B + ∆B ( q ) , (6.4) gdje je B dijagonalana matrica iji konstantni elementi predstavljaju rezultuju e srednje vrijednosti inercije svakog zgloba. Uvode i izraze (6.2) – (6.4) u (6.1) dobija se: τ m = K r−1 B K r−1 q m + Fm q m + d , (6.5) gdje: 5 F m = K r−1 Fv K r−1 , (6.6) predstavlja matricu koeficijenata viskoznog trenja oko osa motora, i d = K r−1 ∆B(q ) K r−1 q m + K r−1C (q, q) K r−1 q m + K r−1 g (q ) , (6.7) što predstavlja doprinos momentu koji je ovisan o konfiguraciji. Kao što ilustruje blok šema na Slici 6.3, manipulator sa motorima se satoji od dva podsistema. Kod jednog podsistema τ m je ulazni vektor, a qm je izlazni vektor. Drugi sistem ima qm, q m i q m kao vektore ulaza, a d je vektor izlaza. Prvi podsistem je linearan, jer svaka komponenta vektora τ m uti e samo na odgovaraju u komponentu qm. Drugi podsistem je nelineran, jer obuhvata sve nelinearne i spregnute izraze dinamike zgloba manipulatora. Gornja blok šema može poslužiti kao osnova za izvo enje nekoliko upravlja kih strategija koja upu uju na detaljno poznavanje dinami kog modela. Najjednostavniji pristup koji se može slijediti, u slu aju visokih redukcionih faktora i/ili ograni enja postavljenih radi postizanja željenih brzina i ubrzanja, je da se razmatra komponenta nelineranog interaktivnog izraza d kao poreme aj koji djeluje na servosistem pojedinog zgloba. Dizajn upravlja ke strategije vodi do decentralizirane upravlja ke strukture, jer se svaki zglob može promatrati odvojeno od drugog. Upravlja ka jedinica zgloba mora garantovati dobre performanse u smislu otklanjanja djelovanja velikih poreme aja i pove enja mogu nosti pra enja trajektorije. Rezultuju a upravlja ka struktura je suštinski bazirana na grešci izme u željenog i stvarnog izlaza, dok ulazni upravlja ki moment na itom aktuatoru zavisi samo od greške na i-tom izlazu. S druge strane, kada manipulator sa motorima djeluje velikim brzinama (Kr = I), nelinearni spregnuti izrazi znatno uti u na preformanse sistema. Stoga, promatranje efekata komponenti izraza d kao poreme aja može dovesti do odstupanja pri pra enju trajektorije. U ovom slu aju, preporu uje se primjena upravlja kog algoritma koji se temelji na detaljnom poznavanju dinamike manipulatora radi kompenzacije nelineranih spregnutih izraza modela. Drugim rije ima, neophodno je eliminisati uzroke, prije nego reducirati efekte koji su njihova posljedica; to zna i generisati kompenzacioni moment za nelinearne izraze u (6.7). To name e nužnost primjene centralizirane upravlja ke šeme koja se bazira na (djelimi nom ili cjelokupnom) znanju dinami kog modela manipulatora. Ipak, treba ukazati na injenicu da sve ove tehnike još uvijek zahtijevaju pra enje greške izme u postignute i željene trajektorije, bez obzira da li su implementirane u povratnoj sprezi ili direktnoj vezi. Ovo je posljedica injenice da razmatrani dinami ki model, ma koliko bio kompleksan, je u svakom slu aju idealiziranje realnosti koja ne uklju uje efekte kao što su: Coulomb-ovo trenje, labavost prenosnika, tolerancija 6 dimenzija, i nedovoljno ta ne pretpostavke, na primjer, potpuno kruti lanci manipulatora i dr. Kao što je prethodno pomenuto, uloga sistema sa motorima je relevantna za izabrani tip upravljanja. U slu aju decentralizovanog upravljanja, aktuator se opisuje preko izraza valastitog modela kao brzinom upravljan generator. U slu aju cetralizovanog upravljanja, aktuator mora generisati dodatni moment na bazi cjelokupnog ili reduciranog dinami kog modela manipulatora; tada se razmatra kao momentom upravljani generator koji je predstavnik aktuatora/sistema za poja anje snage koji zadovoljava gornje zahtjeve. 6.3 Tehnika neovisnog upravljanja zglobovima Najjednostavnija upravlja ka strategija koja se može razmatrati je ona koja se odnosi na manipulator koji se sastoji od n nezavisnih sistema (n zglobova) i upravljanje svakom od osa zglobova kao sistemom tipa jedan ulaz/jedan izlaz. Uticaj efekata pojedinih zglobova na druge zglobove usljed mijenjanja konfiguracije tokom kretanja prikazuje se kroz poreme aje ulaza. Slika 6.4 Blok šema upravaljanja osnaženog zgloba Sistem koji se upravlja je motor i-tog zgloba koji odgovara sistemu tipa jedan ulaz/jedan izlaz prikazan kao dio linearne šeme na Slici 6.3. Interakcija sa drugim zglobovima je opisana komponentom i vektora d izrazu (6.7). Bez gubitka opštosti, aktuator je uzet kao rotacioni DC motor. Stoga se blok šema zgloba i može predstaviti u domenu kompleksne varijable s kao na Slici 6.41. Na ovoj šemi θ je ugaona varijabla motora, I je prosje na vrijednost inercije na osovini motora I i = bii / k ri2 , Ra je armaturni otpor (samoinduktivnost se zanemaruje), kt i kv su momentna i naponska konstanta. Dalje, Gv ozna ava naponsko poja anje poja ala snage, tako da referentni ulaz nije armaturni napon Va, nego ulazni napon Vc poja ala; uo iti da pretpostavljeni propusni opseg mnogo ve i od propusnog opsega upravljanog sistema. Na šemi sa Slike 6.4, tako e je pretpostavljeno da je: ( ) 1 Indeks i je izostavljen radi notacijeske kompaktnosti. Tako e, Laplace-ova transformacija vremenski ovisnih funkcija je predstavljena velikim slovima bez specificiranja ovisnosti od s. 7 Fm << kv kt , Ra na primjer, koeficijent mehani kog viskoznog trenja se zanemaruje uz uvažavanje koeficijenta elektri nog trenja.2 Ulazno/izlazna prenosna funkcija motora se može pisati kao: M (s) = km , s (1 + sTm ) (6.8) gdje su: km = 1 , kv Tm = Ra I , kv kt naponsko poja anje i vremenska konstanta motora, respektivno. 6.3.1 Upravljanje sa povratnom spregom Pri odabiru upravlja ke strukture treba uo iti da se efektivno otklanjanje smetnje d na izlaz θ osigurava sa: • • velikim faktorom poja anja prije ta ke djelovanja poreme aja, primjenom integralnog djelovanja u upravlja koj jedinici da bi se poništili efekti djelovanja gravitacijske komponente na izlazu u stacionarnom stanju (konstanta θ ). Slika 6.5 Blok šema nezavisnog upravljanja zglobom 2 Cjelokupan postupak vezan za aktuatore je opisan u Poglavlju 8. 8 Ove potrebe name u nužnost upotrebe proporcionalno-integralnog upravlja kog djelovanja u direktnoj stazi ija je prenosna funkcija data sa: C ( s) = K c 1 + sTc ; s (PI) (6.9) Pri djelovanju konstantnih poreme aja na sistem greška stacionarnog stanja postaje nula, a postojanje realne nule s = −1 / Tc ukazuje na stabilizaciju procesa. Da bi se poboljšale dinami ke performanse, kontroler se predstavlja kao kaskada elementarnih djelovanja u lokalnim povratnim petljama zatvorenim u okolini porema aja. Pored zatvaranja povratne petlje po poziciji, najopštije rješenje se postiže zatvaranjem unutrašnjih petlji i po brzini i po To dovodi do šeme koja je prikazana na Slici 6.5, gdje CP(s), CV(s) i CA(s), respektivno, predstavljaju prenosne funkcije PI regulatora za poziciju, brzinu i ubrzanje, prema izrazu (6.9), da bi se postigla nulta greška u stacionarnom stanju pri konstantnoj smetnji. Dalje, kTP, kTV i kTA su, respektivno, konstante transduktora. Na šemi sa Slike 6.5 treba uo iti da je momentni poreme aj D pomo u faktora Ra / k t preveden u naponski oblik. U nastavku je prikazan veliki broj mogu ih rješenja koja se izvode iz opšte šeme sa Slike 6.5; na ovom stepenu nisu razmatrani slu ajevi koji nastaju usljed nemogu nosti mjerenja pojedinih fizi kih varijabli. Razmatrana su tri slu aja koja se razlikuju u broju aktivnih povratnih petlji. Slika 6.6 Blok šema upravljanja zglobom sa zatvorenom povratnom petljom po poziciji 9 Zatvorena povratna petlja po poziciji. U ovom slu aju, upravlja ko djelovanje je okarakterisano sa: C P ( s) = K P 1 + sT p s , CV ( s ) = 1 , C A ( s) = 1 , kTV = kTA = 0 . Šema sa Slike 6.6 pokazuje da je prenosna funkcija direktne staze data sa: P( s) = k m K P (1 + sTP ) , s 2 (1 + sTm ) dok je prenosna funkcija povratne grane data sa: H ( s ) = kTP . Na temelju poja anja pozicijske petlje koje je dato sa: k m K P k TPTP Tm mogu e je izvršiti analizu regulacijskog kruga primjenom metode geometrijskog mjesta korijena. Ilustrovane su tri situacije za polove sistema sa zatvorenom petljom koje se odnose na vezu izme u TP i Tm .Stabilnost sistema u zatvorenoj povratnoj petlji name e neka ograni enja vezana za izbor parametara PI regulatora. Ako je TP < Tm , sistem je nestabilan (Slika 6.7a). Zbog toga mora biti Tm < TP (Slika 6.7b). Kako se TP pove ava, pove ava se i apsolutna vrijednost realnog dijela dva korijena, te sistem ima brže vrijeme odziva. Dakle, dobro je ostvariti da je Tm << TP (Slika 6.7c). U svakom slu aju, realni dio dominantnih polova ne može biti manji od − 1 / 2Tm . 10 Slika 6.7 Geometrijsko mjesto korijena za pozicionu povratnu upravlja ku šemu Prenosna funkcija zatvorene petlje data kao odnos ulaz/izlaz: 1 k TP Θ( s ) = , 2 Θ r (s) s (1 + sTm ) 1+ k m K P kTP (1 + sTP ) (6.10) može se predstaviti u obliku: 1 (1 + sTP ) k TP , W ( s) = 2ζs s 2 (1 + + 2 )(1 + sτ ) ωn ωn gdje su ω n i ζ prirodna frekvencija i faktor prigušenja para kompleksnih polova, respektivno i − 1 / τ locira realne polove. Ove vrijednosti se dodjeljuju da bi se definisala dinamika osnaženog zgloba kao funkcija od TP; ako je Tm < TP , tada je 1 / ζω n TP τ 11 Tm << TP (Slika 6.7c), za velike vrijednosti poja anja, tada je i nula u − 1 / TP u prenosnoj funkciji W(s) teže ka poništenju efekta (Slika 6.7b); ako je ζω n 1 / τ ≈ 1 / TP realnog pola. Prenosna funkcija zatvorene petlje data kao odnos smetnja/izlaz: θ ( s) D(s) =− sRa k t K P k TP (1 + sT p ) s 2 (1 + sTm ) 1+ k m K P kTP (1 + sT p ) , (6.11) pokazuje da vrijedi pove ati KP da bi se reducirao efekat poreme aja na izlaz tokom trazijentnog stanja. Funkcija u izrazu (6.11) ima dva kompleksna pola (− ζω ,± j ) 1 − ζ 2ω n , realni pol ( − 1 / τ ) i nulu u ishodištu koordinatnog sistema. Nula je posljedica PI regulatora i dozvoljava poništavanje efekata gravitacije u ugaonoj poziciji kada je θ konstantno. U jedna ini (6.11), može se uo iti da izraz K P k TP faktor redukcije amplitude poreme aja. n Slika 6.8 Blok šema pozicije i brzine regulatora sa povratnom spregom 12 Veli ina XR=KPkTP (6.12) može biti interpretirana kao faktor potiskivanja smetnje,koji je odre en poja anjem KP. Kako god, nije preporu ljivo mnogo pove avati KP zato što mali nivoi prigušenja mogu rezultirati neprihvatljive oscilacije na izlazu. Vrijeme oporavka izlaza TR koje je potrebno sistemu da eliminiše efekte smetnje može se prora unati analizom kretanja TP to je TR izraženo kao: (6.11). Kako je TR=max{ TP ,1/ n} (6.13) Upravljanje sa zatvorenom petljom po poziciji i brzini. U ovom slu aju, upravlja ko dijelovanje je okarakterizovana kao: CP(s)=KP CV(s)=KV(1+sTV)/s CA(s)=1 kTA=0 Za izvo enje geometrijskog mjesta korijena kao funkcije poja anja brzine povratne sprege potrebno je reducirati brzinsku petlju paralelno pozicionoj petlji slijede i uobi ajena pravila pomjeranja blokova. Sa Slike 6.8 prenosna funkcija prethodnog dijela je: P( s) = k m K P K V (1 + sTV ) s 2 (1 + sTm ) dok je H ( s ) = kTP (1 + s k TV ) K P kTP Slika 6.9 Geometrijsko mjesto korjena pozicije i brzine regulatora sa povratnom petljom 13 Nula regulatora na s = s= −1 može se izabrati tako da poništi efekt realnog pola motora na TV −1 . Zatim postavljanjem: Tm TV = Tm , polovi sistema sa zatvorenom petljom se pomijeraju na geometrijskom mjestu korijena kao funkcija porasta petlje kmKvkTV, kao što je prikazano na Slici 6.9. Pove avanjem koeficijenta priraštaja Kp, mogu e je ograni iti polove zatvorene petlje na podru je kompleksne ravni sa velikim apsolutnim vrijednostma realnog dijela. Zatim, stvarna lokacija može biti uspostavljena pogodnim izborom Kv. Ulazno/izlazna prenosna funkcija zatvorene petlje je: θ ( s) = θ r ( s) 1 k TP sk TV s2 1+ + K P k TP k m K P k TP K V (6.14) koja se može uporediti sa obi nom prenosnom funkcijom sistema drugog reda. 1 kTP W ( s) = 2ζ s s 2 1+ + 2 ωn (6.15) ωn Može se primijetiti da je pogodnim izborom poja anja mogu e posti i bilo koju vrijednost prirodne frekvencije n i koeficijenta prigušenja . Ukoliko su n i poznate vrijednosti, mogu e je odrediti slijede e relacije: K V k TV = 2ζω n km K P kTP K V = ωn 2 km (6.16) (6.17) 14 Slika 6.10 Blok šema regulatora pozicije, brzine i ubrzanja sa povratnom petljom Kada se za date konstante pretvara a kTP i kTV, jednom odabere Kv, tako da zadovolji jedna inu (6.16), vrijednost koeficijenta Kp se odre uje iz jedna ine (6.17). Prenosna funkcija smetnja/izlaz sa povratnom spregom je: sRa k t K P k TP K V (1 + sTm ) θ ( s) =− skTV D( s) s2 1+ + K P kTP k m K P kTP K V (6.18) i pokazuje da je faktor potiskivanja smetnje: X R = K P k TP K V (6.19) koji je fiksan kada se koeficijenti Kp i Kv odrede jedna inama (6.16) i (6.17). Procjena vremena oporavka izlaza (regeneracije izlaza) data je vremenskom konstantom: TR = max Tm , 1 ξω n (6.20) što predstavlja napredak u odnosu na prethodni slu aj u (6.13), kada je Tm<<Tp i kada 1 nejednakost ξω n < ne uti e na realni dio dominantnih polova . 2Tm 15 Upravljanje sa zatvorenom povratnom petljom po poziciji, brzini i ubrzanju. U ovom slu aju akcija regulatora je okarakterizirana sa: CV ( s ) = K V C P (s) = K P C A (s) = K A 1 + sTA s Slika 6.11 Geometrijsko mjesto korjena regulatora pozicije, brzine i ubrzanja sa povratnom petljom. Poslije odre enih manipulacija, blok šema sa Slike 6.5 može se reducirati na blok šemu sa Slike 6.10, gdje G'(s) predstavlja slijede u prenosnu funkciju: km G ′( s ) = (1 + k m K A kTA ) 1 + sTm 1 + k m K A kTA TA Tm (1 + k m K A kTA ) Prenosna funkcija direktne staze je: P( s) = K P K V K A (1 + sT A ) G ′( s ) , s2 dok je prenosna funkcija povratne petlje H ( s ) = kTP 1 + skTV . K P kTP 16 Tako er, u ovom slu aju pogodno poništavanje polova je dovoljno, a može se posti i postavljanjem: T A = Tm ili podešavanjem: k m K A kTAT A >> Tm k m K A k TA >> 1 Oba rješenja su ekvivalentna i odnose se na dinami ke perfomanse sistema upravljanja. U oba slu aja, polovi sistema sa zatvorenom petljom su prisiljeni da se pomijeraju na root-locus-u kao funkcija porasta funkcije k m K P K V K A / (1 + k m K A kTA ) (Slika 6.11). Može se raspoznati sli na analogija sa prethodnom šemom, a rezultuju i sistem sa zatvorenom petljom je ponovno sistem drugog reda. Ulazno/izlazna prenosna funkcija sa zatvorenom petljom je: θ ( s) = θ r ( s) skTV 1+ K P k TP 1 kTP s 2 (1 + k m K A kTA ) + k m K P kTP K V K A (6.21) dok je prenosna funkcija smetnja/izlaz sa zatvorenom petljom: sRa k t K P k TP K V K A (1 + sT A ) θ (s ) =− D (s ) skTV s 2 (1 + k m K A k TA ) 1+ + K P k TP k m K P kTP K V K A (6.22) Rezultuju i faktor potiskivanja smetnje dat je kao: X R = K P kTP K V K A (6.23) dok je vrijeme oporavka izlaza dato vremenskom konstantom: (6.24) 17 TR = max T A , 1 (6.24) ξω n gdje TA može biti manje od Tm kako je prethodno nazna eno. S obzirom na prenosnu funkciju u (6.15), kada su , n i XR poznate vrijednosti, mogu e je za svrhe dizajniranja uspostaviti slijede e relacije: 2 K P kTP ωn = kTV ξ k m K A kTA = (6.25) km X R ωn 2 −1 K P kTP K V K A = X R (6.26) (6.27) Za date kTP, kTV i kTA, Kp se bira tako da zadovolji relaciju (6.25), KA se bira da zadovolji relaciju (6.26), a zatim se iz relacije (6.27) odre uje KV. Mora se zapaziti kako prihvatljiva rješenja za kontroler obi no zahtijevaju velike vrijednosti faktora potiskivanja XR. U principu, povratna petlja ubrzanja ne omogu ava samo postizanje bilo kakvog dinami kog ponašanja, nego s obzirom na prethodni slu aj, tako er omogu ava 2 odre ivanje faktora potiskivanja smetnje sve dok je k m X R / ω n > 1 . U izvo enju gornjih šema upravljanja, na in mjerenja varijabli povratne petlje, nije eksplicitno odre en. S obzirom na tipi ne servo-regulatore pozicije, koji su prakti no implementirani u industriji, nema problema pri mjerenju pozicije i brzine, dok je direktno mjerenje ubrzanja, u opštem slu aju, ili nemogu e ili preskupo za obaviti. Stoga, za šemu na Slici (6.10) indirektno mjerenje se može ostvariti rekonstruisanjem ubrzanja iz direktnog mjerenja brzine kroz filter prvog reda (Slika 6.12). Filter je okarakterisan propusnim opsegom ω 3 f = k f . Izborom dovoljno velikog propusnog opsega, efekti zbog kašnjenja u mjerenju nisu znatni i izvodljivo je odvesti izlaz filtera ubrzanja kao vrijednost povratne petlje. Odre eni problemi se mogu javiti s obzirom na šum koji se superponira sa filtriranim signalom ubrzanja. 18 Slika 6.12 Blok šema filtera prvog reda Posezanje za tehnikom filtriranja može biti korisno samo u slu aju kada je mogu e direktno mjerenje. U ovom slu aju, korištenjem filtera drugog reda, mogu e je rekonstruisati brzinu i ubrzanje. Tako er, velika kašnjenja prouzrokovana korištenjem filtera drugog reda, obi no umanjuju perfomanse u odnosu na filter prvog reda, što je rezultat ograni enja propusnog opsega filtera koji je rezultat numeri ke implementacije kontrolera i filtera. Mora se zapaziti da je gornja izvedba bazirana na idealnom dinami kom modelu, kada su efekti prenosne elasti nosti i vremenske konstante motora zanemareni. Ovo povla i da zadovoljenje dizajnerskih zahtjeva traži velike vrijednosti poja anja povratne sprege koje se u praksi ne mogu ostvariti, dok postojanje nemodeliranih dinami nosti ( kao što su elektri na, elasti na zbog nesavršeno krutog prenosa) mogu dovesti do degradacije sistema i eventualno ga dovesti u nestabilnost. 6.3.2 Decentralizovana kompenzacija direktne veze Gornje šeme su izvedene u svrhu postizanja dobrog potiskivanja smetnje. Kada su potrebni zajedni ki upravlja ki servoi u svrhu održanja referentne trajektorije sa velikim vrijednostima brzine i ubrzanja, upravlja ke sposobnosti šeme na Slici 6.5 su neprihvatljivo umanjene. Usvajanje decentralizovane kompenzacije direktne veze omogu ava smanjenje grešaka pra enja trajektorije. Ukoliko su referentni ulazi u tri kontrolne strukture, koji su analizirani u prethodnoj sekciji, respektivno promijenjeni u: θ r ′ (s ) = kTP + s 2 (1 + sTm ) θ d (s) k m K P (1 + sTP ) (6.28) 19 Slika 6.13 Blok šema regulatora pozicije sa decentralizovanom kompenzacijom direktne veze Slika 6.14 Blok šema regulatora pozicije i brzine sa decentralizovanom kompenzacijom direktne veze θ r ′ ( s ) = kTP + sk TV s2 + θ d (s) K P k m K P KV θ r ′ ( s ) = kTP + sk TV (1 + k m K A kTA )s 2 + θ d (s) KP k m K P KV K A (6.29) (6.30) postiže se željena trajektorija zajedni ke pozicije. Zapazimo da izvod prora unatog vremena željene trajektorije ne predstavlja problem, jer je d(t) analiti ki poznato. Šeme upravljanja, koje su rezultat malih izmjena relacija (6.28), (6.29) i (6.30) predstavljene su 20 na slikama 6.13, 6.14 i 6.15 respektivno, gdje M(s) predstavlja prenosnu funkciju motora u (6.8). Slika 6.15 Blok šema regulatora pozicije, brzine i ubrzanja kontrole u direktnoj vezi sa decenralizovanom kompenzacijom direktne veze Sva rješenja dozvoljavaju kretanje ulazne trajektorije unutar opsega validnosti i linearnosti modela. Vrijedno je ista i da je pove anjem broja ugniježdenih povratnih petlji, potrebno manje poznavanje modela sistema za izvedbu kompenzacije direktne veze. U stvari, Tm i km su potrebni za šemu na Slici 6.13, za šemu na Slici 6.14 potreban je samo km, a za šemu na slici 6.15 potrebno je km, ali sa smanjenom težinom. Zna ajno je prisjetiti se da se savršeno kretanje po trajektoriji može ostvariti samo ukoliko se parametri kontrolera i kompenzacije direktne veze poklapaju sa parametrima procesa. Odstupanja od idealnih vrijednosti prouzrokuju smanjenje perfomansi, što e biti analizirano slu aj po slu aj. Prisustvo separacijskih blokova u šemama na slikama 6.13, 6.14 i 6.15 predstavlja namjerne nelinearnosti ija je funkcija ograni avanje odre enih fizi kih vrijednosti u toku tranzijentnog perioda; što je ve i broj povratnih petlji, ve i je broj vrijednosti koje mogu biti ograni ene (brzina, ubrzanje i napon motora). Zbog tog razloga, obi no se kretanje po trajektoriji gubi kada se bilo koja od ovih veli ina razdvoji. Ova situacija se obi no javlja kod industrijskih manipulatora ija je namjena izvršavanje kretanja od ta ke do ta ke; u ovom slu aju manja je briga pra enje stvarne trajektorije, a aktuatori su namjerno uzeti da rade na trenutnim granicama da bi ostvarili najbrže mogu e kretnje. 21 Slika 6.16 Ekvivalentna šema upravljanja PI tipa Slika 6.17 Ekvivalentna šema upravljanja PID tipa Poslije jednostavnog smanjenja prethodnih šema, mogu e je odrediti ekvivalentne kontrolne strukture koje ostvaruju samo povratnu petlju brzine i regulatore sa standardnim akcijama. Potrebno je naglasiti da su dva rješenja ekvivalentna u smislu potiskivanja smetnje i držanja trajektorije. Podešavanje parametara regulatora je manje jednostavno, a eliminacija unutrašnje povratne petlje štiti od mogu nosti zasi enja brzine i/ili ubrzanja. Kontrolne strukture ekvivalentne onima na slikama 6.13, 6.14 i 6.15 predstavljene su na slikama 6.16, 6.17 i 6.18 respektivno; kontrolne akcije tipova PI, PID i PIDD2 predstavljene su i ekvivalentne su slu ajevima: povratne petlje brzine, povratne petlje pozicije i brzine i povratne petlje ubrzanja. Gornje šeme predstavljaju tipi nu strukturu kontrolera implementiranih u kontrolnoj arhitekturi industrijskih robota. Kod ovih sistema važno je izabrati najve e mogu e poja anje tako da nepreciznost modela i ta ke interakcije nemaju zna ajnog uticaja na pozicije pojedinih spojeva. Kako je ranije spomenuto, gornja granica poja anja je nametnuta od strane svih faktora koji nisu modelirani, kao što su implementacija diskretnih vremenskih kontrolera, prisutnost kona nog vremena uzorkovanja, zanemareni dinami ki efekti i šum senzora. Ustvari, 22 uticaj ovih faktora u implementaciji gornjih kontrolera može prouzrokovati zna ajnu degradaciju perfomansi sistema za prevelike vrijednosti poja anja povratne sprege. Slika 6.18 Ekvivalentna šema upravljanja PIDD 2 tipa 6.4 Upravljanje u zatvorenoj povratnoj petlji sa momentom kao vektorom upravljanja Definišimo pozicionu grešku e(t) = d(t) – (t). Pozivaju i se na najopštiju šemu (Slika 6.18), izlaz PIDD2 regulatora može se napisati kao t a 2 e + a1e + a0 e + a −1 e(ξ )dξ što opisuje vrijeme evolucije greške. Konstantni koeficijenti a2, a1, a0, a-1 su odre eni usvajanjem partikularnih rješenja. Sumiranjem rezultata akcija u otvorenoj povratnoj petlji i smetnji dobija se: 1 T R θd + m θd − a d , km km kt gdje je: Tm IRa = km kt km = 1 kv Ulaz u motor (Slika 6.5), zatim, mora zadovoljavati slijede u jedna inu: t a 2 e + a1e + a0 e + a −1 e(ξ )dξ + Tm 1 R T 1 θd + θd − a d = m θ + θ km km kt km km . 23 Sa odgovaraju om promjenom koeficijenata može se pisati: t a 2′ e + a1′e + a0′ e + a −′ 1 e(ξ )dξ = Ra d kt Ova jedna ina opisuje dinamiku greške i pokazuje da bilo koja, fizi ki izvršiva trajektorija je asimptotski pra ena samo ako je dio smetnje d(t)=0. Termin fizi ki izvršiv zna i da granice zasi enja fizi kih vrijednosti, na primjer napona i struja elektri kih motora, nisu narušene u izvršavanju željene trajektorije. Prisutnost dijela d(t) prouzrokuje grešku kretanja ija je veli ina smanjena onoliko koliko je frekvencija smetnje pomjerena ka lijevoj donjoj granici propusnog opsega greške sistema. Prenosna funkcija smetnja/greška je data kao: Ra s E ( s) kt = D (s ) a2′ s 3 + a1′s 2 + a0′ s + a ′−1 ak i kada je dio d(t) predstavljen kao smetnja, njegov izraz je dat sa (6.7). Tada je mogu e dodati još jedan dio prethodnim pred-akcijama, koji je u stanju da kompenzira samu smetnju bolje nego njene efekte. Neka je q(t) željena trajektorija i qmd(t) odgovaraju a aktuatorska trajektorija kao u (6.2). Usvajaju i strategiju inverznog modela, pred-akcija RaKt-1dd može se predstaviti sa: d d = K r ∆B ( qd ) K r qmd + K r C (qd , qd )K r qmd + K r g ( qd ) −1 −1 −1 −1 −1 (6.31) gdje Ra i kt predstavljaju dijagonalne matrice armaturnog otpora i konstantu sile obrtanja aktuatora. Ova akcija ima namjeru da kompenzira stvarnu smetnju izraženu sa (6.7) i omogu ava sistemu upravaljanja da radi u boljim uslovima. Ovo rješenje predstavljeno je na slici 6.19 i konceptualno opisuje sistem upravljanja manipulatora sa upravljanjem sa izra unatom silom obrtanja. Sistem upravljanja sa povratnom petljom predstavljen je sa n nezavisnih upravlja kih servo-a; decentralizovan je, dok kontroler i obra uje reference i mjerenja koje odgovaraju dijelu i. Interakcije izme u razli itih dijelova, izražene sa d, se kompenziraju centralizovanom akcijom ija funkcija je generisanje pred-akcije koja zavisi od dinamike modela manipulatora. Ova akcija kompenzira nelinearnosti koje su posljedica inercije, Coriolisove sile, centrifugalne sile i gravitacione sile, a koje zavise od strukture te imaju razli ite vrijednosti u toku kretanja manipulatora. 24 Slika 6.19 Ekvivalentna šema upravljanja momentom u direktnoj vezi ~ Iako preostali dio smetnje d = d d − d nestaje samo u idealnom slu aju savršenog držanja trajektorije (q=qd) i ta nog dinami kog modeliranja, d predstavlja interakciju smetnji prili no smanjenih vrijednosti u ovisnosti od d. Tehnika izra unavanja momenta ima prednost pri smanjenju potiskivanja smetnje za strukturu upravljanja sa povratnom petljom i dozvoljava ograni ena poja anja. Dok se stvarni kontroler implementira na ra unaru sa kona nim vremenom uzorkovanja, mora se obratiti pažnja pri izra unavanju momenta u ovom vremenskom intervalu. Da ne bi umanjili perfomanse dinami kog sistema, vremena uzorkovanja moraju biti reda milisekundi. Zbog toga, vrijedilo bi izvršiti samo djelimi nu akciju u otvorenoj povratnoj petlji, da bi se kompenzirali uslovi u (6.13) koji daju najzna ajniji doprinos u toku kretanja manipulatora. Obzirom da inercioni i gravitacioni uslovi dominiraju uslovima ovisnim o brzini (kao operativne brzine zglobova koje nisu ve e od nekoliko radijana u sekundi), djelimi na kompenzacija se može dosti i prora unavaju i samo gravitacione i inercione obrtne momente zbog dijagonalne Lemensove inercione matrice. U ovom slu aju samo uslovi koji zavise od globalne konfiguracije manipulatora su kompenzirani dok oni koji su izvedeni iz interakcije kretanja sa drugim zglobovima nisu. 25 6.5 Centarlizovano upravljanje U prethodnim poglavljima razmatrano je projektovanje upravlja kih struktura koje pojedinim zglobovima pristupaju neovisno. One su temeljene na pristupu jedan ulaz/jedan izlaz, kod kojeg se ne uzima u obzir interakcija i me usobna povezanost zglobova robota. Ovi uticaji obuhva eni su kroz poreme ajne ulaze koji djeluju pojedina no na zglob. Me utim, kao što je pokazano dinami kim modelom (6.1) manipulator nije skup n neovisnih upravlja kih sistema ve je multivarijabilan sistem sa n ulaza (momenti motora) i n izlaza (pozicije zglobova) me usobno spregnutih izrazito nelinearnim izrazima. Ukoliko se slijedi metodološki pristup koji je u skladu sa upravlja kim, neophodno je razmatrati problem upravljanja u kontekstu nelinearnih multivarijabilnih sistema. Ovaj pristup bi o igledno dao odgovaraju e objašnjenje za dinami ki model manipulatora i vodio bi pronalaženju pravila o nelinearnom centralizovanom upravljanju ija implementacija je potrebna za visoke dinami ke performanse manipulatora. U drugu ruku, upravljanje prora unatim momentom može biti interpretirano u ovoj cjelini pošto osigurava nelinearno upravlja ko djelovanje zasnovano na modelu s ciljem poboljšanja performansi pra enja trajektorije. Primjetno je, me utim, da se ovaj postupak suštinski izvršava «off line» pošto se izra unava na osnovu vremenskog dijagrama željene trajektorije, ne stvarne. Dinami ki model manipulatora sa motorima može se napisati u pogodnijem obliku. Manipulator je opisan jedna inom (6.1): B(q )q + C (q, q )q + Fv q + g (q) = τ dok su prenosnici opisani jedna inom (6.2): K r q = qm Ako se pozovemo na jedna inu (6.3) i blok šemu sa Slike 6.4, mogu e je dinami ki model n aktuatora koji osnažuju svih n upravljanih koordinata napisati u kompaktnoj matri noj formi jedna inama: K r −1τ = K t ia (6.32) va = Ra ia + K v qm (6.33) va = Gv vc (6.34) U jedna ini (6.32), Kt je dijagonalna matrica momentnih konstanti, a ia je vektor armaturnih struja n motora; u jedna ini (6.33) va je vektor armaturnih napona, Ra je dijagonalna matrica armaturnih otpora a K v je dijagonalna matrica naponskih konstanti n motora; u jedna ini (6.34) Gv je dijagonalna matrica poja anja n poja ala a vc je vektor kontrolnih napona n servomotora. 26 Redukcijom jedna ina (6.1),(6.2),(6.32),(6.33) i (6.34), ukupan dinami ki model manipulatora i motora dat je kao B(q )q + C (q, q )q + Fq + g (q ) = u (6.35) gdje je: F = Fv + K r K t Ra −1 K v K r (6.36) u = K r K t Ra−1Gv vc (6.37) Slika 6.20 Blok šema upravljanja robotom sa naponom kao vektorom upravljanja U jedna ini (6.36), F je dijagonalna matrica koja uzima u obzir mehani ka i elektri na prigušna djelovanja , a u jedna ini (6.37) u je vektor upravlja kih ulaznih varijabli sistema. Primjetimo da stvarni momenti koji odre uju kretanje sistema manipulatora sa motorima mogu se dobiti oduzimanjem utjecaja elktri nog trenja K r Kt Ra −1 K v K r q . Cjelokupni sistem je , onda ,naponski –kontrolisan a odgovaraju a blok šema je ilustrirana na slici 6.20. Ako aktuatori treba da obezbijede doprinose momenta prora unate na bazi kompletnog ili reduciranog modela manipulatora tada dizajniranje vektora u zavisi od matrica Kt , K v i Ra motora. Da bi se smanjio uticaj parametara datih navedenim matricama umjesto napona kao vektora upravlja kih varijabli sistema odabira se moment. U tom slu aju, aktuatori se ponašaju kao momentno-upravljani generatori. Jedna ina (6.33) postaje nepotrebna ,dok se jedna ina (6.34) zamjenjuje sa: ia = Gi vc (6.34') 27 koja prikazuje srazmjernu ovisnost vektora struje armature ( a ujedno i momenata) o vektoru upravlja kih napona n servo motora datih konstantnom matricom Gi . Na taj na in jedna ine (6.36) i (6.37) postaju: F = Fv (6.36') u = KrKtGi vc = τ (6.37') koje pokazuju reduciranu ovisnost vektora u o parametrima motora. Cjelokupni sistem, sada je momentno-kontrolisan sistem a ruzultuju a blok šema takvog sistema ilustrirana je na Slici 6.21. U nastavku emo razmotriti problem nalaženja pravila upravljanja vektorom u, koji garantiraju date performanse za sistem manipulatorima sa motorima. Kako jedna ina (6.37') može biti razmatrana kao konstantan proprcionalni odnos izme u vc i u, algoritmi centralizovanog upravljanja koji e biti dati u nastavku pripadaju generaciji upravljanja momentom u . Slika 6.21 Blok šema upravljanja robotom sa momentom kao vektorom upravljanja 6.5.1 PD upravljanje sa gravitacijskom kompenzacijom Neka je ravnotežno stanje sistema ozna eno vektorom željenih varijabli zgloba qd . Cilj je prona i strukturu regulatora koja garantuje globalnu asimptotsku stabilnost ravnotežnog stanja manipulatora. Za utvr ivanje ponašanja sistema oko ravnotežnog položaja osnovu je pružila Lyapunova direktna metoda. Neka vektor qT qT T opisuje stanje sistema , gdje q = qd − q (6.38) predstavlja razliku izme u planirane i ostvarene kinematike. 28 Neka je pozitivno definitna funkcija V definirana kao: V ( q, q ) = 1 T 1 q B ( q )q + qT K p q > 0 2 2 ∀q, q ≠ 0 (6.39) odabrana za Lyapunovu funkciju, gdje je K p (n × n) pozitivno definitna matrica, tako da, sa energetskog aspekta, prvi izraz sa desne strane jednadžbe (6.39) predstavlja kineti ku, a drugi potencijalnu energiju sistema. Uz pretpostavku da je vektor qd konstantan, diferenciranjem jedna ine (6.39) dobija se: 1 V = q T ( B ( q )q + qT B ( q ) q − qT K p q 2 Ako se izraz za Bq iz jedna ine (6.35) uvede u jedna inu (6.39), dobije se: 1 V = qT ( B(q )q − 2C (q, q ))q − qT Fq + qT (u − g (q ) − K p q ) 2 (6.40) (6.41) Prvi izraz na desnoj strani jedna ine je nula jer matrica N=2B-C zadovoljava jedna inu (4.48), dok je drugi izraz negativno definitan. Odabirom regulatora sa proporcionalnim djelovanjem i gravitacijskom kompenzacijom ije je upravlja ko djelovanje dato sa: u = g (q) + K p q (6.42) funkcija V bit e negativno poludefinitna jer je: V =0 q = 0, ∀q Slika 6.22 Blok šema PD upravljanja sa gravitacijskom kompenzacijom u prostoru zgloba. 29 Isti rezultat bi e postignut odabirom regulatora sa PD djelovanjem i gravitacijskom kompenzacijom: u = g (q) + K p q − K D q , (6.43) gdje je K D pozitivno definitna matrica. Uvo enjem jedna ine (6.43) u (6.41) dobija se: V = − qT ( F + K D ) q (6.44) Jedna ina (6.44) pokazuje da se dodavanjem derivacijskog lana uzrokuje porast apsolutnog iznosa funkcije V duž trajektorije i da to pozitivno uti e na vrijeme odziva sistema. Uvo enje derivacijskog lana naro ito dolazi do izražaja kada se radi o manipulatorima kod kojih se osnaživanje zglobova ostvaruje direktno bez reduktora kretanja, jer je mehani ko viskozno prigušenje prakti no nula. Prema gore navedenom, funkcija V se pove ava sve dok je q ≠ 0 duž svih trajektorija sistema. Za pronalaženje ravnotežnog položaja potrebno je postaviti uslov da je V ≡ 0 samo ako je q ≡ 0 . Primjenjuju i upravljanje (6.43) na dinami ki model robota dobija se: B(q )q + C (q, q )q + Fq + g (q ) = g (q) + K p q − K D q (6.45) U ravnotežnom položaju vrijedi ( q ≡ 0, q ≡ 0 ) , pa je: K pq = 0 (6.46) odnosno q = qd − q ≡ 0 predstavlja traženo ravnotežno stanje. Iz izvedenog se vidi da je bilo koje ravnotežno stanje manipulatora upravljanog PD regulatorom sa gravitacijskom kompenzacijom globalno asimptotski stabilno. Stabilnost sistema je obezbije ena pri bilo kojem K p i K d , sve dok su to pozitivno definitne matrice. Rezultuju a blok šema prikazana je na Slici 6.22. Primjena ovog upravlja kog pravila zahtijeva on-line izra unavanje vektora gravitacijskog djelovanja g(q). Ako je kompenzacija nepotpuna, gore pomenuta diskusija ne vodi uvijek do istih rezultata, što e biti pojašnjeno u narednim poglavljima kada e biti rije i o robusnosti regulatora sa nelinearnom kompenzacijom. 30 6.5.2 Inverzno dinami ko upravljanje Razmotrimo sada problem pra enja trajektorije u prostoru zgloba. Za po etak uzmimo upravljanje nelinearnim multivarijabilnim sistemima. Dinami ki model manipulatora sa n zglobova je dat jedna inom (6.35) koja se može napisati i u slijede em obliku: B ( q ) q + n( q ) q = u , (6.47) gdje je, zbog jednostavnosti stavljeno: n(q, q) = C (q, q )q + Fq + g (q) (6.48) Pristup koji slijedi u nastavku zasniva se na ideji da se prona e vektor upravljanja u, kao funkcija stanja sistema, koji bi ostvario ulaz/izlaz vezu linearnog tipa; drugim rije ima želi se izvršiti globalna linearizacija dinamike sistema dobivena iz nelinarnih stanja povratne sprege. Mogu nost nalaženja lineariziranog regulatora je garantovana specifi nom formom dinamike sistema. Jedna ina (6.47) je zapravo linearna u smislu upravljanja vektorom u i ima matricu B(q) koja može biti invertovana za bilo koju konfiguraciju manipulatora. Ako se uzme upravlja ki vektor u kao funkcija stanja manipulatora u obliku: u = B (q ) y + n( q, q ) (6.49) tada e sistem biti opisan sa q = y , gdje y predstavlja novi ulazni vektor ije objašnjenje tek treba da bude razjašnjeno. Rezultuju a blok šema prikazana je na Slici (6.23). Nelinearno pravilo upravljanja u jedna ini (6.49) predstavlja inverzno dinami ko upravljanje jer je ono zasnovano na izra unavanju inverzne dinamike manipulatora. Sistem na koji se primjeni pravilo upravljanja dato jedna inom (6.49) je linearan i neovisan i ima novi ulaz y. Drugim rije ima, komponenta yi sa dvostrukim integratorom uti e samo na varijable qi zgloba, neovisno o kretanju ostalih zglobova. Ako pogledamo izraz (6.49) problem upravljanja manipulatorom je sveden na nalaženje stabiliziraju eg pravila upravljanja vektorom y. U tu svrhu izbor vektora y u obliku: y = −K pq − KDq + r (6.50) dovodi do sistema jedna ina drugog reda: q + KDq + K pq = r (6.51) 31 koji je, uz pretpostavku da su K p i K d pozitivno definitne matrice, asimptotski stabilan. Slika 6.23 Globalna linearizacija pri inverznom dinami kom upravljanju Ako izaberemo da su K p i K d dijagonalne matrice tipa: K p = diag {ωn12 ,...., ωnn 2 } K D = diag {2ξ1ωn1,.......... , 2ξ nωnn } , onda dobijamo neovisan sistem. Data komponenta ri sa ulaz/izlaz vezom drugog reda koja je okarakterisana prirodnom frekvencijom ωni i koeficijentom prigušenja ξi uti e samo na varijablu zgloba qi . Bilo koja željena trajektorija qd (t ) , odnosno pra enje ove trajektorije za izlaz q(t ) je osigurano izborom r u obliku: r = qd + K D qd + K p qd (6.52) Ustvari, uvrštavanjem (6.52) u (6.51) dobija se homogena diferencijalna jedna ina drugog reda: q + KDq + K pq = 0 (6.53) koja izražava pozicionu grešku pri pra enju željene trajektorije (6.38). Ovakva greška nastupa samo ako je q (0) i/ili q(0) razli ito od nule i konvergira nuli sa brzinom konvergencije koja ovisi o izabranim matricama K p i K d . Rezultuju a blok šema je data na Slici 6.24 . Na slici su predstavljene dvije povratne petlje; unutarnja petlja je na bazi dinami kog modela manipulatora a vanjska petlja uti e na grešku odstupanja postignute od željene pozicije. Funkcija unutrašnje 32 petlje je da se dobije linearna i nezavisna ulaz/izlaz veza, a zadatak vanjske petlje da stabilizuje cjelokupan sistem. Upravljanje regulatorom u vanjskoj petlji je pojednostavljeno jer se operira nad linearnim vremenski-invarijantnim sistemima. Primjetimo da implementacija ove šeme upravljanja zahtijeva izra unavanje inverzne matrice B(q) i vektora Coriolisovih, centrifugalnih, gravitacionih i prigušnih djelovanja n(q, q ) (6.48). Za razliku od izra unavanja kod upravljanja momentom, ova djelovanja moraju biti izra unata on-line ,jer upravljanje je sada bazirano na nelinearnoj povratnoj sprezi trenutnog stanja sistema, pa je nemogu e prera unati gore pomenuta djelovanja off-line. Opisana tehnika podrazumijeva neovisnost i nelinearnu kompenzaciju, što je vrlo atraktivno sa aspekta upravljanja jer je dinamika manipulatora, koja podrazumijeva nelinearnost i zavisnost, predstavljena sa n linearnih i nezavisnih podsistema drugog reda. Pored toga, ova tehnika je bazirana na pretpostavci savršenog poništavanja dinami kih djelovanja a onda je sasvim prirodno zapitati se o problemima osjetljivosti i robusnosti tada neizbježno ne tako savršene kompenzacije. Slika 6.24 Blok šema inverznog dinami kog upravljanja u prostoru zgloba Implementacija pravila inverznog dinami kog upravljanja, doista zahtijeva da su parametri dinami kog modela poznati i da su jedna ine kretanja prora unate u realnom vremenu. Ove uslove je teško ostvariti u praksi. U jednu ruku, model je obi no poznat ali sa odre enim stepenom nesavršenosti uslijed nepoznavanja mehani kih parametra manipulatora, zatim evidentno je postojanje nemodelirane dinamike te ovisnost modela o prihvatnici nije ta no poznata, pa prema tome kompenzacija nije savršena. U drugu ruku, izra unavanje inverzne dinamike se izvršava sa vremenima uzorkovanja reda milisekunde, tako da to garantuje da je pretpostavka rada u kontinualnom vremenskom domenu realisti na. Ovo može izazvati ozbiljnja ograni enja u pogledu hardver/softver arhitekture sistema upravljanja. U takvim slu ajevima preporu ljivo je olakšati ra unanje inverzne dinamike tako da se izra unavaju samo dominantna djelovanja. 33 Osnova gore pomenutih napomena, sa aspekta implementacije, je da kompenzacija može biti nesavršena kako za nepreciznost modela tako i za aproksimacije koje se vrše u on-line ra unanju inverzne dinamike. U narednom izlaganju predstavljene su dvije tehnike upravljanja koje imaju za cilj suprotstaviti se efektima nesavršene kompenzacije. Prva tehnika podrazumijeva uvo enje dopunskog djelovanja inverznoj dinamici regulatora koja treba da obezbijedi robusnost sistema upravljanja pri dejstvovanju efekata koji nastaju prilikom aproksimacija koje se vrše u on-line ra unanju inverzne dinamike. Druga tehnika prilago ava parametre modela korištene za ra unanje inverzne dinamike stvarnim parametrima dinami kog modela manipulatora. 6.5.3 Robusno upravljanje U slu aju nesavršene kompenzacije, razumljivo je pretpostaviti da je u jedna ini (6.47) vektor upravljanja izražen kao : u = Bˆ (q ) y + nˆ (q, q) (6.54) gdje Bˆ i nˆ predstavljaju usvojeni prora unati model procjene djelovanja u dinami kom modelu.Greška procjene, na primjer, nepreciznost je data kao: B = Bˆ − B n = nˆ − n (6.55) i podesna je za nesavršen model kompenzacije kao i za namjerno pojednostavljenje ra unanja inverzne dinamike. Primjetno je da postavljanjem uslova Bˆ = B (gdje je B dijagonalna matrica prosje ne inercije osa zgloba) i nˆ = 0 , imamo šemu upravljanja gdje upravlja ka akcija y može biti PID tipa, prora unata na osnovu greške. Koriste i jedna inu (6.54) kao nelinearno pravilo upravljanja dobija se: ˆ + nˆ Bq + n = By (6.56) gdje je funkcionalna ovisnost izostavljena. Pošto je matrica B invertibilna vrijedi: q = y + ( B −1 Bˆ − I ) y + B −1n = y − η (6.57) gdje je: η = ( I − B −1 Bˆ ) y − B −1n (6.58) Uzimaju i da je y = qd + K D (qd − q) + K p (qd − q ) 34 dobija se: q + KDq + K pq = η (6.59) Sistem opisan jedna inom (6.59) je još uvijek nelinearan i zavisan, pošto je η nelinearna funkcija od q i q ; greška konvergencije jednaka nuli nije garantovana samo djelovanjima sa lijeve strane jedna ine. Da bi se pronašlo pravilo upravljanja koji bi garantovao da greška konvergencije bude nula, prilikom pra enja željene trajektorije, nije dovoljno linearno PD upravljanje. U ovu svrhu, Lyapun-ov direktni metod je ponovo iskoristiv za dizajniranje vanjske povratne petlje na osnovu greške koja e biti robusna na nepreciznost η . Neka je željena trajektorija qd (t ) odre ena u prostoru zgloba i neka je q = qd − q poziciona greška. Njen prvi izvod po vremenu je q = qd − q , dok je njen drugi izvod s obzirom na (6.57) : q = qd − y + η (6.60) Ako se uzme ξ= q (6.61) q kao stanje sistema, dobija se slijede a diferencijalna matri na jedna ina prvog reda: ζ = H ζ + D(qd − y + η ) (6.62) gdje su H i D blok matrice dimenzija (2n × 2n) i (2n × n) respektivno: H= 0 I 0 0 D= 0 I (6.63) Sada, problem pra enja željene trajektorije može biti smatran kao problem nalaženja pravila upravljanja vektorom y koje e stabilizirati grešku nelineranog vremenski-varijantnog sistema. Dizajniranje upravljanja zasnovano je na pretpostavci da ak iako je nepreciznost η nepoznata, mogu a je procjena njenog opsega varijacije. Traženo pravilo upravljanja vektorom y treba da garantira asimptotsku stabilnost za bilo koju varijaciju nepreciznosti η koja je u datom opsegu. 35 Pozivanjem na jedna inu (6.58) odakle se vidi da je η funkcija od q , q i qd date su slijede e pretpostavke: ∀qd (6.64) I − B −1 (q ) Bˆ (q ) ≤ α ≤ 1 ∀q (6.65) n ≤Φ<∞ ∀q, q (6.66) sup qd < QM < ∞ t ≥0 Pretpostavka (6.64) je prakti no zadovoljena pošto bilo koja željena trajektorija ne može zahtijevati beskona na ubrzanja. S obzirom na pretpostavku (6.65) i pošto je B pozitivno definitna matrica sa gornjim i donjim ograni enim normama, slijede a nejednakost sadrži: 0 < Bm ≤ B −1 (q) ≤ BM < ∞ ∀q (6.67) i tada uvijek postoji izbor za Bˆ koji zadovoljava pretpostavku (6.65). Ustvari, ako se Bˆ postavi u obliku: Bˆ = 2 I BM + Bm nejednakost (6.65) postaje: B −1Bˆ − I ≤ BM − Bm =α <1 BM + Bm (6.68) Ako je Bˆ ta nije procijenjeno od inverzne matrice, nejednakost je zadovoljena sa vrijednostima α koje mogu biti proizvoljno male (grani ni slu aj je za Bˆ = B i α = 0 ). Kona no, što se ti e pretpostavke (6.66), primjetno je da je n funkcija od q i q . Za rotacione zglobove dobijena je periodi na ovisnost dok je za translatorne postignuta linearna ovisnost. U drugu ruku, ako se pogleda ovisnost o q , za nestabilan sistem brzine se mogu pove avati neograni eno, ali u stvarnosti postoji zasi enje koje je uvjetovano maksimalnim brzinama motora. Zaklju no, pretpostavka (6,57) tako e može realno biti zadovoljena. S obzirom na jedna inu (6.57) i ako se izabere: y = qd + K D q + K p q + ω (6.69) 36 gdje PD djelovanja osiguravaju stabilizaciju dinami ke greške sistema, qd obezbje uje djelovanje u direktnoj vezi a ω djelovanja su izabrana da bi garantirala robusnost efektima nepreciznosti koja je ozna ena kao η (6.58). Koriste i (6.69) i postavljaju i K = K p K D dobija se: ζ = H ζ + D(η − ω ), (6.70) gdje je: H = ( H − DK ) = 0 −K p I −KD matrica ije karakteristi ne vrijednosti sve imaju negativne realne dijelove. K p i K D su pozitivno definitne što dozvoljava odre ivanje željene greške dinamike sistema. Ustvari, 2 i K D = diag {2ζ 1ωn1 ,..., 2ζ nωnn } n dobijenih ako se izabere K P = diag ωn21 ,..., ωnn { } nezavisnih jedna ina smatraju se linearnim dijelom. Ako djelovanje nepreciznosti is ezava, o igledno je ω = 0 i prethodni rezultat sa egzaktnom inverznom dinamikom kontrolera je obnovljen.( Bˆ = B i nˆ = n ). Da bi se odredilo ω , razmatra se slijde a pozitivno definitna kvadratna forma koja je izabrana za Lyapunovu funkciju: V (ξ ) = ξ T Qξ ∀ξ ≠ 0 (6.71) gdje je Q pozitivno definitna matrica reda (2n × 2n) . Izvod od V duž trajektorija greške sistema (6.70) je: V = ξ T Qξ + ξ T Qξ = ξ T ( H T Q + QH )ξ + 2ξ T QD(η − ω ) (6.72) Pošto H ima svojstvenu vrijednost sa negativnim realnim dijelom, onda vrijedi da za svaku simetri nu pozitivno definitnu matricu P, jedna ina: H T Q + QH = − P (6.73) ima jedinstveno rješenje Q koje je tako e simetri na pozitivno definitna matrica. S obzirom na ovu injenicu, jedna ina (6.72) postaje: V = −ξ T Pξ + 2ξ T QD(η − ω ) (6.74) Prvi lan na desnoj strani jedna ine (6.74) je negativno definitan i tada rješenja konvergiraju ako ξ ∈ N ( DT Q) .U suprotnom ,tj ako ξ ∉ N ( DT Q) ,tada ω mora biti izabrano tako da drugi lan u jedna ini (6.74) bude manji ili jednak nuli. Ako se postavi : 37 z = DT Qξ , tada drugi lan jedna ine (6.74) može biti napisan kao : z T (η − ω ) . Usvajanjem slijede eg pravila upravljanja: ω= ρ z z ρ >0 (6.75) dobija se: z T (η − ω ) = z Tη − ρ z zT z ≤ z η − ρ z = z ( η − ρ ) (6.76) Tada, ako se ρ izabere kao: ρ≥ η ∀q, q, qd (6.77) onda upravljanje (6.75) garantira da e V biti manje od nule duž svih trajektorija greške sistema. Da bi nejednakost (6.77) bila zadovoljena, s obzirom na definiciju nepreciznosti η (6.58) i pretpostavki (6.64)-(6.66) i ako je ω = ρ , mora vrijediti: η ≤ I − B −1Bˆ ( qd + K ξ + ω ) + B −1 n ≤ α Qm + α K ξ + αρ + BM Φ (6.78) Prema tome, ako se postavi: ρ≥ 1 (α QM + α K ξ + BM Φ) 1−α (6.79) dobije se: V = −ξ T Pξ + 2 z T (η − ρ z z) < 0 ∀ξ ≠ 0 (6.80) Rezultuju a blok šema ilustrirana je na Slici (6.25). Da sumiramo, prezentirani pristupi vodili su do pronalaženja pravila upravljanja koja su formirani od tri razli ite vrste djelovanja: ˆ + nˆ osigurava aproksimativnu kompenzaciju nelinearnih efekata i - Izraz By zavisnosti izme u zglobova 38 - Izraz qd + K D q + K p q unosi linearnu akciju direktne veze ( qd + K D qd + K p qd ) i linearnu akciju povratne veze ( − K D q − K p q ) koja stabilizuje grešku dinamike sistema. - Izraz ω = ( ρ / z ) z predstavlja udio robusnosti koja se suprotstavlja nepreciznosti B i n u ra unanju nelinearnih izraza koji zavise od stanja manipulatora . Rezultuju e pravilo upravljanja je tipa jedini nog vektora, pošto je opisano vektorom ρ koji je podešen sa jedini nim vektorom z = DT Qξ , ∀ξ . Slika 6.25 Blok šema robusnog upravljanja u prostoru zgloba Slika 6.26 Trajektorija greške pri robusnom upravljanju 39 Sve rezultuju e trajektorije pri robusnom upravljanju dosežu podprostor z = DT Qξ = 0 koji ovisi o matrici Q u Lyapun-ovoj funkciji V. U ovom podprostoru, nazvanom pokretni podprostor,idealno je da se ω zamijeni sa beskona nom frekvencijom i tada sve komponente greške teže u nulu sa tranzijentnom ovisnoš u o matricama Q, K p , K D . Karakterizacija trajektorije greške u dvodimenzionalnom slu aju data je na slici (6.26). Slika 6.27 Trajektorija greške sa robusnom kontrolom i eliminacijom smetnji Eliminacija ovih visoko frekventnih komponenata smetnji može biti postignuta usvajanjem robusnog upravlja kog pravila koje, ak i ako ne garantuje konvergenciju greške prema nuli, osigurava ograni enu normu grešaka. Upravlja ko pravilo ovog tipa kontrole je : ρ w= z z ρ z ε for z ≥ ε (6.81) for z < ε . U slu aju da se koristi intuitivna interpretacija ovog pravila, primjetimo da jedna ina (6.81) daje nulu na kontrolnom ulazu kada je greška u prostoru nula matrice D T Q . Sa druge strane, jedna ina (6.75) ima ekvivalentan rast prema beskona nosti kada z teži prema nula vektoru, što dovodi do ulaza sa ograni enom veli inom. Kako ovi ulazi zamjenjuju beskona nu frekvenciju, oni prisiljavaju grešku dinami nog sistema da ostane u pokretnom podprostoru. Pozivaju i se na gore navedeni primjer, pravilo (6.81) daje rast prema hiper-ravni z = 0 i greška se mijenja unutar granica sloja ija debljina zavisi od ε (Slika 6.27). 40 Upoznavanje doprinosa temeljenog na ra unanju odgovaraju e linearne kombinacije generalizovane greške potvr uje robusnost upravlja ke šeme temeljene na nelinearnim kompenzacijama. ak i ako je manipulator precizno modelovan, egzaktna nelinearna kompezacija može zahtijevati mnogo ra unanja, i prema tome može zahtijevati ili sofisticiranu hardversku arhitekturu ili pove anje vremena uzorkovanja potrebnog za izra unavanje upravlja kog pravila. Rješenje tada postaje slabo sa inžinjerske ta ke gledišta; o ekivati je ili pove anje troškova arhitekture kontrolera ili slabe performanse zbog smanjenja brzina uzorkovanja. Dakle, razmatranje djelimi nog znanja o dinami kom modelu manipulatora sa preciznom, ponderisanom procjenom nepreciznosti može navesti na robusnija rješenja kontrolera od tipova koji su gore navedeni. Razumljivo je da e procjena nepreciznosti biti zasnovana tako da nametne upravlja ke ulaze koje mehani ka struktura može podnijeti. 6.5.4. Adaptivno upravljanje Ra unarski model upotrijebljen za ra unanje inverzne dinamike obi no ima istu strukturu kao i pravi dinami ki model manipulatora, ali procjena parametara nepreciznosti ipak postoji. U ovom slu aju, postoji mogu nost za rješenja koja dopuštaju online adaptaciju ra unarskog modela na dinami ki model. Ovo izvršava upravlja ka šema inverznog dinami kog modela. Mogu nost nalaženja adaptivnih upravlja kih pravila je osiguran osobinama linearnosti parametara dinami kog modela manipulatora. Ustvari, uvijek je mogu e izraziti nelinearne jedna ine kretanja u linearnoj formi sa poštivanjem odgovaraju eg skupa konstantnih dinami kih parametara kao u (4.80). Jedna ina (6.35) može biti napisana kao: B(q )q + C (q, q)q + Fq + g (q ) = Y (q, q, q )π = u , (6.82) gdje su: π ( p × 1) vektor konstantnih parametara i Y (n × p) matrica koja je funkcija od pozicija zgloba, brzine i ubrzanja. Ova osobina linearnosti dinami kih parametara je fundamentalna za izvo enje adaptivnih upravlja kih pravila. Jedno od najjednostavnijih pravila je iliustrirano ispod: u = B(q )qr + C (q, q)qr + Fqr + g (q) + K Dσ , (6.83) 41 Ako se izabere: q r = q d + Λq~ q r = q d + Λq~, gdje je Λ pozitivno definitna (obi no dijagonalna) matrica, omogu ava se izražavanje nelinearne kompenzacije i razdvajanje lanova kao funkcije željene brzine i ubrzanja, korigovanih sa trenutnim stanjima manipulatora ( q i q ). Ustvari, primjetno je da lan q r = q d + Λq~ odre uje doprinos koji zavisi od brzine i to ne samo na osnovu željene brzine nego tako e i na osnovu pozicije greške pra enja. Sli ni argumenti važe tako er i za doprinos ubrzanja, gdje uslov zavisnosti brzine greške pra enja je uzet u obzir naspram željenog ubrzanja. Uslov K Dσ je ekvivalentan sa PD dejstvom na grešku ako je σ uzeto kao: σ = qr − q = q + Λq. (6.85) Zamjenjuju i (6.83) u (6.82) i uvrštavaju i u (6.85) dobija se: B(q )σ + C (q, q)σ + Fσ + K Dσ = 0. (6.86) Uzimaju i u obzir Lyapunov-u funkciju vrijedi: 1 1 V (σ , q~ ) = σ T B(q )σ + q~ T Mq~ > 0 ∀σ , q~ ≠ 0, 2 2 (6.87) gdje je M (n × n) simetri na pozitivno definitna matrica; uvo enje drugog uslova u (6.87) je potrebno kako bi se dobila Lyapunov-u funkciju cijelog stanja sistema (poziciju greške q~ i brzinu greške σ ). Vremenska derivacija od V duž trajektorija sistema (6.86) je: 1 V = σ T B(q )σ + σ T B(q )σ + q~ T Mq~ 2 T = −σ ( F + K D )σ + q~ T Mq~, (6.88) gdje je iskorištena simetri na osobina (4.47) matrice N = B − 2C . S obzirom na izraz za σ u (6.85), pogodno je izabrati M = 2ΛK D , što dovodi do: V = −σ T Fσ − q~ T K D q~ − q~ T ΒΛK D Λq~. (6.89) 42 Jedna ina (6.89) pokazuje da je vremenska derivacija negativno definitna samo ako T ~ je q ≡ 0 i q~ ≡ 0 ; prema tome , slijedi da je izvor prostora stanja q~ T σ T = 0 globalno asimptoti ki stabilan. Zna ajno je primjetiti da, za razliku od slu aja robusnog upravljanja, greška trajektorije je prirodno ograni ena na podprostor σ = 0 bez potrebe za visoko frekventnim upravljanjem. Na bazi ovih zna ajnih rezultata, upravlja ko pravilo može biti adaptivno uspostavljeno sa uvažavanjem vektora parametara π . [ ] Ako se pretpostavi da prora unati model ima istu strukturu kao i dinami ki model manipulatora, ali da njegovi parametri nisu ta no poznati, upravlja ko pravilo (6.83) je tada modifikovano u: u = Bˆ (q)q r + Cˆ (q, q )q r + Fˆq r + gˆ + K Dσ = Y (q, q, q r , q r )πˆ + K Dσ , (6.90) gdje π predstavlja raspoložive estimacije parametara i. Prema tome, B, C , F i g ozna avaju estimirane lanove u dinami kom modelu. Zamjenjuju i pravilo (6.90) u (6.82) dobija se: ~ ~ ~ B(q )σ + C (q, q )σ + Fσ + K Dσ = − B (q )q r − C (q, q )q r + Fq r − g~ (q ) = −Y (q, q, q ,q )π~, r (6.91) r gdje je osobina linearnosti vektora parametara greške u: π~ = π − π (6.92) uspješno iskorištena. U pogledu jedna ine (6.55) modeliraju a greška je predstavljena sa: ~ B = B−B ~ C = C −C ~ F =F−F g~ = g − g (6.93) Zna ajno je primjetiti da, sa aspekta pozicije (6.84), matrica Y ne zavisi od trenutnog ubrzanja zgloba nego samo od njihovih željenih vrijednosti što rješava probleme vezane za direktno mjerenje ubrzanja. U ovoj slu aju, modifikovana Lyapunov-a funkcija prestavljena jedna inom (6.87) prelazi u oblik: 1 1 V (σ , q~, π~ ) = σ T B(q )σ + q~ T ΛK D q~ + π~ T K π π~ >0 2 2 ∀σ , q~,π~ ≠ 0, (6.94) koji isti e dodatni lan izra unat za parametar greške(6.92), gdje je K π simetri no pozitivno definitno. 43 Vremenska derivacija od V duž trajektorija sistema (6.91) je: V = −σ T Fσ − q~ T K D q~ − q~ T ΛK D Λq~ + π~ T ( K π π~ − Y T (q, q, q r , q r )σ ). (6.95) Ako je estimacija parametara vektora ažurirana kao u adaptivnom pravilu: π = K π −1 y T (q, q, qr , q r )σ , (6.96) jedna ina (6.95) postaje: V = −σ T Fσ − q~ T K D q~ − q~ T ΛK D Λq~ pošto je π = π~ (π je konstanta). Prema argumentima koji su sli ni gore navedenim, nije teško pokazati da trajektorije manipulatora opisane sa modelom: B(q )q + C (q, q )q + Fq + g (q ) = u , i ako se koriste upravlja ka pravila: u = Y (q, q, q r , q r )π + K D (q~ + Λq~ ) i parametri adaptivnog pravila: π = K π −1Y T (q, q, q r , q r )(q~ + Λq~ ), globalno asimptoti ki konvergiraju prema σ = 0 i q~ = 0 , koji impliciraju konvergenciju prema nuli od q~, q~ , i nezavisnost od π . Jedna ina (6.91) pokazuje asimptoti nost: Y (q, q, q r q r )(π − π ) = 0 (6.97) Jedna ina (6.97) ne implicira da π teži prema π ; ustvari, konvergencija parametara prema njihovim stvarnim vrijednostima zavisi od strukture matrice Y (q, q, q r q r ) i od željenih i stvarnih trajektorija. Pored toga, prate i pristup je usmjeren rješavanju problema direktnog adaptivnog upravljanja, tj. pronalaženju upravlja kog pravila koje osigurava ograni enje grešaka pra enja, i ne odre uje trenutne parametre sistema (kao u problemu indirektnog adaptivnog upravljanja). Rezultiraju a blok šema je predstavljena na Slici 6.28. Da rezimiramo, gore navedeno upravlja ko pravilo je formirano prema tri razlli ita dijela : 44 Slika 6.28 Blok šema zgloba spoja prostora adaptivne kontrole. • • • lan Yπ opisuje upravlja ku akciju tipa inverzne dinamike koji obezbje uje aproksimativnu kompenzaciju nelinearnih efekata i razdvajanje zglobova. lan K Dσ uvodi stabiliziraju u linearnu kontrolnu akciju PD tipa na grešku pra enja. Vektor parametara estimacije π je ažuriran po adaptivnom zakonu gradijentnog tipa tako da obezbjedi asimptoti ku kompenzaciju lanova u dinami kom modelu manipulatora; matrica K π determinira brzinu konvergencije parametara prema njihovim asimptoti kim vrijednostima. Primjetimo da, sa σ ≈ 0 , upravlja ko pravilo (6.90) je ekvivalentno istoj inverznoj dinami koj kompenzaciji izra unatog momenta na bazi željenih brzina i ubrzanja; ovo je mogu e samo pri injenici da je Yπ ≈ Yπ . Upravlja ko pravilo sa adaptacijom parametara zahtjeva raspoloživost kompletnog prora unatog modela i ne isti e bilo koju akciju usmjerenu na reduciranje efekata vanjskih smetnji. Stoga, u inak degradacije je o ekivan svaki put kada se pojave nemodelovani dinami ki efekti, na primjer, kada je korišten reducirani ra unarski model ili vanjske smetnje. U oba slu aja, efekti izazvani na izlaznim varijablama se pripisuju kontroleru radi procjene nepoklapanja parmetara. Kao posljedica, upravlja ko pravilo pokušava da poništi te efekte djeluju i na dobijene iznose koji nisu izvorno izazvani. Sa druge strane, tehnike robusnog upravljanja obezbje uju prirodno otklanjanje vanjskih smetnji, premda su osjetljive na nemodelovanu dinamiku; ovo otklanjanje je obezbije eno od strane visoko frekventnog upravlja kog djelovanja koje ograni ava grešku trajektorije da ostane u pokretnom podprostoru. Rezultuju i ulazi u mehani ku strukturu mogu biti neprihvatljivi. Ove smetnje se generalno ne posmatraju sa usvojenim tehnikama adaptivnog upravljanja ije akcije imaju prirodno glatku vremensku karakteristiku. 45 6.6 Upravljanje u radnom prostoru U svim prije pomenutim upravlja kim šemama, uvijek je pretpostavljeno da je željena trajektorija raspoloživa u smislu vremenskih sekvenci pozicija, brzine i ubrzanja zgloba. Prema tome, greška upravlja kih šema je bila izražena u prostoru zgloba. Kao što je prethodno pomenuto, specifikacije kretanja su obi no nazna ene u radnom prostoru, gdje su onda trebali da se iskoriste inverzni kinemati ki algoritmi da transformišu karakteristike radnog prostora u odgovaraju e karakteristikee prostora zgloba. Proces inverzne kinematike pove ava ra unanje kada, osim inverzije direktne kinematike, vrši i inverziju diferencijalne kinematike prvog i drugog reda što se zahtjeva pri transformaciji željenog vremenskog dijagrama pozicije prihvatnice, brzine i ubrzanja u odgovaraju em iznosima na nivou zgloba. Zbog ovog razloga današnji industrijski sistemi robotskog upravljanja ra unaju pozicije zgloba preko inverzne kinematike, i onda izvršavaju numeri ko diferenciranje kako bi izra unali brzinu i ubrzanje. Drugi pristup se sastoji u razmatranju upravlja kih šema razvijenih direktno u radnom prostoru. Ako je kretanje specificirano u smislu varijabli radnog prostora, izmjerene varijable prostora zgloba mogu biti transformirane u odgovaraju e varijable radnog prostora preko direktnih kinemati kih relacija. Upore uju i željeni ulaz sa rekonstruisanim varijablama mogu e je dizajniranje kontrolnih petlji sa povratnom vezom gdje je inverzija trajektorije zamijenjena sa odgovaraju im trasformacijskim kordinatama ugra enim u petlju povratne veze. Sve upravlja ke šeme za radni prostor predstavljaju znatne ra unarske zahtjeve, u pogledu potreba da izvrše broj ra unanja u petlji povratne veze koji je nešto zastupniji od inverznih kinemati kih funkcija. Sa referencama na numeri ku implementaciju, prisustvo prora unatih zahtijevanih optere enja zahtijeva vremena uzorkovanja što može dovesti do degradacije performansi cijelog upravlja kog sistema. U pogledu gore navedenih ograni enja, zna ajno je predstaviti šeme upravljanja u radnom prostoru ije korištenje postaje neophodno kada problem upravljanja interakcijom izme u manipulatora i okoline postane od interesa. Ustvari, upravlja ke šeme prostora zgloba su dovoljne samo za upravljanje kretanjem u slobodnom prostoru. Kada su manipulatorski prihvatnici ograni eni od strane okoline, naprimjer, u slu aju da je prihvatnica u kontaktu sa elasti nom okolinom, neophodno je kontrolirati obje pozicije i silu dodira i pogodno je koristiti šeme za upravljanje u radnom prostoru. Stoga su u nastavku predstavljena neka rješenja; ona su se koristila za vanjsku kontrolu kretanja, ali ona konstituišu premise za interakciju upravlja kih strategija koje e biti ilustrirane u sljede em poglavlju. 46 6.6.1 Generalne šeme Kao što je prethodno istaknuto, šeme za upravljanje u radnom prostoru su bazirane na direktnom pore enju ulaza, specificiraju i trajektorije radnog prostora , sa mjerenjem odgovaraju ih izlaza manipulatora. Slika 6.29 Blok šema Jacobian inverzne kontrole Iz ovog slijedi da e upravlja ki sistem pretvoriti neke akcije koje dozvoljavaju prelazak iz radnog prostora, u kojima je greška specificirana, u prostor zgloba, u kojima je razvijeno upravljanje generalizovanih sila. Mogu a upravlja ka šema koja može biti izvedena je tzv. Jacobian inverzno upravljanje (Slika 6.29). U ovoj šemi lokacija prihvatnice u radnom prostoru je upore ena sa odgovaraju im željenim iznosom, i nakon toga devijacija ∆x radnog prostora može biti izra unata. Pretpostavimo da je za dobar upravlja ki sistem ova devijacija dovoljno mala. ∆x može biti transformirano u odgovaraju u devijaciju ∆q prostora zgloba posredstvom inverzije Jacobian-a manipulatora. Tada, upravljanje ulaznih generalizovanih sila može biti izra unato na bazi ove devijacije posredstvom pogodnog matri nog poja anja povratne veze. Rezultat je vjerovatna redukcija ∆q na ra un ∆x . Druga ije re eno, Jacobian inverzno upravljanje vodi do globalnog sistema koji se intuitivno ponaša sli no mehani kom sistemu sa generalizovanom n dimenzionalnom oprugom u prostoru zgloba, ija je konstantna krutost odre ena sa matricom poja anja povratne veze. Uloga ovakvog sistema je da dovede devijaciju ∆q na nulu. Ako je matri no poja anje dijagonalno, generalizovane opruge odgovaraju n nezavisnim elasti nim elementima, po jedan za svaki zglob. Konceptualna analogna šema je tzv. Jacobian trasponovana kontrola (slika 6.30). U ovom slu aju greška radnog prostora je razmatrana preko matri nog poja anja. Izlaz iz ovog bloka može biti razmatran kao elasti na sila izazvana od strane generalisane opruge ija je funkcija u radnom prostoru da reducira ili uprosti položaj devijacije ∆x . Drugim rije ima, rezultuju a sila pokre e prihvatnicu duž pravca tako da reducira ∆x . Ova sila radnog prostora može onda biti transformirana u generalizovane sile prostora zgloba, posredstvom transponovanja Jacobiana, tako da realizuje opisano ponašanje. 47 Obje Jacobian upravlja ke šeme, inverzna i transponovana, su bile izvedene u intuitivnom obliku. Dakle, nema garancije da su takve šeme efikasne u uslovima stabilnosti i preciznog pra enja trajektorije. Ovi problemi mogu biti prevazi eni koriste i dva matemati ka rješenja , koja su navedena u nastavku i koja e pokazati da su suštinski jednaka gornjim šemama. 6.6.2 PD kontrola sa kompenzacijom gravitacije Prema analogiji sa analizom stabilnosti prostora zgloba, sa datom lokacijom prihvatnice xd , želja je da na emo upravlja ku strukturu tako da greška radnog prostora ~ x = xd − x (6.98) asimptoti ki teži prema nuli. Slika 6.30 Blok šema Jacobian transponovanog upravljana Treba izabrati sljede u pozitivno definitnu kvadratnu formu kao što prikazuje Lyapunov-a funkcija: 1 1 T ~ V ( q, ~ x ) = q T B(q )q + ~ x K P x >0 ∀q, ~ x ≠0 2 2 (6.99) gdje je K P simetri na pozitivno definitna matrica. Diferenciraju i (6.99) po vremenu dobija se: 1 V = q T B(q )q + q T B(q )q + ~ xT KP~ x. 2 Kako je xd = 0, s obzirom na (3.37) vrijedi da je: ~ x = − J A (q)q 48 i onda je: 1 V = q T B(q )q + q T B (q)q − q T J TA (q ) K P ~ x. 2 (6.100) Pozivaju i se na izraz za prostor zgloba dinami kog modela manipulatora (6.35) i osobinu (4.48), jedna ina (6.100) postaje: V = −q T Fq + q T (u − g (q ) − J TA (q ) K P ~ x ). (6.101) Ova jedna ina navodi strukturu kontrolera; ustvari, biraju i upravlja ko pravilo: u = g (q) + J TA (q ) K P ~ x − J TA K D J A (q)q, (6.102) gdje je K D pozitivno definitna matrica, jedna ina (6.101) postaje: V = −q T Fq − q T J TA (q ) K D J A (q )q. (6.103) Kao što se vidi sa slike 6.31, rezultiraju a blok šema otkriva analogiju sa šemom na Slici 6.30. Upravlja ko pravilo (6.102) izvršava nelinearno kompenzacijsko djelovanje gravitacionih sila u prostora zgloba i akciju linearnog PD upravljanja u radnom prostoru. Slika 6.31 Blok šema PD upravljanja radnim prostorom sa kompenzacijom gravitacije. Posljednji izraz je uveden da pove a prigušenje sistema; posebno ako je mjerenje x deducirano od strane q . Može se jednostavno izabrati derivativni lan kao − K D q. Jedna ina (6.103) pokazuje da se, za bilo koju trajektoriju sistema, Lyapunov-a funkcija pove ava sve dok je q ≠ 0 . 49 Sistem tada dostiže ravnotežno stanje. Pri argumentu sli nom onom u prostoru zgloba (jedna ine (6.44)-(6.46)), ovo stanje je odre eno za: J AT (q) K P ~ x = 0. (6.104) Iz (6.104) može se primjetiti pretpostavka o punom rangu Jacobiana, te je: ~ x = xd − x = 0, što predstavlja traženi rezultat. Ako je mjerenje x i x vršeno direktno u radnom prostoru, k (q) i J A (q) u šemi na Slici (6.31) su nagovještaj direktne kinemati ke funkcije; te je, ipak, potrebno mjeriti q kako bi se ažurirale J AT (q ) i g (q ) on-line. Ako su mjerenja radnog prostora indirektna, kontroler tako e treba da ra una i direktne kinemati ke funkcije. 6.6.3 Inverzna dinami ka kontrola Razmotrimo sada problem pra enja trajektorije radnog prostora. Ovdje se poziva na dinami ki problem manipulatora koji je dat u formi (6.47) B ( q ) q + n( q, q ) = u gdje je n dato sa (6.48). Kao i u (6.49), izbor inverznog dinami ki lineariziranog upravljanja: u = B ( q ) y + n( q , q ) dovodi do sistema dvostrukih integratora: q = y. (6.105) 50 Slika 6.32 Blok šema inverznog dinami kog upravljanja radnog prostora. Novi upravlja ki ulaz y je dizajniran tako da dozvoljava pra enje trajektorije specificirane prema xd (t ) . U ovu svrhu, diferencijalna jedna ina drugog reda u oblliku (4.117): x = J A ( q ) q + J A ( q, q ) q sugerira, za neredundantni manipulator, izbor upravlja kog pravila: y = J A−1 (q )( xd + K D ~ x + KP~ x − J A ( q, q ) q ) (6.106) gdje su K P i K D pozitivno definitne dijagonalne matrice. Ustvari, zamjenjuju i (6.106) u (6.105) dobija se jedna ina: ~ x + KD~ x + KP~ x =0 (6.107) koja opisuje grešku dinamike radnog prostora, sa K P i K D koji determinišu brzinu greške konvergencije na nulu. Rezultuju a inverzna dinami ka upravlja ka šema je predstavljena na Slici 6.32, koja potvr uje pretpostavljenu analogiju sa šemom na Slici 6.29. Ponovo, u ovom slu aju, osim x i x potrebno je mjeriti i q i q . Ako su mjerenja x i x indirektna, kontroler mora da ra una direktne kinemati ke funkcije k (q) i J A (q ) online. Kriti ka analiza šema na slikama 6.31 i 6.32 otkriva da dizajn kontrolera radnog prostora uvijek zahtijeva ra unanje Jacobian-a manipulatora. Kao posljedica, upravljanje manipulatora u radnom prostoru je kompleksnije nego upravljanje u prostoru zgloba. Ustvari, prisustvo singulariteta i/ili redundantnih uticaja Jacobian-a, i indukovanih efekata otežavaju rukovanje sa kontrolerom radnog prostora. Na primjer, ako se pojavi singularitet u šemi na Slici 6.31 i ako greška u e u nul prostor Jacobian-a, manipulator 51 može da završi u druga ijoj konfiguraciji od željene. Ovaj problem je još više kriti an za šemu na Slici 6.32, jer zahtijeva ra unanje DLS-inverzije Jacobian-a. Ipak, za redundantni manipulator, upravlja ka šema prostora zgloba je svakako transparentna za ovu situaciju, pošto je redundancija ve bila riješena sa inverznom kinematikom, obzirom na injenicu da upravlja ka šema radnog prostora treba da inkorporira tehnike za rukovanje redundancijom unutar petlje povratne veze. 6.7 Pore enje izme u razli itih upravlja kih šema U želji da se napravi komparacija izme u razli itih upravlja kih šema, razmatra se planarna ruka sa dva segmenta sa istim podacima koji su dati u primjeru 4.2: a1 = a 2 = 1 m k r1 = k r2 = 100 l1 = l 2 = 0.5 m ml1 = ml2 = 50 kg I l1 = I l2 = 10 kg ⋅ m 2 mm1 = mm2 = 5 kg I m1 = I m2 = 0.01 kg ⋅ m 2 Pretpostavljeno je da je ruka pokretana sa dva jednaka aktuatora sa slijede im podacima: Fm1 = Fm2 = 0.01 N ⋅ m ⋅ s rad kt1 = k t2 = 2 N ⋅ m A Ra1 = Ra 2 = 10 ohm k v1 = k v2 = 2 V ⋅ s rad Ovo može biti provjereno tako da je Fmi << k vi k ti Rai za i = 1,2. Željeni nagib trajektorija ima tipi ni trapezoidni profil brzine, i prema tome, za o ekivati je da e oštre varijacije obrtnog momenta biti inducirane. Nagib putanje je kretanje za 1.6m duž horizontalne ose, kao u putanji u primjeru 4.2. U prvom slu aju (brza trajektorija), vremensko ubrzanje je 0.6s a maksimalna brzina je 1m/s. U drugom slu aju (spora trjektorija), vremensko ubrzanje je 0.6s a maksimalna brzina je 0.25m/s. Kretanje upravljane ruke je simulirano na kompjuteru usvajanjem diskretne vremenske implementacije kontrolera sa vremenom uzorkovanja od 1ms. Upotrijebljene su slijede e upravlja ke šeme u prostoru zgloba i u radnom prostoru: A. Nezavisno upravljanje zgloba sa pozicionom i brzinskom povratnom vezom (Slika 6.8) sa slijede im podacima za svaki servo ure aj zgloba: KP = 5 KV = 10 kTP = k tv = 1, koji su korespondentni sa ω n = 5 rad s i ξ = 0.5. 52 B. Nezavisno upravljanje zgloba sa pozicionom, brzinskom i akceleracijskom povratnom vezom (Slika 6.10) sa slijede im podacima za svaki servo ure aj zgloba: K P = 5 KV = 10 K A = 2 kTP = k tv = kTA = 1, koji su korespondentni sa ω n = 5 rad s , ξ = 0.5 i X R = 100. Za rekonstrukciju ubrzanja, iskorišten je filter prvog reda (Slika 6.12) koji je okarakterisan sa ω 3 f = 100 rad s . C. Kao u šemi A sa dodavanjem decentralizovane direktne veze (Slika 6.14). D. Kao u šemi B sa dodavanjem decentralizovane direktne veze (Slika 6.15). E. Upravljanje prora unatim momentom prostora zgloba (Slika 6.19) sa direktnom kompenzacijom dijagonalnih lanova u inercionoj matrici i gravitacionih lanova, te decenralizovanom povratnom vezom kontrolera kao u šemi A. F. PD upravljanje prostorom zgoba sa kompenzacijom gravitacije (Slika 6.22), modifikovan sa dodavanjem direktne veze brzinskog lana K D q d , sa slijede im podacima: K P = 3750I K D = 750I G. Inverzno dinami ko upravljanje prostora zgloba (Slika 6.24) sa slijede im podacima: K P = 25I K D = 5I H. Robusno upravljanje prostora zgloba (Slika 6.25), pretpostavljaju i konstantnu inerciju ( B = B ) i kompenzaciju trenja i gravitacije (n = Fv q + g ) , sa slijede im podacima: K P = 25I K D = 5I P=I ρ = 70 ε = 0.004. I. Kao u slu aju H sa ε = 0.01. J. Adaptivno upravljanje prostora zgloba (Slika 6.28) sa parametrizacijom dinami kog modela ruke (4.81) kao i (4.82) i (4.83). Inicijalna estimacija vektora π je ra unata na bazi nominalnih parametara. Ruka je predvi ena da nosi teret što uzrokuje slijede e varijacije u parametrima drugog segmenta: ∆m2 = 10 kg ∆m2 lC2 = 11 kg ⋅ m ∆Iˆ2 = 12.12 kg ⋅ m 2. 53 Ove informacije su iskorištene samo da ažuriraju simulirani model ruke. Dalje su korišteni slijede i podaci: Λ = 5I K D = 750I Kπ = 0.01I K. PD upravljanje radnog prostora sa kompenzacijom gravitacije (Slika 6.31), modifikovana sa dodavanjem direktne veze brzinskog lana K D xd , sa slijede im podacima: K P = 16250 I K D = 3250 I L. Inverzno dinami ko upravljanje radnog prostora (Slika 6.32) sa slijede im podacima: K P = 25I K D = 5I Slika 6.33 Vremenski dijagram pozicija i obrtnh momenata zgloba i nagib pozicija grešaka za brzu trajektoriju sa upravlja kom šemom A. Zna ajno je primjetiti da je usvojeni model dinami kog sistema ruke sa pogonima opisan prema jedna ini (6.35). U decentralizovanim upravlja kim šemama (A-E) zglobovi su naponsko kontrolirani kao u blok šemi na Slici 6.20, sa jedini nim poja anjem (Gv = I ). Sa druge strane, u centralizovanim upravlja kim šemama (F-L), 54 zglobovi su strujno kontrolirani kao u blok šemi na Slici 6.21, sa jedini nim poja ava em (Gi = I ). Gledaju i parametre razli itih kontrolera, ovi su izabrani tako da obezbijede zna ajano pore enje performansi svake šeme sa podudaraju im upravlja kim akcijama. Može se primjetiti: • • Dinami ko ponašanje zglobova je isto za šeme A-E. Poja anja PD djelovanja u šemama F, J i K su podešena tako da se dobija vremenski odziv sli an onom u šemama A-E. • Poja anja PD djelovanja u šemama G, H, I i L su izabrana tako da se dobija ista prirodna frekvencija i prigušenje kao oni u šemama A-E. Rezultati dobijeni sa razli itim upravlja kim šemama su ilustrirani na slikama 6.336.41 za brzu trajektoriju i slikama 6.42-6.50 za sporu trajektoriju, respektivno. U slu aju dvaju veli ina prikazanih u istom dijagramu može se primjetiti da: • Za trajektorije zgloba, isprekidana linija pokazuje referentnu trajektoriju dobijenu iz nagiba trajektorije preko inverzne kinematike, dok puna linija pokazuje trenutnu trajektoriju koju ruka sljedi. • Za obrtne momente zgloba, puna linija se odnosi na zglob 1 dok se isprekidana linija odnosi na zglob 2. • Za nagib greške pozicije puna linija pokazuje komponentu greške duž horizontalne ose, dok isprekidana linija pokazuje komponentu greške duž vertikalne ose. Slika 6.34 Vremnski dijagram obrtnih momenata zgloba i norma nagiba pozicije greške za brzu trajektoriju; lijevo-sa upravlja kom šemom C, desno – sa kontrolnom šemom D. 55 Slika 6.35 Vremenski dijagram obrtnih momenata zgloba i norma nagiba pozicije greške za brzu trajektoriju sa upravlja kom šemom E. Slika 6.36 Vremenski dijagram pozicija i momenata zgloba i norma nagiba greške pozicije za brzu trajektoriju sa upravlja kom šemom F. 56 Slika 6.37 Vremenski dijagram momenata zgloba i norma nagiba greške pozicije za brzu trajektoriju sa upravlja kom šemom G. Kona no, predstavljanje brojnih sistema je napravljeno sa ciljem da se omogu i više direktnih pore enja rezultata. U pogledu performansi razli itih upravlja kih šema za brzu trajektoriju, dobijeni rezultati dopuštaju crtanje slijede a razmatranja. Slika 6.38 Vremenski dijagram obrtnih momenata zgloba i norma nagiba greške pozicije za brzu trajektoriju; lijevo –sa upravlja kom šemom H, desno – sa upravlja kom šemom I. 57 Slika 6.39 Vremenski dijagram norme nagiba pozicije greške i norma parametara greške za brzu trajektoriju sa upravlja kom šemom J. Devijacija trajektorija aktualnog zgloba od željenih trajektorija pokazuju da je pra enje performansi šeme A dosta slabo (Slika 6.33). Treba primjetiti, da je, ipak, najve i uticaj na grešku uzrokovan vremenskim zaostajanjem trenutne trajektorije iza željene, dok je distanca nagiba od geometrijske putanje prili no zadržana. Sli ni rezultati se dobijaju sa šemom B, ali oni nisu prikazani. Slika 6.40 Vremenski dijagram obrtnih momenata zgloba i norma nagiba greške pozicije za brzu trajektoriju sa upravlja kom šemom K. Slika 6.41 Vremenski dijagram obrtnih momenata zgloba i norma nagiba greške pozicije za brzu trajektoriju sa upravlja kom šemom L. 58 Sa šemama C i D je mogu e procijeniti ta nost pra enja poboljšanja (Slika 6.34), sa boljim performansama za drugu šemu, zahvaljuju i vanjskoj akceleracijskoj petlji povratne veze koja dozvoljava otklanjanje faktora smetnje dvostruko brže nego u slu aju prve šeme. Primjetimo da direktna veza dozvoljava upotrebu skupa momenata koji su bliži zahtjevanim nominalnim vrijednostima kako bi dobili željenu trajektoriju. Vremenski dijagram obrtnog momenta ima diskontinuitete u predstavljanju ponašanja ubrzanja i smanjenja brzine. Greška pra enja je još više smanjena sa šemom E (Slika 6.35), na osnovu dodatih nelinearnih kompenzacija sa direktnom vezom. Šema F garantuje stabilnu konvergenciju kona nog položaja ruke sa boljim performansama pra enja nego u slu aju šema A i B, zahvaljuju i prisustvu brzinske direktne veze, ali gore nego u slu aju šema C-E, s obzirom na nedostatak dejstva ubrzanja direktne veze (Slika 6.36). Slika 6.42 Vremenski dijagram pozicija i obrtnih momenata zgloba i norma nagiba greške pozicije za sporu trajektoriju sa upravlja kom šemom A. Logi no bi bilo o ekivati najbolje rezultate posmatranja sa šemom G gdje je greška pra enja prakti no nula, i to je glavni doprinos numeri ke diskretizacije kontrolera (Slika 6.37). Zna ajno je spomenuti pore enje performansi šema H i I (Slika 6.38). Ustvari, izbor male vrijednosti praga za ε (šema H) izaziva visoko frekventne komponente u momentu zlgoba 1 (vidjeti podebljani dio šeme za momenat) kao prednost veoma limitirane greške pra enja. Kada je vrijednost praga pove ana (šema I), moment podrazumjeva bolju glatkost na ra un udvostru ene norme greške pra enja. 59 Za šemu J je primjetna niža greška pra enja nego za šemu F, zahvaljuju i efektivnom adaptivnom dejstvu parametara dinami kog modela. Pored toga, parametri ne konvergiraju prema njihovim nominalnim vrijednostima, kao kod vremenskog dijagrama norme parametra vektora greške koji doseže ne nultu vrijednost kona nog stanja (Slika 6.39). Na kraju, performanse šema K i L su suštinski uporedive u odnosu na odgovaraju e šeme F i G (Slika 6.40 i 6.41). Slika 6.43 Vremenski dijagram obrtnih momenata zgloba i norma nagiba pozicije greške za sporu trajektoriju; lijevo – sa upravlja kom šemom C, desno - sa upravlja kom šemom D. Slika 6.44 Vremenski dijagram obrtnih momenata zgloba i norma nagiba pozicije greške za sporu trajektoriju sa upravlja kom šemom E. 60 Performanse razli itih upravlja kih šema za sporu trajektoriju su u cijelosti bolje nego za brzu trajektoriju. Takvo poboljšanje je naro ito evidentno za decentralizovane upravlja ke šeme (slike 6.42 – 6.44), s obzirom na injenicu da je redukcija za centralizovane upravlja ke šeme manje složena (slike 6.45 – 6.50)i s obzirom da je mali red veli ine grešaka ve dobijen za brzu trajektoriju. U svakom slu aju, za ocjene performasi svake pojedina ne šeme, mogu e je napraviti veliki broj opažanja analognih sa onim koji su prethodno napravljeni. Slika 6.45 Vremenski dijagram pozicija i obrtnih momenata zgloba i norma nagiba pozicije greške za sporu trajektoriju sa upravlja kom šemom F. Slika 6.46 Vremenski dijagram obrtnih momenata zgloba i norma nagiba pozicije greške za sporu trajektoriju sa upravlja kom šemom G. 61
© Copyright 2024 Paperzz