- •Математическое обеспечение промышленных роботов
- •Лабораторная работа № 1 Матрица однородного преобразования
- •Основные положения
- •Матрица поворота
- •Однородные координаты
- •Однородная матрица преобразования
- •Содержание работы
- •Методика выполнения работы
- •Задание
- •Лабораторная работа № 2 Методы описания ориентации объекта в пространстве
- •Углы тангаж, крен и рысканье (Pitch, Roll, Yaw)
- •1.2 Углы Эйлера
- •Эквивалентное представление ориентации с помощью вектора и угла.
- •2. Содержание работы
- •3.Методика выполнения работы
- •4. Задание
- •5.Содержание отчета
- •6. Литература
- •Лабораторная работа № 3 Виды изображения объёмных тел в координатах экрана монитора, алгоритмы изображения движущихся тел
- •1.Основные положения
- •2.Содержание работы
- •3.Методика выполнения работы
- •4.Задание
- •5.Содержание отчета
- •6.Литература
- •1.2. Алгоритм интерполяции в обобщенных координатах
- •Содержание работы
- •Задание
- •Содержание отчета
- •Пример реализации
- •Литература
- •Алгоритм линейной интерполяции траектории в декартовых координатах
- •3. Содержание работы
- •4.Задание
- •5. Методика выполнения
- •1. По заданным значениям матриц однородных преобразований и , скорости и ускорения определить (вручную):
- •2. (На компьютере)
- •6. Исходные данные
- •7. Содержание отчета
- •8.Пример реализации
- •Литература
- •Содержание отчета
- •Пример реализации
- •11. Литература
- •Линейная интерполяция со сглаживанием отрезков
- •Метод интерполяции по формуле Лагранжа
- •4. Сплайн-интерполяция
- •Вариант 3
- •8. Содержание отчета
- •9. Примеры реализации программы
- •10. Литература
- •Содержание
- •Математическое обеспечение промышленных роботов
Линейная интерполяция со сглаживанием отрезков
В
настоящее время наиболее широко
распространена линейная интерполяция
со сглаживанием отрезков. В этом случае
движение между узловыми точками
на участках
происходит по прямой линии (см. рисунок
7.2). Для обеспечения
непрерывности скорости ускорения
переход с одной прямой на другую в
течение интервалов сопряжения
происходит по кривой, описываемой
степенной функцией (полиномом). Полином
может быть второй, третьей ли четвертой
степени в зависимости от требований
условия непрерывности скорости и
ускорения.
Рисунок 7.2 - Линейная интерполяция со сглаживанием отрезков
Таким образом, график положения будет описываться последовательностью полиномов первой и второй степени, которые стыкуются между собой с соблюдением соответствующих условий непрерывности.
Достоинством этого метода является точное следование вдоль прямых линий при планировании в декартовой системе координат, недостатком является то, что желаемая траектория (с учетом сопряжении) не проходит точно через промежуточные точки (см. рисунок 7.2).
Метод интерполяции по формуле Лагранжа
Теоретически можно провести непрерывную и гладкую кривую точно через последовательность узловых точек, используя формулу , интерполяции Лагранжа:
(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 |
