POLITECHNIKA GDAŃSKA KRZYSZTOF LIPIŃSKI UKŁADY WIELOCZŁONOWE Z WIĘZAMI JEDNOSTRONNYMI W ZASTOSOWANIU DO MODELOWANIA ZŁOŻONYCH UKŁADÓW MECHANICZNYCH GDAŃSK 2012
PRZEWODNICZĄCY KOMITETU REDAKCYJNEGO WYDAWNICTWA POLITECHNIKI GDAŃSKIEJ Romuald Szymkiewicz REDAKTOR PUBLIKACJI NAUKOWYCH Janusz T. Cieśliński REDAKTOR SERII Marek Szkodo RECENZENCI Wojciech Blajer Stanisław Wojciech PROJEKT OKŁADKI Jolanta Cieślawska Wydano za zgodą Rektora Politechniki Gdańskiej Oferta wydawnicza Politechniki Gdańskiej jest dostępna pod adresem www.pg.gda.pl/wydawnictwo/oferta Copyright by Wydawnictwo Politechniki Gdańskiej, Gdańsk 2012 Utwór nie może być powielany i rozpowszechniany, w jakiejkolwiek formie i w jakikolwiek sposób, bez pisemnej zgody wydawcy ISBN 978-83-7348-420-7 WYDAWNICTWO POLITECHNIKI GDAŃSKIEJ Wydanie I. Ark. wyd. 21,0, ark. druku 23,0, 123/639 Druk i oprawa: EXPOL P. Rybiński, J. Dąbek, Sp. Jawna ul. Brzeska 4, 87-800 Włocławek, tel. 54 232 37 23
SPIS TREŚCI WYKAZ WAŻNIEJSZYCH OZNACZEŃ... 7 1. WPROWADZENIE... 17 1.1. Sformułowanie problemu... 17 1.2. Cel pracy... 19 1.3. Zakres i układ pracy... 21 2. WSPÓŁRZĘDNE STOSOWANE W ANALIZIE UKŁADÓW WIELOCZŁONOWYCH... 23 2.1. Współrzędne niezależne... 24 2.2. Współrzędne absolutne... 25 2.2.1. Kąty Eulera... 26 2.2.2. Kąty Cardana (Cardano/Bryanta/Tait-Bryana/Tait-Bryanta)... 27 2.2.3. Kąty Eulera, kąty Cardana osie pasywne... 28 2.2.4. Parametry Eulera... 28 2.2.5. Parametry Eulera-Rodriguesa... 30 2.2.6. Niezależne elementy macierzy opisującej orientację członu... 31 2.2.7. Elementy skośno-symetrycznej macierzy Cayleya... 31 2.2.8. Alternatywne reprezentacje czteroparametrowe... 31 2.2.9. Reprezentacje sześcioparametrowe... 31 2.3. Współrzędne naturalne... 32 2.4. Współrzędne złączowe... 34 2.5. Współrzędne podukładów... 36 2.6. Współrzędne mieszane... 36 2.7. Stosowanie różnych rodzajów współrzędnych w zależności od etapu obliczeń... 37 3. STOSOWANE OZNACZENIA WERSORY, WEKTORY, TENSORY, TABLICE WEK- TORÓW... 38 3.1. Macierze, wektory, tablice wektorów... 38 3.2. Układy współrzędnych, wersory, wektory, tensory... 39 3.3. Macierze orientacji układów współrzędnych... 41 3.4. Współrzędne opisujące orientacje a macierze orientacji... 43 3.4.1. Obrót względem zadanej osi... 43 3.4.2. Obroty względem osi układu współrzędnych... 44 3.4.3. Kąty Eulera... 45 3.4.4. Kąty Cardana... 45 3.4.5. Kąty Eulera ujęcie pasywne... 45 3.4.6. Kąty Cardana ujęcie pasywne... 46 3.4.7. Znormalizowane parametry Eulera... 46 3.4.8. Parametry Eulera-Rodriguesa... 47 3.4.9. Niezależne elementy macierzy orientacji... 48 3.4.10. Elementy skośno-symetrycznej macierzy Cayleya... 49 3.4.11. Reprezentacje sześcioparametrowe... 49 3.4.12. Małe kąty obrotu... 49 3.5. Wyznaczanie pochodnych... 50 3.5.1. Macierze i ich pochodne względem czasu... 50 3.5.2. Macierze orientacji i ich pochodne względem czasu... 50 3.5.3. Sekwencja obrotów i ich pochodna względem czasu... 52 3.5.4. Prędkość kątowa a pochodne niezależnych elementów macierzy orientacji... 53 3.5.5. Obrót względem nieruchomej osi... 54
4 Spis treści 3.5.6. Obroty względem osi układu współrzędnych... 55 3.5.7. Zależności wiążące prędkość kątową i pochodne kątów Eulera... 56 3.5.8. Zależności wiążące prędkość kątową i pochodne kątów Cardana... 57 3.5.9. Zależności wiążące prędkość kątową i pochodne parametrów Eulera... 58 3.5.10. Zależności wiążące prędkość kątową i pochodne parametrów Eulera-Rodriguesa... 60 3.5.11. Prędkości i pochodne względne... 60 3.5.12. Macierze i ich pochodne względem zmiennej... 63 3.5.13. Pochodne cząstkowe funkcji skalarnych, wektorów i tablic wektorów... 64 3.5.14. Pochodna zupełna funkcji skalarnej, wektora i tablicy wektorów... 65 3.5.15. Macierze i ich pochodne zupełne... 65 4. SKŁADNIKI ELEMENTARNE I TOPOLOGIA UKŁADU WIELOCZŁONOWEGO... 66 4.1. Macierze teorii grafów... 68 4.1.1. Najważniejsze definicje... 68 4.1.2. Macierze opisujące grafy... 71 4.2. Dedykowany sposób numerowania członów... 72 4.3. Informacja kodowana w równaniach więzów... 76 5. KINEMATYKA UKŁADU WIELOCZŁONOWEGO... 77 5.1. Położenia, prędkości i przyśpieszenia punktów układu opisanego współrzędnymi absolutnymi... 77 5.1.1. Układ, w którym orientację opisano kątami Eulera lub kątami Cardana... 79 5.1.2. Układ, w którym orientację opisano parametrami Eulera... 80 5.2. Położenia, prędkości i przyśpieszenia punktów układu opisanego współrzędnymi naturalnymi... 81 5.2.1. Człon opisany przez współrzędne dwóch punktów i dwóch wektorów nieleżących w jednej płaszczyźnie... 82 5.2.2. Człon opisany przez współrzędne trzech punktów i jednego wektora nieleżącego w płaszczyźnie wyznaczonej przez punkty... 83 5.2.3. Człon opisany przez współrzędne dwóch punktów i jednego wektora nieleżącego na linii wyznaczonej przez punkty... 84 5.3. Położenia, prędkości i przyśpieszenia punktów układu opisanego współrzędnymi złączowymi... 85 5.3.1. Metoda korzystająca z macierzy ścieżek i macierzy sąsiedztwa... 85 5.3.2. Transformacje jednorodne... 90 5.3.3. Transformacje jednorodne we współrzędnych Denavita-Hartenberga... 92 5.3.4. Sumowanie parametrów łańcucha odniesienia... 95 5.4. Układ opisany współrzędnymi dla położenia i prędkości... 107 5.5. Równania więzów... 108 5.5.1. Jawna (rozwikłana) postać równań więzów (metoda podziału współrzędnych)... 110 5.5.2. Podprzestrzeń styczna do równań więzów (macierz uzupełnienia ortogonalnego)... 113 5.5.3. Równania więzów dla wybranych typów więzów dwustronnych... 115 5.5.4. Równania więzów opisujące styk członów... 130 6. DYNAMIKA UKŁADU WIELOCZŁONOWEGO... 156 6.1. Dynamika członu swobodnego... 157 6.1.1. Wykorzystanie parametrów Eulera... 160 6.1.2. Wykorzystanie współrzędnych naturalnych... 163 6.2. Dynamika układu członów swobodnych... 167 6.3. Dynamika układu członów z więzami... 167 6.3.1. Równania ruchu we współrzędnych zależnych... 170 6.3.2. Równania ruchu we współrzędnych zależnych, wykorzystanie macierzy dopełnienia ortogonalnego... 171 6.3.3. Stabilizacja więzów... 172 6.3.4. Metoda eliminacji redukcja do równań we współrzędnych niezależnych... 175
Spis treści 5 6.4. Dynamika układu wieloczłonowego o strukturze drzewa... 203 6.4.1. Analiza rekurencyjna z eliminacją oddziaływań bezpośrednich następców... 203 6.4.2. Kinetostatyka górnej części łańcucha kinematycznego... 212 6.4.3. Wykorzystanie tablic wektorów... 213 6.4.4. Współrzędne wektorów występujących w równaniach dynamiki... 215 6.4.5. Metoda korzystająca z macierzy ścieżek i macierzy sąsiedztwa... 217 6.4.6. Pozostałe, najważniejsze metody wyznaczania równań dynamiki... 218 7. WIĘZY JEDNOSTRONNE MODELOWANIE UDERZEŃ O PRZESZKODĘ... 222 7.1. Zderzenia z powierzchniami idealnie gładkimi... 229 7.1.1. Impulsy fazy kompresji sformułowanie we współrzędnych niezależnych... 229 7.1.2. Impulsy fazy ekspansji sformułowanie we współrzędnych niezależnych... 231 7.1.3. Impulsy fazy kompresji sformułowanie ze współrzędnymi zależnymi (układ z więzami domykającymi)... 231 7.2. Układ z tarciem zderzenie zakończone stykiem bez poślizgu... 233 7.3. Kontrola realizowalności wymaganego impulsu stycznego... 234 7.3.1. Zderzenia w układach płaskich... 235 7.3.2. Zderzenia w układach przestrzennych... 242 8. NAPĘDY NADMIAROWE... 248 8.1. Relacje wiążące kinematykę elementu wykonawczego i kinematykę węzłów... 249 8.2. Wielkości napędowe siły i pary sił generowane w napędach... 250 8.2.1. Pseudoodwrotność... 253 8.2.2. Selekcja najmniejszego zbioru wielkości napędowych... 253 8.2.3. Warunki nakładane na mnożniki Lagrange a... 254 8.2.4. Warunki nakładane na wielkości napędowe i relacje między nimi... 254 8.2.5. Równoczesne nakładanie warunków na mnożniki Lagrange a oraz relacje między wielkościami napędowymi... 255 8.3. Rozwiązania dedykowane maszynom kroczącym... 257 8.3.1. Napędy symetryczne... 259 8.3.2. Napędy symetryczno-antysymetryczne... 260 9. PRZYKŁADY... 261 9.1. Macierz mas i wektor sił dla przykładowego, otwartego łańcucha kinematycznego... 261 9.2. Równania więzów płaskiego czworoboku przegubowego... 264 9.3. Przestrzenny układ wieloczłonowy o dwóch stopniach swobody... 266 9.4. Sferyczny czworobok przegubowy... 272 9.5. Drgania wyrównoważonego płaskiego czworoboku przegubowego... 278 9.6. Kontakt z nieruchomą krzywką... 284 9.7. Przegub występujący pomiędzy układem wieloczłonowym i belką odkształcalną... 290 9.8. Układ wieloczłonowy ślizgający się po belce odkształcalnej... 296 9.9. Wieloczłonowy model pojazdu dwukołowego... 299 9.10. Wieloczłonowy model pojazdu szynowego... 302 9.11. Równania nieliniowe względem mnożników Lagrange a wybór współrzędnych zależnych oraz równań służących do wyznaczenia mnożników Lagrange a... 310 9.12. Uderzenie o przeszkodę płaski otwarty łańcuch kinematyczny... 313 9.13. Uderzenie o przeszkodę płaski zamknięty łańcuch kinematyczny... 316 9.14. Wózek dwukołowy uderzający kołami o grunt... 319 9.15. Układ przestrzenny odnóże uderzające o grunt... 324 9.16. Napęd nadmiarowy dla płaskiego manipulatora równoległego... 331 9.17. Napęd nadmiarowy dla siedmioczłonowej, płaskiej maszyny kroczącej... 335 9.18. Napęd nadmiarowy dla pięcioczłonowej, płaskiej maszyny kroczącej... 341 10. PODSUMOWANIE... 347 BIBLIOGRAFIA... 352
6 Spis treści Streszczenie w języku polskim... 364 Streszczenie w języku angielskim... 365