Цхай Н.В., Котов Е.С.
СРАВНЕНИЕ МЕТОДОВ РЕШЕНИЯ ПРЯМОЙ ЗАДАЧИ КИНЕМАТИКИ МАНИПУЛЯТОРОВ И ПРЕДСТАВЛЕНИЕ МЕТОДА РЕШЕНИЯ ОБРАТНОЙ ЗАДАЧИ КИНЕМАТИКИ С ПОМОЩЬЮ МЕТОДА КВАТЕРНИОНОВ *
Аннотация:
в работе представлен анализ методов решения прямой задачи кинематики и на их основе, а также на основе методов кватернионов представлено решение обратной задачи кинематики манипуляторов.
Ключевые слова:
матрица Денавита-Хартенберга, манипулятор, углы Эйлера, кватернионы
Матрица Денавита-Хартенберга - это метод, используемый в кинематике роботов для описания относительного положения и ориентации звеньев робота. Она состоит из матрицы 4x4 для каждого звена, описывающей положение и ориентацию относительно предыдущего звена. Этот метод часто используется при расчетах кинематики робота и планировании движения. Матрица для n-ого количества звеньев имеет вид:[1]Tn0=cosisinicosisinisiniaicosisinicosicosicosisiniaisini0sinicosidi0001, (1.1)где:i –угол вокруг оси 1 от 1 до ;i – угол вокруг оси от 1 до ;ai – расстояние вдоль оси от 1 до ;di -расстояние вдоль оси 1 от 1 до .Результирующая матрица перемещения имеет вид: Tn0q=T0qT1q…Tnq=Rn0(q)pn0(q)01, (1.2)где:pn0q=xn0(q)yn0(q)zn0(q), (1.3)является матрицей координат конечной точки искомой системы координат;Rn0q=r11(q)r12(q)r13(q)r21(q)r22(q)r23(q)r31(q)r32(q)r33(q), (1.4)является матрицей поворота, решения которой имеют несколько вариаций.Если r33(q)±1sin((q))= ±1cos2()=±1r33(q)q=atan2±1r33q, r33(q) (q)=atan2(±r23(q), ±r13(q)) (q)=atan2(±r32(q), ±r31(q)) Если r33q=1() = 0,() + () = atan2 (21(), 11())Если r33q=1() = () () = atan2 (12(), 11()).где: – угол поворота вокруг оси Yi - угол поворота вокруг оси Zi- угол поворота вокруг оси Xi Основные преимущества применения матрицы Денавита-Хартенберга это простота представления, так как матрица Денавита-Хартенберга представляет собой стандартный и удобный способ описания кинематики робота. Простая структура делает ее понятной и позволяет использовать в самых разных приложениях. Универсальный метод может быть применен к широкому спектру роботов, включая манипуляторы с различными конфигурациями и степенями свободы. Его можно применять для моделирования и управления как промышленными, так и сервисными роботами. Расчет кинематики и планирование движения данным способом облегчает расчет кинематики робота и планирование движения. Это позволяет определять положение и ориентацию рабочего инструмента на основе углов сочленений. [2]Однако существуют некоторые недостатки. К ним можно отнести аппроксимацию - матричный метод Денавита-Хартенберга основан на предположении, что каждое звено робота жесткое и имеет идеальную форму. В реальности роботы могут иметь гибкие элементы и неидеальные сочленения, что может привести к неправильной оценке. Также чувствительность к ошибкам параметров существенно требовательны к точным данным углов и длины звеньев. Даже небольшие погрешности в измерениях могут привести к большим ошибкам в расчетах. Матричный метод Денавита-Хартенберга не учитывает динамические эффекты, такие как инерционные силы и гравитация. Существует также метод углов Эйлера для решения прямой задачи кинематики. Данный метод представляет собой решение перемещения в пространстве как вращение вокруг одной оси, которая сопряжена с начальной системы координат. Уравнение матрицы углов Эйлера имеет вид: R = Rz,*Ru,*Rw, = = cossin0sincos0001*1000cossin0sincos*cossin0sincos0001 =coscossincossincossinsincoscossinsinsincos+cossincossinsin+coscoscoscossinsinsincossincos(2.1) где: – угол поворота вокруг оси U сопряженной оси Yi (тангаж) - угол поворота вокруг оси V сопряженной оси Zi (крен)- угол поворота вокруг оси W сопряженной оси Xi (рысканье) Однако уравнение для полного перемещения имеет вид: R = Rz,*Ru,*Rw,*P (2.2)Где Р является матрицей перемещения вдоль осей U,V,W и имеет вид:Р=abc, где а - перемещение вдоль оси U, b – вдоль оси V, c – вдоль оси W Преимущества данного метода заключается в исключении неоднозначности нахождения конечной системы координат при решении прямой задачи кинематики манипуляторов. Также удобство изменения ориентации в пространстве. К недостатку можно отнести сложность программирования и настройки данного метода, особенно для сложных манипуляторов со множеством звеньев. Также возможны проблемы с вычислительной производительностью при работе в реальном времени.Метод кватернионов. Существует еще один способ решения прямой задачи кинематики- метод кватернионов. Метод кватернионов — это математический метод представления перемещения предмета в трёхмерном пространстве. Кватернионы это расширенный комплекс чисел, включающий в себя дополнительное векторное измерения вида: q=a+bi+cj+dk. Где: I, j,k мнимые некоммутативные единицы, которые удовлетворяют правило умножения i2=j2=k2=ijk=-1. Метод кватернионов использует сопряженное умножение, которое удовлетворяет угол вектора или биквантериона поворота в трехмерном пространстве. Данный метод решения можно использовать для нахождения более точного положения поворота объекта в пространстве, что дает преимущество перед матрицами Денавита-Хартенберга. Если представить условие задачи, что m = m0+m1i+m2j+m3k=b *a *c (3.1)Где: b ,a ,c векторы представленные в виде кватернионовa =a0+a1ib =b0+b2jc =m0+с3k (3.2)Для решения необходимо решить вспомогательное уравнение:n =n0+n1i+n2j+n3kn =b +a (3.4)n0n3+n2n1=0Если n12+n020, то: a =n0n12+n02b =(n2*n12+n02)/ n0, если n020b =(n3*n12+n02)/ n0, если n02=0Также введем А, В которые равны тождествам:А=m0m3+m2m1, В=m02-m12+m22-m32А0, то b ,a ,c имеют решения:с0=А2А2(В+В2+4А2)с3=А-(В+В2+4А2)2А2+(В+В2+4А2) (3.5)b ,a определяются по формуле 3.2 , где n =m0(с0с3к)Если В0 и А=0, то :n =m , c =1Основными преимуществами метода кватернионов является однозначность решений прямой задачи кинематики. Также если учитывать ускорение звеньев манипулятора, что можно задать при решении уравнения, можно рассчитать полную картину поведения манипулятора. Однако главным недостатком является применение мнимых единиц, что усложняет процесс решения задачи, так как не каждая программное обеспечения управления манипулятором может учитывать мнимую часть уравнений.
Номер журнала Вестник науки №5 (74) том 1
Ссылка для цитирования:
Цхай Н.В., Котов Е.С. СРАВНЕНИЕ МЕТОДОВ РЕШЕНИЯ ПРЯМОЙ ЗАДАЧИ КИНЕМАТИКИ МАНИПУЛЯТОРОВ И ПРЕДСТАВЛЕНИЕ МЕТОДА РЕШЕНИЯ ОБРАТНОЙ ЗАДАЧИ КИНЕМАТИКИ С ПОМОЩЬЮ МЕТОДА КВАТЕРНИОНОВ // Вестник науки №5 (74) том 1. С. 579 - 585. 2024 г. ISSN 2712-8849 // Электронный ресурс: https://www.вестник-науки.рф/article/14286 (дата обращения: 22.03.2025 г.)
Вестник науки СМИ ЭЛ № ФС 77 - 84401 © 2024. 16+