logo search
Лекция Робототехника (КРАСНОБАЕВ)

Решение обратной задачи кинематики для первых трех сочленений

Вектор p, выходящий из начала системы координат плеча (x0, y0, z0) и заканчивающийся на пересечении в точке пересечения осей трех последних сочленений, определяется выражением:

, (7-6)

что соответствует вектору положения матрицы :

=. (7-7)