Разработка и проектирование робота для разминирования
Если временной
интервал hi
заменен на
hi
для i=1,2,…,n-1,
тогда величины
скорости, ускорения
и скорости
изменения
ускорения будут
уменьшены
коэффициентами
соответственно.
Эти изменения
обеспечат
скорость, ускорение
и скорость
изменения
ускорения
значениями,
отвечающими
требованиям.
называется
коэффициентом
возможного
регулирования.
Процедура,
выполняющая
приведение
некорректных
величин к
удовлетворяющему
виду называется
преобразователь
возможного
решения (ПВР).
В итоге, процедура
имеет вид:
Вычисление
в
уравнениях
(9)-(12).
Замещение
временных
интервалов
(h1, h2,…,
hn-1)
на (
).
Замещение
wj,2,
wj,3,…,
wj,n-1
на
соответственно.
j=1,2,…, N.
Алгоритм оптимизации
Матрица А(Х) определена как вектор временных интервалов между выбранными узлами, т.е. [h1, h2,…, hn-1]. Основной задачей Х является представление Т(Х) и соответствует (h1+h2+…+hn-1). Сначала выбирается n – максимальное количество вершин Хi , (i=1,2,…, n), для формирования исходного многогранника. Пусть Xg и Xs имеют максимальное и минимальное значения функции. Предположим, что Хn+1 – центроид многогранника, не включая Хg. Вычисляется это так:

.
(13)
Алгоритм пытается выбрать наилучшие значения (в соответствии с минимальным значением функции) вдоль прямой, соединяющей Xg и Xn+1, для замещения неудовлетвори-тельной величины Xg. Если это ему не удается, то многогранник уменьшается. Процедура поиска необходимых величин и уменьшения размера многогранника включает в себя отображение, растяжение, сжатие и уменьшение. Все они представлены ниже:
1)Отображение: Отображение Xg через центроид вычисляется следующим образом:
Xn+2=Xn+1+a(Xn+1-Xg), (14)
где а>0 – коэффициент
отображения.
Отметим, что
все элементы
Xn+2
являются временными
интервалами.
Для того, чтобы
все интервалы
были положительными,
коэффициент
а должен быть
правильно
определен.
Сначала, примем
его равным 1.
Если какой-нибудь
элемент Xn+2
будет отрицательным,
то коэффициент
следует уменьшить.
Пусть Xp=[
].
Для а=1 Xn+2
приобретает
вид:
Xn+2=2Xn+1-Xg
= [
].
Все элементы
должны быть
положительными,
т.е.
для
всех i. Если
для
какого-либо
i, тогда
уменьшаем
коэффициент
а.
Из (14) получаем
.
Если
,
тогда
.
Следовательно,
коэффициент
а должен быть
меньше, чем
,
чтобы
был
положительным.
Учитывая все
выше сказанное,
коэффициент
а может быть
определен как:
,
(15)
где 0<
<1
выбрана для
того, чтобы
убирать Xn+2
от границы, где
хотя бы один
элемент Xn+2
= 0.
2) Растяжение: Растянуть вектор (Xn+2-Xn+1) можно следующим образом:
Xn+3=Xn+1+
(Xn+2-Xn+1),
(16)
где
>1
– коэффициент
растяжения.
Для того, чтобы
значения всех
элементов Xn+3
были положительными,
этот коэффициент
должен быть
определен
следующим
образом:
,
(17)
где 0<
<1.
3) Сжатие: Сжать вектор (Xg-Xn+1) можно следующим образом:
Xn+4=Xn+1+
(Xg-Xn+1),
(18)
где 0<
<1
– коэффициент
сжатия.
Уменьшение: Уменьшить все вектора (Xi-Xs), i=1,2,…,n, деля их пополам начиная с Xs можно следующим образом:
,
i=1,2,…,n,
(19)
До начала поиска выберем n – максимальное количество вершин многогранника. Пусть qj,1, qj,3,…, qj,n-2, qj,n - присоединенные переменные, соответствующие положению схвата в j-й узловой точке. Из-за особенностей 2-ой и n-1 точек, qj,2 и qj,n-1 еще не определены. Временно они определены как qj,2=(qj,1+qj,3)/2 и qj,n-1=(qj,n-2+qj,n)/2. Таким образом, нижняя граница вектора временных интервалов оценивается как:
,
(20)
Первая вершина
Х10 вычисляется
как
,
если
нам
подходит, или
обозначается
как подходящая
вершина, преобразованная
процедурой
(ПВР) из
.
Для вычисления
остальных (n-1)
вершин {
},
вычисляются
как:
,
(21)
где

D – выбранное
расстояние.
Поэтому,
вычисляется
как
,
если
нам
подходит, или
обозначается
как подходящая
вершина, преобразованная
процедурой
(ПВР) из
.
D влияет
на размер
многогранника.
Повторением
операции мы
уменьшаем
размеры исходного
многогранника
и потом отслеживаем
шаги поиска
и приближения
(к пределу). В
процессе уменьшения
многогранник
иногда может
принимать
настолько малые
размеры, что
невозможно
будет найти
решение. Для
возобновления
процесса поиска
мы будем использовать
,
которая выбирает
новый многогранник
и новый процесс
многократного
уменьшения
многогранника
начинается
заново. Размер
многогранника
определяется
как
.
Если
будет меньше
ранее определенного
значения e1,
то начнет выполняться
новый цикл.
Построение
большего по
размерам
многогранника
позволяет
получить следующие
преимущества:
Увеличение размера многогранника увеличивает шаг поиска на столько, чтобы он был способен достичь наилучшей вершины.
Форма многогранника изменяется в соответствии с направлением поиска.
Результаты двух следствий сравниваются. Цикл будет повторяться до тех пор, пока не возникнет каких-либо существенных различий между результатами, т.е. разность решений двух циклов будет меньше ранее определенного значения e2. Ниже представлен подробный алгоритм вычисления. LВ алгоритме, при достижении 14 шага, цикл завершается. На 13 шаге завершается стадия повторения этого цикла. Таким образом, kk – номер цикла, который начинается с 0, а k – номер стадии для каждого цикла, который тоже начинается с 0.
(Инициализация)
Шаг 1) Пусть
kk=0 и k=0.
Выбираем
и
в
выражениях
(15), (17) и (18). Также выбираем
е1 и е2. Пусть
OLDХs=[0,0,…,0].
(Вычисление первой вершины многогранника)
Шаг 2) Вычисляем
по (20). Если
подходит, тогда
;
иначе, величине
присваивается
подходящая
вершина, преобразованная
процедурой
(ПВР) из
.
(Вычисление остальных n-1 вершин многогранника)
Шаг 3) Для i=2,3,…,n
вычисляем
по
(21). Если
подходит, тогда
;
иначе, величине
присваивается
подходящая
вершина, преобразованная
процедурой
(ПВР) из
.
Шаг 4) Из n
вершин
а)
определяем
,
которая принимает
наименьшее
значение функции
и б)
,
которая принимает
наибольшее
значение функции.
Из этого следует
и
.
Шаг 5) Вычисляем
центр многогранника
по
(13).
(Отображение)
Шаг 6) Проводим
отображение
для получения
с помощью (14) и
(15). Полученную
величину
приводим
к подходящему
для нас виду
процедурой
(ПВР), если до
этого она была
не подходящей.
(Растяжение,
при
)
Шаг 7) Если
,
то выполняем
а), б), и с) ………………………;
иначе, переходим
к шагу 8).
а) Если
полагаем
,
потом увеличиваем
k=k+1 и
переходим на
шаг 13),
иначе продолжаем
(Замечание:
показывает,
что некоторые
вершины многогранника
в результате
отображения
имеют хоть и
малые, но положительные
значения. Растяжение
нельзя проводить,
т.к. они могут
стать отрицательными,
а это нарушает
условие о
положительных
временных
интервалов.
б) Выполняем
отображение
для получения
по формулам
(16) и (17). Приводим
к подходящему
для нас виду
процедурой
(ПВР), если до
этого она была
не подходящей.
с) Выбираем

потом увеличиваем k=k+1 и переходим на шаг 13).
Шаг 8) Если
для некоторых
полагаем
,
потом увеличиваем
k=k+1 и
переходим на
шаг 13).
Шаг 9) Если
,
тогда полагаем
.
(Сжатие)
Шаг 10) Выполняем
сжатие для
получения
величины
по
формуле (18). Полученную
величину
приводим
к подходящему
для нас виду
процедурой
(ПВР), если до
этого она была
не подходящей.
Шаг 11) Если
,
тогда полагаем
,
потом увеличиваем
k=k+1 и
переходим на
шаг 13), иначе
продолжаем.
(Уменьшение)
Шаг 12) Уменьшаем многогранник следующим образом:
,
i=1,2,…,n.
(Проверка размера многогранника)
Шаг 13) Если
,
тогда переходим
на шаг 14), иначе
переход на шаг
4).
(Проверка на близость результатов решений двух циклов)
Шаг 14) Если
,тогда
выводим
как результат
и прекращаем
поиск; иначе
полагаем
,
.
Потом увеличиваем
kk=kk+1, обнуляем
k=0, и переходим
на шаг 3).
Алгоритм
оптимизации
всегда приводит
не удовлетворяющую
величину к
подходя-щему
для нас виду
процедурой
(ПВР), которая
выполняет
преобразование
не удовлетворяющих
величин умножением
на величину
.Процедура
преобразования
занимает очень
мало времени.
В начале
каждого цикла
n вершин
первоначально
определяются
так, что любая
из (n-1) вершин
линейно независима.
Новая вершина,
которая замещает
,
всегда представляет
собой линейную
комбинацию
и остальных
n-1 вершин.
Следовательно,
любая из (n-1)
вершин из нового
выбора вершин
n все еще
линейно независима.
Расположение
исключает
возможность
того, что поиск
попадет в
подпространство.
Вычисление
производной
для
![]()
Условие
непрерывности
по скорости
дает нам
,
i=1,2,…,n-1,что
при использовании
уравнений (1) и
(2) приводит нас
к уравнению
вида:
,
i=1,2,…,n-1.
(22)
Не оговоренные
присоединенные
переменные
в двух особых
точках могут
быть выражены
граничными
величинами
начальных и
конечных узлов
вместе с
и
.
Следовательно,
,
(23)
(24)
Подставляя (23) и (24) в (22) получаем
(25)
(26)
(27)
(28)
(29)
Из-за условия
непрерывности
по ускорению
в уравнениях
(25) и (29)
примем
равным
.Таким
образом, (25) – (29)
–система, состоящая
из n-2 уравнений
с n-2 неизвестными
,для
i=2,3,…,n-1.
ВЫВОДЫ
В представленной курсовой работе был разработан робот для разминирования различных объектов, рассчитаны его параметры и рабочие характеристики, которые были получены при моделировании в пакете прикладной программы Mathcad 2001.
В ходе данной разработке был проведен анализ задачи «Проектирование робота». Разработана структура функционирования и передвижения ноги робота.
В результате курсового проектирования была выполнена поставленная задача разработки исследуемого объекта.
ПЕРЕЧЕНЬ ССЫЛОК
1. Советов Б.Я., Яковлев С.А. “Робототехника”. - М.: Высш. шк., 2005.- 271 с.
2. Методические указания к курсовой работе по дисциплине "Робототехника и мехатроника" для студентов специальности ГКСР ". 1999.
Аш Ж., Андре П., Бофрон Ж. Датчики измерительных систем. В 2 т. Пер с фр. М.:Мир, 2002;
Бауман Э. Измерение сил электрическими методами: Пер. с нем. Мир, 1978. Энергоатомиздат, 2001;
Воротников С.А. Информационные устройства робототехнических систем. М.: Изд. МГТУ им. Н.Э.Баумана, 2005
Вульвет Дж. Датчики в цифровых системах: Пер. с англ. М.:Энергоиздат, 2003;
Гориневский Д.М. Формальский А.М., Шнейдер А.Ю. Управление манипуляционными системами на основе информации об усилиях. М.:Изд.фирма «Физико-математическая литература», 2001;
Погребной В.О., Рожанковский И.В., Юрченко Ю.П. Основы информационных процессов в роботизированном производстве;
Письменный Г.В., Солнцев В.И., Воротников С.А. Системы силомоментного очувствления роботов. М.: Машиностроение, 2000