Professional Documents
Culture Documents
DMS Example 1
DMS Example 1
DMS Example 1
1, in
terms of θ 2 , the angular velocity of the crank shaft.
Solution:
There are 3 bodies in this system if the ground is ignored. The coordinates of the bodies are
T
for the crank shaft: q 2 = ⎡⎣ Rx2 Ry2 θ 2 ⎤⎦
T
for the connecting rod: q 3 = ⎡⎣ Rx3 Ry3 θ 3 ⎤⎦
T
for the slider: q 4 = ⎡⎣ Rx4 Ry4 θ 4 ⎤⎦
There are two simple ways to find the solution to this problem. One is using the methods of
multi-body dynamics, and the other is through simple geometric reasoning.
Due to the simplicity of this problem, simple geometric reasoning can produce the solution very
rapidly. Note from the diagram of the mechanism that the following relationships can be
deduced.
l2
Rx2 = cos θ 2 (EQAD)
2
l2
Ry2 = sin θ 2 (EQAE)
2
l3
R = l cos θ + cos θ 3
3
x
2 2
(EQAF)
2
These equations alone can be used to find all velocity relationships of this mechanism.
⎛ l 2 cos θ 2 sin θ 3 ⎞ 2
δ Rx4 = ⎜ −l 2 sin θ 2 + ⎟ δθ (EQAW)
⎝ cos θ 3 ⎠
l2
δ Rx2 = − sin θ 2δθ 2 (EQAI)
2
l2
δ Ry2 = cos θ 2δθ 2 (EQAJ)
2
⎛ l 2 cos θ 2 sin θ 3 ⎞ 2
δ Rx3 = ⎜ −l 2 sin θ 2 + ⎟ δθ
⎝ 2cos θ 3 ⎠
l2
δ Ry3 = cos θ 2δθ 2
2
⎡ l2 ⎤
⎢ − sin θ 2 ⎥
⎢ 2 ⎥
⎢ l2 ⎥
⎡δ Rx2 ⎤ ⎢ cos θ 2
⎥
2
⎢ 2⎥ ⎢ ⎥
⎢δ Ry ⎥ ⎢ 1 ⎥
⎢ δθ 2 ⎥ ⎢ l cos θ sin θ
2 2 3⎥
⎢ 3 ⎥ ⎢ −l 2 sin θ 2 + ⎥
⎢δ Rx ⎥ ⎢ 2 cos θ 3 ⎥
⎢δ R 3 ⎥ = ⎢ l 2 ⎥ δθ 2 (EQAV)
⎢ 3y ⎥ ⎢ cos θ 2
⎥
⎢ δθ ⎥ ⎢ 2 ⎥
⎢δ R 4 ⎥ ⎢ l cos θ
2 2 ⎥
⎢ x⎥ ⎢ − 3 ⎥
⎢δ Ry4 ⎥ ⎢ l cos θ 3 ⎥
⎢ 4⎥ ⎢ 2 l 2
cos θ 2
sin θ 3⎥
⎣ δθ ⎦ ⎢ −l sin θ 2 + ⎥
⎢ cos θ 3 ⎥
⎢ 0 ⎥
⎢ ⎥
⎣ 0 ⎦
On the other hand, the methods of multi-body dynamics can also be used to find the same
solution, though written in a different form. In this method, the Jacobian matrix of the constraint
equations is required. First, the constraint equations are presented.
R 2 + A 2uo2 = 0 (EQAK)
where
T
⎡cos θ 2 − sin θ 2 ⎤ ⎡ l2 ⎤
A =⎢
2
⎥ and u 2
o = ⎢− 0⎥
⎣ sin θ cos θ 2 ⎦
2
⎣ 2 ⎦
⎡ l2 ⎤
⎡ Rx2 ⎤ ⎡cos θ 2 − sin θ 2 ⎤ ⎢ − ⎥ ⎡0 ⎤
⎢ 2⎥ + ⎢ ⎥ 2⎥=⎢ ⎥
⎣⎢ Ry ⎦⎥ ⎣ sin θ
2
cos θ 2 ⎦ ⎢ ⎣0 ⎦
⎣⎢ 0 ⎦⎥
which is
l2
Rx2 − cos θ 2 = 0
2 (EQAL)
l2
Ry − sin θ 2 = 0
2
R 2 + A 2u 2A − R 3 − A 3u 3A = 0 (EQAM)
T T
⎡l2 ⎤ ⎡ l3 ⎤
where u = ⎢2
A 0 ⎥ and u 3A = ⎢ − 0⎥
⎣2 ⎦ ⎣ 2 ⎦
which is
l2 l3
Rx2 + cos θ 2 − Rx3 + cos θ 3 = 0
2 2 (EQAN)
2
l l3
Ry2 + sin θ 2 − Ry3 + sin θ 3 = 0
2 2
⎡l2 ⎤ ⎡ l3 ⎤
⎡ Rx2 ⎤ ⎡cos θ 2 − sin θ 2 ⎤ ⎢ ⎥ ⎡ Rx ⎤ ⎡cos θ 3
3
− sin θ 3 ⎤ ⎢ − ⎥ ⎡0 ⎤
⎢ 2⎥ + ⎢ ⎥ 2 − ⎢ 3⎥ − ⎢ ⎥ 2⎥=⎢ ⎥
⎢⎣ Ry ⎥⎦ ⎣ sin θ
2
cos θ 2 ⎦ ⎢ ⎥ ⎢⎣ Ry ⎥⎦ ⎣ sin θ 3 cos θ 3 ⎦ ⎢ 0
⎢⎣ 0 ⎥⎦ ⎢⎣ 0 ⎥⎦ ⎣ ⎦
The constraint equations for the revolute joint at Point B are
R 3 + A3u 3B − R 4 = 0 (EQAO)
⎡ l3 ⎤
⎡ Rx3 ⎤ ⎡cos θ 3 − sin θ 3 ⎤ ⎢ ⎥ ⎡ Rx ⎤ ⎡0 ⎤
4
⎢ 3⎥ + ⎢ ⎥ 2 − ⎢ 4⎥ = ⎢ ⎥
⎢⎣ Ry ⎥⎦ ⎣ sin θ
3
cos θ 3 ⎦ ⎢ ⎥ ⎢⎣ Ry ⎥⎦ ⎣0 ⎦
⎣⎢ 0 ⎦⎥
which is
l3
Rx3 + cos θ 3 − Rx4 = 0
2 (EQAP)
l3
Ry3 + sin θ 3 − Ry4 = 0
2
In order to build the Jacobian matrix of the constraints, the derivatives of the constraint equations
are required.
The virtual changes in the coordinates for the revolute joint at Point O are
l2
δ Rx2 + sin θ 2δθ 2 = 0
2 (EQAQ)
l2
δ Ry2 − cos θ 2δθ 2 = 0
2
⎡ l2 ⎤
sin θ 2 ⎥ ⎡δ Rx ⎤ ⎡0 ⎤
2
⎢ 1 0
⎢ ⎥
⎢ 2 ⎥ ⎢δ Ry2 ⎥ = ⎢0 ⎥
⎢ ⎢ ⎥
2⎥⎢
2
l 2⎥
⎢⎣ 0 1 − cos θ ⎥⎦ ⎣ δθ ⎦ ⎢⎣0 ⎥⎦
2
The virtual changes in the coordinates for the revolute joint at Point A are
l2 l3
δ R − sin θ δθ − δ Rx − sin θ 3δθ 3 = 0
2
x
2 2 3
2 2 (EQAR)
2
l l3
δ Ry2 + cos θ 2δθ 2 − δ Ry3 + cosθ 3δθ 3 = 0
2 2
The virtual changes in the coordinates for the revolute joint at Point B are
l3
δ Rx3 − sin θ 3δθ 3 − δ Rx4 = 0
2 (EQAS)
l3
δ Ry3 + cos θ 3δθ 3 − δ Ry4 = 0
2
⎡δ Rx2 ⎤
⎢ 2⎥
⎡ l3 ⎤ ⎢δ Ry ⎥ 0
⎢1 0 − 2 sin θ
3
−1 0 0 ⎥ ⎢ 2 ⎥ ⎡ ⎤
δθ
⎢ ⎥ ⎢ 3 ⎥ = ⎢0⎥
⎢ l3 ⎥ δR ⎢ ⎥
⎢⎣ 0 1 cos θ 3 0 −1 0 ⎥ ⎢ x3 ⎥ ⎢⎣0 ⎥⎦
2 ⎦ ⎢δ R y ⎥
⎢ 3⎥
⎣⎢ δθ ⎦⎥
The virtual changes in the coordinates for the prismatic joint for Body 4 are
⎡δ Ry4 ⎤ ⎡0 ⎤
⎢ 4⎥=⎢ ⎥ (EQAT)
⎣ δθ ⎦ ⎣0 ⎦
Cqδ q = 0
where
⎡δ Rx2 ⎤
⎢ 2⎥
⎢δ Ry ⎥
⎢ δθ 2 ⎥
⎢ 3⎥
⎢δ Rx ⎥
δ q = ⎢δ Ry3 ⎥
⎢ 3⎥
⎢ δθ ⎥
⎢δ R 4 ⎥
⎢ x⎥
⎢δ Ry4 ⎥
⎢ 4⎥
⎣ δθ ⎦
where
⎡1 0 0 0 0 0 0⎤
0 ⎡ l2 ⎤
⎢0 ⎥ ⎢ sin θ 2 ⎥
⎢ 1 0 0 0 0 0 0⎥ ⎢ 22 ⎥
⎢ l3 ⎥ ⎡ δ Rx
2
⎤ ⎢ l 2⎥
⎢1 0 −1 0 − sin θ 3 0 0 0⎥ ⎢ 2⎥ ⎢ − 2 cos θ ⎥
⎢ 2 ⎥ ⎢δ Ry ⎥ ⎢ 2 ⎥
⎢ l3 ⎥ ⎢δ Rx3 ⎥ ⎢ l 2⎥
⎢0 1 0 −1 cos θ 3 0 0 0⎥ ⎢ 3⎥
δ Ry ⎥ ⎢ − 2 sin θ ⎥
Cq d =⎢
2 ⎥ , δ qd = ⎢ , Cq i = ⎢ 2 ⎥,
⎢ l3 ⎥ ⎢ δθ 3 ⎥ ⎢ l cos θ 2 ⎥
⎢0 0 1 0 − sin θ 3 −1 0 0 ⎥ ⎢ 4⎥ ⎢ 2 ⎥
⎢ 2 ⎥ ⎢δ Rx ⎥ ⎢ ⎥
⎢ l 3
⎥ ⎢δ R 4 ⎥ ⎢ 0 ⎥
⎢0 0 0 1 cos θ 3 0 −1 0 ⎥ ⎢ y⎥ ⎢ ⎥
2 0
⎣⎢ δθ ⎦⎥
4
⎢ ⎥ ⎢ ⎥
⎢0 0 0 0 0 0 1 0⎥ ⎢ 0 ⎥
⎢0 0 0 0 0 0 0 1⎦ ⎥ ⎢ 0 ⎥
⎣ ⎣ ⎦
and δ qi = ⎡⎣δθ 2 ⎤⎦
Cqd is an invertible 8 × 8 matrix. It is just Cq with the third column removed. Cqi is just the
third column of Cq .
δ q d = −Cq−1 Cq δ qi
d i
which is the same relationship as found in Eq. (EQAV). This can be verified using symbolic
mathematical manipulation software such as Maple.