Книжная полка Сохранить
Размер шрифта:
А
А
А
|  Шрифт:
Arial
Times
|  Интервал:
Стандартный
Средний
Большой
|  Цвет сайта:
Ц
Ц
Ц
Ц
Ц

Фильтр Калмана в задачах спутниковой и инерциальной навигации

Покупка
Новинка
Артикул: 897619.01.99
Доступ онлайн
900 ₽
В корзину
Пособие посвящено методам стохастического оценивания состояния в задачах навигации на основе линейного фильтра Калмана. Изложены системы координат и метрики точности навигационного решения, теория и диагностика согласованности фильтра Калмана, модели спутниковых измерений по псевдодальности, доплеровскому сдвигу частоты и фазе несущей, а также модели инерциальных измерений. Отдельно рассмотрены архитектуры слабосвязанной и сильносвязанной интеграции глобальных навигационных спутниковых систем и инерциальных навигационных систем. Каждая глава сопровождается примерами и контрольными вопросами. Пособие предназначено для студентов высших учебных заведений, обучающихся по направлениям подготовки «Информатика и вычислительная техника» и «Электроника и наноэлектроника», а также для специалистов в области навигации, робототехники и обработки измерительной информации.
Калеев, Д. В. Фильтр Калмана в задачах спутниковой и инерциальной навигации : учебное пособие / Д. В. Калеев. - Москва : Техносфера, 2026. - 130 с. - ISBN 978-5-94836-759-0. - Текст : электронный. - URL: https://znanium.ru/catalog/product/2287962 (дата обращения: 18.11.2026). – Режим доступа: по подписке.
Фрагмент текстового слоя документа размещен для индексирующих роботов
Д. В. Калеев
Фильтр Калмана в задачах
спутниковой и инерциальной
навигации
Учебное пособие
ТЕХНОСФЕРА
Москва


УДК 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


Доступ онлайн
900 ₽
В корзину