Способ и устройство мобильного робота для прохождения замкнутых контуров и лабиринтов Российский патент 2018 года по МПК B25J5/00 B25J9/16 G05B19/45 G05D1/02 

Изобретение относится к робототехнике и может быть использовано в роботах, например для поиска пути в лабиринтах и пересеченной местности.

Известен мобильный робот [Патент РФ №2487007, кл. B25J 5/00, 2012 (аналог)], который содержит платформу, устройство для обнаружения препятствия, манипулятор, позиционно чувствительный датчик, энкодер.

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

Наиболее близким изобретением по технической сущности является мобильный робот [Патент РФ №2274543, кл. B25J 5/00, 2006 (прототип)]. Устройство содержит блок обнаружения препятствия, блок определения текущего местоположения, блок наблюдения за текущим пространством перед роботом и источник питания.

Недостаток этого устройства заключается в том, что оно не способно принимать решения о перемещении самостоятельно, а управляется только серверным компьютером через канал Интернет, что не позволит его использование там, где нет сигнала интернета.

Известен способ нечеткого управления движением подвижного состава рельсового транспортного средства с возможностью плавного управления тягой [Патент РФ №2296357, кл. G05B 13/02, B60L 15/20, 2017 (аналог)].

Недостатком является то, что он основан на традиционных моделях нечеткого вывода, где число заключений равно числу нечетких правил управления (НПУ). Причем с ростом числа НПУ увеличивается и число заключений. Это значительно увеличивает сложность вычислений.

Наиболее близким по способу вычисления является способ управления скоростью резания на токарном оборудовании с ЧПУ [Патент РФ №2465115, кл. B23Q 15/00, 2012 (прототип)].

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

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

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

Изобретение поясняется чертежами: фиг. 1 - общий вид мобильного робота для прохождения замкнутых контуров и лабиринтов, вид сверху; фиг. 2 - общий вид мобильного робота для прохождения замкнутых контуров и лабиринтов, вид справа; фиг. 3 – функциональная схема мобильного робота для прохождения замкнутых контуров и лабиринтов; фиг. 4 – схема– поиска максимального расстояния и угла поворота α; фиг. 5 – функция принадлежности входной переменной величины сигнала ШИМ (широтно-импульсная модуляция); фиг. 6 – функция принадлежности входной переменной угол (α); фиг. 7 – функция принадлежности выходной переменной задержки времени.

Мобильный робот для прохождения замкнутых контуров и лабиринтов содержит платформу 1, правый и левый электродвигатели 2 и 4, правое и левое колеса 3 и 5, роликовый стабилизатор горизонтальной плоскости 6, сервопривод 7, ультразвуковой датчик расстояния 8, центральную неподвижную угловую опору 9, центральный инфракрасный датчик расстояний 10, правое угловое креплении 11, правый инфракрасный датчик расстояний 12, левое угловое крепление 13, левый инфракрасный датчик расстояний 14, плату управления двигателями 15 (порты rd1, rd2, ld1, ld2, D4, D5, D6, D7), микроконтроллер 16 (порты rid1, rid2, rid3, cid1, cid2, cid3, lid1, lid2,lid3, sp1, sp2, sp3, ud1, ud2, ud3, ud4, M4, M5, M6, M7, POW), содержащий блок нечетких вычислений и принятия решений 17, блок расчета угла поворота 18 и блок питания 19.

Связи в мобильном роботе для прохождения замкнутых контуров и лабиринтов расположены следующим образом. На платформе 1 закреплены правый и левый электродвигатели 2 и 4, на которых жестко установлены правое и левое колеса робота 3 и 5. Правый электродвигатель 2 соединен проводами с платой управления электродвигателями 15 через порты rd1 и rd2, а левый электродвигатель 4 соединен проводами с платой управления электродвигателями 15 через порты ld1 и ld2. Входы и выходы платы управления двигателями 15 соединены портами D4, D5, D6, D7 с входами и выходами микроконтроллера 16 M4, M5, M6, M7 соответственно. Левый и правый инфракрасные датчики расстояний 12 и 14 закреплены на угловых креплениях 11 и 13 установленных на платформе 1 под углом 45 градусов по отношению к центральной оси платформы 1, а центральный инфракрасный датчик расстояний 10 закреплен на угловой опоре 9 в передней части платформы 1. Угловые крепления 11 и 13, а также угловая опора 9 жестко закреплены на платформе 1. Информационный выход левого инфракрасного датчика расстояния 14 соединен с портом lid2 микроконтроллера 16, информационный выход правого инфракрасного датчика расстояния 12 соединен с портом rid2 микроконтроллера 16, информационный выход центрального инфракрасного датчика расстояния 10 соединен с портом cid2 микроконтроллера 16. Ультразвуковой датчик 8 закреплен на подвижной опоре сервопривода 7, который закреплен в передней части платформы 1. Информационные выходы ультразвукового датчика 8 расстояний соединены с входами микроконтроллера 16 через порты ud2 и ud3. Вход сервопривода 7 соединен с выходом микроконтроллера 16 через порт sp2. Блок нечетких вычислений и принятия решений 17 и блок расчета угла поворота 18 встроены в микроконтроллер 16. На платформе 1 закреплен блок питания мобильного робота 19, вход и выход которого подключен к разъему питания POW микроконтроллера 16. На платформе 1 (снизу) установлен роликовый стабилизатор 6. Порты микроконтроллера 16 rid1, cid1, lid1, sp1, ud1 подключены через порт POW к контакту питания +5V блока питания 19. Порты микроконтроллера 16 rid3, cid3, lid3, sp3, ud4 подключены через порт POW к контакту заземления (GND) блока питания 19.

Принцип работы мобильного робота для прохождения замкнутых контуров и лабиринтов заключается в следующем. Напряжение от блока питания 19 поступает в микроконтроллер 16. Микроконтроллер 16 предает сигнал ШИМ в диапазоне от [0, 255] через выходы M4 и M5 на входы платы управления электродвигателями 15 D4 и D5. Затем напряжение поступает на правый и левый электродвигатели 2 и 4 через порты rd1, rd2 и ld1, ld2, что приводит мобильный робот для прохождения замкнутых контуров и лабиринтов в движение. При этом через выходы M6 и M7 микроконтроллера 16 передается сигнал о направлении вращения колес 3 и 5 на входы платы управления электродвигателями 15 D6 и D7 в следующей зависимости: при подаче логической «1» на M6 и M7 – движение вперед, при подаче логического «0» на M6 и M7 – движение назад, при подаче логической «1» на M6, а логического «0» на M7 - поворот направо, при подаче логического «0» на M6, а логической «1» на M7 - поворот влево.

В процессе движения мобильный робот для прохождения замкнутых контуров и лабиринтов постоянно сканирует пространство с помощью инфракрасных датчиков расстояний 10, 12, 14 и передает данные о наличии препятствий по портам rid2, cid2 и lid2 в микроконтроллер 16. Данные из микроконтроллера 16 поступают в блок расчета угла поворота 18 и блок нечетких вычислений и принятия решений 17, где они обрабатываются, и принимается решение о следующем действии. При отсутствии препятствий мобильный робот для прохождения замкнутых контуров и лабиринтов продолжает двигаться прямо. Как только препятствие обнаружено, т.е. расстояние от центрального инфракрасного датчика 10 или левого инфракрасного датчика 14 или правого инфракрасного датчика 12 меньше порогового значения расстояния, питание на электродвигатели 2 и 4 отключается, и робот останавливается, т.е. от микроконтроллера 16 через порты M4 и M5 на порты D4 и D5 платы управления двигателями 15 передается сигнал ШИМ равный 0, вследствие этого шпиндели электродвигателей 2 и 4 перестают вращаться и мобильный робот останавливается. Далее от микроконтроллера 16 на порт sp2 сервопривода 7, на котором закреплен ультразвуковой датчик расстояний 8, подается сигнал для вращения. Путем поворота сервопривода 7 от 0° до 180° через каждые 10° делается замер расстояний (l₁, l₂, l₃, …, l_n) с помощью ультразвукового датчика расстояний 8. Эти данные попадают в массив, где каждому значению расстояния l_n ставится в соответствие угол α_n, на который был повернут сервопривод 7. Построенный массив передается в микроконтроллер 16 и затем в блок расчета угла поворота 18. Из массива размеров находится максимальное расстояние l_max и определяется связанный с ним угол поворота α_max. Причем в массив попадает 19 пар значений [l_n, α_n] и если l_max на 15 позиции, следовательно, угол поворота связанный с ним определиться как α_max = (15 – 1)⋅10 =140°. Далее для вычисления угла поворота необходимо сделать проверку. Если α _max больше 90°, то его необходимо преобразовать по правилу α = α _max – 90° = 140 – 90 = 50° и робот понимает, что необходимо совершить поворот на 50° вправо. Для этого от микроконтроллера 16 на плату управления электродвигателями 15 подается сигнал логической «1» на M6, а логического «0» на M7. В случае если угол α _max меньше 90°, например α_max = 60°, то роботу необходимо повернуться влево и расчет производится по правилу α = 90° – α _max = 90 – 60 = 30°. После этого от микроконтроллера 16 на плату управления электродвигателями 15 подается сигнал логического «0» на M6, а логической «1» на M7. Рассчитанный и преобразованный угол α передается в блок нечетких вычислений и принятия решений 17, где согласно способу, рассмотренному ниже, определяется временная задержки t для поворота, в течение которого сигнал ШИМ действует через порты M4 и M5 на электродвигатели 2 и 4. В течении этого времени задержки t мобильный робот поворачивается на требуемый угол α.

Способ для прохождения замкнутых контуров и лабиринтов мобильным роботом с целью расчета времени задержки, в течение которого сигнал ШИМ от микроконтроллера 16 действует через порты M4 и M5 на электродвигатели 2 и 4 для поворота его на требуемый угол α, состоит из следующих шагов.

Шаг 1. Фаззификация входных переменных. Формируется нечеткая MISO-система, у которой на входе величина сигнала ШИМ S=[s₁]+[s₂]+[s₃]+[s₄]+[s₅] и требуемый угол поворота A=[a₁]+[a₂]+[a₃], а на выходе временная задержка подачи питания на электродвигатели 2 и 4 T=[t₁]+[t₂]+[t₃]+[t₄]+[t₅]+[t₆]+[t₇]. Входная лингвистическая переменная угла поворота имеет три терма, сигнала ШИМ пять термов, а выходная времени задержки t семь термов.

Шаг 2. Происходит определение степеней принадлежности для каждой из входных переменных на основе информации о текущем значении параметра сигнала ШИМ на двигателях мобильного робота для прохождения замкнутых контуров и лабиринтов и требуемого угла поворота для продолжения движения. В результате определяются фаззифицированные вектора значений для каждого терма функции принадлежности s’, a’.

(1)

Шаг 3. Формирование базы знаний, в которой содержатся нечеткие правила вида «Если … То » (табл. 1).

Таблица 1. Нечеткая база знаний

НП Если То НП Если То НП Если То НП₁ s₁ a₁ t₇ НП₆ s₂ a₃ t₄ НП₁₁ s₄ a₂ t₃ НП₂ s₁ a₂ t₆ НП₇ s₃ a₁ t₅ НП₁₂ s₄ a₃ t₂ НП₃ s₁ a₃ t₅ НП₈ s₃ a₂ t₄ НП₁₃ s₅ a₁ t₃ НП₄ s₂ a₁ t₆ НП₉ s₃ a₃ t₃ НП₁₄ s₅ a₂ t₂ НП₅ s₂ a₂ t₅ НП₁₀ s₄ a₁ t₄ НП₁₅ s₅ a₃ t₁

Шаг 4. Построение матрицы нечетких отношений.

Таблица 2. Матрица нечетких отношений

Выходной терм Композиция Максимум t'₇ b₁=soft-min(s₁; a₁) b₁ t'₆ b₂=soft-min(s₁; a₂) b₄=soft-min(s₂; a₁) soft-max(b₂, b₄) t'₅ b₃=soft-min(s₁; a₃) b₅= soft-min(s₂; a₂) b₇=soft-min(s₃; a₁) soft-max(b₃, b₅, b₇) t'₄ b₆=soft-min(s₂; s₃) b₈= soft-min(s₃; a₂) b₁₀=soft-min(s₄; a₁) soft-max(b₆, b₈, b₁₀) t'₃ b₉=soft-min(s₃; a₃) b₁₁= soft-min(s₄; a₂) b₁₃=soft-min(s₅; a₁) soft-max(b₉, b₁₁, b₁₃) t'₂ b₁₂=soft-min(s₄; a₃) b₁₄= soft-min(s₅; a₂) soft-max(b₁₂, b₁₄) t'₁ b₁₅=soft-min(s₅; a₃) b₁₅

На этом шаге согласно матрице нечетких отношений (табл. 2) и нечеткой базы знаний (табл. 1) с помощью мягких арифметической операций минимума (soft-min) и максимума (soft-max) нечеткой логики выбирается минимальное значение из термов входных переменных:

(2)

В качестве мягкой арифметической операций нахождения мягкого минимума (soft-min) используется формула вида:

(3)

В качестве мягкой арифметической операций нахождения мягкого максимума (soft-max) используется формула вида:

(4)

где γ – оператор параметризации, равный 0,009.

Следует заметить, что количество заключений нечетко-логического вывода в матрице нечетких отношений будет равнять числу термов выходной переменной, то есть 7. В традиционной модели нечеткого вывода, количество заключений равняется числу нечетких правил, то есть 15. За счет рационального расположения элементов в матрице нечетких отношений уменьшается количество вычислений.

Шаг 5. Усечение термов выходной переменной, согласно формуле

(5)

где i=1..n – номер заключения нечетко-логического вывода; n = 7.

Шаг 6. Объединение усеченных термов выходной переменной

(6)

Шаг 7. Дефаззификация осуществляется на основе метода центра тяжести

. (7)

Результат вычисления блока нечетких вычислений и принятия решений 17 – величина времени задержки t'' по вышеуказанному способу передается от микроконтроллера 16 через плату управления двигателями 15 на электродвигатели 2 и 4. После поворота мобильного робота на требуемый угол α он продолжает движение прямо до необходимости следующей остановки при обнаружении препятствия.

В качестве примера разберем ситуацию, когда на вход нечеткой MISO-системы подаются значение сигнала ШИМ равное 180 и требуемый угол поворота направо равный 50° вправо.

На первом шаге выполняем формирование функций принадлежности термов входной и выходной переменных.

Для входной переменной сигнала ШИМ функция принадлежности имеет следующий вид:

Функция принадлежности для входной переменной угла поворота имеет вид:

Функция принадлежности для выходной переменной времени задержки сигнала ШИМ на двигателях мобильного робота для прохождения замкнутых площадей и лабиринтов имеет вид:

На втором шаге формируем фаззифицированные вектора значений для каждого терма функции принадлежности s’, a’.

.

(0; 0,333; 0,667).

На третьем шаге строится база состояющая из 15 нечетких правил:

НП₁: Если «a = a₁» И «s = s₁» TO «t = t₇»;

НП₂: Если «a = a₂» И «s = s₁» TO «t = t₆»;

НП₃: Если «a = a₃» И «s = s₁» TO «t = t₅»;

НП₄: Если «a = a₁» И «s = s₂» TO «t = t₆»;

НП₅: Если «a = a₂» И «s = s₂» TO «t = t₅»;

НП₆: Если «a = a₃» И «s = s₂» TO «t = t₄»;

НП₇: Если «a = a₁» И «s = s₃» TO «t = t₅»;

НП₈: Если «a = a₂» И «s = s₃» TO «t = t₄»;

НП₉: Если «a = a₃» И «s = s₃» TO «t = t₃»;

НП₁₀: Если «a = a₁» И «s = s₄» TO «t = t₄»;

НП₁₁: Если «a = a₂» И «s = s₄» TO «t = t₃»;

НП₁₂: Если «a = a₃» И «s = s₄» TO «t = t₂»;

НП₁₃: Если «a = a₁» И «s = s₅» TO «t = t₃»;

НП₁₄: Если «a = a₂» И «s = s₅» TO «t = t₂»;

НП₁₅: Если «a = a₃» И «s = s₅» TO «t = t₁».

Далее на четвертом шаге строится матрица нечетких отношений.

Выходной терм Композиция Максимум t'₇ b₁= -0,0238 -0,0238 t'₆ b₂= -0,0006 b₄= -0,0238 -0,0018 t'₅ b₃= 0,0003 b₅= -0,0006 b₇= -0,0238 -0,0009 t'₄ b₆= 0,0003 b₈= -0,0006 b₁₀= -0,0041 0,00005 t'₃ b₉= -0,0006 b₁₁= 0,1095 b₁₃= 0,0005 0,0988 t'₂ b₁₂= 0,1111 b₁₄= 0,3331 0,3220 t'₁ b₁₅= 0,6655 0,6655

На пятом шаге, выполняется усечение термов выходной переменной.

На шестом шаге выполняем объединение усеченных термов выходной переменной.

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

С помощью предложенного способа осуществляется расчет нового значения временной задержки (t) сигнала ШИМ на электродвигателях 2 и 4 мобильного робота для прохождения замкнутых контуров и лабиринтов, чтобы совершить поворот на требуемый угол (α ), для объезда препятствия.

Таким образом, время задержки сигнала ШИМ на двигателях мобильного робота для прохождения замкнутых контуров и лабиринтов для поворота на 50° градусов и величине сигнала ШИМ 180 равняется 107,14 миллисекундам.

Изобретение относится к робототехнике и может быть использовано для поиска пути в лабиринтах и пересеченной местности. Робот содержит платформу с двумя закрепленными на ней электродвигателями, на которых жестко установлены колеса, микроконтроллер и плату управления двигателями с помощью нечетких правил. Робот содержит сервопривод с закрепленным на нем ультразвуковым датчиком расстояния и тремя инфракрасными датчиками расстояния. Платформа выполнена с жестко закрепленными на ней угловыми креплениями и угловой опорой. Микроконтроллер содержит блок нечетких вычислений и принятия решений, блок расчета угла поворота робота и блок питания. Изобретение направлено на снижение сложности вычислений и устранение зон нечувствительности при прохождении мобильным роботом замкнутых контуров и лабиринтов. 7 ил., 3 табл.

Мобильный робот, предназначенный для прохождения замкнутых контуров и лабиринтов, содержащий платформу с двумя закрепленными на ней электродвигателями, на которых жестко установлены колеса, микроконтроллер и плату управления двигателями, управляемыми с помощью нечетких правил, отличающийся тем, что он снабжен сервоприводом с закрепленным на нем ультразвуковым датчиком расстояния и тремя инфракрасными датчиками расстояния, платформа выполнена с жестко закрепленными на ней угловыми креплениями и угловой опорой, микроконтроллер содержит блок нечетких вычислений и принятия решений, блок расчета угла поворота мобильного робота и блок питания, при этом два инфракрасных датчика расстояния закреплены на угловых креплениях платформы, а один - по центру в передней части платформы, причем микроконтроллер выполнен с возможностью передачи сигналов широтно-импульсной модуляции (ШИМ) мобильного робота на электродвигатели через плату управления двигателями для приведения робота в движение и его поворота на требуемый угол с помощью следующих нечетких правил:

где s₁…₅ - термы функции принадлежности входной переменной для значения сигнала ШИМ, a₁…₅ - термы функции принадлежности входной переменной величины угла поворота, t₁…₅ - термы функции принадлежности выходной переменной задержки времени на двигателях,

при этом перерасчет времени задержки сигнала ШИМ осуществляют по формуле

где - объединение усеченных термов выходной переменной.