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

Загрузите предопределенную модель робота LBR KUKA, которая задана как RigidBodyTree объект.

load exampleRobots.mat lbr

Установите формат данных на 'row'. Для всех вычислений динамики форматом данных должен быть любой 'row' или 'column'.

lbr.DataFormat = 'row';

Установите Gravity свойство дать определенное гравитационное ускорение.

lbr.Gravity = [0 0 -9.81];

Сгенерируйте случайную настройку для lbr.

q = randomConfiguration(lbr);

Вычислите необходимые объединенные крутящие моменты для lbr статически содержать ту настройку.

tau = inverseDynamics(lbr,q);

Используйте externalForce функция, чтобы сгенерировать матрицы силы, чтобы примениться к модели дерева твердого тела. Матрица силы является m-6 вектором, который ссорится для каждого соединения на роботе, чтобы применить ключ с шестью элементами. Используйте externalForce функционируйте и задайте исполнительный элемент конца, чтобы правильно присвоить ключ правильной строке матрицы. Можно добавить, что несколько спрессовывают матрицы, чтобы прикладывать несколько сил к одному роботу.

Чтобы вычислить объединенные крутящие моменты, которые противостоят этим внешним силам, используйте inverseDynamics функция.

Загрузите предопределенную модель робота LBR KUKA, которая задана как RigidBodyTree объект.

load exampleRobots.mat lbr

Установите формат данных на 'row'. Для всех вычислений динамики форматом данных должен быть любой 'row' или 'column'.

lbr.DataFormat = 'row';

Установите Gravity свойство дать определенное гравитационное ускорение.

lbr.Gravity = [0 0 -9.81];

Получите домашнюю настройку для lbr.

q = homeConfiguration(lbr);

Установите внешнюю силу на link1. Входной вектор ключа выражается в базовой системе координат.

fext1 = externalForce(lbr,'link_1',[0 0 0.0 0.1 0 0]);

Установите внешнюю силу на исполнительном элементе конца, tool0. Входной вектор ключа выражается в tool0 система координат.

fext2 = externalForce(lbr,'tool0',[0 0 0.0 0.1 0 0],q);

Вычислите объединенные крутящие моменты, требуемые сбалансировать внешние силы. Чтобы объединить силы, добавьте матрицы силы вместе. Объединенные скорости и ускорения приняты, чтобы быть нулем (вход как []).

tau = inverseDynamics(lbr,q,[],[],fext1+fext2);