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

Лекция 13 Рекуррентные уравнения динамики манипулятора

[Рекурретный (recurrens) – возвращающийся]. Рекуррентные уравнения – уравнения приведения, сводящие вычисления n-го члена последовательности к вычислению нескольких предыдущих ее членов.

Основываясь на полученных выше кинематических соотношениях, воспользуемся принципом Д'Аламбера для вывода уравнений динамики движения манипулятора. Принцип Д'Аламбера позволяет применить известные условия статического равновесия к задачам динамики за счет рассмотрения (наряду с внешними действующими на механическую систему силами) сил инерции, препятствующих движению. Принцип Д'Аламбера выполняется для механической системы в любой момент времени. По сути это несколько модифицированный второй закон Ньютона, формулируемый следующим образом:

«Алгебраическая сумма внешних сил и сил инерции, действующих на тело в любом направлении, равна нулю».

Рассмотрим i-е звено (рис. 8.1). Пусть точка О' совпадает с центром масс этого звена. Устанавливая соответствие между рис. 11.4 и 13.1, введем следующие обозначения (все векторы заданы в базовой системе координат):

Рисунок 13.1. Силы и моменты, действующие на i-е звено

- масса i-го звена;

- положение центра масс i-го звена в базовой системе координат;

- положение центра масс i-го звена относительно начала

системы координат ;

- положение начала i-й системы координат относительно

начала -й системы координат;

- линейная скорость центра масс i-го звена;

- линейное ускорение центра масс i-го звена;

-суммарная внешняя сила, приложенная к центру масс

i-го звена;

-суммарный момент внешних сил, приложенных к i-му

звену;

- матрица инерции i-го звена относительно его центра

масс в базовой системе координат;

- сила, с которой -е звено действует на i-е звено в

системе координат ;

- момент, вызванный действием -го звена на i-е

звено в системе координат .

Пренебрегая силами трения в сочленениях, применив принцип Д'Аламбера к i-му звену, получаем:

, (13-1)

. (13-2)

Входящие в эти формулы линейные скорость и ускорение центра масс i-го звена в соответствии с равенствами (12-32) и (12-35) определяются выражениями:

, (13-3)

. (13-4)

Суммарная сила и момент , приложенные к i-му звену, обусловлены действием на него силы тяжести, а также сил со стороны соседних -го и -го звеньев. Таким образом:

, (13-5)

(13-6)

Эти уравнения можно представить в рекуррентной форме, воспользовавшись тем, что:

, (13-7)

. (13-8)

Полученными уравнениями, имеющими рекуррентную форму, можно воспользоваться для вычисления сил и моментов , действующих на звенья n-звенного манипулятора. Для этого достаточно учесть, что и представляют собой соответственно силу и момент, с которыми объект манипулирования действует на схват манипулятора. Момент, создаваемый приводом i-го сочленения, должен быть равен сумме проекции момента на ось и момента вязкого трения в i-м сочленении (если сочленение – вращательное). Если же i-е сочленение – поступательное, оно реализует смещение на единиц длины относительно системы координат вдоль оси . В этом случае сила , создаваемая в этом сочленении, должна быть равна в системе координат сумме проекции силы на ось и силы вязкого трения. Таким образом, момент (сила) , создаваемый приводом i-го сочленения, определяется формулой:

, (13-9)

где - коэффициент вязкого трения в i-м сочленении.

Если основание манипулятора закреплено на платформе и 0-е звено неподвижно, то , , и с учетом силы тяжести:

, где . (13-10)

Таким образом, для исследователя существует возможность выбора одной из трех следующих форм представления уравнений движения манипулятора:

  1. удобная для анализа, но неэффективная в вычислительном плане форма Лагранжа-Эйлера;

  2. эффективная с вычислительной точки зрения, но малопригодной для анализа форма Ньютона-Эйлера;

  3. достаточно удобные для анализа при умеренных вычислительных затратах обобщенные уравнения Д'Аламбера.