Научная статья на тему 'Система обхода препятствий робота посредством УЗ дальномеров с применением пропорционального регулятора'

Система обхода препятствий робота посредством УЗ дальномеров с применением пропорционального регулятора Текст научной статьи по специальности «Математика»

CC BY
290
37
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
МИКРОКОНТРОЛЛЕР / ПРОПОРЦИОНАЛЬНЫЙ РЕГУЛЯТОР / УЛЬТРАЗВУКОВОЙ ДАТЧИК / ДРАЙВЕР ДВИГАТЕЛЯ / MICROCONTROLLER / PROPORTIONAL CONTROLLER / ULTRASONIC SENSOR / MOTOR DRIVER

Аннотация научной статьи по математике, автор научной работы — Черных А. А.

В данной работе будет описано реализация и отладка робототехнической платформы с системой обхода препятствий посредством УЗ дальномеров с применением пропорционального регулятора.

i Надоели баннеры? Вы всегда можете отключить рекламу.
iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

ROBOT OBSTACLE AVOIDANCE SYSTEM BY USING ULTRASONIC RANGEFINDER AND PROPORTIONAL CONTROLLER

In this article will be described the implementation and debugging of robotic platform with obstacle avoidance system using ultrasonic rangefinders and a proportional controller.

Текст научной работы на тему «Система обхода препятствий робота посредством УЗ дальномеров с применением пропорционального регулятора»

Из неравенства (3) находим, что,

2

Ха в,-

г г г

г=1 ) V г=1 ) г=1

=1 Е«гВг Е«г-в; |=E«2|b,U2+Z«,«,b,b;=х«г2|b,U2 +

г * J

+Ya.a (в.в* +в .в*)<У«2|В.| 2 +Уаа (|В.| 2 +|в .1 2) = Уа2|В.| 2 +

Lu г Jy г j J г/ Lu г I Лк Lu г j Л г \r \ J\-R ' Lu г I г Ir

Лемма доказана.

+

—V аа (|В J 2 +|в .1 ) = Уа2 |В .1 2 +—\аа. |В .1 2 +—\аа. |в

о Lu г jy\ г\к J\r ' ^ г I г1к г JI г1к г J

г* j

г* j

г* j

J Ir

= ^а2 |В .1 +V аа |В .1 =V а (а + а9 +... + а) |В .1 =Уа |В .1

г | г |r г j \ г |r г V 1 2 n ' \ г |r г | г |r

г=1 г* j г=1 г=1

Доказательство теоремой 3.

Рассмотрим следующие случае:

1- случай. Для Vi (i = 1, п) пусть at = 0 . Тогда очевидно будить равенства.

_____ а2 в

2- случай. Для V. (i = 1,п) пусть а. * 0 . Для а = —г— и G. = —г- е L(H)

п ,2 г а

V

j=1

а.

операторы выполняет условие леммы. Тогда выполняет следующие неравенства: 2

<VаGI2

R i=1

ТаЯ

г=1

Значит

IR

а2 В,

Еы г ц,-

п

V

г=^ а 2 а.

j=1

1 V

j=1

В,

V а г В г

Отсюда следуют неравенства:

2

п п

<Т а2 ТВ Ir ■

r г=1 г=1

3-случай. Для а = 0,а2 = 0, ...ак = 0,ак+1 * 0,ак+2 * 0,...,ап * 0 тогда, для а. * 0 (г = к +1, п ) выполняет следующие неравенства:

V ав

i=k+1

начит,

п

V ав

пп

г ^ I г Ir

r г=к+1 г=к+1

< V а.2 V |в

г=к+1 i п

V а.в

R

г=1

Таким оброзом,

п п

а

пп

< V а2 Ев Ir 2 = V а,2 Ёв

г ^ \ гт ^ г ^ \ г Ir

r г=к+1 г=к+1 г=1 г=к+1

пп

пп

V а2 V |В, |r 2 < V а2 V в Ir 2 + V а2 V|B, R2 =V а2 Vk r

г=1 г=к+1 г=1 г=к+1 г=1 г=1 г=1 г=1

теорема доказана.

Литература

R

г=1

г=1

2

г=1

2

2

2

а

а

2

R

R

2

2

2

2

г=к+1

1. Ф.Р.Гантмахер. «Теория матриц». часть I, II .Москва. “Наука”1988.

2. Р.М.Мадрахимов, Ф.К.Атаев. «Коши-Буняковский тенгсизлигининг матрицавий аналоги» .Хоразм Маъмун академияси ахборотномаси.2008, № 3/4(8).9-11.

3. Г.Г.Харди, Дж.Е.Литтльвуд и Г. Полиа. Неравенства. Москва Государственное издательство иностранной литературы. 1948 г.

4. R. Bellman, A. Hoffman, A note on an inequality of Ostrowski and Taussky, Arkiv. Math., 5 (1954), 123-127.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

5. E.F.Beckenbach, An inequality for definite hermitian determinants, Bull. Am. Math. Soc., 35 (1929), 325-329/

6. J. Hadamard, The psychology of invention in the mathematical field, Princeton, N.J., Princeton University Press, 1949.

7. М. Рид, Б. Саймон. Функциональный анализ. 1-часть Издательство «Мир» Москва 1977.

Черных А.А.

Студент; НИ Томский политехнический университет

СИСТЕМА ОБХОДА ПРЕПЯТСТВИЙ РОБОТА ПОСРЕДСТВОМ УЗ ДАЛЬНОМЕРОВ С ПРИМЕНЕНИЕМ ПРОПОРЦИОНАЛЬНОГО РЕГУЛЯТОРА

Аннотация

В данной работе будет описано реализация и отладка робототехнической платформы с системой обхода препятствий посредством УЗ дальномеров с применением пропорционального регулятора.

Ключевые слова: микроконтроллер, пропорциональный регулятор, ультразвуковой датчик, драйвер двигателя.

17

Chernykh A.A.

Student; Tomsk Polytechnic University

ROBOT OBSTACLE AVOIDANCE SYSTEM BY USING ULTRASONIC RANGEFINDER AND PROPORTIONAL

CONTROLLER

Abstract

In this article will be described the implementation and debugging of robotic platform with obstacle avoidance system using ultrasonic rangefinders and a proportional controller.

Keywords: microcontroller, proportional controller, ultrasonic sensor, motor driver.

Введение

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

Работа УЗ дальномеров с микроконтроллером

Характеристики датчика HC-SR04: измеряемый диапазон 3 см — 500 см, точность 0,3 см, угол обзора < 15 °, напряжение питания 5V.

Ширина обзора одного датчика на расстоянии 4 - 5 метров составляет около двух метров (т.е. угол обзора 30°). Это позволяет охватывать достаточно большую область одним датчиком.

В документации на модуль датчика расстояния HC-SR04 указано, что для запуска измерений на вход Trig надо подать импульс длительностью 10-15 микросекунд. После чего на выходе Echo появится импульс длительностью 150мкс — 25мс. Длительность этого импульса пропорциональна расстоянию до объекта, от которого отразился ультразвуковой сигнал. Для того что бы из длительности сигнала в микросекундах получить расстояние в сантиметрах используется формула:

D = T/58

где T — длительности сигнала в микросекундах, D — расстояние в сантиметрах. Была собрана схема согласно рисунку 1 и установлена на платформу.

Рис. 1 Электрическая принципиальная схема подключения УЗ датчика Лабораторные испытания колесной платформы малых габаритов

Для экспериментов была использована колесная платформа (рис.2) с габаритами 250мм х180мм в качестве макета для апробации алгоритма. Была написана программа на языке C++. Произведены натурные испытания.

Рис.2 Платформа для лабораторных испытаний

18

Проектирование силовой части для тестирования макета платформы

Рис.3 Силовой модуль на основе драйвера L293D

Для макета платформы была реализована силовая часть, основанная на драйвере двигателя L293D. Управляющий сигнал подается с микроконтроллера на драйвер. К драйверу подключен внешний источник питания. Данный драйвер способен выдерживать ток до 600мА на канал, что достаточно для данного малогабаритного робота. Также драйвер позволяет управлять скоростью двигателей с помощью изменения скважности ШИМ.

Составление печатной платы произведено в программе SLayout-5.

Готовый силовой модуль приведен на рисунке 3.

Принцип работы алгоритма обхода препятствий роботом по УЗ датчикам

Измерение дистанции осуществляется двумя УЗ датчиками. Диапазон работы от 0,03 до 5 метров. Для обхода препятствия используем пропорциональный регулятор. Установлено два датчика по краям платформы на передней части бампера, направленных вперед.

Рис.4 Схема определения препятствия роботом

Определение препятствия (рис.4):

• Измерение с датчика 1;

• Измерение с датчика 2;

• Разность показаний с датчика 1 и датчика 2;

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

• Умножение получившегося результата на коэффициент, в зависимости от конструкции и чувствительности рулевого механизма.

К — коэффициент усиления (в зависимости от конструкции поворотного механизма)

L = (L1- L2)

U = KL

Соответственно U будет в пределах от -4,97К до 4,97К. Поэтому крайние значения соответствуют крайним положениям рулевого узла (при -4,97К поворот влево при максимально вывернутом рулевом механизме, при 4,97К поворот вправо при максимально вывернутом рулевом механизме). Изменяем скважность сигнала ШИМ, подавая его на сервопривод, пропорционально значению U.

Заключение

Была разработана система обхода препятствий робота посредством УЗ дальномеров с применением пропорционального регулятора. Произведены натурные испытания. В дальнейшем планируется реализация полноценного ПИД регулятора для данной системы.

19

Литература

1. Черных А.А., Тутов И.А. Разработка платформы на основе Arduino UNO для проведения анализа алгоритмов обхода препятствий подвижным объектом. - Сборник трудов международной X научно-практической конференции студентов, аспирантов и молодых ученых, с. 219-220, НИ ТПУ, 2012.

2. Datasheet на ультразвуковой датчик HC-SR04.

3. Datasheet на драйвер L293D.

4. Brian W. Evans. Arduino Programming Notebook.- Publeshed: First Edition August 2007.

Черных А.А.

Студент; НИ Томский политехнический университет

СОПРЯЖЕНИЕ GPS МОДУЛЯ UBLOX 6M С AVR МИКРОКОНТРОЛЛЕРОМ

Аннотация

В данной работе будет описано сопряжение и настройка GPS модуля Ublox 6m с микроконтроллером AVR ATmega 328. Подобные модули активно применяют в робототехнике для навигации робота в пространстве на открытой местности.

Ключевые слова: микроконтроллер, GPS модуль, протокол NMEA.

Chernykh A.A.

Student; Tomsk Polytechnic University

GPS UBLOX 6M MODULE PAIRING WITH THE AVR MICROCONTROLLER

This article describes the pairing and setup process GPS module Ublox 6m with AVR microcontroller ATmega 328. Similar modules are actively used in robotics for robot navigation in open space conditions.

Keywords: microcontroller, GPS module, NMEA protocol.

Введение

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

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

Сопряжение GPS модуля с МК

Первоначальным этапом необходимо настроить GPS модуль для передачи координат на микроконтроллер и отделением нужной информации для ее дальнейшего применения в программировании по алгоритму движения робота, так как сам модуль отсылает на МК много разной информации. Был выбран GPS модуль u-blox 6m.

Для передачи GPS координат на микроконтроллер используют NMEA 0183 протокол.

NMEA («National Marine Electronics Association») — полное название «NMEA 0183» — текстовый протокол связи морского (как правило, навигационного) оборудования между собой. Стал особенно популярен в связи с распространением GPS приёмников, использующих этот стандарт.

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

$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M„*47

GGA - NMEA заголовок, 123519 -UTC время 12:35:19;

4807.038, N - Широта, 48 градусов 7.038 минуты северной широты;

01131.000, Е - Долгота, 11 градусов 31.000 минуты восточной долготы.

Подключение GPS модуля к МК

Рис.1 Вывод координат на LCD

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

Была собрана схема подключения (рис.2) GPS, LCD к микроконтроллеру и написана программа на языке C++. В качестве демонстрационного варианта были выведены координаты на LCD дисплей (рис.1). Использовался МК ATmega 328, 16 символьный дисплей 8*2 (модель 1602 ZFC), GPS u-blox 6.

20

i Надоели баннеры? Вы всегда можете отключить рекламу.