Добавил:
Upload Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:
МОПР лабораторные.doc
Скачиваний:
3
Добавлен:
01.07.2025
Размер:
2 Мб
Скачать
☆
  1. Линейная интерполяция со сглаживанием отрезков

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

Рисунок 7.2 - Линейная интерполяция со сглаживанием отрезков

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

Достоинством этого метода является точное следование вдоль прямых линий при планировании в декартовой системе координат, недостатком является то, что желаемая траектория (с учетом сопря­жении) не проходит точно через промежуточные точки (см. рисунок 7.2).

  1. Метод интер­поляции по формуле Лагранжа

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

(6.1)

где - значения аргумента в опорных точках траектории.

- значения функции в этих точках.

В этом случае мы получаем высокую плавность траектории, без каких либо скачков скорости и ускорения (см. рисунок 7.3), однако при этом методе степень полинома растет пропорционально числу точек, что увеличивает время расчетов и колебательность.

Рисунок 7.3 - Метод интер­поляции по формуле Лагранжа

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

4. Сплайн-интерполяция

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

Сущность сплайн-интерполяции заключается в представлении тра­ектории между узловыми точками с помощью кривой, описываемой сте­пенными полиномами третьей, четвертой или пятой степени вида.

При этом коэффициенты полиномов выбираются так, чтобы обес­печить непрерывность функций положения, скорости и ускорения при, переходе с одного сегмента на другой. Последовательность степен­ных функций, сцепленных друг с другом, представляют желаемую траекторию, которая обеспечивает плавное движение манипулятора (см. рисунок 7.4).

Рисунок 7.4 - Сплайн-интерполяция

Порядок полинома, выбранного для представления желаемой траекто­рии, зависит от спецификации манипуляционной задачи. Когда зада­ны положения и скорость в начальные и конечные моменты времени, то этим четырем условиям удовлетворяет полином третьей степени с четырьмя неизвестными параметрами. Если в эти моменты времени также задано ускорение, тогда необходимо удовлетворение 6 условий и соответственно необходим полином 5 степени с шестью неизвестными параметрами.

5. Содержание работы

Работа предполагает выполнение следующего задания:

Построить графики положения, скорости и ускорения в зависи­мости от времени при планировании сглаженной траектории.

6. Методика выполнения работы

1. При планировании траектории методом линейной интерпо­ляции с сопряжением отрезков рассмотрим рисунке 7.5:

Рисунок 7.5 - Планирование траектории методом линейной интерпо­ляции с сопряжением отрезков

Для интервала положение, скорость и ускорение вычисляются по следующим формулам:

где

При траектория формируется по следующим формулам:

.

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

2. Для интерполяции траектории полиномами можно воспользоваться интерполяционной формулой Лагранжа, имеющей следующий вид:

где - значение аргумента в опорных точках траектории

- значение функции в этих точках.

3. При выполнении сплайн-интерполяции траектории рассмотрим -ый участок траектории (см. рисунок 6.6), который описывается следующим полиномом:

,

где

Рисунок 7.6 - -ый участок траектории

7. Варианты заданий к лабораторной работе

Вариант 1

Осуществить планирование траектории методом линейной интер­поляции с сопряжением отрезков.

Таблица 7.1 - Исходные данные

№ вар.

Время

1

0,1

0

1,0

1,4

2,0

5,1

2

0,15

0

1,0

2,0

3,0

3,7

3

0,2

0

1,0

2,0

4,0

11,0

4

0,25

0

1,0

4,0

12,0

18,0

5

0,3

0

1,0

7,5

8,4

12,0

6

0,35

0

8,0

10,0

12,0

13,0

№ вар.

Положение

-

1

100

200

400

600

700

2

800

400

250

200

100

3

100

200

400

100

400

4

100

400

200

800

200

5

100

800

400

200

400

6

800

400

200

100

800

Вариант 2

Осуществить планирование траектории с помощью интерполя­ционной формулы Лагранжа.

Таблица 7.2 - Исходные данные

№ вар.

Время

1

0

1,0

1,4

2,0

5,1

2

0

1,0

2,0

3,0

3,7

3

0

1,0

2,0

4,0

11,0

4

0

1,0

4,0

12,0

18,0

5

0

1,0

7,5

8,4

12,0

6

0

8,0

10,0

12,0

13,0

№ вар.

Положение

1

100

200

400

600

700

2

800

400

250

200

100

3

100

200

400

100

400

4

100

400

200

800

200

5

100

800

400

200

400

6

800

400

200

100

800