Sterowanie przegubem obrotowym z wykorzystaniem sprzężenia

Sterowanie przegubem obrotowym z wykorzystaniem sprzężenia Sterowanie przegubem obrotowym z wykorzystaniem sprzężenia

rab.ict.pwr.wroc.pl
from rab.ict.pwr.wroc.pl More from this publisher
12.07.2015 Views

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

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

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!