Sterowanie przegubem obrotowym z wykorzystaniem sprzÄżenia
Sterowanie przegubem obrotowym z wykorzystaniem sprzÄżenia Sterowanie przegubem obrotowym z wykorzystaniem sprzÄżenia
40009003500800Odczyt z czujnika3000250020001500Odczyt z czujnika700600500400300100020050010000 5 10 15 20 25 30 35Przesuniecie [mm]00 20 40 60 80 100 120 140 160 180 200F l[N]Rysunek 46: Zależność wartości pomiarowej F l od przesunięciaczujnikaRysunek 47: Zależność wartości pomiarowej F l od siłydziałającej na efektor600500400F [N]30020010000 0.002 0.004 0.006 0.008 0.01 0.012 0.014 0.016 0.018 0.02X [m]Rysunek 48: Zależność siły działającej na sprężynę od przesunięcia sprężynyw jedn. , stąd: mk s = WS X · 10 3[ ]110 · 103 kg= = 25000(29)WS F 4.4s 2Współczynnik skalowania dla odczytu położenia można było wyznaczyć korzystając jedyniez danych technicznych kodera przyrostowo-impulsowego oraz przekładni. Jeden pełen obrótkodera odpowiada 4096 impulsom, skok śruby przekładni wynosi 0.0025m na obrót, zatem:WS Xm = 4096[ jedn.0.0025 = 1638400 mWspółczynnik skalowania dla odczytu prądu wynika z parametrów przetwornika A/Coraz układu elektronicznego. Zakres pomiarowy 12 bitowego przetwornika A/C wynosi 3.3V.](30)47
Wzmocnienie toru pomiarowego prądu zostało dobrane tak, by napięciu 0.5V odpowiadał prąd1A. Współczynnik skalujący pomiar prądu wynosi więc WS I = 0.5·4095 ≈ 620 jedn. . Współczynnikten, z punktu widzenia sterowania siłownikiem, nie jest zbytnio interesujący. O wiele3.3 Abardziej interesująca jest zależność siły F m od prądu zadanego I d . Prąd I d w rzeczywistymsiłowniku odpowiada sile F m w modelu siłownika. W celu zbadania tej zależności należałowykonać następujące czynności:1. Zablokować efektor siłownika.2. Rozewrzeć pętlę siłowego sprzężenia zwrotnego (rozkaz f i).3. Dobrać parametry regulatora prądu.4. Zadać wymuszenie I d .5. W stanie ustalonym zebrać pomiary z czujnika siły.350300250200Fm [N]1501005000 200 400 600 800 1000 1200Wartosc zadana praduRysunek 49: Zależność siły F m od wartości zadanej prądu I dO ile rozwarcie pętli siłowego sprzężenia zwrotnego nie było kłopotliwe, o tyle dobranie nastawregulatora prądu było zadaniem trudnym i czasochłonnym. Początkowo próbowano dobieraćnastawy na podstawie odpowiedzi silnika na skok przy rozwartej pętli regulacji prądu. Układokazał się jednak zbyt szybki w stosunku do częstotliwości zbierania pomiarów. Trudno było, napodstawie otrzymanych wyników, wyznaczyć odpowiednie stałe czasowe układu. Po zgrubnychprzybliżeniach z poprzedniej metody nastawy regulatora prądu zostały dobrane eksperymentalnie.Badano odpowiedź układu na różne wymuszenia, przy różnych warunkach obciążenia.Ostatecznie poszczególne wzmocnienia dla regulatora prądu ustalono na poziomie: K p ≈ 1.0253,K i ≈ 0.0354, K d ≈ 0.1585. Pomiarów należało dokonywać w stanie ustalonym ponieważ wtedy,przy zablokowanym efektorze, siła F m = F l . Wyniki pomiarów pokazane są na rysunku 49.Można zauważyć, że dla małych wartości prądu siła F m równa jest 0. Powyżej pewnej wartościcharakterystyka jest liniowa. To przesunięcie wynika z oporów tarcia silnika oraz przekładni, na48
- Page 1: Politechnika WrocławskaWydział El
- Page 4 and 5: Spis treści1 Wstęp 51.1 Cel i zak
- Page 6 and 7: 44 Widok stanowiska badawczego (1)
- Page 8 and 9: 1 WstępWiększość komercyjnych a
- Page 10 and 11: Znając działająca siłę, moment
- Page 12 and 13: 2.3 Model matematycznyRysunek 3 pok
- Page 14 and 15: Rysunek 4: Model części energetyc
- Page 16 and 17: Równanie swobodnie poruszającej s
- Page 18 and 19: 14. Czujnik siły.15. Podstawa.16.
- Page 20 and 21: Rysunek 15: Widok czujnika siłyRys
- Page 22 and 23: Widok silnika przedstawiony jest na
- Page 24 and 25: Rysunek 22: Płytka sterownika - st
- Page 26 and 27: cechuje się dużą szybkością dz
- Page 28 and 29: • układ czuwający COP (ang. Com
- Page 30 and 31: Złącze Z6 umożliwia połączenie
- Page 32 and 33: 14000 obr , dlatego częstotliwoś
- Page 34 and 35: 3.2.3 ZasilaczDo zasilania całośc
- Page 36 and 37: • narzędzie zarządzające budow
- Page 38 and 39: Rysunek 38: Diagram głównej pętl
- Page 40 and 41: o rozmiarze maksymalnie 250 punktó
- Page 42 and 43: ENMASKbit 15-11 10 9 8 7 - 6 5 4 3
- Page 44 and 45: • K p — wzmocnienie części pr
- Page 46 and 47: 5 Interfejs użytkownika - dostępn
- Page 48 and 49: 3. Naciśnij ENTER.4. Czekaj na nap
- Page 52 and 53: pokonanie których potrzebny jest p
- Page 54 and 55: nień wyliczonych tą metodą ukła
- Page 56 and 57: napędowy. Ze względu na to że ni
- Page 58 and 59: DodatekRysunek 60: Rysunek złożen
- Page 60 and 61: Rysunek 62: Tylnia ściana efektora
- Page 62 and 63: Rysunek 65: Przednia ściana siłow
- Page 64 and 65: Rysunek 69: Główna prowadnica si
Wzmocnienie toru pomiarowego prądu zostało dobrane tak, by napięciu 0.5V odpowiadał prąd1A. Współczynnik skalujący pomiar prądu wynosi więc WS I = 0.5·4095 ≈ 620 jedn. . Współczynnikten, z punktu widzenia sterowania siłownikiem, nie jest zbytnio interesujący. O wiele3.3 Abardziej interesująca jest zależność siły F m od prądu zadanego I d . Prąd I d w rzeczywistymsiłowniku odpowiada sile F m w modelu siłownika. W celu zbadania tej zależności należałowykonać następujące czynności:1. Zablokować efektor siłownika.2. Rozewrzeć pętlę siłowego sprzężenia zwrotnego (rozkaz f i).3. Dobrać parametry regulatora prądu.4. Zadać wymuszenie I d .5. W stanie ustalonym zebrać pomiary z czujnika siły.350300250200Fm [N]1501005000 200 400 600 800 1000 1200Wartosc zadana praduRysunek 49: Zależność siły F m od wartości zadanej prądu I dO ile rozwarcie pętli siłowego sprzężenia zwrotnego nie było kłopotliwe, o tyle dobranie nastawregulatora prądu było zadaniem trudnym i czasochłonnym. Początkowo próbowano dobieraćnastawy na podstawie odpowiedzi silnika na skok przy rozwartej pętli regulacji prądu. Układokazał się jednak zbyt szybki w stosunku do częstotliwości zbierania pomiarów. Trudno było, napodstawie otrzymanych wyników, wyznaczyć odpowiednie stałe czasowe układu. Po zgrubnychprzybliżeniach z poprzedniej metody nastawy regulatora prądu zostały dobrane eksperymentalnie.Badano odpowiedź układu na różne wymuszenia, przy różnych warunkach obciążenia.Ostatecznie poszczególne wzmocnienia dla regulatora prądu ustalono na poziomie: K p ≈ 1.0253,K i ≈ 0.0354, K d ≈ 0.1585. Pomiarów należało dokonywać w stanie ustalonym ponieważ wtedy,przy zablokowanym efektorze, siła F m = F l . Wyniki pomiarów pokazane są na rysunku 49.Można zauważyć, że dla małych wartości prądu siła F m równa jest 0. Powyżej pewnej wartościcharakterystyka jest liniowa. To przesunięcie wynika z oporów tarcia silnika oraz przekładni, na48