Przykładowy sprawdzian z kinematyki v 2 0
y
c
a
Sprawdzian z TMM zadania przykładowe
0
É3
Wyniki obliczeń należy wpisać do tabelki z dokładnością do trzech cyfr po przecinku. 3
b
1. Na rysunku przedstawiono schemat kinematyczny mechanizmu w położeniu jakie przyjął w chwili, gdy
2
prÄ™dkość kÄ…towa czÅ‚onu 1 wynosiÅ‚a É1. Policzyć prÄ™dkość kÄ…towÄ… czÅ‚onu 3 w rozpatrywanej chwili.
a
É1 1
Dane: a = 1 (m), b = 2 (m), c = 3 (m), É1 = 1 (rad/s). x
0
y
a
2. Na rysunku przedstawiono schemat kinematyczny mechanizmu. Człon 3 porusza się
1
Õ2
Õ1
b
wzdłuż prowadnicy równoległej do osi x globalnego układu odniesienia, parametr r
odmierza jego poÅ‚ożenie. Orientacja czÅ‚onu 1 jest okreÅ›lona przez kÄ…t Õ1. Należy
2
c
policzyć kÄ…t Õ1 w chwili, gdy r = 6 (cm). Do tabelki należy wpisać rozwiÄ…zanie
x
z przedziału (0, Ą/2).
3
r
Dane: a = c = 1 (cm), b = 6 (cm).
îÅ‚ -1 łł 0
x2 + y îÅ‚ łł
3. Dany jest układ równań: Ś(x, y) a"
ïÅ‚x3 2 y - 4śł = .
ïÅ‚0śł
-
ðÅ‚ ûÅ‚
ðÅ‚ ûÅ‚
Układ rozwiązywano metodą Newtona Raphsona, przyjmując przybliżenie startowe x0 = 2 oraz y0 = 1. Należy obliczyć wartość x1,
uzyskanÄ… po pierwszym kroku iteracji.
ImiÄ™ i nazwisko É3 (rad/s) Õ1 (rad) x1 ( )
Marek Wojtyra 0.375 1.240 1.500
RozwiÄ…zanie zadania 1
Wprowadzamy lokalne, związane z członami, układy odniesienia w sposób pokazany na rysunku b).
y y0 y
c
a
Ą3
c
0
É3
3
b
b
2
Ą2
d
a
a
Ą1
É1 1
x x0 x
0
a) b) c)
Aańcuch kinematyczny opisujemy za pomocą wieloboku wektorowego, pokazanego na rysunku c).
Wektory a, b, c i d są stałe w odpowiednich układach odniesienia:
0 c a + c
îÅ‚ łł îÅ‚ łł îÅ‚ łł îÅ‚ - a
łł
a(1) =
ïÅ‚aśł, b(2) = ïÅ‚bśł, c(3) = ïÅ‚ śł, d(0) = ïÅ‚a + bśł. (1)
0
ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
Pisząc równanie wieloboku wektorowego pamiętamy, aby wszystkie wektory dodawać w tym samym,
globalnym układzie odniesienia. Przeliczając wektor z lokalnego do globalnego układu odniesienia korzystamy
z odpowiedniej macierzy kosinusów kierunkowych. Otrzymujemy następujące równanie wieloboku
wektorowego:
R1a(1) + R2b(2) - R3c(3) - d(0) = 0 . (2)
Ze sposobu wprowadzenia lokalnych układów odniesienia wynika, że w rozpatrywanej chwili kąty opisujące
obroty członów względem podstawy mechanizmu są zerowe (należy jednak pamiętać, że są to wielkości
zmienne w czasie):
cosÕ1 - sinÕ1 1 0
îÅ‚ łł îÅ‚ łł
Õ1 = 0, R1 = =
ïÅ‚sinÕ cosÕ1 śł ïÅ‚0 1śł = I2×2, Õ2 = 0, R2 = I2×2, Õ3 = 0, R3 = I2×2. (3)
ðÅ‚ 1 ûÅ‚ ðÅ‚ ûÅ‚
Różniczkując równanie wieloboku wektorowego, pamiętamy, że jedynie macierze kosinusów kierunkowych
zależą od czasu, otrzymujemy zatem:
&ð &ð &ð
©R1a(1)Õ1 + ©R2b(2)Õ2 - ©R3c(3)Õ3 = 0 . (4)
&ð &ð
To samo równanie można zapisać inaczej, grupujÄ…c nieznane prÄ™dkoÅ›ci Õ2 i Õ3 po lewej stronie, a znanÄ…
&ð
prÄ™dkość Õ1 = É1 po prawej:
&ð
Õ2
îÅ‚ łł
&ð
[©R2b(2) - ©R3c(3)] ïÅ‚ śł = -©R1a(1)Õ1 . (5)
&ð
ðÅ‚Õ3 ûÅ‚
Jak wiadomo, macierz &! ma następującą postać:
0
îÅ‚ -1
łł
© =
ïÅ‚1 0 śł. (6)
ðÅ‚ ûÅ‚
PodstawiajÄ…c (1), (3) i (6) do (5), otrzymujemy:
&ð
îÅ‚- b 0 Õ2 aÉ1
łł îÅ‚ łł îÅ‚ łł
= . (7)
ïÅ‚ śł
&ð
c - (a + c)śł ïÅ‚Õ3 śł ïÅ‚ 0
ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
Pozostaje tylko podstawienie danych liczbowych i rozwiązanie układu równań liniowych (np. metodą
wyznaczników):
&ð
îÅ‚- 2 0 Õ2 1
łł îÅ‚ łł îÅ‚ łł - 3
&ð
= , É3 = Õ3 = = -0.375 (rad/s) . (8)
ïÅ‚
&ð
3 - 4śł ïÅ‚Õ3 śł ïÅ‚0śł 8
ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
Warto zauważyć, że przystępując do rozwiązywania zadania, lokalne układy odniesienia można związać
z członami na wiele różnych sposobów. Schemat postępowania nie ulegnie zmianie, mogą się jednak zmienić
szczegóły obliczeń. Dla rozwiania wątpliwości, wprowadzmy lokalne układy odniesienia nieco inaczej
i przepiszmy wzory w odpowiednio zmienionej formie.
y0
Ą3
Ą2
Ą1
x0
d)
Dla lokalnych układów odniesienia wprowadzonych tak, jak na rysunku d) zmianie ulegają tylko wzory (1)
i (3), pozostałe równania pozostają natomiast bez zmian:
îÅ‚
a a + c
îÅ‚ łł îÅ‚ łł îÅ‚ łł îÅ‚ - a
łł
b2 + c2 łł f
a(1) =
ïÅ‚0śł, b(2) = ïÅ‚ 0 śł = ïÅ‚0 śł, c(3) = ïÅ‚ śł, d(0) = ïÅ‚a + bśł. (1a)
0
ðÅ‚ ûÅ‚ ïÅ‚ śł ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
ðÅ‚ ûÅ‚
0
îÅ‚ -1 c / f 1 0
łł îÅ‚ - b / f
łł îÅ‚ łł
Õ1 = Ä„ / 2, R1 =
ïÅ‚1 0 śł, Õ2 = atan2(b,c), R2 = ïÅ‚b / f c / f śł, Õ3 = 0, R3 = ïÅ‚0 1śł. (3a)
ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
RozwiÄ…zanie zadania 2
Wprowadzamy lokalne, związane z członami, układy odniesienia w sposób pokazany na rysunku a).
y
y
a
a
1
Õ2
Õ1
b
b
2
c
c
x
x
rw
3
r
a) b)
Aańcuch kinematyczny opisujemy za pomocą wieloboku wektorowego, pokazanego na rysunku b).
Wektory a, b, c i w są stałe w odpowiednich układach odniesienia:
a b 0 1
îÅ‚ łł îÅ‚ łł îÅ‚ łł îÅ‚ łł
a(1) =
ïÅ‚0śł, b(2) = ïÅ‚0śł, c(0) = ïÅ‚cśł, w(0) = ïÅ‚0śł. (1)
ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
Pisząc równanie wieloboku wektorowego pamiętamy, aby wszystkie wektory dodawać w tym samym,
globalnym układzie odniesienia. Przeliczając wektor z lokalnego do globalnego układu odniesienia korzystamy
z odpowiedniej macierzy kosinusów kierunkowych. Otrzymujemy następujące równanie wieloboku
wektorowego:
c(0) + R1a(1) + R2b(2) - rw(0) = 0 , (2)
gdzie:
cosÕ1 - sinÕ1 cosÕ2 - sinÕ2
îÅ‚ łł îÅ‚ łł
R1 =
ïÅ‚sinÕ cosÕ1 śł, R2 = ïÅ‚sinÕ cosÕ2 śł. (3)
ðÅ‚ 1 ûÅ‚ ðÅ‚ 2 ûÅ‚
W zadaniu dana jest wartość przemieszczenia r, poszukiwane sÄ… natomiast kÄ…ty Õ1 i Õ2, zależność (2) możemy
zatem potraktować jako układ dwóch równań z dwiema niewiadomymi. W przypadku bardziej złożonych
zależności rozwiązania układu (2) poszukiwalibyśmy zapewne metodami numerycznymi, tym razem jednak
znajdziemy analityczne rozwiązanie układu nieliniowych równań algebraicznych (2). Podstawiając (1) i (3) do
(2), otrzymujemy:
0 cosÕ1 - sinÕ1 a cosÕ2 - sinÕ2 b r 0
îÅ‚ łł îÅ‚ łł îÅ‚ łł îÅ‚ łł îÅ‚ łł îÅ‚ łł îÅ‚ łł
+ + - = , (4)
ïÅ‚cśł ïÅ‚sinÕ cosÕ1 śł ïÅ‚0śł ïÅ‚sinÕ cosÕ2 śł ïÅ‚0śł ïÅ‚0śł ïÅ‚0śł
ðÅ‚ ûÅ‚ ðÅ‚ 1 ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ 2 ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
A po wykonaniu mnożenia macierzy i wektorów oraz uporządkowaniu:
b cosÕ2 = r - a cosÕ1
ńł
òÅ‚bsinÕ = -(c + a sinÕ1) . (5)
ół 2
Sumując stronami powyższe równania podniesione do kwadratu, otrzymujemy:
b2 cos2 Õ2 + b2 sin2 Õ2 = r2 - 2ra cosÕ1 + a2 cos2 Õ1 + c2 + 2casinÕ1 + a2 sin2 Õ1 . (6)
Wykorzystując tzw. jedynkę trygonometryczną i porządkując wzór (6), otrzymujemy:
2a(r cosÕ1 - csinÕ1)= r2 + a2 + c2 - b2 . (7)
Przyjmując, że pewna zmienna pomocnicza ł jest zdefiniowana jako ł = atan2(c, r), możemy napisać:
r c
c
Å‚
cosł = , sin ł = . (8)
r
r2 + c2 r2 + c2
Wykorzystując powyższe podstawienia, a następnie wzór na kosinus sumy kątów
( cos(Ä… + ² ) = cosÄ… cos ² - sinÄ… sin ² ), równanie (7) możemy przeksztaÅ‚cić do postaci:
r2 + a2 + c2 - b2
cos(Õ1 + Å‚ )= . (9)
2a r2 + c2
Z równania (9) możemy wyznaczyć poszukiwany kÄ…t Õ1:
r2 + a2 + c2 - b2
Õ1 = Ä… arccos - atan2(c, r) . (10)
2a r2 + c2
W obliczeniach według wzoru (10) należy przyjąć znak +, aby uzyskać rozwiązanie z przedziału (0, Ą/2):
Õ1 H"1.2405 (rad)
RozwiÄ…zanie zadania 3
Niewiadome x i y zapisujemy w postaci wektora:
x
îÅ‚ łł
q = . (1)
ïÅ‚
yśł
ðÅ‚ ûÅ‚
Układ równań można przepisać w postaci:
2
îÅ‚ x2 + y -1 łł
îÅ‚ q1 + q2 -1 łł 0
îÅ‚ łł
Åš(q)a" . (2)
ïÅ‚x3 2 y - 4śł =
ïÅ‚q3 2q2 - 4śł =
ïÅ‚0śł
-
-
ðÅ‚ ûÅ‚
ðÅ‚ 1 ûÅ‚
ðÅ‚ ûÅ‚
Macierz Jacobiego obliczamy, różniczkując Ś(q) względem wektora q:
2x 1
îÅ‚ łł îÅ‚ łł
2q1 1
Åšq(q)a" a" . (3)
ïÅ‚3x2
- 2śł ïÅ‚3q2 - 2śł
ðÅ‚ ûÅ‚ ðÅ‚ 1 ûÅ‚
Zgodnie z treścią zadania przybliżenie startowe wynosi:
x0 2
îÅ‚ łł îÅ‚ łł
q0 = = . (4)
ïÅ‚ śł ïÅ‚1śł
y0
ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
Funkcja wektorowa Ś, dana równaniem (2) ma w punkcie q0 wartość:
îÅ‚ 22 +1-1 4
łł
îÅ‚ łł
Åš(q0)=
ïÅ‚23 2 Å"1- 4śł = ïÅ‚2śł . (5)
-
ðÅ‚ ûÅ‚
ðÅ‚ ûÅ‚
Macierz Jacobiego, dana równaniem (3) ma w punkcie q0 wartość:
2 Å" 2 1
îÅ‚ łł 4 1
îÅ‚ łł
Åšq(q0)=
ïÅ‚3Å" 22 - 2śł =
ïÅ‚12 - 2śł . (6)
ðÅ‚ ûÅ‚
ðÅ‚ ûÅ‚
Przyrost obliczany w pierwszym kroku iteracji N-R oznaczamy przez "q:
"x x1
łł
îÅ‚ łł îÅ‚ - x0
"q = = . (7)
ïÅ‚"yśł ïÅ‚ śł
y1 - y0
ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚
Wartość przyrostu "q oblicza się rozwiązując następujący układ równań liniowych:
Åšq(q0)"q = -Åš(q0). (8)
PodstawiajÄ…c (5), (6) i (7) do (8), otrzymujemy:
4 1 "x 4
îÅ‚ łł îÅ‚ łł îÅ‚- łł
= . (9)
ïÅ‚12 - 2śł ïÅ‚"yśł ïÅ‚
ðÅ‚ ûÅ‚ ðÅ‚ ûÅ‚ ðÅ‚- 2śł
ûÅ‚
Rozwiązując powyższy układ równań, znajdujemy:
-1
"x = . (10)
2
Ostatecznie zatem, korzystając z zależności (7), obliczamy:
1 3
x1 = x0 + "x = 2 - = = 1.5 . (11)
2 2
Wyszukiwarka