Академический Документы
Профессиональный Документы
Культура Документы
Баумана
Кафедра
«Приборы и системы ориентации, стабилизации и навигации»
Д. Б. Пазычев, В. М. Терешков
МАЛОГАБАРИТНАЯ ИНЕРЦИАЛЬНАЯ
НАВИГАЦИОННАЯ СИСТЕМА
«КОМПАНАВ-2»
Методические указания
к лабораторной работе
по курсу
«Инерциальные навигационные системы»
Москва, 2008
Цель работы: ознакомление с принципом работы бесплатформенной малогабаритной
инерциальной навигационной системы «КомпаНав-2»; экспериментальное изучение основ-
ных погрешностей ее чувствительных элементов и их влияния на выходные показания; ис-
следование свойств радиальной коррекции.
ТЕОРЕТИЧЕСКАЯ ЧАСТЬ
2
рометрического высотомера она функционирует в режиме навигационной системы с полной
выходной информацией:
– географические координаты: широта ϕ , долгота λ ;
3
В состав системы входят следующие основные устройства.
1. Три датчика угловой скорости – вибрационных гироскопа Analog Devices
ADXRS300. Основной элемент гироскопа – закрепленная на упругих растяжках рамка, внут-
ри которой совершает поступательные колебательные движения чувствительная масса (рис.
3). Колебания возбуждаются электростатическим способом. На внешней поверхности рамки
и на подложке расположены выступы, образующие обкладки системы плоских конденсато-
ров. При колебаниях рамки относительно подложки расстояния между этими выступами из-
меняются, соответственно изменяется и электрическая емкость конденсаторов. Когда под-
ложка неподвижна или движется прямолинейно и равномерно, рамка не колеблется. Если
подложка вращается вокруг оси чувствительности, то под действием силы Кориолиса возни-
кают вынужденные (вторичные) колебания рамки. Изменение емкости системы конденсато-
ров при этом несет информацию об угловой скорости прибора.
2. Два двухканальных датчика линейного ускорения – акселерометра Analog Devices
ADXL210. На рис. 4 показана элементарная ячейка датчика. Чувствительная масса закрепле-
на в корпусе на растяжках, выполняющих роль упругого подвеса. Ее выступ образует под-
вижную обкладку плоского конденсатора. При наличии кажущегося ускорения прибора в
направлении оси чувствительности масса смещается относительно корпуса. В результате
смещения расстояния между подвижной и неподвижными обкладками изменяются, соответ-
ственно изменяется и электрическая емкость конденсатора. Это несет информацию о вели-
чине кажущегося ускорения прибора.
3. Три магнитометра.
4. Барометрический высотомер.
5. Аналого-цифровые преобразователи сигналов и цифровой вычислитель на основе
сигнального процессора Analog Devices ADSP2188M.
4
Алгоритм бесплатформенной навигационной системы
cos γ cosψ + sin ϑ sin γ sinψ cos ϑ sinψ sin γ cosψ − sin ϑ cos γ sinψ
C = − cos γ sinψ + sin ϑ sin γ cosψ
N
B cos ϑ cosψ − sin γ sinψ − sin ϑ cos γ cosψ ;
− cos ϑ sin γ sin ϑ cos ϑ cos γ
5
Блок чувстви- Пересчет ка- Вычисление скоростей Вычисление ко-
тельных элемен- жущихся уско- V = V (0) + ( f − (ω + u )V +(ω + u )V )dt ,
t ординат
тов рений из свя- E E ∫0 E N N UP UP UP N
занного в нави- ϕ = ϕ (0) +
t
VN = VN (0) + ∫ ( f N + ωEVUP −(ωUP + uUP )VE )dt
гационный 0 tV
+
трехгранник VN
ωE = − R , ∫0 R
N
dt ,
f XB fUP VE ϕ
λ = λ (0) +
Акселерометр X
fE f B
VE
ω N = + uN ,
X
fYB f = CN f B fE VN t VE λ
N B Y R + ∫0 dt
Акселерометр Y
f B VE R cos ϕ
B
fUP fN
ωUP = R tgϕ + uUP
f Z
Z
Акселерометр Z
ωN
Радиальная коррекция VE (0) VN (0) ϕ (0) λ (0)
ωC
CBN ω = − Kf N ,
C
E
C Магнитометр Z
ω N = Kf E
ω N + ωC ψM
ΦE = ΦN = 0 .
Если учесть угловые скорости дрейфа ωEDR , ω NDR относительно северного и восточного
направлений, то погрешности приведения воображаемой платформы в плоскость горизонта
ωEDR ω NDR
будут равны Φ E = , ΦN = . Эти ошибки тем меньше, чем больше сила радиальной
Kg Kg
коррекции K .
Основным недостатком такой коррекции является возникновение баллистических (обу-
словленных ускорениями) погрешностей. Пусть объект движется с ускорениями aE , aN . То-
гда кажущиеся ускорения будут равны
8
f E = aE − gФN , f N = aN + gФE ,
ЭКСПЕРИМЕНТАЛЬНАЯ ЧАСТЬ
9
Включение МИНС «КомпаНав-2» производится подачей напряжения питания, после че-
го система переходит в режим горизонтальной выставки, длящейся 30 с. Этот режим также
может быть установлен специальной программной командой. Автономная азимутальная вы-
ставка не осуществляется. Во время проведения выставки перемещение и поворот блока
МИНС не допускается. Режим навигации включается автоматически по окончании выставки.
МИНС «КомпаНав-2» передает с интервалом 0,02 с на порт персонального компьютера
двоичные пакеты данных, в которых содержатся:
– показания датчиков угловой скорости и акселерометров;
– вычисленные значения углов крена, тангажа, инерциального и магнитного курса;
– показания барометрической высоты и вертикальной скорости;
– вычисленные значения путевой скорости и географических координат (в отсутствие
коррекции от GPS не выводятся).
Кроме того, с интервалом 1 с передаются пакеты данных, полученных непосредственно
от приемника GPS, если приемник подключен к системе.
Для вывода на экран монитора полученной от навигационной системы информации, а
также ее сохранения в файл с целью последующей обработки используется программа
LogPlan (рис. 6). Данная программа работает в режиме реального времени и позволяет:
– отображать время, прошедшее с момента перехода в режим навигации; отрицатель-
ные значения времени соответствуют режиму выставки;
– отображать углы крена и тангажа в числовом виде и на индикаторе авиагоризонта;
– отображать углы курса (магнитного и инерциального с коррекцией от магнитного) в
числовом виде и на циферблате компаса;
– управлять режимом коррекции курса;
– сохранять данные в двоичный файл специального формата RAW.
10
Рис. 6. Окно программы LogPlan
Для работы с файлами формата RAW используется программа RawPlot (рис. 7), которая
способна отображать на экране данные, прочитанные из файла, в виде графиков. В програм-
ме предусмотрена возможность вывода показаний чувствительных элементов и их отфильт-
рованных значений, интегралов от показаний гироскопов, выходных сигналов МИНС, сигна-
лов приемника GPS.
Программа позволяет задавать различные фиксированные значения силы радиальной
коррекции и сравнивать вычисленные в этих условиях показания с показаниями МИНС в
штатном режиме работы.
11
Рис. 7. Окно программы RawPlot
Проведение эксперимента
12
4) Запустить программу LogPlan. Убедиться, что показания навигационной системы
выводятся на экран в режиме реального времени.
5) В поле имени сохраняемого файла ввести, например, «Bias1.raw» без кавычек.
6) Нажать кнопку «Старт» для начала записи показаний МИНС в файл с выбранным
именем.
7) Оставить блок неподвижным в режиме навигации на 3 минуты.
8) По истечении 3 минут нажать кнопку «Стоп» для прекращения записи показаний
МИНС в файл.
13
найденные погрешности установки стенда и определить тем самым статические
ошибки МИНС.
6) Вернуть блок в первоначальное положение. Проделать п. 5 для углов крена в +10º и
–10º.
7) Вернуть блок в первоначальное положение и повернуть на угол курса в (120…150)º.
Наблюдать расхождения в показаниях инерциального и магнитного курса.
14
2) Не отключая питания системы, повторить последовательность действий опыта 1, за-
писав результат в файл с другим именем, например, «Bias2.raw».
Обработка результатов
15
Вопрос 5. Чем обусловливается различие инерциального и магнитного курса?
СОДЕРЖАНИЕ ОТЧЕТА
16