Filtr wejściowy (Input shaping filter) do sterowania napędem z
Transkrypt
Filtr wejściowy (Input shaping filter) do sterowania napędem z
Eliminacja drgań w układach o słabym tłumieniu przy zastosowaniu filtru wejściowego (Input Shaping Filter) 1. WSTĘP W wielu złożonych układach mechanicznych elementy występują połączenia elastyczne (długi wał, sprężystość, lina, elastyczne ramię robota). Skutkuje to występowaniem, po zmianie wymuszenia (wartości wejściowej), słabo tłumionych drgań o częstotliwości zależnej od parametrów układu. Podobne zjawiska mogą występować też w układach elektronicznych z elementami biernymi (L, C). Celem ćwiczenia jest badanie metod ograniczania drgań wzbudzonych w układach o słabym tłumieniu przez modyfikację sygnału wejściowego. Jednym z możliwych rozwiązań jest filtr wejściowy (ZV - Zero Vibration Shaper) projektowany w dziedzinie czasu. Filtry takie są stosowane w wielu układach nie tylko mechanicznych jak: suwnice, roboty przemysłowe, napędy twardych dysków ale także w układach elektronicznych jak zasilacze rezonansowe. Są trzy podstawowe metody tłumienia drgań: tłumiki mechaniczne, aktywne tłumienie przez sprzężenie zwrotne oraz filtry w układzie otwartym. Tłumiki mechaniczne są trudne do projektowania, strojenia i są źródłem dodatkowych kosztów. Metody aktywne tłumienia drgań ze sprzężeniem zwrotnym pozwalają na osiągnięcie znakomitych rezultatów pomimo nieliniowości w układzie i niedokładności modelu. Główną niedogodnością aktywnego tłumienia jest konieczność zainstalowania czujników pomiarowych, złożone projektowanie regulatora i większy koszt obliczeniowy. Metody filtrowania w układzie otwartym mają stosunkowo prosty algorytm. Wartość zadana jest modyfikowana w taki sposób, że sygnał wartości zadanej podawany na wejście obiektu nie wzbudza w nim drgań o określonej częstotliwości i niepożądanych procesów przejściowych. Zaletą jest proste projektowanie i brak czujników (koniecznych w układzie zamkniętym). Głównym problemem jest ograniczona odporność na niedokładność modelu, wynikająca ze struktury układu (układ otwarty). 2. PROJEKTOWANIE FILTRU WEJSCIOWEGO Zasada działąnia filtru wejściowego Zasada eliminacji drań polega na wytworzeniu sygnału sterującego o takich właściwościach, że powoduje on eliminację drgań o określonej częstotliwości. Drgania wzbudzane przez pierwszą część sygnału sterującego są kompensowane przez drgania wzbudzane przez kolejną część sygnału sterującego. Filtr wejściowy umieszczony pomiędzy sygnałem sterującym a obiektem modyfikuje sygnał sterujący (rys.1). Rys. 1. Sposób umieszczenia filtru wejsciowego [wikipedia] Projektowanie filtru polega na wyznaczeniu ciągu impulsów, takich, że odpowiedź impulsowa obiektu na kolejny impuls eliminuje drgania powodowane przez poprzedni impuls. W rezultacie, przy dobrze zaprojektowanym filtrze, po wystąpieniu ostatniego impulsu drgania obiektu są zerowe. Zasadę pokazano na rysunku 2. Rys.2. Zasada eliminacji drgań. Odpowiedź impulsowa obiektu na impuls A1 (niebieska), na impuls A2 (czerwona) i ich sumę (czarna ze znacznikiem). [3] Filtr wejściowy o postaci n impulsów może być opisany w postaci funkcji: h(t ) IS (t ) i 1,...n Ai (t ti ), 0 ti ti 1 , Ai 0 (1) gdzie Ai oznacza amplitudę i-tego impulsu a jest funkcja Diraca z przesunięciem o czas ti. Ze wzoru wynika, że filtr wejściowy ma postać sumy ciągu opóźnionych sygnałów wejściowych z wagami Ai i opóźnieniami ti. Odpowiedź filtru (input shaper, IS) w dziedzinie czasu jest określona przez splot filtru (1) z dowolnym sygnałem wejściowym, (co pokazano na rysunku 3): v(t ) h(t ) f (t ) h( ) f (t )d A (t t ) f (t )d A f (t t ) i i i i (2) gdzie h(t) jest oznacza filtr, f(t) pierwotny sygnał wejściowy a v(t) sygnał zmodyfikowany. Jak wynika ze wzoru (2) filtr ma postać sumy opóźnionych o ti sygnałów wejściowych z odpowiednimi wagami Ai. Pierwotny sygnał wejściowy jest splatany z filtrem wejściowym i następnie podawany na wejście obiektu. Do sterowania obiektem używany jest ten nowy, odpowiednio ukształtowany sygnał wejściowy. Ciąg impulsów spleciony z pierwotnym, dowolnym, sygnałem sterującym obiektem skutkuje tym, że odpowiedź obiektu na to zmodyfikowane sterowanie też ma zerowe drgania (po wystąpieniu ostatniego impulsu, residual vibrations) (Rys.4). Amplitudy i położenie impulsów zależą od pulsacji drgań własnych i tłumienia obiektu. Filtr można zaprojektować tak aby był odporny na błędy parametrów obiektu. Rys.3. Modyfikowanie sygnału sterującego [2] Realizacja filtru wejściowego Jeżeli uwzględni się zależność: f (t ) ( Ai (t ti ) Ai f (t ti ) (3) to realizacja filtru może być oparta zarówno na operacji splotu jak i na operacji sumowania ciągu przeskalowanych i przesuniętych w czasie sygnałów wejściowych (rys.4). Rys.4. Realizacje filtru wejściowego przez operację splotu (po lewej) i zgodnie ze wzorem (3) (po prawej). [2] Projektowanie filtru IS polega na doborze wartości amplitud Ai i opóźnień ti, tak aby po ostatnim impulsie amplituda drgań resztowych była równa zero (Zero Vibration IS) lub miała ograniczoną wartość. Przykład filtru wejściowego Poniżej pokazano filtr wejściowy (ZV IS) dla układu drugiego rzędu o transmitancji: P( s) 2 s 2 2s 2 (4) o dopowiedzi impulsowej: y p (t ) 1 2 et sin(d t ) (5) i filtrze ZV złożonym z dwóch impulsów o postaci: IS (t ) A1 (t t1 ) A2 (t t2 ) (6) gdzie , d, oznaczają odpowiednio pulsację drgań nietłumionych, tłumionych i współczynnik tłumienia obiektu. Z warunku, że po wystąpieniu drugiego impulsu, czyli dla t>t2 amplituda drgań jest równa zero oraz przy dodatkowym założeniu, że suma amplitud impulsów jest równa 1: (7) A1 A2 1 Otrzymuje się następujące wyrażenia, określające parametry filtru ZV IS: 1 A1 , 1 K K A2 , K e 1 K t1 0, t2 , d 1 2 d 1 2 (8) Do poprawnego zaprojektowania filtru ZV muszą być więc znane (8): pulsacja drgań własnych i współczynnik tłumienia obiektu. Błąd w ocenie parametrów modelu skutkuje niezerowymi drganiami resztowymi. Jeżeli parametry modelu są znane niedokładnie lub są zmienne w pewnym zakresie, to należy zaprojektować inny filtr, odporny na zmiany parametrów. Odporny filtr jest projektowany przez dodanie dodatkowych warunków. Modyfikacja polega na uwzględnieniu np. dodatkowego warunku: V ( , ) 0 (9) gdzie V oznacza amplitudę drgań resztowych. Warunek ten oznacza, że funkcja V osiąga ekstremum dla wybranej pulsacji, czyli że w otoczeniu tej pulsacji amplituda drgań resztowych jest niewielka. Otrzymuje się IS złożony z trzech impulsów i nosi on nazwę ZVD (Zero Vibration Derivative). Filtr ten jest mniej wrażliwy na zmiany parametrów modelu, ale kosztem wydłużenia czasu odpowiedzi układu na wartość zadaną. Spotyka się także bardziej złożone filtry np.; ZVDD, czy filtry dla dwóch częstotliwości. W tabeli 1 pokazano parametry filtru ZV, ZVD oraz ZVDD dla obiektu drugiego rzędu. Tabela 1[2] Jeżeli na obiekt działają zakłócenia to filtr wejściowy nie tłumi drgań przez nie indukowanych. Stąd wniosek, że filtry wejściowe stosuje się do układów, gdzie poziom zakłóceń jest niewielki. W przypadku, gdy celem układu regulacji jest nie tylko wyeliminowanie drgań powodowanych przez zmianę wartości zadanej ale także ograniczenie wpływu zakłóceń, stosuje się zamknięty układ regulacji z filtrem wejściowym. Struktura taka pozwala na zastosowanie większych wzmocnień w regulatorach i szybszą kompensację zakłócenia a jednocześnie przeregulowanie w odpowiedzi na wartość zadaną jest mniejsze. 3. CEL I ZAKRES ĆWICZENIA Celem ćwiczenia jest 1. zaprojektowanie dla zadanego obiektu filtru wejściowego ZV, zbadanie jego działania i odporności na zmiany parametrów, 2. zaprojektowania filtru odpornego ZVD i ZVDD wraz z określeniem odporności na zmiany parametrów obiektu, 3. zaprojektowanie zamkniętego układu regulacji bez filtru wejściowego, zbadanie jego odpowiedzi na wartość zadaną i zakłócenie, 4. zaprojektowanie zamkniętego układu regulacji wraz z filtrem wejściowym 5. porównanie właściwości zbadanych układów. 4. OBIEKT BADAŃ Obiektem jest suwnica z podwieszonym ładunkiem, który przy zmianie pozycji wózka zachowuje się jak wahadło i kołysze się. Tłumienie kołysań zależy od oporów ruchu, ale przeważnie jest niewielkie. Schemat obiektu pokazano na rys.5. Celem zadania jest zaprojektowanie filtru wejściowego, który ograniczy kołysanie ładunku przy zmianie położenia zadanego. Schemat blokowy układu przedstawiony jest na rysunku 6. Rys.5. Schemat suwnicy z ładunkiem Rys.6. Schemat blokowy modelu obiektu [1] Model obiektu składa się z części elektrycznej, czyli serwonapędu z regulatorem położenia i prędkości wózka (część CRANE) oraz z części mechanicznej, czyli modelu ładunku na linie (część LOAD). Część elektryczna opisuje dynamikę ruchu wózka a część mechaniczna dynamikę ruchu ładunku (obciążenia). Dynamika ruchu ładunku opisana jest członem oscylacyjnym drugiego rzędu: gdzie , to pulsacja drgań nietłumionych i współczynnik tłumienia obiektu, Vc to prędkość wózka dźwigu a Vl to prędkość kątowa ładunku. Transmitancja opisuje zależność pomiędzy prędkością wózka a prędkością ładunku. Układ regulacji serwonapędu (Rys.7) składa się z trzech pętli o strukturze kaskadowej: prądu, prędkości i położenia. Pętla regulacji prądu może być zamodelowana jak obiekt inercyjny pierwszego rzędu a regulatory prędkości i położenia mają strukturę odpowiednio PI i P. W układzie przewidziano także generator trajektorii, czyli sprzężenia typu FF reprezentujące pożądaną trajektorię prędkości (sp_v) i przyspieszenia (sp_a). Sygnałem wejściowym do układu serwomechanizmu jest wartość zadana położenia wózka a sygnałem wyjściowym - siła napędowa wózka. Rys.7. Struktura układu regulacji serwonapędu [1] W odpowiedzi na zmianę wartości zadanej położenia wózka indukowane są wahania ładunku. Jeżeli w układzie zastosuje się filtr wejściowy, to wartość zadana dla serwomechanizmu jest filtrowana tak aby wyeliminować drgania o określonej częstotliwości i w rezultacie ruch wózka nie wzbudza drgań ładunku (albo je bardzo ogranicza). W badanym przypadku filtr jest projektowany dla układu drugiego rzędu opisującego dynamikę ruchu ładunku i właściwości filtrujące są zachowane po przejściu przez dynamikę serwonapędu. Założenie to jest prawdziwe gdy układ jest liniowy, czyli gdy żaden z regulatorów nie osiąga ograniczeń. W przeciwnym przypadku drgania nie są całkowicie eliminowane. 5. BIBLOGRAFIA [1]. Gobej M., Skarda R., Schlegel M., Input shaping filter for the control of electric al driver with flexible load, 17-th Int. Conf. on Process Control 2009, Slovakia, [2]. Arolovich I., Agranovich G., Control Improvement of under-damped systems and structures by input shaping, [3]. Singh T., Singhose W., Tutorial on input shaping/ time delay control of maneuvering flexible structures