Разработка высокоточных и надежных систем определения параметров движения является одной из ключевых задач современной навигационной техники. Несмотря на повсеместное распространение спутниковых навигационных систем, существуют условия, при которых их сигнал недоступен или подвержен помехам (тоннели, городские застройки «каньоны», подводное применение). В таких случаях единственным источником информации о положении, скорости и ориентации объекта остается инерциальная навигационная система (ИНС). Ядром любой ИНС является измеритель параметров движения, состоящий из гироскопов, измеряющих угловые скорости, и акселерометров, измеряющих кажущиеся ускорения. Традиционные механические гироскопы обладают высокой точностью, но они дороги, громоздки и имеют короткий срок службы. Современное развитие технологий предлагает две альтернативы: волоконно-оптический гироскоп (ВОГ) и микромеханический (МЭМС) акселерометр. ВОГ, основанный на эффекте Саньяка, не имеет движущихся частей, отличается высокой надежностью, широким динамическим диапазоном и хорошей точностью, что подтверждается исследованиями по повышению его характеристик [3; 5] и анализу зоны нечувствительности [2]. МЭМС-акселерометры, производимые по микроэлектронной технологии, напротив, обладают умеренной точностью, но они исключительно дешевы, малогабаритны и обладают низким энергопотреблением, а их параметры могут быть оптимизированы для конкретных задач [4]. Комбинация высокоточного ВОГ по угловым скоростям и трёх установленных ортогонально МЭМС-акселерометров позволяет создать компактный, энергоэффективный и экономически эффективный измерительный модуль, подобный описанным в работах по построению триад датчиков [7].
Структура предлагаемого ИПД включает в себя три основных блока: блок чувствительных элементов, блок сбора и предварительной обработки данных и вычислительный блок. Блок чувствительных элементов состоит из одного трехосевого ВОГ и трех одноосевых МЭМС-акселерометров, оси чувствительности которых ориентированы вдоль взаимно перпендикулярных осей связанной системы координат объекта (X, Y, Z). ВОГ измеряет проекции вектора угловой скорости объекта ωx, ωy, ωz, а акселерометры – проекции кажущегося ускорения ax, ay, az. Данные с аналоговых выходов акселерометров и цифрового выхода ВОГ поступают на блок сбора данных, где осуществляется их синхронизация по времени, оцифровка аналоговых сигналов и предварительная фильтрация для подавления высокочастотного шума и помех. Основная обработка информации происходит в вычислительном блоке, который реализует алгоритм инерциальной навигации. Алгоритм работы ИПД можно разделить на несколько последовательных этапов. На первом этапе производится калибровка датчиков: определение нулевых смещений bgyro, baccel и масштабных коэффициентов Kgyro, Kaccel для каждого канала. Эта процедура выполняется при стационарном положении модуля перед началом работы.
Таблица 1.
Основные источники погрешностей чувствительных элементов
|
Источник погрешности |
Гироскоп (ВОГ) |
Акселерометр (МЭМС) |
|
Смещение нуля (Bias) |
0.1 - 1 °/ч |
0.5 - 2 mg |
|
Уход смещения нуля (Bias Instability) |
0.01 - 0.1 °/h |
50 - 200 µg |
|
Шум (Angle Random Walk) |
0.001 - 0.01 °/√h |
100 - 500 µg/√Hz |
|
Масштабный коэффициент |
50 - 500 ppm |
1000 - 5000 ppm |
После калибровки начинается основной цикл навигации. Измеренные угловые скорости ωmeas и ускорения ameas корректируются с учетом калибровочных коэффициентов:
ωcorr = (ωmeas - bgyro) * Kgyro, acorr = (ameas - baccel) * Kaccel (1)
Далее, для определения ориентации объекта (углов Крылова – Эйлера: крен φ, тангаж θ, рыскание ψ) производится интегрирование угловых скоростей. Однако прямое интегрирование приводит к быстрому накоплению ошибки из-за дрейфа гироскопа. Для компенсации этого дрейфа используется информация от акселерометров. В стационарном состоянии или при медленном движении акселерометры измеряют вектор гравитации Земли g, что позволяет определить углы наклона (крен и тангаж) относительно горизонтальной плоскости. Эти данные используются в качестве опорных для коррекции показаний гироскопа. Для оптимального объединения данных с гироскопа и акселерометра применяется цифровой фильтр Калмана, который оценивает текущее состояние системы (углы ориентации, смещения датчиков) и минимизирует среднеквадратическую ошибку оценки. После того как ориентация объекта определена, вычисляется матрица направляющих косинусов C, которая служит для преобразования измеренного вектора кажущегося ускорения acorr из связанной системы координат в навигационную (местную географическую) систему координат (Север, Восток, Низ):
anav = C * acorr (2)
В навигационной системе координат из вектора anav вычитается вектор силы тяжести gnav = [0, 0, g]^T, чтобы получить вектор чистого ускорения объекта aobject:
aobject = anav - gnav. (3)
Далее производится двойное интегрирование вектора a_object для определения скорости V и координат P объекта:
V(t) = V0 + ∫aobject dt, P(t) = P0 + ∫V dt (4)
Именно на этом этапе ошибки акселерометров, особенно смещение нуля, интегрируются дважды, что приводит к кубическому росту ошибки определения координат во времени. Для компенсации этого накопления ошибки необходимо использование внешней информации, например, от спутникового приемника или одометра, однако в рамках данной работы рассматривается автономный режим.
Таблица 2.
Оценка ошибок определения положения при автономной работе
|
Время работы, t (мин) |
Ошибка положения (только гироскоп/акселерометр), м |
Ошибка положения (с фильтром Калмана), м |
|
1 |
0.5 - 2 |
0.1 - 0.5 |
|
10 |
500 - 2000 |
10 - 50 |
|
60 |
> 10 000 |
100 - 500 |
Результаты математического моделирования работы ИПД в среде MATLAB/Simulink подтвердили эффективность применения фильтра Калмана [1; 7]. Моделировалось движение объекта по траектории продолжительностью 10 минут. Как видно из таблицы 2, даже с применением коррекции, ошибка положения неуклонно растет со временем из-за фундаментальных ограничений инерциальной навигации. Однако использование фильтра Калмана позволяет снизить ошибку на порядок и более по сравнению с простым интегрированием, что делает систему пригодной для кратковременной навигации (несколько минут) с приемлемой точностью.
Заключение. В ходе проведенного исследования была разработана архитектура и алгоритм работы измерителя параметров движения на основе волоконно-оптического гироскопа и микромеханического акселерометра. Показано, что предложенная компоновка позволяет создать малогабаритный и экономичный инерциальный модуль [1]. Ключевым элементом, обеспечивающим работоспособность системы, является алгоритм комплексной обработки данных на основе фильтра Калмана, который эффективно компенсирует собственные шумы и дрейфы датчиков, используя их взаимодополняющие свойства: кратковременную точность гироскопов и долговременную стабильность акселерометров по определению ориентации. Проведенное математическое моделирование продемонстрировало, что разработанный ИПД способен обеспечивать определение углов ориентации с высокой точностью (погрешность менее 0.1°), а определение координат – с приемлемой точностью для кратковременной автономной работы (сотни метров после часа работы). Основным направлением дальнейших исследований является интеграция разработанного ИПД с дополнительными источниками навигационной информации, такими как спутниковый приемник (GPS/ГЛОНАСС), барометрический высотомер и одометр, для создания интегрированной навигационной системы, способной обеспечивать точное и надежное определение местоположения в любых условиях [6; 8].
Список литературы
- Алейник, A.C. Повышение точности волоконно-оптического гироскопа / A.C. Алейник // Гироскопия и навигация. 2009. № 2 (65). С. 101
- Алейник, A.C. Повышение точности волоконно-оптического гироскопа / A.C. Алейпик //Навигация и управление движением: Материалы докладов XI конференции молодых ученых «Навигация и управление движением». СПб., 2009. С. 185-190
- Вавилов В.Д., Волков В.Л., Нулюшкин А.В. Оптимизация параметров микромеханического акселерометра // Труды НГТУ им. Р. Е. Алексеева. 2010. № 3. С. 308-314
- Волоконно-оптические датчики вращения для сейсмических измерений / А.Н. Ткаченко // Оптический журнал. 2010. № 7. С. 54-59
- Исследование зоны нечувствительности волоконно-оптических гироскопов / A.C. Алейник, Г.Б. Дейнека, В.Е. Стригалев и др. // Гироскопия и наветация. 2011. № 2 (73). С.64-77
- Коптенков М. И. Основы проектирования измерительных устройств на базе волоконно-оптического гироскопа // Вестник МГУЛ – Лесной вестник. 2015. № 3. С. 63-70
- Ткаченко, А.Н. Результаты калибровочных испытаний триады волоконно-оптических гироскопов / А.Н. Ткаченко, А.М. Боронахин // Известия СПбГЭТУ «ЛЭТИ».2010. № 7. С. 89-98
- Ткаченко, А.Н. Использование волоконно-оптических гироскопов в сейсмологии/ А.Н. Ткаченко, Л.Н. Олейник // Материалы X конференции молодых ученых «Навигация и управление движением». СПб: Гироскопия и навигация, 2009. С. 81-86


