Интеллектуальные робототехнические системы



         

Погрешности выходного звена


Погрешности выходного звена будем рассматривать в системе координат (XYZ)П. Данные погрешности путем матричных преобразований можно получить в любой другой координатной системе. Определим связь межу погрешностями, представленными в системах (XYZ)i и (XYZ)П (рис. 13.2). С точностью до элементов первого порядка малости погрешности датчиков ?xдi,?yдi или ?zдi приводят к погрешностям вычисления линейных координат ?xп,?yп и ?zп

[?xп?yп?zп]T=пCдi[?xдi?yдi?zдi]T (13.2)

и погрешностям вычисления угловых координат



Рис. 13.2. 

где [?xдi?yдi?zдi]T - вектор, определяющий положение точки 0дi в системе координат (XYZ)П (4-й столбец матрицы преобразования координат пAдi); пCдi - подматрица направляющих косинусов матрицы пAдi.

Как правило, датчики, расположенные в сочленениях звеньев, измеряют только одну из координат xдi,yдi или zдi, поэтому соответствующий данной координате столбец матрицы пCдi в (13.2) или в произведении матриц (13.3)


представляет коэффициенты в матрице KJ (13.1) при одной из координат xдi,yдi или zдi, измеряемой датчиком

[?xп?yп?zп]T=[K1дiK2дiK3дi]?дi (13.4)

Если датчик измеряет один из углов поворота вокруг оси Xдi,Yдi или Zдi, то погрешности ?

дi,??дi или ??дi приводят к погрешности вычисления угловых координат ?
п,??п или ??п, определяемых соотношением

[?

п??п??п]T=пCдi[?
дi??дi??дi]T (13.5)

Для каждой одной угловой координаты, измеряемой датчиком, коэффициенты KJ в (13.1) представляют столбец в матрице пCдi при этой координате

[?

п??п??п]T=[K1дiK2дiK3дi]?дi (13.6)

Задача определения линейных погрешностей ?xп, ?yп и ?zп в системе координат (XYZ)П по заданным погрешностям датчиков, измеряющих только угловые координаты в сочленениях звеньев, имеет решение только при измерении одного из углов в системе (XYZ)дi. На рисунке 13.2 - это угол вращения относительно оси Xдi. Для этого случая связь линейных погрешностей в системе координат (XYZ)дi с угловой погрешностью датчиков по координате ?qi определяется из векторного произведения


где R0=[x0y0z0]T - вектор, проведенный из 0дi в точку 0п.


Содержание  Назад  Вперед