Подводная лодка уходит на глубину — и теряет GPS. Баллистическая ракета летит на полюс, где магнитная навигация бесполезна. Самолёт пересекает Тихий океан без единой наземной станции. Во всех этих случаях — и во многих других — навигацию обеспечивает инерциальная система: устройство, которое «помнит» каждое своё движение с момента последней привязки и накапливает их в пространственный маршрут.
Принцип опирается на законы Ньютона. Если известно начальное положение и скорость, а затем непрерывно измеряется ускорение, координаты можно вычислить в любой момент времени. Инерциальный навигационный комплекс (ИНК или ИНС — инерциальная навигационная система) делает именно это: измеряет ускорения акселерометрами, интегрирует их дважды, получая положение, — и следит за ориентацией с помощью гироскопов.
Система отсчёта и базовые уравнения
Прежде чем двигаться дальше, договоримся о терминах.
- ECI (Earth-Centered Inertial) — инерциальная система, центр в центре Земли, оси направлены на звёзды. В ней действует второй закон Ньютона.
- ECEF (Earth-Centered, Earth-Fixed) — система, вращающаяся вместе с Землёй. В ней заданы координаты из WGS-84.
- NED (North-East-Down) — локальная горизонтальная система: X на север, Y на восток, Z вниз. Удобна для навигации.
- Тело (body frame) — система, жёстко связанная с аппаратом. Именно в ней измеряют акселерометры и гироскопы.
Уравнение навигации в NED-системе:
v̇ = R_b^n · f - (2Ωₑ + ω) × v + g
Здесь f — измеренное акселерометрами удельное усилие (специфическая сила), R_b^n — матрица поворота из системы тела в NED, Ωₑ — угловая скорость Земли (7,292 × 10⁻⁵ рад/с), ω — угловая скорость транспортного средства, g — вектор силы тяжести. Двукратное интегрирование по времени даёт координаты.
Гироскопы: измерение угловых скоростей
Гироскоп — это датчик угловой скорости. Интегрируя его показания, система вычисляет углы поворота и поддерживает актуальную матрицу ориентации.
Классический механический гироскоп
Быстро вращающийся ротор (10 000–40 000 об/мин) обладает кинетическим моментом L = Iω, где I — момент инерции, ω — угловая скорость ротора. Под действием внешнего момента M гироскоп прецессирует перпендикулярно M со скоростью Ω = M/L. Если ротор подвешен в кардановом подвесе (гимбале) с двумя степенями свободы, он сохраняет ориентацию оси в инерциальном пространстве, а углы карданова подвеса и дают измеряемые углы.
Динамически настраиваемый гироскоп (DTG) — более поздняя разработка: ротор подвешен на гибком упругом подвесе (вибрирующем на резонансной частоте), который при правильно подобранной скорости вращения становится «неперекрёстным» — чувствительным к углу без трения. DTG применялся в авиационных ИНС 1970–90-х годов.
Кольцевой лазерный гироскоп (RLG)
RLG (Ring Laser Gyroscope) произвёл революцию в навигации с 1970-х годов. Принцип — эффект Саньяка (1913 г.): в закрытом кольце два луча лазера, распространяющихся в противоположных направлениях, при вращении кольца проходят разные оптические пути. Разность хода приводит к разности частот, которая и пропорциональна угловой скорости:
Δf = 4A · Ω / (λ · P)
где A — площадь контура, P — периметр, λ — длина волны лазера, Ω — угловая скорость.
Конструктивно RLG — треугольный или квадратный моноблок из ситалла (нулевое расширение), в котором прорезаны каналы с зеркалами и накачной секцией He-Ne лазера. Поляризационный делитель смешивает оба луча на детекторе, образуя интерференционную картину — биения с частотой Δf. Счётчик фаз биений даёт угол поворота с разрешением ~0,0001°.
Проблема захвата (lock-in): при очень малых угловых скоростях (ниже ~0,01 рад/с) обратное рассеяние на зеркалах синхронизирует оба луча, и биения исчезают. Решение — механическое дизерирование: треугольный корпус вибрирует с амплитудой ~100 угловых секунд и частотой ~400 Гц, непрерывно выводя RLG из зоны захвата.
Волоконно-оптический гироскоп (FOG)
FOG использует тот же эффект Саньяка, но вместо резонатора — длинная (100–2000 м!) катушка оптоволокна. Большая площадь контура компенсирует слабость сигнала. Свет от суперлюминесцентного диода делится надвое и обходит катушку в обоих направлениях; разность фаз на интерферометре Саньяка пропорциональна угловой скорости.
FOG не имеет движущихся частей, нечувствителен к ударам, стартует мгновенно (в отличие от RLG, не нужно прогревать газ), не требует дизерирования. Тактические FOG-гироскопы достигают дрейфа 0,01–1 °/час; навигационные FOG (например, KVH DSP-3000) — 0,1 °/час. Это уже уровень, пригодный для навигации без GPS на несколько часов.
МЕМС-гироскоп
МЕМС (Micro-Electro-Mechanical Systems) позволили разместить гироскоп на кристалле кремния. Принцип — сила Кориолиса: тело, движущееся со скоростью v в системе, вращающейся с угловой скоростью Ω, испытывает силу F = 2m · v × Ω.
В МЕМС-гироскопе микроструктура вибрирует с известной частотой и амплитудой вдоль одной оси; при вращении сила Кориолиса вызывает колебания по перпендикулярной оси, регистрируемые ёмкостными электродами. Современные тактические МЕМС (Analog Devices ADXRS450, InvenSense ICM-42688) достигают дрейфа 1–10 °/час; навигационные МЕМС (IMU-класс, например Sensonor STIM377) — 0,3–1 °/час.
МЕМС-гироскопы — основа навигации смартфонов, дронов, автомобилей.
Акселерометры: измерение специфической силы
Акселерометр измеряет не гравитацию — гравитация является частью инерции системы отсчёта и не регистрируется датчиком. Измеряется специфическая сила: результирующее неграитационное ускорение (тяга двигателей, аэродинамика, нормальная реакция). В состоянии покоя акселерометр измеряет реакцию опоры — то есть ускорение g направленное вверх.
Маятниковый интегрирующий гироскопический акселерометр (PIGA)
Самый точный из когда-либо созданных акселерометров. Применялся в баллистических ракетах MX, Minuteman, морской ракете Trident. Принцип: маятник, подвешенный на гироскопическом подвесе, при ускорении создаёт момент; гироскоп прецессирует пропорционально скорости (однократному интегралу ускорения), что позволяет измерять именно приращение скорости — без второго интегрирования. PIGA достигал систематической погрешности 10 мкg и менее.
МЕМС-акселерометр
Пробная масса удерживается упругими балками; смещение под действием ускорения измеряется ёмкостным методом. Сигнал подаётся на схему обратной связи, возвращающую массу в нейтральное положение — сила обратной связи и есть мера ускорения. Точность тактических МЕМС: 0,1–5 мg смещения нуля; навигационные (Honeywell Q-Flex, силиконовый QL-40) — единицы мкg.
Вибрационный струнный акселерометр (VBA)
Кварцевая струна натяжением деформируется при ускорении, что меняет её резонансную частоту. Частота легко измеряется цифровым счётчиком с высокой точностью. VBA широко применяются в инерциально-навигационных блоках авиационного класса (L3 SensorSystems, Honeywell).
Платформенные и бесплатформенные ИНС
Платформенная ИНС
Акселерометры и гироскопы установлены на гиростабилизированной платформе (гимбальном подвесе с 3–4 степенями свободы), которая удерживается в постоянной ориентации относительно инерциального пространства. Углы карданового подвеса дают углы крена, дифферента и рыскания непосредственно как механические величины. Платформа изолирует датчики от движений носителя — аналоговая реализация матрицы поворота.
Достоинства: высокая точность (механическая стабилизация снижает требования к динамическому диапазону датчиков). Недостатки: механическая сложность, большие масса и объём, проблема карданова замка (gimbal lock) при угле 90° по крену.
Бесплатформенная ИНС (strapdown)
Датчики жёстко закреплены на корпусе аппарата. Матрица поворота R_b^n от тела к навигационной системе вычисляется программно — интегрированием показаний гироскопов. Это позволяет создавать компактные, лёгкие и ударостойкие блоки (IMU — Inertial Measurement Unit).
Кватернионы vs углы Эйлера. Ориентацию можно описать тремя углами Эйлера (крен φ, дифферент θ, рыскание ψ), но они имеют сингулярность при θ = ±90°. Кватернион q = [q₀, q₁, q₂, q₃] с ограничением |q|² = 1 представляет поворот без сингулярностей. Дифференциальное уравнение для кватерниона:
q̇ = (1/2) · Ω_q · q
где Ω_q — кватернионная матрица угловой скорости. Кватернион пересчитывается в матрицу направляющих косинусов (DCM) для вычисления навигационных уравнений.
Современные bесплатформенные ИНС используют тактовые частоты обновления 100–1000 Гц для точного интегрирования в условиях вибраций и манёвров.
Накопление ошибок
Принципиальное ограничение автономной ИНС: ошибки накапливаются со временем и не могут быть исправлены изнутри системы.
Законы роста ошибок
Пусть гироскоп имеет дрейф (bias) b. Тогда:
- Угловая ошибка накапливается линейно: δφ = b · t
- Ошибка скорости от наклона горизонтальной платформы: δv = g · δφ · t = g · b · t²
- Ошибка положения: δx = (1/2) · g · b · t³
Для типичного тактического гироскопа с дрейфом b = 0,01 °/час:
- За 1 час: угол 0,01°, ошибка положения ~10 м
- За 10 часов: угол 0,1°, ошибка положения ~10 км
Случайный угловой блуждание (ARW, Angular Random Walk) — случайный шум гироскопа с характеристикой n °/√час. Для хорошего FOG n ≈ 0,001–0,01 °/√час. Вклад ARW в ошибку скорости: δv = g · n · t^(3/2).
Колебание Шулера
Интересная особенность навигации вблизи поверхности Земли — маятник Шулера с периодом 84,4 минуты. Это резонансный период маятника с длиной, равной радиусу Земли; он же — орбитальный период спутника у поверхности.
При ошибке горизонтирования платформы проекция g на горизонталь создаёт кажущееся ускорение, которое через двойное интегрирование даёт ошибку положения. Эта ошибка не растёт бесконечно — она осциллирует с периодом 84,4 мин. Подобная система устойчива: амплитуда ошибки не нарастает, а колеблется. Прецизионные морские ИНС спроектированы так, чтобы обеспечить чистое шулерное поведение; длиннопериодические ошибки при этом поддаются коррекции внешними измерениями.
Начальная выставка (alignment)
Перед навигацией ИНС должна «знать» свою начальную ориентацию. Статическая выставка на неподвижном основании использует два вектора: силу тяжести (для горизонтирования) и угловую скорость Земли (для курса). Угловая скорость Земли 7,292 × 10⁻⁵ рад/с = 15 °/час; её горизонтальная составляющая ωE · cos(φ) указывает на север. Точная выставка курса возможна только при уровне гироскопного шума, достаточно малом для обнаружения этой ничтожной скорости.
Динамическая выставка (в движении) требует внешних привязок — GPS, созвездий звёзд, известных ориентиров.
Фильтр Калмана
Фильтр Калмана (Рудольф Калман, 1960) — оптимальный алгоритм оценки состояния линейных систем с гауссовым шумом. В навигации он стал стандартным инструментом для слияния данных от ИНС и внешних датчиков.
Структура фильтра
Вектор состояния для ИНС/GPS содержит 15 компонент: 3 ошибки положения, 3 ошибки скорости, 3 угловые ошибки, 3 ошибки дрейфа гироскопов, 3 ошибки смещения акселерометров.
Шаг предсказания (prediction step):
x̂ₖ⁻ = F · x̂ₖ₋₁
Pₖ⁻ = F · Pₖ₋₁ · Fᵀ + Q
Матрица F — линеаризованная динамика системы; Q — матрица шума процесса (шумы гироскопов и акселерометров); P — ковариационная матрица ошибки оценки.
Шаг коррекции при получении измерения z (например, GPS-позиции):
Kₖ = Pₖ⁻ · Hᵀ · (H · Pₖ⁻ · Hᵀ + R)⁻¹
x̂ₖ = x̂ₖ⁻ + Kₖ · (z − H · x̂ₖ⁻)
Pₖ = (I − Kₖ · H) · Pₖ⁻
K — матрица усиления Калмана; R — ковариация шума измерения; H — матрица наблюдения. Кан можно читать как динамическое взвешивание: если измерение точное (R мало) — доверяем измерению; если шумное — доверяем предсказанию.
EKF (Extended Kalman Filter) применяется для нелинейных систем (навигация в пространстве относится к таким): F и H заменяются якобианами нелинейных функций, вычисляемыми в текущей точке оценки.
UKF (Unscented Kalman Filter) и частицевые фильтры применяются при сильных нелинейностях или негауссовом шуме.
Интеграция ИНС с GPS
Слабосвязная интеграция (Loose Coupling)
GPS-приёмник выдаёт готовые координаты и скорость (решение position+velocity). Они подаются как измерения в фильтр Калмана. Разность GPS-позиции и ИНС-позиции — остаточная погрешность, которая фильтр использует для коррекции ошибок ИНС.
Достоинство: простота реализации. Недостаток: GPS-приёмник должен выдавать решение (не менее 4 спутников); при потере GPS данные от ИНС экстраполируются самостоятельно, ошибка накапливается.
Жёсткосвязная интеграция (Tight Coupling)
В фильтр поступают сырые псевдодальности и псевдоскорости от каждого видимого спутника. Это позволяет работать с любым числом спутников (даже 1–3), используя ИНС для предсказания позиции, что облегчает захват и сопровождение сигнала. Эта архитектура значительно устойчивее в условиях частичного перекрытия неба.
Сверхтесная (Ultra-Tight) интеграция
Сигнал от ИНС поступает прямо в корреляторы GPS-приёмника, управляя опорным генератором кода и несущей. Это минимизирует ошибки слежения в условиях динамических манёвров и помех. Реализуется в специализированных военных и авиационных системах.
Применения
Авиация: IRS и ADIRS
Авиалайнеры Airbus и Boeing оснащены IRS (Inertial Reference System) или ADIRS (Air Data and Inertial Reference System). Три независимых блока на основе FOG или RLG гироскопов с акселерометрами Q-Flex обеспечивают точность ~ 0,2 морской мили в час автономно. ADIRS совмещает ИНС с системой воздушных данных: воздушной скоростью, высотой, температурой. Система выставляется на земле (~10 минут), затем работает всё время полёта, периодически корректируясь от GPS.
Морской флот: SINS
Корабельная инерциальная навигационная система (SINS) предъявляет особые требования: работа в условиях качки, вибрации главной энергетической установки, длительных переходов без обновления от GPS. Платформенные SINS на поплавковых гироскопах (Honeywell SN-502, российский «Токар-Э») достигали дрейфа < 0,5 морской мили/сутки. Современные бесплатформенные системы на RLG/FOG + GPS — менее 0,1 мили/сутки.
Подводные лодки
Для подводной лодки ИНС — основной и нередко единственный навигационный инструмент на глубине. Требования экстремальны: ошибка не более 0,1 морской мили за 24 часа без всплытия. Применяются гиросферы Sperry Marine Mk 49/Mk 29 на ЭСГ (электростатически подвешенном гироскопе) и SF-85 от Sagem. Периодически лодка всплывает для сеанса GPS или использует инерциально-доплеровскую коррекцию (DVL — Doppler Velocity Log).
Ракеты и управляемые снаряды
Баллистические ракеты используют автономную ИНС без GPS (которого нет на МБР по электромагнитной уязвимости). Системы типа AIRS (Advanced Inertial Reference Sphere) для ракеты MX содержали поплавковые гироскопы в прецизионной вакуумной сфере; КВО (круговое вероятное отклонение) достигало 90–100 м для цели через 10 000 км.
Будущее инерциальной навигации
Атомные интерферометрические гироскопы (основанные на волновых свойствах атомов цезия или рубидия в магнитно-оптических ловушках) уже демонстрируют дрейф менее 10⁻⁴ °/час в лабораторных условиях — на порядки превосходя лучшие оптические гироскопы. Атомные интерферометрические акселерометры обещают систематическую погрешность на уровне нанограмм.
Когда эти технологии выйдут из лаборатории в компактные полевые устройства, ИНС следующего поколения смогут работать без привязки к GPS сутками, сохраняя метровую точность. До этого момента связка ИНС + GNSS остаётся золотым стандартом навигации — каждая из систем компенсирует слабость другой.