Как перенести матрицу Якобиана для 6-ти манипуляторов

Понимание того, как вывести матрицу Якобиана, необходимо для управления 6-градусным роботизированным манипулятором (6-DOF). Якобиан связывает скорости соединения со скоростями конечного эффекта, обеспечивая точное движение и контроль силы.

Кинематическая модель манипулятора

Первый шаг включает в себя создание кинематической модели робота. Обычно для определения координатных рамок для каждого соединения используются параметры Денавита-Хартенберга (D-H). Эти параметры включают длины связей, повороты, смещения и углы соединения.

Используя параметры D-H, можно вывести матрицы трансформации из одного соединения в другое. Умножение этих матриц приводит к общей трансформации от основания к конечному эффектору.

Вычисление якобианцев

Якобианская матрица состоит из двух частей: линейной скорости Якобиана и угловой скорости Якобиана, для каждого сустава определяйте, является ли он револьвентным или призматическим, так как это влияет на вычисление.

Для револьверных соединений линейная скоростная составляющая является поперечным произведением оси сустава и вектором от сустава до конечного эффекта. Угловая скоростная составляющая — это просто вектор оси сустава. Для призматических суставов линейная составляющая — вектор оси сустава, а угловая составляющая — ноль.

Построение Якобианской матрицы

Соберите матрицу Якобиана, укладывая векторы линейных скоростей и векторы угловых скоростей для каждого соединения. Полученная матрица 6х6 связывает скорости соединения со скоростями конечных эффектов.

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