Конспект лекций по КМР
.pdf
где
Fa
|
|
|
|
3 |
F |
|
|
|
|
|
4 10 |
|
|||
|
в |
|
|
|
a |
; |
|
d |
2 |
E |
|||||
|
|
|
|||||
|
|
|
|
||||
|
|
|
0 |
|
|||
|
|
|
|
|
|
||
|
|
|
|
F |
|
|
|
|
оп |
|
|
|
a |
, |
|
K |
|
d |
|
||||
|
|
|
|
|
|||
|
|
|
п |
ш.в |
|
||
|
|
|
|
|
|
||
– суммарная осевая сила, действующая на рабочую гайку, Н:
F |
F |
F |
, |
åñëè F |
0,35F |
; |
|
||||
|
a |
í |
à |
|
|
|
í |
|
a |
|
|
|
F |
0,65F |
, |
åñëè F |
0,35F |
, |
|||||
F |
|||||||||||
|
a |
í |
|
|
à |
|
|
í |
|
a |
|
(7.41)
Fн – сила предворительного натяга, Н (см. раздел 9.1). Вероятностное значение мертвого хода, мкм:
J |
tp |
K |
p |
J |
t |
max |
. |
|
|
||
|
|
|
|
|
|
|
|
||||
|
|
|
|
|
|
|
|
|
|
|
|
Значение мертвого хода в минутах, (... ): |
|||||||||||
J |
|
|
21,6 |
J |
|
|
|
|
|||
Р |
|
|
t |
|
|
|
|||||
|
|
|
|
|
|
|
|
|
|||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
h |
|
|
|
|
|
|
|
|
и радианах, (рад): |
|
|
|
|
|
|
|
|
|
|
|
J |
|
|
|
|
|
1 |
|
J |
|
. |
|
|
|
|
|
|
|
t |
|||||
|
|
159,15 P |
|
||||||||
|
|
|
|
|
|||||||
|
|
|
|
|
|
|
|
|
h |
|
|
(7.42)
(7.43)
(7.44)
Кинематическая погрешность многоступенчатых преобразователей движения. Суммарная кинематическая погрешность многоступенчатого преобразователя движения (рис. 7.7) при расчете по методу максимума-минимума, приведенная к выходному звену, равна:
|
n |
|
i i, |
|
i 1 |
(7.45)
где i – кинематическая погрешность i-й передачи:
i , рад ( минуты), при преобразовании вращательного
или поступательного движения во вращательное;
i F , м, при преобразовании поступательного
i0
или вращательного движения в поступательное;
i – передаточный коэффициент погрешности i-й передачи, учитывающий изменение кинематической погрешности передачи при приведении ее к выходному звену кинематической цепи:
160
i |
|
1 |
|
1 |
, |
(7.46) |
|
|
|||||
|
n |
ui 1,n |
uk |
|
|
|
k i 1 |
– передаточное отношение между (i+1)-й передачей и выходным звеном многоступенчатого механизма; uk – передаточное отношение k-й передачи; n – число передач.
Например, для многоступенчатого зубчатого механизма (рис. 7.7):
i |
|
1 |
. |
|
|||
3 |
|||
|
|
uk |
|
|
|
k i 1 |
|
Передаточные коэффициенты погрешностей передач равны:
|
|
|
1 |
|
|
|
|
|
|
1 |
|
|
|
; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||
1 |
|
u u |
|
|
z |
3 |
|
z |
4 |
|
|
|
||||
|
|
|
|
|
|
|
|
|
||||||||
|
|
|
2 |
3 |
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
|
|
z |
2 |
z |
3 |
|
|
|
||||
|
|
|
|
|
|
|
|
|
|
|
|
|||||
|
|
|
1 |
|
|
|
1 |
|
; |
|
|
1. |
||||
2 |
u |
z |
|
|
|
z |
|
3 |
||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|||||
|
|
|
|
4 |
|
|
3' |
|
|
|
|
|
|
|||
|
|
|
3 |
|
|
|
|
|
|
|
|
|
|
|
||
Рис.7.7
При расчете по вероятностному методу суммарная кинематическая погрешность:
где
E |
|
|
V |
||
|
|
|
|
n |
|
2 |
|
|
p E |
t1 |
iV |
|
, |
(7.47) |
||
V |
i |
|
|||||
|
|
i 1 |
|
|
|
||
|
|
|
|
|
|
|
– координата середины поля рассеяния кинематической
погрешности кинематической цепи:
E |
|
n |
i max i min ; |
|
i |
||||
|
V |
i 1 |
2 |
|
|
|
|
||
|
|
|
|
|
t1 – коэффициент, выбираемый из табл. 7.12 в зависимости от процента риска Р; Vi – поле рассеяния кинематической погрешности i-й передачи:
Vi i max i min.
161
|
|
|
Т а б л и ц а 7.12 |
|
Значения коэффициентов t1 |
и t2 |
|
|
|
|
|
Р, % |
|
t1 |
t2 |
10,00 |
|
0,26 |
0,21 |
4,50 |
|
0,35 |
0,28 |
1,00 |
|
0,48 |
0,39 |
0,27 |
|
0,57 |
0,46 |
В том случае, если выходное звено (колесо или рейка) одной или нескольких передач совершает неполный оборот, соответсвующие значения кинематических погрешностей рассматриваемых передач, кроме винтовых, рассчитанные по формулам, умножают на коэффициент К , значение которого в зависимости от угла поворота выходного звена выбирают по табл. 7.13.
|
|
|
|
|
|
|
|
|
Т а б л и ц а |
7.13 |
||
|
|
|
Значения коэффициента К |
|
|
|
|
|||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
Угол поворота , град. |
|
|
|
|
|
|||
|
|
|
|
|
|
|
|
|
|
|
|
|
30 |
60 |
90 |
120 |
150 |
180 |
210 |
240 |
270 |
|
300 |
330 |
360 |
|
|
|
|
|
|
|
|
|
|
|
|
|
0,02 |
0,07 |
0,15 |
0,25 |
0,37 |
0,5 |
0,63 |
0,75 |
0,85 |
|
0,93 |
0,98 |
1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
Для исполнительного устройства робота в целом вектор суммарных кинематических погрешностей отдельных степеней подвижности равен:
|
, |
(7.48) |
где
j
|
|
|
|
|
|
|
T, |
|
1 |
2 |
|
|
n |
|
|
|
|
|
|
|
- суммарная кинематическая погрешность j-й степени подвиж-
ности;- матрица кинематических погрешностей преобразователей дви-
жения степеней подвижности:
|
|
|
|
|
|
11 |
12 |
1n |
|
|
21 |
22 |
2n , |
|
|
|
|
|
|
|
|
m2 |
|
|
m1 |
mn |
|||
162
ij - кинематическая погрешность i-й передачи j-й степени по-
движности; m – число передач в j-й степени подвижности; n – число степеней подвижности;- матрица передаточных коэффициентов погрешностей преобра-
зователей движения степеней подвижности:
ij
|
|
|
|
|
|
||||||
|
|
||||||||||
|
|
11 |
|
12 |
|
|
1n |
|
|||
|
|
21 |
|
22 |
|
|
2n |
, |
|||
|
|
|
|
|
|
|
|||||
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
m1 |
|
m2 |
|
|
mn |
|
|||
|
|
|
|
|
|
||||||
- передаточный коэффициент погрешности i-й передачи j-й сте-
пени подвижности.
Мертвый ход многоступенчатых преобразователей движения.
Cуммарный мертвый ход многоступенчатого преобразователя движения (рис. 7.7) при расчете по методу максимума-минимума, приведенный к выходному звену, равен:
J |
|
|
n iJi
i 1
,
(7.44)
где Ji – мертвый ход i-й передачи:
J i, рад ( минуты), при преобразовании вращательного
или поступательного движения во вращательное;
J i
J ti, м, при преобразовании поступательногоили вращательного движения в поступательное.
При расчете по вероятностному методу суммарный мертвый ход:
|
|
E j |
t |
|
n |
V j 2 |
|
|
|
J |
p |
2 |
|
, |
(7.50) |
||||
|
|
|
|
i |
i |
|
|
||
|
|
V |
|
|
i 1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
где EVj – координата середины поля рассеяния мертвого хода ме-
ханизма:
E j |
n |
J i max J i min ; |
|
i |
|||
V |
i 1 |
2 |
|
|
|
||
|
|
|
|
163
t2 – коэффициент, выбираемый из табл. 7.12 в зависимости от про-
цента риска Р; V |
|
j |
– поле рассеяния мертвого хода i-й передачи: |
|||
i |
|
|||||
|
|
|
|
|
|
|
|
|
|
V |
|
j |
J i max J i min ; |
|
|
|
i |
|
||
|
|
|
|
|
|
|
Для всего исполнительного устройства робота вектор суммарных мертвых ходов отдельных степеней подвижности равен:
где
J
J |
|
J |
1 |
J |
2 |
|
J |
n |
|
T |
, |
|
|||||||||||
|
|
|
|
|
|
|
|
J
,
(7.51)
J j
- суммарный мертвый ход j-й степени подвижности;
J |
- матрица мертвых ходов преобразователей движения степеней |
||
подвижности: |
|
|
|
|
J11 |
J12 |
J1n |
|
|
|
|
|
J J 21 |
J 22 |
J 2n , |
|
|
|
|
|
|
Jm2 |
|
|
Jm1 |
Jmn |
|
J ij
- мертвый ход i-й передачи j-й степени подвижности; m - число
передач в j-й степени подвижности; n – число степеней подвижности;
7.5. Погрешности обобщенных координат, вызванные податливостью преобразователей движения приводов
Звенья преобразователей движения приводов исполнительного устройства робота не являются абсолютно жесткими. Под действием нагрузок они деформируются. Это приводит к изменению положения функциональных звеньев, т.е. возникновению погрешностей обобщенных координат.
Рассмотрим j-й привод исполнительного устройства (рис. 7.8), состоящий из двигателя Mj, преобразователя движения ПДj, имеющего податливость еj, и j-го функционального звена. От действия
внешней силы ная сила:
F
Qj
в j-й степени подвижности возникает обобщен-
|
|
rC F |
xC F |
yC F |
zC , |
|
F |
(7.52) |
|||||
|
|
q j |
x q j |
y q j |
z q j |
|
164
где нат;
x |
C |
, |
|
|
q j
yC, zC |
- проекции точки С рабочего органа на оси коорди- |
- j-я обобщенная координата.
Рис.7.8
Она вызывает деформацию преобразователя движения j-го привода, что приводит к появлению погрешности j-й обобщенной координаты, рад:
q e Q |
. |
|
j |
j j |
|
(7.53)
Для всего исполнительного обобщенных координат из-за движения степеней подвижности
устройства вектор погрешностей податливостей преобразователей можно записать в виде:
где
q j
q E F ,
q q |
q |
|
q |
|
, |
|
|
|
|
T |
|
1 |
2 |
|
n |
|
|
- податливость j-й степени подвижности;
(7.54)
E - матрица податливостей преобразователей движения степеней подвижности:
165
e |
ix |
, e |
iy |
, e |
iz |
|
|
|
|
|
|
e |
x |
|
e |
y |
e |
|
z |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
q |
|
q |
q |
|
|
|
|
|
|
|
|
|
|
|
|
||||
|
|
1 |
|
1 |
1 |
|
|
e |
|
e |
|
e |
|
|||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||
|
|
|
1 |
|
|
1 |
|
|
1 |
|
|
|
|
|||||||||
|
|
|
x |
|
|
y |
|
|
z |
|
|
|
1x |
|
|
1y |
|
1z |
|
|||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
e |
|
|
e |
|||||
|
|
e2 |
|
|
e2 |
|
e2 |
|
|
|
|
e |
2x |
|
2y |
|
|
|||||
E |
q |
|
q |
q |
|
|
|
|
|
|
|
|
2z |
|||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
, |
|||||||||
|
|
|
|
2 |
|
|
2 |
|
|
2 |
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
x |
|
|
y |
|
|
z |
|
|
|
e |
|
e |
|
e |
||||
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||
|
|
e |
|
e |
e |
|
|
|
|
|
nx |
|
|
ny |
|
nz |
||||||
|
|
q |
|
q |
q |
|
|
|
|
|
|
|
|
|
|
|
||||||
|
|
|
n |
|
n |
n |
|
|
|
|
|
|
|
|
|
|
|
|
||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||
|
|
|
|
n |
|
|
n |
|
|
n |
|
|
|
|
|
|
|
|
|
|
||
- приведенные податливости: |
|
|
|
|
|
|
|
|
|
|||||||||||||
e |
|
e |
x |
; |
|
e |
e |
|
y |
; |
|
|
|
e |
|
e |
|
z |
; |
|||
ix |
q |
|
i |
q |
|
|
|
|
iz |
i |
q |
|||||||||||
|
|
i |
|
|
iy |
|
|
|
|
|
|
|
|
|
|
|||||||
|
|
|
|
|
|
|
|
|
i |
|
|
|
|
|
|
|
|
|
||||
|
|
|
|
i |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
i |
|
||
F |
- вектор внешней силы, |
нительного устройства: |
|
|
F |
приложенной к рабочему органу испол-
F |
F |
F |
|
T |
, |
|
|||||
x |
y |
z |
|
|
|
F |
x |
, |
|
|
оси
F |
y |
, F |
z |
|
|
||
x, y, z |
|||
- проекции вектора
.
F
внешней силы на координатные
7.6. Погрешности обобщенных координат, вызванные упругими свойствами функциональных звеньев исполнительного устройства
|
|
При нагружении исполни- |
|||
|
тельного устройства |
силой F |
|||
|
функциональные звенья упруго |
||||
|
деформируются. На рис. 7.9 |
||||
|
положение недеформированно- |
||||
|
го исполнительного устройства |
||||
|
изображено |
сплошной основ- |
|||
|
ной линией, деформированно- |
||||
|
го – штриховой линией. |
||||
|
|
Ввиду малой кривизны из- |
|||
|
гиба продольной оси звеньев |
||||
|
их |
можно |
условно |
заменить |
|
Рис.7.9 |
прямолинейными |
осями |
|||
(сплошная тонкая линия). Угол |
|||||
|
|||||
|
j |
между начальным (штрих- |
|||
166
пунктирная линия) и конечным положениями j-го функционального звена представляет собой его угловую деформацию.
Величина погрешности j j-й обобщенной координаты равна,
рад:
|
ki |
|
|
|
|
|
|
|
|
j |
i |
MFiM1i |
dzi eiMi , |
(7.55) |
|||||
|
|
|
|||||||
|
i |
0 |
E |
J |
|
i |
|
||
|
|
i |
i |
|
|
||||
где ki – линейная деформация(перемещение конечной точки) i-го звена; i – длина i-го звена.
MFi и M1i - аналитические выражения изгибающих моментов на
i-м звене соответственно от внешней нагрузки и единичной силы; Ei - модуль упругости первого рода материала i-го звена; J i - осе-
вой момент инерции поперечного сечения i-го звена; ei - податливость i-го звена при изгибе:
M i
|
|
|
|
|
|
|
|
|
|
i |
dz |
|
|
||
ei |
|
|
i |
; |
|||
|
|
||||||
|
|
|
|
|
|
||
|
|
0 |
E |
J |
i |
||
|
|
i |
|
|
|||
- эквивалентный изгибающий момент:
Mi |
M |
Fi |
M |
1i |
. |
|
|
||||
|
|
|
|
||
|
|
i |
|
|
|
|
|
|
|
|
Так как исполнительное устройство робота имеет несколько степеней подвижности, то вектор погрешностей обобщенных координат имеет вид:
|
|
|
Eз M, |
(7.56) |
где |
1 |
2 |
T |
|
n , |
|
|||
j |
- погрешность j-й обобщенной координаты; |
|
||
Eз |
- матрица податливостей функциональных звеньев при изгибе: |
|||
M
|
|
|
|
|
|
|
|
|
|
|
|
|
e |
0 |
0 |
|
|||
|
|
|
|
1 |
|
|
|
|
|
|
|
|
0 |
e |
|
|
0 |
||
E |
|
|
|
2 |
|
|
|||
|
|
|
|
|
|||||
з |
|
|
|
|
|
|
; |
||
|
|
|
|
|
|
|
|
||
|
|
|
|
|
|
|
|||
|
|
|
|
0 |
0 |
|
e |
|
|
|
|
|
|
|
|
||||
|
|
|
|
|
|
|
m |
||
- вектор эквивалентных изгибающих моментов:
M M1 M2 Mm T .
167
7.7. Погрешность установки исполнительного устройства робота
В процессе эксплуатации нескольких роботов с общим управлением неточность установки исполнительного устройства какоголибо робота относительно общей базовой системы координат x0, y0, z0 (рис. 7.10) приводит к появлению погрешности позицио-
нирования этого робота. Аналогичное может произойти и при замене одного из роботов.
Рис. 7.10
В этом случае вектор погрешности позиционирования робота можно записать в виде:
|
|
|
|
|
|
|
|
c |
|
|
|
|
c |
|
|
|
|
|
|
уст |
|
r |
q0 |
|
r |
, |
|
||||
|
|
r |
(7.57) |
||||||||||||
|
|
|
|
|
|
q0 |
|
|
|
|
|
||||
где |
r c |
- радиус – вектор характеристической рабочей точки (ХРТ) |
|||||||||||||
С исполнительного устройства робота; q0 - установочная обобщен-
168
ная координата – угол между осью x0 |
БСК и проекцией L радиус |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
– вектора r c на горизонтальную плоскость |
x0 0y0 ; т.е. |
|
|
|||||||||||
|
|
L |
1 |
cos |
2 |
cos( q |
2 |
) |
3 |
cos( q |
2 |
q |
3 |
); |
|
|
|
|
|
|
|
|
|
||||||
q0 - погрешность установочной обобщенной координаты. Она
представляет собой погрешность (угол) |
z |
установки исполни- |
||||||
тельного устройства относительно оси |
z0 , т.е. |
|
||||||
|
|
q0 |
z ; |
|
|
(7.58) |
||
- угол между осью z0 |
и прямой |
L ; |
- погрешность угла : |
|||||
|
|
z |
x |
z |
y |
, |
|
(7.59) |
|
|
|
|
|||||
|
|
|
L |
|
|
|||
|
|
|
|
|
|
|
|
|
z
x x
и |
zy - перемещения вдоль оси z0 , вызванные погрешностями |
и |
y установки исполнительного устройства относительно |
осей
x0
и
y0
:
z |
|
|
x |
|
|
z |
y |
|
|
L sin q0 x
L cosq0 y
.
(7.60)
После подстановки (7.60) в (7.59) получим угол
|
x |
sin q |
0 |
|
y |
cosq |
0 |
. |
|
|
|
|
|
в виде:
(7.61)
Решая совместно (7.57), (7.58) и (7.61) получим вектор погрешности позиционирования робота из-за погрешностей установки исполнительного устройства:
где
|
|
|
|
|
|
c sin q |
|
|
|
|
|
c cosq |
|
|
|
|
c |
|
|
|
|
||||
|
|
уст |
|
r |
|
|
|
r |
|
|
r |
|
|
|
|
||||||||||
r |
x |
y |
z |
, |
(7.62) |
||||||||||||||||||||
|
|
|
|
|
0 |
|
|
|
|
|
0 |
|
q0 |
|
|
|
|||||||||
r уст x |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||
|
|
y |
|
z |
|
|
T |
. |
|
|
|
|
|
|
|
|
|
|
|
|
|||||
уст |
|
уст |
уст |
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||
В проекциях на оси координат:
|
|
|
|
|
xc sin q0 |
x |
xc cosq0 |
y |
xc |
z ; |
|
|||||||||||
xуст |
|
|
||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
q0 |
|
|
|
|
|
|
|
|
|
|
y |
|
|
|
|
y |
|
|
|
|
|
|
y |
|
|
|
|
|
y |
|
|
c |
sin q |
|
|
|
c |
cosq |
|
|
|
c |
|
|
; |
(7.63) |
|||||
уст |
|
x |
|
y |
q0 |
z |
||||||||||||||||
|
|
|
|
0 |
|
|
0 |
|
|
|
|
|
||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||
|
z |
уст |
|
zc sin q |
|
x |
|
zc cosq |
|
y |
|
zc |
|
z |
, |
|
||||||
|
|
|
|
|
0 |
|
|
|
0 |
|
|
q0 |
|
|
|
|||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||
|
|
|
|
|
|
|||||||||||||||||
где xc , yc и zc |
- проекции радиус-вектора r c |
на оси x0, y0 и z0 : |
|
|||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
169 |
|
