Добавил:
Upload Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:
Eraliev_19_05_16.doc
Скачиваний:
0
Добавлен:
01.07.2025
Размер:
4.82 Mб
Скачать

15. Как осуществляется независимое программное управление движением по ускорению?

Независимое программное управление движением по ускорению

Независимое программное управление движением по ускорению [186] расширяет возможности управления движением по скорости, включая управление ускорением. Оно является альтернативной управлению по положению, при котором непосредственно учитывается положение или ориентация конечного звена манипулятора. Всякое управление по обратной связи производится относительно конечного звена, следовательно, предполагается.что желаемые ускорения при

заданном движении конечного звена заранее определяются пользователем.

Действительное и желаемое положения и ориентация конечного звена манипулятора могут быть представлены следующими однородными матрицами преобразования размерностью 4X4:

где п, s. а — единичные векторы, направленные соответственно вдоль главных осей х, у. zсистемы координат конечного звена, а р(0—вектор положения конечного звена относительно базовой системы координат. Ориентация подматрицы [л. s. а] определяется с помощью углов Эйлера, описывающих вращение (а. р. у) относительно базовой системы координат и соответствии с уравнением (5.7-25.

(0 = pJ(?) — р(f) =

рЦ>) — Ри (О РІ (0 -р,(п_

(5.7-27)

Ошибка позиционирования конечного звена определяется как разность между желаемым и действительным положением конечного звена и может быть записана в виде

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

образом:

е0(/) = 1/2 in(/) X n" + s(о X s* + a (QX а*|. (5.7-28)

Следовательно, управление манипулятором основывается на сведении указанных ошибок конечного звена к нулю.

Для шестизвенного манипулятора можно совместить линейные скорости v(/) и угловые скорости ш(/) конечного звена в шестимерном векторе х(/):

X(')=[I(/) ] = N(4)q(,)' (5-7-29)

где N (q) — матрица размерностью GX 6, определенная уравнением (5.7-10). Уравнение (5.7-29) является основным для независимого программного управления движением по скорости, где скорости в сочленениях находятся из скоростей конечного звена. Аналогично могут быть определены ускорения в сочленениях нз ускорения конечного звена х (/). Производная по времени от х(/) представляет собой ускорение конечного звена

х (0 = N (q) q(0 + N (q. q) q(t). (5.7-30)

Управление заданным движением по ускорению с использованием обратной связи основано на сведении ошибок позиционирования и ориентации конечного звени к нулю. Если траектория движения манипулятора задана в декартовых координатах, то известны желаемые положения pJ(/), скорость vd(/) и ускоренно v*(/) относительно базовой системы координат. Для уменьшения ошибки Позиционирования каждый двигатель в сочленениях манипулятора должен развить необходимые моменты и усилия. По существу это приводит к возникновению линейного ускорения конечного звена v(/), которое удовлетворяет следующему уравнению:

V (0 = Vd(/) + к,[v-W- V (/)] + ft, Ip* {/) - Р (0]. (5.7-31)

где k\н k%— скалярные константы. Уравнение (5.7-31) может быть записано в виде

ёр (0 + *іё„ (0 + k#p(0 — 0. (5.7-32)

где ер(/)=р**(/)—р(/). Входные моменты и силы должны выбираться таким образом, чтобы гарантировать асимптотическую сходимость к нулю ошибки позиционирования конечного звени. Для этого необходимо выбрать k\н k2так, чтобы характеристические корни уравнения (5.7-32) имели

Соседние файлы в предмете [НЕСОРТИРОВАННОЕ]