Матрица погрешностей: стандартная форма

В общем случае движения тела (т. е. движения с 6 степенями свободы) матрица преобразования представляет собой шестипараметрическую расширенную матрицу Эйлера:

    , (6)

где, как и ранее, pxi, pyi, pzi - параметры смещения i-го тела по осям Xi-1-, Yi-1- и Zi-1 соответственно; θi, ψi, ϕi - углы Эйлера последовательных поворотов вокруг осей Xi-1-, Yi-1- и Zi-1 соответственно (в заданном порядке!).

Если шесть параметров смещения матрицы AEu, уравнение (6), являются бесконечно малыми, матрицу можно упростить, используя линеаризацию тригонометрических функций, уравнения (1-2). После подстановки малых значений δx, δy, δz, δθ, δψ и δϕ на регулярные значения px, py, pz, θ, ψ и ϕ соответственно в матрице AEu ее элементы подчиняются условиям линеаризации:

                                                         ,                                            (7)

    .       (8)

Следовательно, матрица малых смещений звена, вызванных шестью бесконечно малыми позиционными и ориентационными смещениями звена, становится:

                       (9)

где δx, δy, δz - погрешности перемещения (небольшие линейные перемещения вдоль осей координат); и δθ, δψ,δϕ – погрешности вращения (небольшие вращения вокруг осей координат).

Очевидно, матрица W может быть представлена как сумма двух матриц размерностью 4 × 4:

                                                                                  (10)

где I4 × 4 - единичная матрица размерностью 4 × 4; а E - бесконечно малая матрица, называемая матрицей стандартных погрешностей (далее «матрица погрешностей»):

                                           ,                                (11)

Матрица E объединяет:

1. Элементы δx, δy и δz четвертого столбца, моделирующие малые перемещения звена вдоль осей координат.

2. Верхняя левая антисимметричная (косая) блок-матрица размерностью 3×3, составляющая малые угловые смещения δθ, δψ и δϕ вокруг осей координат X, Y, Z.

3. Нули в четвертой строке.

В связи со значительной важностью матрицы погрешностей в следующем материале ниже сформулированы ее специфические особенности.

 




double arrow
Сейчас читают про: