Главная страница
Навигация по странице:

  • «Московский государственный технический университет имени Н.Э. Баумана

  • ФАКУЛЬТЕТ

  • 2. Работа с электронно-библиотечными ресурсами сети Интернет, анализ их значимости для исследования, изучение и обобщение полученной информации

  • 2.2. Инерциальные системы навигации

  • 3. Исследование объекта мехатроники, систематизация информации из различных источников 3.1. Исследуемый объект мехатроники

  • 3.2. Основные датчики бесплатформенных инерциальных навигационных систем

  • 3.3. Рассмотрение датчиков, используемых в мобильных устройствах 3.3.1.Одноосевой MEMS-гироскоп с вибрирующим кремниевым кольцом

  • 3.3.2.Емкостной трехосевой MEMS-акселерометр с цифровым выходом

  • 4. Исследование методик и подходов к решению поставленной практической задачи, построение модели объекта мехатроники 4.1. Обзор подходов к инерциальным системам навигации

  • 4.2. Снижение погрешности на этапе измерений

  • 4.2.1. Метод средних значений

  • 4.2.3. Фильтры низких частот

  • Список использованных источников

  • Научноисследовательская работа Исследование инерциальных систем навигации мобильных роботов


    Скачать 0.78 Mb.
    НазваниеНаучноисследовательская работа Исследование инерциальных систем навигации мобильных роботов
    Дата23.12.2021
    Размер0.78 Mb.
    Формат файлаpdf
    Имя файлаbaumanb-61_2020_nir (1).pdf
    ТипНаучно-исследовательская работа
    #316269

    Министерство науки и высшего образования Российской Федерации
    Калужский филиал федерального государственного бюджетного образовательного учреждения высшего образования
    «Московский государственный технический университет имени Н.Э. Баумана
    (национальный исследовательский университет)»
    (КФ МГТУ им. Н.Э. Баумана)
    ФАКУЛЬТЕТ _М-КФ «Машиностроительный»____________________
    КАФЕДРА __М7-КФ «Мехатроника и робототехнические системы»__
    НАУЧНО-ИССЛЕДОВАТЕЛЬСКАЯ РАБОТА
    «Исследование инерциальных систем навигации мобильных
    роботов»
    Студент гр. МХТ.Б–61 _________________ (Лобова А.И.)
    (подпись) (Ф.И.О.)
    Руководитель _________________ (Масюк В.М.)
    (подпись) (Ф.И.О.)
    Оценка руководителя _____ баллов ___________
    30-50 (дата)
    Оценка защиты _____ баллов ___________
    30-50 (дата)
    Оценка проекта _____ баллов __________________
    (оценка по пятибалльной шкале)
    Комиссия: _________________ (_____________________)
    (подпись) (Ф.И.О.)
    _________________ (_____________________)
    (подпись) (Ф.И.О.)
    _________________ (_____________________)
    (подпись) (Ф.И.О.)
    Калуга, 2020

    3
    Содержание
    1.
    Введение ................................................................................................................ 4 2.
    Работа с электронно-библиотечными ресурсами сети Интернет, анализ их значимости для исследования, изучение и обобщение полученной информации5 2.1.
    Навигация мобильных роботов ..................................................................... 5 2.2.
    Инерциальные системы навигации ............................................................... 6 3. Исследование объекта мехатроники, систематизация информации из различных источников ................................................................................................ 9 3.1. Исследуемый объект мехатроники ................................................................. 9 3.2. Основные датчики бесплатформенных инерциальных навигационных систем ...................................................................................................................... 12 3.3. Рассмотрение датчиков, используемых в мобильных устройствах .......... 14 3.3.1.Одноосевой MEMS-гироскоп с вибрирующим кремниевым кольцом 14 3.3.2.Емкостной трехосевой MEMS-акселерометр с цифровым выходом ... 15 4.
    Исследование методик и подходов к решению поставленной практической задачи, построение модели объекта мехатроники ................................................. 17 4.1. Обзор подходов к инерциальным системам навигации .............................. 17 4.2.
    Снижение погрешности на этапе измерений ............................................. 18 4.2.1.
    Метод средних значений ....................................................................... 18 4.2.2.
    Фильтр Калмана ..................................................................................... 18 4.2.3.
    Фильтры низких частот ......................................................................... 20 5.
    Заключение .......................................................................................................... 21
    Список использованных источников ...................................................................... 22

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

    5
    2. Работа с электронно-библиотечными ресурсами сети Интернет,
    анализ их значимости для исследования, изучение и обобщение
    полученной информации
    2.1. Навигация мобильных роботов
    Для успешной навигации в пространстве бортовая система робота должна уметь строить маршрут, управлять параметрами движения (задавать угол поворота колес и скорость их вращения), правильно интерпретировать сведения об окружающем мире, получаемые от датчиков, постоянно отслеживать собственные координаты.
    Технические сложности мобильной навигации:
    • Чтобы двигаться к цели, роботу необходимо сформировать достаточно точный образ окружающего его пространства.
    • В ходе движения робот должен быстро и точно управлять мотором и положением колес.
    • Робот должен знать свое реальное местоположение, которое почти всегда отличается от хранящегося в бортовой системе.
    Существует несколько схем навигации автономных устройств:
    • Глобальная – определение абсолютных координат устройства при движении по длинным маршрутам.
    • Локальная – определение координат устройства по отношению к некоторой (обычно стартовой) точке. Эта схема востребована разработчиками тактических беспилотных самолетов и наземных роботов, выполняющих миссии в пределах заранее известной области.
    • Персональная – позиционирование роботом частей своей конструкции и взаимодействие с ближайшими предметами, что актуально для устройств, снабженных манипуляторами.
    Считается, что чем крупнее аппарат, тем важнее применение глобальной навигации и ниже – персональной.
    Также системы навигации могут быть классифицированы еще по одному признаку – они могут быть пассивными и активными.
    Пассивная система навигации подразумевает прием информации о собственных координатах и других характеристиках своего движения от внешних источников, а активная рассчитана на определение местоположения исключительно посредством собственных устройств (датчиков и т.д.) робота.

    6
    Как правило, все глобальные системы навигации пассивные, локальные бывают и теми, и другими, а персональные схемы всегда активные.
    Пассивные навигационные системы:
    • Глобальная спутниковая система GPS (ошибка в определении собственных координат не может превышать размера автономного аппарата; в противном случае возможны столкновения с устройствами такого же или меньшего размеров и другие конфликты со средой).
    • Радиомаяки (размещение в зоне действий робота источников радиосигналов, которые обрабатываются бортовым микропроцессором; так как радиомаяки располагаются в фиксированных точках некоторого маршрута, аппарат теряет возможность обходить препятствия или выбирать альтернативный путь движения).
    Активные навигационные системы:
    • Инерциальные навигационные системы.
    • Механические и оптические гироскопы (измеряют усилие (момент внешней силы), прикладываемое к телу, на котором они размещены, на этой основе определяется положение аппарата относительно позиции, с которой началось движение, а также его скорость).
    • Механические акселерометры (определяют собственное ускорение).
    • Одометр (периодически измеряет скорость вращения колеса и по известному диаметру определяет пройденный путь).
    • Лазерные дальномеры LIDAR.
    • Генератор радио- или иных сигналов (чаще всего ультразвуковых и инфракрасных).
    • Стереоскопические видеосистемы.
    2.2. Инерциальные системы навигации
    Инерциальная навигация – это метод навигации и управления движением, основанный на свойствах инерции нет, являющийся автономным, то есть не требующим наличия внешних ориентиров или поступающих извне сигналов.
    Данная система позволяет отслеживать мобильные устройства автономно.
    Основная ее идея заключается в том, чтобы, основываясь на некоторой начальной информации о местонахождении объекта, отслеживать его перемещение на основании показаний датчиков мобильного устройства – акселерометра и гироскопа.

    7
    Сущность инерциальной навигации состоит в определении ускорения объекта и его угловых скоростей с помощью установленных на движущемся объекте приборов и устройств, а по этим данным – местоположения (координат) этого объекта, его курса, скорости, пройденного пути и др., а также в определении параметров, необходимых для стабилизации объекта и автоматического управления его движением. Это осуществляется с помощью:
    1. Датчиков линейного ускорения (акселерометров).
    2. Гироскопических устройств, воспроизводящих на объекте систему отсчета и позволяющих определять углы поворота и наклона объекта, используемые для его стабилизации и управления движением.
    3. Вычислительных устройств (ЭВМ), которые по ускорениям (путем их интегрирования) находят скорость объекта, его координаты и др. параметры движения.
    Преимущества методов инерциальной навигации состоят в автономности, помехозащищенности и возможности полной автоматизации всех процессов навигации. Благодаря этому методы инерциальной навигации получают все более широкое применение при решении проблем навигации надводных, подводных и воздушных судов, космических судов и аппаратов и других движущихся объектов.
    Инерциальные навигационные системы делятся на имеющие гиростабилизированную платформу платформенные
    (ПИНС) и бесплатформенные (БИНС).
    В платформенных ИНС взаимосвязь блока измерителей ускорений и гироскопических устройств, обеспечивающих ориентацию акселерометров в пространстве, определяет тип инерциальной системы. Известны три основных типа платформенных инерциальных систем.
    • Инерциальная система геометрического типа имеет две платформы.
    Одна платформа с гироскопами ориентирована и стабилизирована в инерциальном пространстве, а вторая с акселерометрами — относительно плоскости горизонта.
    Координаты объекта определяются в вычислителе с использованием данных о взаимном расположении платформ.
    Обладает высокой точностью позиционирования относительно поверхности планеты (например
    Земли), но неудовлетворительно работает на высокоманевренных аппаратах и в космическом пространстве. Применяется, в основном, на самолётах с большой дальностью полёта (гражданские, военно- транспортные, стратегические бомбардировщики), подводных лодках и крупных надводных кораблях.

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

    9
    3. Исследование объекта мехатроники, систематизация информации
    из различных источников
    3.1. Исследуемый объект мехатроники
    В качестве исследуемого объекта мехатроники в данной научно- исследовательской работе выступает мобильная платформа с датчиками позиционирования и двумя приводными двигателями (Рисунок 1).
    Рисунок 1 – 3D-модель механизма
    На мобильную платформу установлено следующее электронное оборудование:
    • Датчик гироскопа;
    • Датчик акселерометра;
    • Bluetooth;
    • Н-мост на МОСФЕТ транзисторах (с минимальными потерями по току, в отличие от обычных PNP/NPN);
    • 2 двигателя постоянного тока;
    • Микроконтроллер Arduino Nano (уровень управления приводной частью);
    • Микроконтроллер Arduino Mega 2560 (верхний уровень управления).
    Общая схема подключения оборудования представлена на Рисунке 2.

    10
    Рисунок 2 – Общая схема подключения
    Алгоритм работы программного обеспечения представлен на Рисунке 3.
    Рисунок 3 – Алгоритм работы ПО
    Примеры реализованных команд управления (для управляющей консоли) представлены в Таблице 1.
    Таблица 1 – Список основных команд
    Команда
    Описание
    Ответ (при наличии)
    “R” или “L”
    Вызывает подпрограмму разворота. Ограничения
    (программные): для скорости -
    50об\м, угла – 720 град, радиуса - 5м.
    Запрос максимальной угловой скорости, угла поворота и радиуса относительно центра оси.
    “F”
    Прямолинейное движение.
    Ограничения (программные): для скорости - 50об\м, расстояния движения - 100м.
    Запрос максимальной угловой скорости и дальности движения.

    11
    “S”
    Программная аварийная остановка.
    Сообщает об остановке ус-ва.
    “volt”
    Передает показатели батареи
    Выводит значения в консоль и обновляет индикаторы.
    Отдельно стоит выделить функцию, обеспечивающую прием данных по
    COM-порту с использованием цельной строки и знака окончания приема, написанную специально для данного проекта. Данная функция позволяет безошибочно передавать сложные консольные команды и в последствии (в обработчике) готовые строки можно перевести в любой тип данных микроконтроллера.
    String inpute() {
    String inString = ""; while (true) { while (Serial.available()) { char inChar = Serial.read(); if (inChar == ';') { return inString;
    } inString += inChar;
    }
    }
    }
    График данных, снятых с акселерометра, будет иметь следующий вид
    (Рисунок 4).
    Рисунок 4 – Данные с акселерометра

    12
    3.2. Основные датчики бесплатформенных инерциальных
    навигационных систем
    Основными датчиками бесплатформенных инерциальных систем можно считать акселерометр и гироскоп. На Рисунке 5 представлены основные типы гироскопов.
    Рисунок 5 – Основные типы гироскопов
    Акселерометры в свою очередь подразделяются на три группы:
    • Макромеханические;
    • Микромеханические;
    • Интегральные.
    Чувствительный элемент акселерометра представляет инерционную массу на подвесе. К группе макромеханических акселерометров можно отнести те, в которых подвес реализован в виде пружин, шарикоподшипниковых, электромагнитных узлов, которые могут выполнять роль измерительных элементов в так называемых поплавковых акселерометрах с гидростатической разгрузкой узлов подвеса. Антиподом макромеханических акселерометров по размеру являются микромеханические, а интегральные (гибридные) акселерометры являются продуктом совместного применения макро- и микроэлектромеханических технологий.
    В случае бесплатформенной ИНС гироскопы и акселерометры размещаются на корпус объекта, а функции гиростабилизирующей платформы выполняет бортовое вычислительное устройство. Это плюс и в то же время самый большой минус работы. МикроЭВМ всегда надо держать в памяти

    13 матрицы перехода, которые содержат тригонометрические функции. Задача навигационной системы на выходе выдать углы крена, тангажа и рысканья.
    Распространено три способа подсчета этих углов:
    • Углы Эйлера-Крылова (самый простой в плане понимания формул и реализации);
    • Направляющие косинусы;
    • Родрига-Гамильтона (кватернионы).
    Кинематические уравнения в углах Эйлера-Крылова имеют невысокий порядок (третий) и понятную структуру, но содержат тригонометрические функции от искомых углов и допускают вырождение при угле тангажа, равное
    90˚. Все это обусловливает их непригодность в БИНС.
    Уравнения БИНС, записанные с использованием матрицы направляющих косинусов, – линейные, определены для любых углов рыскания, тангажа и крена, однако уравнения имеют достаточно высокий (девятый) порядок. Кроме того, уравнения должны быть дополнены шестью уравнениями связи.
    Кватернионы предоставляют удобное математическое обозначение положения и вращения объектов в пространстве. В сравнении с углами Эйлера, кватернионы позволяют проще комбинировать вращения, а также избежать проблемы, связанной с невозможностью поворота вокруг оси, независимо от совершенного вращения по другим осям. В сравнении с матрицами они обладают большей вычислительной устойчивостью и могут быть более эффективными.
    Обобщенная блок-схема работы всей системы приведена на Рисунке 6.
    Рисунок 6 – Блок-схема работы системы

    14
    3.3. Рассмотрение датчиков, используемых в мобильных
    устройствах
    3.3.1.Одноосевой MEMS-гироскоп с вибрирующим кремниевым
    кольцом
    Данный кремниевый цифровой гироскоп разработан с учетом требований к низкой стоимости изделия и экономичному энергопотреблению для систем навигации и наведения нового поколения. Он способен измерять угловую скорость с большой точностью и имеет два режима вывода: аналоговый сигнал напряжений, линейно-пропорциональный угловой скорости, цифровой по протоколу SPI.
    Режим вывода – аналоговый или цифровой – выбирается пользователем при подключении датчика к какой-либо системной плате. Главной отличительной особенностью гироскопа является применение технологии сбалансированного вибрирующего кольца в качестве датчика угловой скорости.
    Именно она обеспечивает надежную работу и точное измерение скорости вращения даже в условиях сильной вибрации.
    Датчик состоит из пяти основных компонентов:
    • Кремниевый кольцевой МЭМС-сенсор (MEMS-ring);
    • Основание из кремния;
    • Интегральная микросхема гироскопа;
    • Корпус;
    • Крышка.
    Гироскопы в мобильных устройствах являются, как правило, твердотельными элементами без подвижных частей, исключая лишь сенсорное кольцо – возможность отклоняться необходима ему, чтобы показывать величину и направление угловых скоростей за счет использования эффекта от силы
    Кориолиса. Кориолисова сила воздействует на кремниевое кольцо во время вращения гироскопа, в результате чего происходит радиальное движение кольца по периметру. По периметру кольца расположены равномерным образом восемь приводов. При этом есть одна пара первичных снимающих преобразователей, которые расположены относительно главных осей приводов первичного движения (0˚ и 90˚). Есть также две пары вторичных переключающих преобразователей, которые расположены относительно вторичных осей этих приводов (45˚ и 135˚). Первичные переключающие преобразователи действуют совместно с приводами первичного движения в замкнутой системе, возбуждая и контролируя первичную рабочую вибрационную амплитуду и частоты.

    15
    В то же время радиальное движение на вторичных осях распознается вторичными снимающими преобразователями. Величина этого движения пропорциональна угловой скорости вращения, из-за которой гироскопу придается угловая скорость. Преобразователи генерируют двухполосный сжатый сигнал, который демодулируется обратно в полосы, ширину которых пользователь может легко изменить при помощи внешнего конденсатора.
    Благодаря этому, пользователь может полностью контролировать производительность системы, а преобразование становится абсолютно независимым от постоянного напряжения или низкочастотных параметрических условий электроники.
    Подобные гироскопы обладают очень маленькими габаритами и весом, а также низким потреблением энергии, предоставляя при этом высокую точность и надежность измерений.
    Такие устройства используются в автомобилестроении, промышленной аппаратуре, робототехнике и многих других областях. Применяются они также в персональных мобильных устройствах, где находят свое применение благодаря выгодному сочетанию стоимости, качества и малых размеров.
    3.3.2.Емкостной трехосевой MEMS-акселерометр с цифровым
    выходом
    Называемая «3D-MEMS», эта разработка представляет собой сочетание нескольких технологий для формирования трехмерных структур из кремния, его инкапсуляции и контактирования для облегчения монтажа и сборки.
    Результатом является устройство, способное измерять ускорение в трех ортогональных направлениях, и отличающееся высокой точностью сенсора, малым размером и низким потреблением энергии.
    Данная технология позволяет производить оптимизированные структуры для точных датчиков угла наклона, что полезно при решении таких задач, как обеспечение механического затухания в акселерометрах с целью использования сенсоров в условиях сильной вибрации. Низкое энергопотребление является несомненным плюсом при использовании в устройствах с питанием от батареи, сохраняя при этом хорошую точность измерения.
    Принцип определения ускорения в таком акселерометре достаточно простой и надежный. Основными элементами акселерометра являются тело, пружина и инерционная масса (ИМ), которая позволяет ощущать ускорение во время перемещения. При изменении скорости тела сенсора ИМ посредством пружины так же побуждается последовать этим изменениям. Воздействующая на ИМ сила является причиной изменения ее движения, поэтому происходит

    16 сжимание или разжимание пружины, что приводит к изменению расстояния между телом и ИМ пропорционально ускорению тела.
    Рабочие принципы сенсоров различаются в зависимости от того, каким образом определяется движение между телом и ИМ. В емкостном сенсоре тело и ИМ изолированы друг от друга и измеряются их емкость или емкостной заряд.
    При уменьшении дистанции между ними происходит увеличение емкости, что приводит к движению электрического тока по направлению к сенсору. Если же расстояние увеличивается, то происходит обратный эффект: сенсор преобразует ускорение тела в электрический ток, заряд или напряжение.
    Хорошие характеристики таких датчиков основываются на технологии емкостного измерения, поэтому они хорошо подходят для измерения малых изменений в движении. Чувствительный элемент, определяющий ускорение, в таких акселерометрах делается из стекла и монокристального кремния, что обеспечивает сенсору высокую надежность и точность показаний, а также их достаточно хорошую устойчивость перед воздействием температуры. Одной из причин уменьшения зависимости от температуры является симметричное строение чувствительного элемента, который изготавливается по технологиям объемной микромеханики и обладает двумя чувствительными конденсаторами.
    Из-за этого улучшается и линейность элемента.

    17
    4. Исследование методик и подходов к решению поставленной
    практической задачи, построение модели объекта мехатроники
    4.1. Обзор подходов к инерциальным системам навигации
    Инерциальные навигационные системы в последнее время получают все большее распространение для решения задач управления пространственным движением объектов, поскольку позволяют получить информацию об угловом и поступательном движении рассматриваемого объекта. Эти системы при условии введения в них некоторого объема начальной информации об окружающих полях, системах координат и т.п. позволяют автономно определять требуемые для управления навигационные параметры с нужной точностью во время движения объекта. Первичная информация ИНС измеряется с помощью датчиков параметров поступательного движения (акселерометров), или гироинтеграторов линейных ускорений, и датчиков параметров углового движения объекта, обычно гироскопических. Эта информация (как правило, измеренные вектор кажущегося ускорения и вектор абсолютной угловой скорости) обрабатывается в бортовом вычислителе с целью получения интересующей навигационной информации об ориентации, скоростях движения и местоположения объекта.
    Инерциальный метод счисления пути основывается на двукратном интегрировании по времени абсолютных ускорений, измеряемых акселерометрами с целью получения информации о скоростях и координатах местоположения объекта. Однако показания акселерометра при произвольной ориентации его оси чувствительности определяются вектором кажущегося ускорения (векторной суммой абсолютного ускорения и напряженности поля тяготения Земли):
    2 2
    ( )
    k
    d R
    a
    g R
    dt
    =
    =
    (4.1) или
    ( )
    k
    a
    a
    g R
    = −
    (4.2)
    В связи с тем, что решение задачи навигации требует интегрирования ускорений, вызванных действием лишь активных сил (сил, приводящих объект в движение), то содержащуюся в показаниях акселерометра информацию о
    ( )
    g R
    необходимо исключить. Этого можно добиться двумя способами:

    18
    • Удерживая в процессе движения оси чувствительности акселерометров в плоскости местного горизонта;
    • Исключать проекции вектора
    ( )
    g R
    на направления осей чувствительности акселерометров аналитически, обрабатывая их выходные сигналы, для чего необходимо для любого движения измерительных осей определять их ориентацию в базовых осях и вычислять проекции вектора
    ( )
    g R
    на измеренные или вычисленные направления.
    4.2. Снижение погрешности на этапе измерений
    Показания мобильных акселерометров подвержены многочисленным шумовым эффектам. Существует несколько распространенных подходов к сглаживанию и фильтрации получаемых акселерометром данных.
    4.2.1. Метод средних значений
    Одним из самых простых методов для фильтрации шума является метод средних значений. Он заключается в том, что на каждом шаге k, значение
    k

    вычисляется как среднее из n предыдущих значений акселерометра.
    0
    n
    k i
    i
    k
    a
    n


    =
    =

    (4.3)
    При средних значениях n данный метод предоставляет хороший уровень сглаживания, но его недостатком является достаточно большая задержка в значениях.
    4.2.2. Фильтр Калмана
    Фильтр Калмана – это самый популярный алгоритм фильтрации, используемый во многих областях науки и техники. Данный метод достаточно простой и эффективный, его можно встретить в GPS-приемниках, обработчиках показаний датчиков, при реализации систем управления и т.д.
    Фильтр Калмана использует динамическую модель системы (например, физический закон движения), известные управляющие воздействия и множество последовательных измерений для формирования оптимальной оценки состояния.

    19
    Алгоритм состоит из двух повторяющихся фаз: предсказание и корректировка. На первом рассчитывается предсказание состояния в следующий момент времени (с учетом неточности их измерения). На втором новая информация с датчика корректирует предсказанное значение (также с учетом неточности и зашумленности этой информации) (Рисунок 7).
    Рисунок 7 – Алгоритм фильтра Калмана
    Реализация фильтра сама по себе не очень сложна. Нужно определить и реализовать несколько операций с матрицами и просто следовать формулам.
    Главная задача – определить вектор состояния системы, матрицу перехода, управляющий вектор и прочие компоненты фильтра Калмана. Одна из самых сложных задач – определить ковариационные матрицы шума процесса и шума измерений.
    Матрицы в текущем решении основываются на законе равномерного движения, только в матричной форме. В такой форме довольно легко расширить фильтр, чтоб он учитывал и ускорение вверх.
    Эффективность фильтра Калмана при фильтрации реальных значений можно проследить на Рисунке 8.
    Рисунок 8 – Фильтрация значений с помощью фильтра Калмана

    20
    4.2.3. Фильтры низких частот
    Под фильтрами низких частот понимают группу фильтров, общая характеристика которых – способность фильтровать сигналы выше определенной указанной частоты, пропуская сигналы более низкой частоты. Это позволяет устранить шумовые помехи сигнала и применимо, в том числе, к акселерометрам.
    Рассмотрим формулу:
    1 1
    (
    )
    n
    n
    n
    n
    Q
    Q
    I
    Q



    =
    +

    , (4.4) где Q – отфильтрованное выходное значение сигнала,
    n
    I – нефильтрованные входные значения,

    – коэффициент фильтрации ( 0 1

      ).
    При этом
    1

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

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

    22
    Список использованных источников
    1. Бобровский, С.Н. Навигация мобильных роботов [Текст] / С.Н.
    Гончаров// Журн. PC Week. – 2004. – №9. – С. 60-63 2. Управление роботами. Состояние и перспективы [Текст] : материалы ХХ общ. собрания академии навигации и управления движением, 26 октября 2005 г.
    С.-Петербург / редкол : П.К.Плотников (отв. ред.). – С.-Петербург:
    Электроприбор, 2008. - 20 с.
    3. Черных И.В. Моделирование электротехнических устройств в
    MATLAB, SimPowerSystems и Simulink [Текст]. – ДМК Пресс, 2007. – 156 с.
    4. Навигация мобильных роботов [Электронный ресурс] / Лондон,
    Имперский Колледж. – Режим доступа: www/ URL: http://computer- vision.ucoz.ru/MobRoboNavigati/mobile..
    (Дата обращения 10.04.2020)
    5. Интернет-портал “RoboCraft”. [Электронный ресурс]. – URL: http://robocraft.ru/blog/robosoft/2879.html (Дата обращения 20.05.2020)
    6. Хабр. [Электронный ресурс]. – URL: https://habr.com/ru/post/183096/
    (Дата обращения 15.04.2020)
    7. Интеллектуальный мобильный робот [Электронный ресурс] / -
    Евстигнеев
    Д.В.

    Режим доступа: www/
    URL: http://robot- rad.narod.ru/index.html/
    (Дата обращения 15.04.2020)


    написать администратору сайта