Добавил:
Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:

Математическое обеспечение промышленных роботов

.pdf
Скачиваний:
0
Добавлен:
24.11.2025
Размер:
2.44 Mб
Скачать

МИНИСТЕРСТВО ОБРАЗОВАНИЯ РЕСПУБЛИКИ БЕЛАРУСЬ

Белорусский национальный технический университет

Кафедра «Робототехнические системы»

МАТЕМАТИЧЕСКОЕ ОБЕСПЕЧЕНИЕ ПРОМЫШЛЕННЫХ РОБОТОВ

Учебно-методическое пособие

М и н с к Б Н Т У

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