Robotizirani jojo: strategija vodenja z uporabo nelinearnih dinamičnih sistemov Tadej Petrič, Andrej Gams, Leon Žlajpah Institut "Jožef Stefan ", Jamova cesta 39, 1000 Ljubljana, Slovenija E-požta: tadej.petric@ijs.si Povzetek. V prispevku je predstavljena uporaba nelinearnih dinamičnih sistemov za izvajanje ritmičnih nalog. Za nalogo je bila izbrana naprava jojo. To je naprava, sestavljena iz dveh diskov, povezanih s tanko osjo. Vodenje naprave jojo je nelinearna dinamična naloga in zahteva nenehno adaptacijo frekvence izvajanja. Za vodenje te naloge je bil uporabljen imitacijski sistem, kije sestavljen iz dveh nivojev. Prvi nivo sestavljajo prilagodljivi frekvenčni oscilatorji, njegova naloga pa je prilagajanje frekvence vhodnega signala. Naloga drugega nivoja je generiranje trajektorije. Ta nivo sestavlja sklop diferencialnih enacb. Zmogljivost imitacijskega sistema, da se lahko prilagodi frekvenci vhodnega signala, nam omogoca uspešno igranje naprave jojo. V prispevku so predstavljeni uporaba nelinearnega dinamicnega sistema za vodenje dinamicnih ritmicnih nalog in rezultati vodenja realnega sistema. Ključne besede: posnemanje gibanja z robotom, periodicne naloge, jojo, adaptivni oscilatorji Robotic yoyo: a control strategy based on nonlinear dynamic systems Extended abstract. The paper presents the use of a nonlinear dynamic system to preform a certain rhythmic task. The object of the task was a device named yoyo. It is a toy made of two discs connected with a short thin axle, dynamic in nature, highly non-linear and requiring on-line adaptation of the frequency at which it is preformed. The nonlinear dynamic system used to preform this task was of two layers. The first layer was used to adapt to the frequency of the input and was based on adaptive-frequency oscillators. The second layer was used to provide the desired trajectory and is based on a set of differential equations. The ability of the imitation system to adapt to the frequency of the input signal allowed us to successfully play with the yoyo. Results for real-world experiments are presented, thus validating the use of the proposed nonlinear dynamic system for controlling dynamic rhythmic tasks. Key words: movement imitation with robot, periodic task, yoyo, adaptive oscillators 1 Uvod V zadnjih letih je v robotiki opaziti povecan razvoj algoritmov za izvajanje periodicnih oz. ritmicnih nalog [1, 2]. Med te naloge spadajo povsem vsakdanje naloge, kot je npr. hoja [3] ali rokovanje [4], ter naloge vodenja ra-zlicnih naprav, kot sta npr. napravi jojo [1] in ziroskopska naprava imenovana Powerball [2, 5, 6]. Tako naprava jojo kot ziroskopska naprava Powerball sta nelinearna di-namicna sistema, ki za uspešno izvedbo zahtevata sinhro-nizirano gibanje upravljavca in naprave. Njuno vodenje je za cloveka povsem preprosto. Izvedba teh nalog z roboti pa je zahteven problem, ki zahteva uporabo naprednih algoritmov vodenja in kompleksnih senzorskih sistemov [1, 2]. Generiranje robotske trajektorije in njeno moduliranje je v robotiki zahteven problem, ki za splosšen sistem se ni rešen. Eden od pristopov je generiranje trajektorije s posnemanjem oz. imitacijo [7]. Robotske trajektorije lahko posnemamo na razlicne nacine [8]. Preprosteje je, da si zapomnimo casovno indeksirane vektorje [9]. Veckrat se uporabijo bolj kompaktni zapisi trajektorij, npr. z uporabo zlepkov [10] ali pa verjetnostnih zapisov v obliki skritih modelov Markova [11]. Eden od kompaktnejsih zapisov je tudi uporaba dinamicnih primitivov imenovanih DMP [12], ki trajek-torijo zapišejo z vektorjem utezi, rekonstruirajo pa jo z linearno kombinacijo jedrnih funkcij. Dodatna prednost DMPjev je tudi zapis trajektorije z diferencialno enacšbo drugega reda, ki zagotavlja zvezno in odvedljivo trajek-torijo. Pri izvajanju periodicšnih nalog je bistveno dolocšiti osnovno frekvenco gibanja [6]. Da lahko izlocijo osnovno frekvenco gibanja, morajo sistemi posnemanja gibanja najprej obdelati demonstracijski signal [8]. V clanku opisujemo uporabo sistema za posnemanje gibanja, ki deluje na podlagi DMP, kjer je dolocanje osnovne 32 Petric, Gams, Zlajpah frekvence demonstracijskega signala vključeno v sam sistem. Tako sistem ne potrebuje nobene dodatne obdelave signala in omogoča sprotno prilagajanje frekvenci zunanjega signala. Sistem deluje vzporedno v dveh nivojih. Prvi nivo določi frekvenco merjenega signala, drugi pa zagotavlja sledenje obliki trajektorije. Dvo-nivojski sistem posnemanja gibanja, ki smo ga uporabili za izvedbo periodične naloge vodenja naprave jojo, temelji na frekvenčno prilagodljivih oscilatorjih in nelinearnih dinamičnih sistemih [8] oz. DMPjih. V [8] so avtorji pokazali, da je sistem uporaben za določanje frekvenče vhodnega signala, učenje oblike ene periode vhodnega signala in posnemanje naučenega signala s poljubno frekvenčo in amplitudo. V tem prispevku bomo pokazali, da se lahko podobno strukturiran sistem uporabi za vodenje dinamičnih nelinearnih periodičnih nalog, kot je vodenje naprave jojo. Robotsko vodenje naprave jojo je ze bilo predmet več raziskav [1, 13, 14]. Razviti so bili namenski algoritmi vodenja s klasičnim pristopom na podlagi modeliranja sistemov. Nas raziskovalni izziv je namesto klasičnega pristopa z matematičnim modeliranjem uporabiti pristop, ki se zgleduje po človeku. Povprečni uporabniki te naprave o dinamiki ne vedo kaj dosti, kljub temu pa se večina kaj hitro nauči uporabljati napravo. Podobno velja tudi za predlagani imitačijski sistem, saj ta ne temelji na modelih vodene naprave, temveč je odvisen le od merljivega periodičnega signala. Takšna struktura vodenja bistveno poenostavi sinhronizačijo robota z zadano nalogo in omogoča preprosto doseganje človeku podobnih rezultatov pri izvajanju nalog, ki zahtevajo sinhro-nizačijo z vodeno napravo. V naslednjih poglavjih je najprej podan opis predlaganega sistema vodenja (2. poglavje). V 3. poglavju je opisan eksperimentalni sistem in dokumentirani so rezultati vodenja. Sklepi so podani v 4. poglavju. 2 Imitacijski sistem Imitačijski sistem je bil podrobno opisan za uporabo v čikličnih periodičnih nalogah v [8]. Avtorji so pokazali, da je sistem uporaben za določanje frekvenče vhodnega signala, učenje oblike ene periode in posnemanje naučenega signala pri poljubni frekvenči in amplitudi. V tem prispevku je predstavljena uporaba imitačijskega sistema za določanje frekvenče periodične naloge, sinhro-nizačije robota s spečifično nalogo in modulačijo pred-definirane trajektorije. Predlagana struktura vodenja omogoča vodenje različnih periodičnih nalog, ki imajo vsaj eno merljivo periodično veličino. Strukturo imitačijskega sistema sestavljata dva nivoja, kot to prikazuje slika 1. Prvi nivo predstavlja kanonični dinamičšni sistem (nabor diferenčialnih enačšb). Naloga na tem nivoju je izločšiti osnovno frekvenčo vhodnega signala, kije katerakoli merljiva periodična veličina. (Če se imitacijski sistem uporabi za učenje trajektorije, kot v [8], je zelena trajektorija enaka vhodnemu signalu. Drugi nivo sistema je izhodni dinamičšni sistem, katerega izhod je zelena trajektorija robota. Diferenčialne enačbe tega sistema so drugega reda, kar zagotavlja gladko in odvedljivo trajektorijo. Izhodni signal sestavimo z linearno kombi-načijo uteznih in jedrnih funkčij —. Kanonični i Izhodni dinamični < dinamični sistemJg <1 w r sistem Slika 1. Predlagana dvonivojska struktura sistema vodenja. Vhod v sistem je merjena periodična veličina yin, izhod je želena trajektorija robota yd.