Исследование малых отклонений от программных движений манипуляционных систем с упругой податливостью, сосредоточенной в сочленениях звеньев

Размещено на http://www.allbest.ru/

Размещено на http://www.allbest.ru/

Исследование малых отклонений от программных движений манипуляционных систем с упругой податливостью, сосредоточенной в сочленениях звеньев

О.Н. Крахмалев

Аннотация

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

Ключевые слова: манипуляционная система, уравнение движения, упругие звенья, малые отклонения.

Статья посвящена проблеме точности отработки движений манипуляционными системами (МС) промышленных роботов (ПР), конструкция которых обладает упругой податливостью, сосредоточенной в сочленениях звеньев. Методика исследования основывается на математической модели МС ПР [1].

МС ПР структурно представляет собой разомкнутую кинематическую цепь, состоящую из звеньев, соединённых между собой кинематическими парами пятого класса. В используемой методике звенья МС моделируются абсолютно твёрдыми телами, а упругая податливость находится в центрах кинематических пар. Основу математической модели составляют матричные уравнения движения МС. Уравнение, описывающее программное движение жёсткой МС, имеющей n степеней свободы

[M]{q} + [S]{q²} + 2[K]{q_i q_j} = {Q_D}+{Q_G}+ {Q_F}, i?j (i,j=1,…,n) (1)

Уравнение, определяющее малые упругие отклонения МС от программного движения, имеет вид

[M]{Дq}+2[S]{qДq}+2[K]{q_iДq_j+q_jДq_i}={Q_P}+{Q_G}+{Q_F}_,i?j(i,j=1,…,n). (2)

{Q_D}, {Q_F}, {Q_G}, {Q_P} - векторы обобщённых сил соответственно от усилий, развиваемых приводами, сил внешней нагрузки, сил тяжести звеньев и сил упругости.

{q} = [q₁ q₂…q_n]^T, {q²} = [q²₁ q²₂…q²_n]^T, {q_iq_j} = [q₁q₂…q₁ q_n q₂ q₃…q₂ q_n…q_n-1 q_n]^T

векторы производных от обобщённых координат {q} по времени.

[M], [S] и [K] - матричные коэффициенты, соответствующие инерционным параметрам манипуляционной системы:

Здесь A_0k - матрица (размерностью 4Ч4) однородного преобразования координат из локальной системы координат, связанной с k-м звеном, в базовую систему отсчёта; H_k - матрица инерции (размерностью 4Ч4) k-го звена как твёрдого тела.

Малые упругие отклонения обобщённых координат можно представить в виде суммы

{Дq_i} = {Дq_si} + {Дq_di}, i=1,…,n,

где {Дq_si} - квазистатическое малое упругое отклонение обобщённой координаты i-го звена; {Дq_di} - малые упругие колебания i-го звена.

Уравнения для расчёта квазистатической и колебательной составляющих малых упругих отклонений будут иметь вид

[M]{Дq_s} + 2[S]{qДq_s} + 2[K]{q_iДq_sj + q_jДq_si} = {Q_Ps}+{Q_G}+ {Q_F} ,

[M]{Дq_d} + 2[S]{qДq_d} + 2[K]{q_iДq_dj + q_jДq_di } = {Q_Pd}.

Исследуем движение и возникающие малые упругие отклонения на примере трёхзвенной МС, кинематическая схема которой приведена на рис.1. Первое звено исследуемого манипулятора вращается вокруг вертикальной оси, имеет массу m₁ и моделируется тонкостенной трубой длиной l₁ и радиусом R₁. Второе звено массой m₂ вращается вокруг горизонтальной оси и моделируется тонким стержнем длиной l₂. Третье звено представляет собой сосредоточенную массу m₃ и совершает поступательные перемещения вдоль оси второго звена.

Рис. 1. Кинематическая схема исследуемой МС

Уравнения движения, согласно выражениям (1) и (2), имеют следующий вид:

- уравнение, описывающее программное движение:

[M][q₁ q₂ q₃]^T+[S][q₁² q₂² q₃²]^T +2[K][q₁q₂ q₁q₃ q₂q₃]^T = {Q_D} + {Q_G} ; (3)

- уравнение, описывающее малые упругие отклонения от программного движения:

[M][Дq₁Дq₂Дq₃]^T+2[S][Дq₁q₁Дq₂q₂Дq₃q₃]^T+2[K][Дq1q2+Дq2q1Дq1q3+Дq3q1Дq2q3+Дq3q2]T = {QP}+ {QG} (4)

Аналитические выражения для матричных коэффициентов [M], [S] и [K], входящих в эти уравнения, для выбранной модели имеют следующий вид [1]:

Вектор обобщённых сил от сил тяжести имеет вид

Матричные коэффициенты динамической модели [M], [S] и [K], а также вектор {Q_G} при компьютерном моделировании формируются автоматически.

Зададим программную траекторию движения в виде прямой. Движение рабочего органа по выбранной траектории представим двумя участками. На первом участке характерная точка рабочего органа из неподвижного состояния начинает равноускоренное движение до средней точки траектории. На втором участке происходит равноускоренное торможение рабочего органа до полной его остановки.

Используя уравнение (3), вычислим усилия в приводах (рис.2), необходимые для выполнения программного движения.

Рис. 2.Графики усилий, развиваемых приводами

Для анализа влияния сил инерции на усилия, развиваемые приводами, в рассматриваемом примере удобно полученное матричное уравнение движения записать через ненулевые элементы матричных коэффициентов [M], [S] и [K]:

Q_D1= M₁₁q₁ + 2K₁₁q₁q₂ + 2K₁₂q₁q₃ - Q_G1 ;

Q_D2= M₂₂q₂ + S₂₁q²₁ + 2K₂₃q₂q₃ - Q_G2 ;

Q_D3= M₃₃q₃ + S₃₁q²₁ + S₃₂q²₂ - Q_G3 .

Из первого уравнения полученной системы видно, что на усилие D₁ = Q_D1, развиваемое приводом первого звена, оказывают влияние кориолисовы эффекты, возникающие из-за сложного относительного движения звеньев.

Сопоставление графиков усилий, развиваемых приводами манипулятора (рис.2), с учётом динамики, определяемой заданным законом движения (сплошной график), и графиков, соответствующих условию [S]=0 и [K]=0 (пунктирная линия), позволяет отметить существенное влияние сил инерции на приводы. Анализ влияния сил инерции на усилия, развиваемые приводами, через анализ ненулевых элементов матричных коэффициентов позволяет выполнить допустимую корректировку программной траектории с учётом оптимизации этого влияния.

Точность отработки манипулятором заданной программной траектории определяется разностью между требуемым и действительным положениями рабочего органа во время его движения, именующейся динамической ошибкой. Значения отклонений (динамических ошибок) обобщённых координат q₁, q₂ и q₃, вычисленные на основе уравнения (4), описывающего квазистатические малые упругие отклонения, представлены на рис.3.

Рис.3. Квазистатические отклонения обобщённых координат q₁, q₂ и q₃

Для третьего звена рассчитаны малые упругие колебания вблизи программного движения (рис.4).

Рис.4. Упругие колебания обобщённой координаты q₃ (с₃=1.0Ч10⁴ Н/м)

При увеличении жёсткости механической системы частота упругих колебаний возрастает. На рис. 5 представлен график упругих колебаний обобщённой координаты q₃, рассчитанных при увеличении коэффициента жёсткости третьего сочленения с₃ до 1.0Ч10⁶ Н/м.

Рис.5. Упругие колебания обобщённой координаты q₃ (с₃=1.0Ч10⁶ Н/м)

Для анализа влияния сил инерции на малые отклонения обобщённых координат уравнения для расчёта квазистатических отклонений представим в развёрнутом виде:

M₁₁Дq₁ + 2K₁₁ (Дq₁q₂ + Дq₂q₁) + 2K₁₂ (Дq₁q₃ + Дq₃q₁) = Q_P1 + Q_G1 ;

M₂₂Дq₂ + 2S₂₁Дq²₁ + 2K₂₃(Дq₂q₃ + Дq₃q₂) = Q_P2 + Q_G2 ;

M₃₃Дq₃ +2 S₃₁Дq²₁ + 2S₃₂Дq²₂ = Q_P3 + Q_G3 .

Поочерёдно приравнивая к нулю значения коэффициентов уравнений системы, получим решения, позволяющие оценить влияние соответствующих этим коэффициентам сил инерции на отклонения (динамические ошибки) обобщённых координат.

На рис. 6 представлены графики, соответствующие квазистатическому упругому отклонению первой обобщённой координаты, рассчитанные для случаев K₁₁=0 и K₁₂=0. Для сравнения приведены графики, соответствующие фактическим решениям системы (пунктирные линии), представленные ранее на рис. 3.

Рис. 6. Влияние кориолисовых сил на Дq₁

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

Рис. 7. Влияние центробежных сил на Дq₃

В завершение анализа динамики исследуемой манипуляционной системы определим усилия, действующие на приводы, с учётом возникающих упругих деформаций (отклонений).

Рис. 8. Влияние упругости на усилие D₁ привода первого звена

На рис. 8 представлены графики D₁(t) моментов, действующих на привод первой кинематической пары: в случае программного движения - q₁=q₁(t) (пунктирная линия), в случае упругих отклонений - q₁=q₁(t)+?q₁(t) (сплошная линия).

Поскольку при вычислении усилий, развиваемых приводами, приходится дважды дифференцировать зависимости ?q_i(t) упругих отклонений, зависимости D_i(t) имеют высокочастотные колебания с большими амплитудами.

Для оценки квазистатических и колебательных составляющих на рис. 9-11 представлены участки зависимостей D_i(t) (i=1, 2, 3) в увеличенном масштабе.

Рис. 9. Колебания усилия D₁ привода первого звена

Рис. 10. Колебания усилия D₂ привода второго звена

Рис. 11. Колебания усилия D₃ привода третьего звена

Полученные результаты расчёта, выполненного на примере трёхзвенного манипулятора, иллюстрируют возможности моделирования движений МС произвольной формы.

упругий податливость манипуляционный привод

Список литературы

1. Крахмалев О.Н. Моделирование движения манипуляционных систем с упругими звеньями / О.Н. Крахмалев, А.П. Болдырев, Л.И. Блейшмидт // Вестн. БГТУ. - 2010. - №3. -С.31-38.

Размещено на Allbest.ru