Математическое обеспечение промышленных роботов
.pdf
МИНИСТЕРСТВО ОБРАЗОВАНИЯ РЕСПУБЛИКИ БЕЛАРУСЬ
Белорусский национальный технический университет
Кафедра «Робототехнические системы»
МАТЕМАТИЧЕСКОЕ ОБЕСПЕЧЕНИЕ ПРОМЫШЛЕННЫХ РОБОТОВ
Учебно-методическое пособие
М и н с к Б Н Т У
2 0 1 5
МИНИСТЕРСТВО ОБРАЗОВАНИЯ РЕСПУБЛИКИ БЕЛАРУСЬ Белорусский национальный технический университет
Кафедра «Робототехнические системы»
МАТЕМАТИЧЕСКОЕ ОБЕСПЕЧЕНИЕ ПРОМЫШЛЕННЫХ РОБОТОВ
Учебно-методическое пособие к лекциям для студентов специальности
1-53 01 06 «Промышленные роботы и робототехнические комплексы»
Минск
БНТУ
2015
1
УДК 007.52:51(076.5) ББК 32.816я7
М34
Авторы:
А. Р. Околов, А. В. Дрозд, Ю. Н. Матрунчик, О. B. Лицкевич
Рецензенты:
С. Н. Павлович, В. С. Юденков
Математическое обеспечение промышленных роботов : учебноМ34 методическое пособие к лекциям для студентов специальности 1-53 01 06 «Промышленные роботы и робототехнические комплексы» /
А. Р. Околов [и др.]. – Минск : БНТУ, 2015. – 55 с. ISBN 978-985-550-561-8.
Данное учебно-методическое пособие направленно на более качественное и эффективное изложение лекционного материала курса «Математическое обеспечение промышленных роботов», так как позволяет освободить лектора и обучаемых от необходимости механического переписывания объемных и сложных формул и матриц и дает возможность сосредоточить основное внимание студентов на понимании
иусвоении основных вопросов, связанных с математическим описанием динамики
икинематики промышленного робота, планированием и моделированием траектории его движения.
Учебно-методическое пособие может быть полезно студентам, инженерам и препо-
давателям, занимающихся проектирование и эксплуатацией промышленных роботов.
УДК 007.52:51(076.5) ББК 32.816я7
ISBN 978-985-550-561-8 |
© Белорусский национальный |
|
технический университет, 2015 |
2
ЛЕКЦИЯ 1
Кинематика манипулятора Основные задачи кинематики манипулятора
Рис. 1.1. Схема взаимосвязи прямой и обратной задач кинематики
Прямая задача кинематики Матрицы поворота (вращения)
Рис. 1.2. Абсолютная и связанная системы координат
3
puvw = (pu, pv, pw)T и pxyz = (px, py, pz)T,
где Т – операция транспонирования.
pxyz = Rpuvw.
puvw = puiu + pvjv + pwkw,
px = ixp = ixiupu + ixjvpv + ixkwpw, py = jyp = iyiupu + jyjvpv + jykwpw, pz = kzp = kziupu + kzjvpv + kzkwpw.
Или в матричной форме
p |
|
i i |
|
|
x |
x u |
|
py |
jyiu |
||
p |
|
k i |
|
|
z |
z u |
|
ix jv jy jv
kz jv
i k |
|
|
|
p |
|
||
x w |
|
|
u |
|
|||
j |
y |
k |
|
p |
|
||
|
|
w |
|
v |
|
||
k |
|
k |
|
|
p |
|
|
z |
|
|
w |
||||
|
|
w |
|
|
|
||
(1.1)
(1.2)
(1.3)
(1.4)
(1.5)
С учетом этого выражения матрица R в равенстве (1.2) примет вид
i |
i |
i |
|
j |
x u |
x |
v |
||
R jyiu |
jy jv |
|||
k |
i |
k |
z |
j |
|
z u |
|
v |
|
ixkw
jykw . (1.6) kz kw
Аналогично координаты puvw можно получить из координат pxyz:
или |
|
|
puvw = Qpxyz, |
|
|
|
|
|
|
|
|
(1.7) |
|||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
p |
|
iuix |
iuiy |
iu kz |
|
|
p |
|
|
|
|||||
u |
|
|
|
j i |
|
j |
k |
|
|
|
|
x |
. |
(1.8) |
|
p |
j i |
|
z |
|
p |
|
|||||||||
v |
|
|
x |
y |
|
|
|
|
|
|
y |
|
|||
p |
|
k i |
k j |
|
k |
k |
|
|
|
p |
|
|
|
||
w |
|
y |
z |
|
|
|
|
|
|||||||
|
|
w x |
w |
w |
|
|
z |
|
|||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
4
Поскольку операция скалярного произведения коммутативна, то из соотношений (1.6), (1.7) и (1.8) следует
Q = R–1 = RT; |
(1.9) |
QR = RTR = R–1R = I3, |
(1.10) |
где I3 – единичная матрица размерностью 3 3. |
|
pxyz = Rx, puvw, |
(1.11) |
Причем ix iu, и |
|
|
i i |
i |
j |
|
x u |
x |
v |
Rx, |
jyiu |
jy jv |
|
|
k i |
k |
j |
|
z u |
z |
v |
i k |
|
1 |
0 |
0 |
|
|
||
x |
w |
|
0 |
|
sin |
|
|
|
j |
y |
k |
cos |
, |
(1.12) |
|||
|
w |
|
|
|
|
|
||
k |
k |
|
|
sin |
|
|
|
|
|
0 |
cos |
|
|
||||
|
z |
w |
|
|
|
|
|
|
|
cos |
0 |
sin |
|
|
cos |
sin |
0 |
|
|||
R |
|
0 |
1 |
0 |
|
, |
R |
sin |
cos |
0 |
. (1.13) |
|
y, |
|
|
|
|
|
|
z, |
|
|
|
|
|
|
|
sin |
0 |
|
|
|
|
|
0 |
0 |
|
|
|
|
cos |
|
|
|
1 |
|
|||||
Матрицы Rx, , Ry, и Rz, называют матрицами элементарных поворотов.
5
|
|
Рис. 1.3. Вращающаяся система координат |
|
|
|
|
||||||
|
|
Матрицы сложных поворотов |
|
|
|
|
||||||
|
|
C |
0 |
S |
C |
S |
0 |
1 0 |
|
0 |
|
|
R = Ry, Rz, Rx, = |
|
1 |
|
|
C |
|
|
C |
|
|
= |
|
0 |
0 |
S |
0 |
0 |
|
S |
||||||
|
|
|
0 |
|
|
0 |
|
|
S |
|
|
|
|
|
S |
C |
0 |
1 |
0 |
|
C |
|
|||
C C |
S S C S C |
C S S S C |
|
|
|
|||||||
|
S |
|
C C |
|
|
C S |
|
, |
(1.14) |
|||
= |
|
|
|
|
||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
S C C C C C C |
C C S S S |
|
|
|
||||||||
6
где С = cos ; S = sin ; C = cos ; S = sin ; C = cos ; S = sin .
|
1 0 |
0 |
|
C |
S |
0 |
C 0 |
S |
|
|||
|
|
C |
S |
|
|
C |
|
|
0 1 |
0 |
|
= |
R = Rx, Rz, Ry, = 0 |
|
S |
0 |
|
|
|||||||
|
|
S |
|
|
|
0 |
|
|
|
|
|
|
|
0 |
C |
0 |
1 |
S 0 |
C |
|
|||||
|
C C |
|
S |
|
C S |
|
|
|
|
|||
|
|
|
|
C C |
|
|
|
|
|
(1.15) |
||
= C S C S S |
C S S S C . |
|
||||||||||
|
|
|
|
S C |
|
|
|
|
|
|
|
|
S S C C S |
S S S C C |
|
|
|
||||||||
Пример. Требуется найти матрицу поворота, являющегося результатом последовательного выполнения поворотов сначала на угол , вокруг оси OY, затем на угол вокруг оси OW на угол вокруг оси OU.
Решение:
R = Ry, I3Rw, Ru, = Ry, I3Rw, Ru, =
C 0 |
S |
C |
S |
0 |
1 |
0 |
|
0 |
|
|
|
0 1 |
|
|
C |
|
|
C |
|
|
= |
= |
0 |
S |
0 |
0 |
S |
|||||
|
|
|
|
0 |
|
|
S |
|
|
|
S 0 |
C |
0 |
1 |
0 |
|
C |
|
|||
C C |
S S C S C C S S S C |
|
||||||||
|
S |
|
C C |
|
|
C S |
|
|
||
= |
|
|
|
. |
||||||
|
|
S S C C S |
|
|
|
|
|
|
||
S C |
C C S S S |
|
||||||||
Матрица результирующего поворота такая же, как (1.14), но последовательность поворотов отличается в последовательности, результатом которой является выражение (1.14).
7
ЛЕКЦИЯ 2
Матрица поворота вокруг произвольной оси
Рис. 2.1. Вращение вокруг произвольной оси
Rr, = Rx,- Ry, Rz, Ry,- Rx, =
|
|
1 |
|
0 |
|
0 |
C 0 |
S C |
S |
0 |
|
|||||||
|
|
|
|
C |
|
|
|
|
0 |
|
|
1 |
|
|
|
C |
|
|
|
0 |
|
|
S |
|
|
|
0 |
S |
0 |
||||||||
|
|
|
|
S |
|
|
|
|
|
|
|
|
|
0 |
0 |
|
|
|
|
|
0 |
|
C S 0 |
C |
1 |
|
|||||||||||
|
|
|
|
|
C |
0 S 1 |
0 |
|
0 |
|
|
|||||||
|
|
|
|
|
|
0 |
1 |
|
0 |
|
|
C |
|
|
|
|
||
|
|
|
|
|
|
|
0 |
S . |
|
|
||||||||
|
|
|
|
|
|
|
0 C |
|
|
S |
|
|
|
|
|
|||
|
|
|
|
|
S |
0 |
|
C |
|
|
||||||||
|
ry |
|
|
|
|
|
r |
|
|
|
|
|
|
|
r2 r2 . |
|||
sin = |
|
|
|
; cos = |
|
|
z |
|
|
; sin = rx; |
cos = |
|||||||
|
|
|
|
|
|
|
|
|||||||||||
|
r2 |
r2 |
|
|
|
|
r2 |
r2 |
|
|
|
|
|
y |
z |
|||
|
y |
|
z |
|
|
|
|
y |
z |
|
|
|
|
|
|
|
|
|
8
Подстановка этих равенств в предыдущее выражение дает
|
|
r2V c |
r r V r s |
r r V r s |
|
|
||||
|
|
x |
|
x y |
z |
x z |
y |
|
|
|
R |
r r V r s |
r2V c |
r r V r s |
, |
(2.1) |
|||||
r, |
|
x y |
z |
y |
|
y z |
x |
|
|
|
|
r r V r s |
r r V r s |
r2V c |
|
|
|
||||
|
|
x z |
y |
y z |
x |
z |
|
|
|
|
где V = vers = 1 – cos .
Представление матриц поворота через углы Эйлера
|
Три системы углов Эйлера |
Таблица 2.1 |
|
|
|
||
|
|
|
|
|
1 |
2 |
3 |
Последова- |
На вокругосиOZ |
На вокругосиOZ |
На вокругосиOX |
тельность |
На вокругосиOU |
На вокругосиOV |
На вокругосиOY |
поворотов |
|
|
|
На вокругосиOW |
На вокругосиOW |
На вокругосиOZ |
|
|
|
|
|
Рис. 2.2. Первая система углов Эйлера
9
