Фильтр Калмана в задачах спутниковой и инерциальной навигации
Покупка
Новинка
Издательство:
Техносфера
Автор:
Калеев Дмитрий Вячеславович
Год издания: 2026
Кол-во страниц: 130
Дополнительно
Вид издания:
Учебное пособие
Уровень образования:
ВО - Бакалавриат
ISBN: 978-5-94836-759-0
Артикул: 897619.01.99
Пособие посвящено методам стохастического оценивания состояния в задачах навигации на основе линейного фильтра Калмана. Изложены системы координат и метрики точности навигационного решения, теория и диагностика согласованности фильтра Калмана, модели спутниковых измерений по псевдодальности, доплеровскому сдвигу частоты и фазе несущей, а также модели инерциальных измерений. Отдельно рассмотрены архитектуры слабосвязанной и сильносвязанной интеграции глобальных навигационных спутниковых систем и инерциальных навигационных систем. Каждая глава сопровождается примерами и контрольными вопросами. Пособие предназначено для студентов высших учебных заведений, обучающихся по направлениям подготовки «Информатика и вычислительная техника» и «Электроника и наноэлектроника», а также для специалистов в области навигации, робототехники и обработки измерительной информации.
Тематика:
ББК:
- 221: Математика
- 328: Кибернетика. Общая радиотехника. Электроника. Электроакустика. Элетросвязь. Радиосвязь
УДК:
- 519: Комбинатор. анализ. Теория графов. Теория вер. и мат. стат. Вычисл. мат., числ. анализ. Мат. кибер..
- 621: Общее машиностроение. Ядерная техника. Электротехника. Технология машиностроения в целом
ОКСО:
- ВО - Бакалавриат
- 09.03.01: Информатика и вычислительная техника
- 11.03.04: Электроника и наноэлектроника
ГРНТИ:
Скопировать запись
Фрагмент текстового слоя документа размещен для индексирующих роботов
Д. В. Калеев Фильтр Калмана в задачах спутниковой и инерциальной навигации Учебное пособие ТЕХНОСФЕРА Москва
УДК 621.396.96:519.226(075.8) ББК 32.844.1:22.18я73 К17 Рецензенты: Умняшкин С. В., д. ф.-м. н., профессор, кафедра высшей математики №1 МИЭТ Кузьмин Е. В., д. т. н., доцент, кафедра радиотехники СФУ К17 Калеев Д. В. Фильтр Калмана в задачах спутниковой и инерциальной навигации: [электронное учебное пособие]. – Москва: ТЕХНОСФЕРА, 2026. – Загл. с титул. экрана. – ISBN 978-5-94836-759-0. – URL: https://www.litres.ru (дата обращения 22.07.2026). – URL: https:/e.lanbook.com (дата обращения 22.07.2026). – Текст : электронный. Пособие посвящено методам стохастического оценивания состояния в задачах навигации на основе линейного фильтра Калмана. Изложены системы координат и метрики точности навигационного решения, теория и диагностика согласованности фильтра Калмана, модели спутниковых измерений по псевдодальности, доплеровскому сдвигу частоты и фазе несущей, а также модели инерциальных измерений. Отдельно рассмотрены архитектуры слабосвязанной и сильносвязанной интеграции глобальных навигационных спутниковых систем и инерциальных навигационных систем. Каждая глава сопровождается примерами и контрольными вопросами. Пособие предназначено для студентов высших учебных заведений, обучающихся по направлениям подготовки «Информатика и вычислительная техника» и «Электроника и наноэлектроника», а также для специалистов в области навигации, робототехники и обработки измерительной информации. УДК 621.396.96:519.226(075.8) ББК 32.844.1:22.18я73 © Калеев Д. В., 2026 © АО «РИЦ «ТЕХНОСФЕРА», оригинал-макет, оформление, 2026 ISBN 978-5-94836-759-0
Оглавление Предисловие 5 Введение 7 1. Базовые понятия навигации 11 1.1. Локальные и связанные системы координат . . . . . . . . . . . . . . . . 11 1.2. Геоцентрические и геодезические координаты . . . . . . . . . . . . . . 13 1.3. Геодезические системы отсчёта . . . . . . . . . . . . . . . . . . . . . . . 14 1.4. Преобразования между системами . . . . . . . . . . . . . . . . . . . . . 16 1.4.1. Преобразование между геоцентрической и локальной системами 16 1.4.2. Преобразование между связанной и навигационной системами 17 1.5. Пример. Работа с локальной системой координат . . . . . . . . . . . . 18 1.6. Метрики качества навигационного решения . . . . . . . . . . . . . . . . 19 1.6.1. Эмпирические и предсказанные метрики . . . . . . . . . . . . . 20 1.6.2. Покомпонентные метрики и RMSE . . . . . . . . . . . . . . . . 21 1.6.3. Метрики горизонтальной точности . . . . . . . . . . . . . . . . 21 1.6.4. Эллипс ошибок . . . . . . . . . . . . . . . . . . . . . . . . . . . . 23 1.6.5. Метрики трёхмерной точности . . . . . . . . . . . . . . . . . . . 23 1.6.6. Пример. Расчёт метрик для локального решения . . . . . . . . 24 2. Линейный фильтр Калмана 28 2.1. Оценивание состояния динамической системы . . . . . . . . . . . . . . 28 2.2. Дискретная модель системы и измерений . . . . . . . . . . . . . . . . . 29 2.3. Вывод формул этапа прогноза . . . . . . . . . . . . . . . . . . . . . . . 31 2.4. Этап обновления и усиление Калмана . . . . . . . . . . . . . . . . . . . 32 2.5. Свойства апостериорной оценки и форма Джозефа . . . . . . . . . . . 33 2.6. Согласованность фильтра и статистические критерии . . . . . . . . . . 34 2.7. Связь апостериорной ковариации с метриками качества навигационного решения . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 36 2.8. Численная устойчивость и инициализация . . . . . . . . . . . . . . . . 38 2.9. Кинематические модели движения объекта . . . . . . . . . . . . . . . . 39 2.9.1. Модель движения с постоянной скоростью . . . . . . . . . . . .
Оглавление 2.9.2. Модель движения с постоянным ускорением . . . . . . . . . . . 41 2.9.3. Модель координированного разворота . . . . . . . . . . . . . . . 42 2.9.4. Выбор модели и настройка интенсивности шума процесса . . . 42 2.10. Подбор ковариаций шумов на практике . . . . . . . . . . . . . . . . . . 43 2.11. Пример. Одномерное оценивание положения . . . . . . . . . . . . . . . 44 2.12. Пример. Модель постоянной скорости в плоскости . . . . . . . . . . . . 46 3. Спутниковая навигация 49 3.1. Структура сигнала и формирование измерений . . . . . . . . . . . . . 49 3.2. Псевдодальность как поверхность положения . . . . . . . . . . . . . . . 51 3.3. Модель измерения псевдодальности . . . . . . . . . . . . . . . . . . . . 51 3.4. Доплеровские измерения и оценка скорости . . . . . . . . . . . . . . . . 53 3.5. Фазовые измерения несущей и целочисленная неоднозначность . . . . 54 3.6. Решение навигационной задачи методом взвешенных наименьших квадратов . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 58 3.6.1. Общая схема метода наименьших квадратов . . . . . . . . . . . 58 3.6.2. Линеаризация и метод Гаусса – Ньютона . . . . . . . . . . . . . 59 3.6.3. Применение к псевдодальностям . . . . . . . . . . . . . . . . . . 60 3.7. Контроль качества и автономный контроль целостности . . . . . . . . 61 3.8. Геометрия созвездия и DOP . . . . . . . . . . . . . . . . . . . . . . . . . 63 3.9. Рекуррентное оценивание по доплеровским измерениям . . . . . . . . 65 3.10. Пример. Решение навигационной задачи по четырём спутникам . . . . 68 4. Инерциальная навигация 71 4.1. Принципы инерциального счисления пути . . . . . . . . . . . . . . . . . 71 4.2. Бесплатформенная механизация ИНС . . . . . . . . . . . . . . . . . . . 74 4.3. Представление ориентации матрицей направляющих косинусов . . . . 75 4.4. Обновление ориентации, скорости и положения . . . . . . . . . . . . . 77 4.4.1. Обновление ориентации . . . . . . . . . . . . . . . . . . . . . . . 77 4.4.2. Преобразование удельной силы и обновление скорости . . . . . 79 4.4.3. Численное интегрирование скорости и положения . . . . . . . . 80 4.5. Модели ошибок инерциальных датчиков . . . . . . . . . . . . . . . . . 81 4.5.1. Состав ошибок . . . . . . . . . . . . . . . . . . . . . . . . . . . . 81 4.5.2. Шумовая составляющая . . . . . . . . . . . . . . . . . . . . . . . 82 4.5.3. Гауссово-марковский процесс первого порядка . . . . . . . . . . 82 4.6. Одномерная задача распространения ошибок инерциальной навигации 83 4.6.1. Постановка задачи . . . . . . . . . . . . . . . . . . . . . . . . . . 84 4.6.2. Простейшая модель с постоянным смещением . . . . . . . . . . 84 4.6.3. Расширенная модель со смещением и шумом . . . . . . . . . . . 85 4.6.4. Рост неопределённости в автономном режиме . . . . . . . . . .
Оглавление 4.7. Базовая модель ошибок ИНС . . . . . . . . . . . . . . . . . . . . . . . . 87 4.7.1. Модели ошибок датчиков в трёхмерном случае . . . . . . . . . 87 4.7.2. Распространение ошибок при вычислении ориентации . . . . . 88 4.7.3. Распространение ошибок при преобразовании удельной силы . 89 4.7.4. Распространение ошибок при интегрировании . . . . . . . . . . 90 4.7.5. Сборка модели ошибок . . . . . . . . . . . . . . . . . . . . . . . 91 4.7.6. Применимость и расширения . . . . . . . . . . . . . . . . . . . . 92 4.8. Пример. Одномерный дрейф инерциальной навигации от смещения акселерометра . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 93 5. Интеграция ГНСС и ИНС 96 5.1. Комплементарная природа ГНСС и ИНС . . . . . . . . . . . . . . . . . 96 5.2. Архитектуры интеграции . . . . . . . . . . . . . . . . . . . . . . . . . . 98 5.3. Слабосвязанная интеграция . . . . . . . . . . . . . . . . . . . . . . . . . 99 5.3.1. Структура алгоритма . . . . . . . . . . . . . . . . . . . . . . . . 100 5.3.2. Вектор наблюдений и матрица наблюдений . . . . . . . . . . . 101 5.3.3. Ковариационная матрица ошибок измерений . . . . . . . . . . . 102 5.3.4. Сводка алгоритма слабосвязанной интеграции . . . . . . . . . . 103 5.4. Сильносвязанная интеграция и модель наблюдений по псевдодальностям . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 104 5.4.1. Структура алгоритма . . . . . . . . . . . . . . . . . . . . . . . . 105 5.4.2. Комплементарные псевдодальномерные наблюдения . . . . . . 105 5.5. Временные разности фазы несущей в фильтре . . . . . . . . . . . . . . 108 5.5.1. Формирование наблюдения из разности инерциального предсказания и фазового измерения . . . . . . . . . . . . . . . . . . 108 5.6. Учёт выноса антенны . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 110 5.7. Модели часов приёмника по созвездиям . . . . . . . . . . . . . . . . . . 111 5.8. Кинематические ограничения . . . . . . . . . . . . . . . . . . . . . . . . 112 5.9. Примеры. Слабосвязанная и сильносвязанная интеграция ГНСС/ИНС 114 Заключение 118 Список сокращений 120 Список обозначений 123 Список литературы
Предисловие Современные автономные и полуавтономные системы – от беспилотных летательных аппаратов и наземных робототехнических платформ до высокоточного геодезического оборудования и мобильных устройств – опираются на непрерывное и устойчивое определение положения, скорости и ориентации в условиях неполной наблюдаемости и зашумлённых измерений. Во многих приложениях требуются не только координаты на карте, но и количественная оценка их качества: доверительные интервалы, показатели согласованности и устойчивость решения при ухудшении условий измерений. Поэтому методы стохастического оценивания стали неотъемлемой частью инженерной практики в задачах позиционирования и слежения. Задачами комплексирования спутниковых и инерциальных навигационных систем занимаются научные и инженерные коллективы ведущих университетов и НИИ России. В МИЭТ это направление развивается в Институте микроприборов и систем управления им. Л. Н. Преснухина, возглавляемом д.т.н., доц. А. Л. Переверзевым, в рамках научной школы д.т.н., проф. В. А. Бархоткина и работ НИИ вычислительных средств и систем управления под руководством д.т.н., проф. Ю. В. Савченко. Существенный вклад в тематику интегрированных навигационных систем внес коллектив д.т.н. А. Н. Соловьёва, в составе которого велись собственные разработки в этой области. Автор пособия – участник этого коллектива; его опыт лёг в основу структуры и содержания книги. Навигация рассматривается в пособии как задача оценивания состояния динамического объекта по результатам измерений: определение его положения, скорости и ориентации вместе с характеристикой их качества. Внимание сосредоточено на моделях движения, измерительных моделях и статистических характеристиках ошибок. В спутниковых системах базовой измеряемой величиной служит псевдодальность, а ключевым элементом модели – время: совместно с координатами оценивается смещение часов приёмника, и именно корректность стохастической модели измерений определяет достижимую точность. В инерциальных системах навигация реализуется через механизацию – интегрирование измерений инерциального измерительного устройства (ИИУ); характерная особенность таких систем – накопление ошибок во времени, что требует периодической коррекции по внешним источникам. Комплексирование глобальных навигационных спутниковых систем (ГНСС) и инерциальных навигационных систем (ИНС) позволяет объединить преимущества обоих
Предисловие подходов и обеспечить устойчивое позиционирование при помехах, пропусках наблюдений и динамических манёврах объекта. Центральным методическим инструментом пособия выступает линейный фильтр Калмана и его непосредственные обобщения. Изложение последовательно ведётся от теоретических основ оценивания состояния и моделирования траектории к моделированию спутниковых и инерциальных измерений и далее – к архитектурам интеграции ГНСС и ИНС, применяемым в современных навигационных системах [9, 13]. Каждая глава содержит примеры, иллюстрирующие применение изложенного материала, и контрольные вопросы для самопроверки. Примеры построены, как сквозная линия, связывающая темы глав с первой по пятую: задача, поставленная при работе с системами координат и оценке точности (гл. 1), получает рекуррентное решение средствами фильтра Калмана (гл. 2), затем переносится на спутниковые (гл. 3) и инерциальные (гл. 4) измерения и, наконец, объединяется в интегрированном фильтре ГНСС/ИНС (гл. 5). Благодаря этому читатель прослеживает один и тот же объект и единый понятийный аппарат на всех уровнях изложения, а не разрозненные иллюстрации к отдельным темам. Отдельное внимание уделено единообразию терминов и обозначений. В пособии унифицированы обозначения, которые в литературе по ГНСС и ИНС часто различаются от источника к источнику. В части спутниковых измерений и практических аспектов реализации алгоритмов использованы соглашения, принятые в RTKLIB (автор – T. Takasu) [14]. В части принципов и архитектур интеграции ГНСС и ИНС опорным источником служит глава A. Soloviev [13]; общее изложение интегрированных навигационных систем дано в [9], классических учебниках по ГНСС – в [10, 11], по теории оценивания – в [6, 12]. Принятая унификация позволяет рассматривать ГНССпозиционирование, инерциальную механизацию и их комплексирование в одном понятийном поле и с единым набором обозначений, что особенно важно при построении фильтра Калмана. Наряду с теоретическим изложением в пособии приводятся практические советы по проектированию фильтра Калмана и работе с интегрированными ГНСС/ИНС-системами – от выбора структуры вектора состояния и настройки ковариационных матриц шумов до диагностики согласованности и организации вычислений в реальной реализации. Пособие может быть использовано в образовательных программах, ориентированных на моделирование динамических систем, обработку измерительной информации, навигацию и робототехнику, а также в междисциплинарной подготовке специалистов по направлениям, связанным с электроникой, радиотехникой, информационноуправляющими системами и программной инженерией. В качестве предшествующей методической работы автора рекомендуется лабораторный практикум по метрологии и электрорадиоизмерениям [4], формирующий экспериментальную базу для понимания природы измерительных погрешностей, на которые опирается стохастическая постановка рассматриваемых задач. Освоение изложенного материала форми6
Предисловие рует фундаментальные компетенции в области статистического оценивания и обеспечивает прикладную готовность к решению инженерных задач, в которых качество решения определяется не только полученной траекторией, но и обоснованной оценкой её точности и надёжности.
Введение Современные навигационные системы решают задачу определения положения, скорости и во многих случаях ориентации подвижного объекта по данным разнородных измерителей. В спутниковой навигации такими измерителями являются приёмники глобальных навигационных спутниковых систем, формирующие псевдодальности, доплеровские измерения, фазовые измерения и навигационные решения. В инерциальной навигации используются измерения угловой скорости и удельной силы, получаемые от инерциальных измерительных устройств. Каждый из этих источников обладает собственными достоинствами и ограничениями: ГНСС обеспечивает абсолютную привязку к глобальной системе координат, но зависит от условий приёма спутниковых сигналов; ИНС, напротив, автономна и обладает высокой частотой обновления, но её ошибки накапливаются во времени. Поэтому в практических навигационных задачах особое значение приобретает совместная обработка измерений. Она позволяет объединить преимущества спутниковых и инерциальных систем: использовать ГНСС для ограничения долговременного ухода инерциального решения и применять ИНС для обеспечения непрерывности, сглаживания и кратковременного прогноза навигационных параметров при ухудшении спутниковой видимости. Математической основой такой обработки является стохастическое оценивание состояния динамической системы, а одним из наиболее распространённых и практически важных инструментов – фильтр Калмана. Фильтр Калмана не является просто сглаживающим алгоритмом, его назначение состоит в рекуррентном объединении двух источников информации: априорной, задаваемой моделью движения объекта и моделью эволюции ошибок, и измерительной, поступающей от навигационных датчиков. При этом вклад каждого источника определяется его неопределённостью, описываемой ковариационными матрицами. Благодаря такой постановке фильтр Калмана позволяет не только получать оценку состояния, но и количественно характеризовать её качество, что особенно важно для анализа точности, проверки согласованности модели и построения интегрированных навигационных решений. Настоящее пособие посвящено применению фильтра Калмана в задачах спутниковой и инерциальной навигации. Изложение построено последовательно: от базовых навигационных понятий и линейной теории оценивания к моделям спутниковых и инерциальных измерений, а затем к комплексированию данных ГНСС и ИНС. Такой
Введение порядок позволяет рассматривать фильтр Калмана не как абстрактный математический аппарат, а как рабочий инструмент, применяемый к конкретным навигационным моделям, измерениям и системам координат. Базовая прикладная задача, к которой будет применяться последующая теория, – задача позиционирования, то есть определения положения объекта в выбранной системе координат на основе априорной информации и результатов измерений. Её результатом является не только оценка координат, но и характеристика их качества: без последней результат не пригоден для инженерного использования. В навигации важно не просто получить численное значение координат, скорости или ориентации, но и понимать, насколько этой оценке можно доверять, как она связана с геометрией измерений, уровнем шумов, выбранной моделью движения и принятыми соглашениями о системах координат. Методы позиционирования различаются используемой измерительной информацией, предположениями о движении объекта и характером накапливаемой ошибки. Методы счисления пути (англ. dead reckoning) основаны на интегрировании измерений скорости, ускорения и угловой скорости; они обеспечивают автономность, но характеризуются неизбежным накоплением погрешности во времени из-за смещений, дрейфов и шумов датчиков. Методы сопоставления по карте (англ. map matching) используют априорные сведения о среде и корректируют оценку положения путём привязки наблюдаемых признаков к объектам карты. Методы поверхностей положения опираются на измерения, связывающие положение объекта с внешними ориентирами или источниками сигналов, формируя геометрические множества допустимых положений – линии и поверхности равных дальностей, разностей дальностей или направлений. В спутниковых навигационных системах основным методом этой группы является псевдодальномерный метод. Каждое из этих семейств обладает собственными достоинствами и ограничениями, и ни одно из них не является универсальным. Именно это обстоятельство приводит к необходимости комплексирования – совместной обработки разнородных измерений в рамках единой стохастической модели. В такой модели состояние объекта описывается вектором скрытых переменных, а измерения рассматриваются как неполные и зашумлённые наблюдения этого состояния. Динамическая модель предсказывает эволюцию состояния во времени, а измерительная модель задаёт связь между состоянием и наблюдаемыми величинами. Фильтр Калмана реализует рекуррентную схему «прогноз – обновление», в которой апостериорная оценка предыдущего шага сначала переносится вперёд по модели движения, а затем уточняется по новому измерению. Спутниковые методы навигации обеспечивают долговременно устойчивое определение координат и времени, но их точность и доступность ограничены условиями приёма сигналов: затенениями, многолучёвостью, помехами, ошибками эфемерид, задержками распространения сигнала и нестабильностью шкалы времени приёмника. Инерциальная навигация, напротив, полностью автономна и обеспечивает высокоча8