Транспортный робот с наблюдателем статического момента БГУИР КП 1-53 01 07 ПЗ

Министерство  образования Республики Беларусь

 

Учреждение  образования

БЕЛОРУССКИЙ ГОСУДАРСТВЕННЫЙ УНИВЕРСИТЕТ

ИНФОРМАТИКИ И РАДИОЭЛЕКТРОНИКИ

 

 

Факультет  информационных технологий и управления

 

Кафедра  систем управления

 

 

 

 

 

 

 

ПОЯСНИТЕЛЬНАЯ ЗАПИСКА

к курсовому  проекту

на тему

 

ТРАНСПОРТНЫЙ  РОБОТ

С НАБЛЮДАТЕЛЕМ СТАТИЧЕСКОГО МОМЕНТА

БГУИР КП 1-53 01 07 ПЗ

 

 

Студенты	Олешкевич А.С. Столпинский Н.О.
Руководитель	Хаджинов М.К.

 

 

 

 

 

 

 

 

 

Минск 2013

РЕФЕРАТ

 

РОБОТ-СНЕГОУБОРЩИК, ТРАНСПОРТНЫЙ, НАБЛЮДАТЕЛЬ СТАТИЧЕСКОГО МОМЕНТА, АЛГОРИТМ ФУНКЦИОНИРОВАНИЯ, МОДЕЛИРОВАНИЕ

 

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

 

 

СОДЕРЖАНИЕ

 

РЕФЕРАТ 2

ВВЕДЕНИЕ 4

1   ОПИСАНИЕ СИСТЕМЫ УПРАВЛЕНИЯ 6

1.1 Конструкция и принцип действия системы 6

1.2 Функциональная схема 10

1.3 Алгоритм функционирования 12

1.4 Приводное устройство 15

2  АНАЛИЗ СИСТЕМЫ НАВИГАЦИИ 18

2.1 Общие сведения и классификация систем навигации 18

2.2 Система навигации с использованием одометрических алгоритмов 23

3   МОДЕЛИРОВАНИЕ СИСТЕМЫ 26

3.1 Математическая модель системы навигации 26

3.2 Математическая модель двигателя постоянного тока 28

3.3 Реализация наблюдателя статического момента инерции 32

СПИСОК ИСТОЧНИКОВ 35

 

ВВЕДЕНИЕ

 

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

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

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

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

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

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

 

1   ОПИСАНИЕ СИСТЕМЫ УПРАВЛЕНИЯ

1.1 Конструкция и принцип действия системы

 

Робототехническая система-снегоуборщик обеспечивает эффективное выполнение уборки местности от снега по команде путем распознавания расстояния и направления движения робота-снегоуборщика.

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

 

 

Рисунок 1.1 – Изображение робота-снегоуборщика

 

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

 

 

 

Рисунок 1.2- Подключаемые узлы уборочной  части

 

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

В состав установленных на роботе комплексов приборов и оборудования входят:

• навесное оборудование
• система освещения
• приводы
• система связи
• пост управления
• энергоустановка
• система датчиков

 

Рисунок 1.3 – Обобщенная структура  робота-снегоуборщика

 

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

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

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

Задача навигации робота-снегоуборщика, задачи определения встретившихся  преград и т.п. возлагаются на систему управления.

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

Рисунок 1.4 – Обобщенная структура  мобильного робототехнического комплекса

 

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

1.2 Функциональная схема

 

Робот-снегоуборщик выполняет уборку снега по заранее составленной карте местности. Во время движения производится автоматическая коррекция траектории движения робота. Управление роботом осуществляется автономной СУ (бортовым компьютером) или по радио с помощью телерадиомодуля. СУ объединена с подсистемами датчиков, управления и связи.

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

 

 

Рисунок 1.4- Функциональная схема робота-снегоуборщика

 

Центральное управляющее устройство выполнено с универсальной вычислительной машиной, функциональная схема которой  показана на рисунке 1.5. Центральное управляющее устройство содержит центральный процессор (ЦП), постоянное запоминающее устройство (ПЗУ), оперативное запоминающее устройство (ОЗУ), дисплей, устройство ввода, запоминающее устройство и устройство связи.

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

 

 

Рисунок 1.5- Блок-схема связи по шине данных вычислительной машины и функциональных блоков робота-снегоуборщика

 

1.3 Алгоритм функционирования

 

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

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

Рисунок 1.6 – Алгоритм составления  карты местности

 

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

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

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

 

 

Рисунок 1.7 - Алгоритм функционирования робота-снегоуборщика

 

1.4 Приводное устройство

 

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

Рисунок 1.6 – Вид в перспективе приводного устройства

 

На рисунке 1.6 приняты следующие обозначения: 1 - два электродвигателя, 2 - два ведущих колеса, 3 - ведущий шкив, 4 - ведущая ось, 5 - два ведомых колеса, 6 - ведомая ось, 7 - ведомый шкив.

 

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

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

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

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

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

 

Рисунок 1.8 – Вид сбоку, показывающий основные части приводного устройства робота-пылесоса

 

2  АНАЛИЗ СИСТЕМЫ НАВИГАЦИИ

2.1 Общие сведения и классификация систем навигации

 

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

 

 

Рисунок 2.1 – Базовые элементы всех роботизированных систем

 

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

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

 

Рисунок 2.2- Замкнутая кольцевая система во взаимодействии

с окружающей средой

 

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

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

 

Рисунок 2.3- Зоны навигации

 

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

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

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

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

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

В робототехнике выделяют три навигационные  системы:

а) глобальная - определение абсолютных координат устройства при движении по длинным маршрутам;

б) локальная - определение координат устройства по отношению к некоторой (обычно стартовой) точке. Эта схема востребована разработчиками тактических беспилотных самолетов и наземных роботов, выполняющих миссии в пределах заранее известной  области;

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

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

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

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

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

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

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

Следующий способ навигации – это  использование лазерных дальномеров  и ультразвуковых генераторов (сонаров). Однако лазерный луч поможет получить образ среды только в зоне прямой видимости. Кроме того, на пути луча часто возникают мелкие помехи, вносящие погрешность в такой образ. А  ультразвуковые датчики характеризуются  большим временем отклика (если робот  находится на большом и открытом пространстве), порядка десятых долей  секунды, что не позволяет роботу перемещаться быстро. Скорость звука  в разных условиях также может "плавать", влияя на точность оценки расстояния, в результате в "голове" робота искажается общая картина окружающей среды. Создание трехмерных карт с помощью  лазеров в масштабе реального  времени еще более затруднительно и, как минимум, требует существенных вычислительных мощностей, которые  пока не удается воплотить в виде компактных бортовых плат. По этим причинам ценность информации, поступающей от бортовых датчиков, невелика. Роботу необходимо перевести ее в формальное и структурированное "словесное" описание мира (задача распознавания).

 

2.2 Система навигации с использованием одометрических алгоритмов

 

Одометрические системы используются для оценки перемещения, используя  данные о движении приводов. Эти  данные поступают от датчиков угла поворота (энкодер или ДУП). Такие датчики могут быть накапливающими и абсолютными.

Мы будем использовать абсолютные ДУПы. Они выдают на выходе сигналы, которые можно однозначно интерпретировать как угол поворота вала датчика угла. Датчики угла этого типа не требуют привязки системы отсчёта к какому-либо нулевому положению.

Рассмотрим робота с энкодерами считающими углы поворота колес. Он некоторое время движется вперед (возможно объезжает препятствия), и хочет узнать пройденное расстояние. Так как суммарный угол поворота каждого колеса известен, так же как и его радиус, пройденное расстояние можно легко вычислить.

Зная радиус колеса r можно вычислить длину окружности:

(2.1)

 

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

(2.2)

 

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

Полный  путь, пройдённый роботом за время  отсчета определяется по формуле 2.3.

 

(2.3)

 

Здесь N – количество импульсов энкодера на участок, L – расстояние, которое проходит робот за один импульс.

 

Рисунок 2.4 – Ошибка одометрии

 

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