RU2486472C1 - Способ калибровки чувствительных элементов бесплатформенной инерциальной навигационной системы в полете - Google Patents

Abstract

Изобретение относится к области приборостроения и может быть использовано при разработке бесплатформенных инерциальных навигационных систем (БИНС) для решения задач управления доводочными ступенями (ДС) различного назначения. Технический результат - повышение точности. Для этого способ калибровки чувствительных элементов (ЧЭ) БИНС обеспечивает сравнение текущей информации о векторе кажущейся скорости (ВКС) и векторе углов поворота изделия, полученной от ЧЭ БИНС, с аналогичной информацией, полученной от комплекса командных приборов (ККП) системы управления (СУ) носителя, которая является эталоном. При этом предлагаемая совокупность действий по обработке и разделению этой информации на составляющие на заданных интервалах времени позволяет определить калибруемые параметры методом наименьших квадратов с высокой точностью.

Description

Предлагаемый способ относится к области приборостроения и может быть использован при разработке бесплатформенных инерциальных навигационных систем (БИНС) для решения задач управления доводочных ступеней (ДС) различного назначения.

Классическая схема построения БИНС предполагает жесткое крепление бесплатформенного инерциального блока (БИБ) непосредственно на корпусе ДС.

При управлении движением ДС с использованием БИНС значительную часть погрешностей составляют погрешности чувствительных элементов (ЧЭ) БИБ.

Проблема существенного повышения точности БИНС может решиться путем калибровки ЧЭ БИБ на разных этапах жизненного цикла: изготовление и сборка БИНС, сдача изделия в эксплуатацию, проведение регламентных проверок, предполетная (предстартовая) подготовка, полет ДС с БИНС на носителе. Каждый из этапов отличается как условиями функционирования БИНС, так и технологическими средствами и приемами, которые могут быть использованы для калибровки ее ЧЭ.

Решающим фактором при определении необходимости и времени (этапа) проведения калибровки данного параметра ЧЭ является зависимость его значения от времени, температуры, перегрузки и других условии эксплуатации БИНС. Если значение параметра стабильно, то его калибровку достаточно проводить в производственных условиях. Если значение параметров нестабильно, то его калибровку желательно проводить в последнем запуске непосредственно перед стартом или во время полета изделия.

В процессе калибровки определяется текущее значение измеряемого параметра (масштабный коэффициент, углы выставки) или, если измеряемый параметр рассматривается как погрешность прибора, то определяется систематическая составляющая погрешности для последующей ее компенсации алгоритмическими методами во время полета. При проведении калибровки могут быть использованы как прямые, так и косвенные методы определения калибруемых параметров.

Известны способы калибровки чувствительных элементов (ЧЭ) при стендовых испытаниях (У.Ригли, У.Холлистер, У.Денхард «Теория, проектирование и испытания гироскопов» изд. Мир, М., 1972 г); И.Е.Виноградов, И.В.Гусев, А.И.Глазков «Определение калибровочных параметров инерциальных измерительных блоков (ИИБ) с помощью трехосного поворотного стола» труды «ФГУП НПЦАП» «Системы и приборы управления» №2(8) 2009 г. и др. Недостатком этих способов является отсутствие возможности калибровки ЧЭ без снятия их с изделия.

Известен «Способ калибровки ЧЭ БИНС и устройство для его осуществления» без снятия БИБ с изделия. Патент на изобретение №2334947 приоритет от 26.03.2007 г. авторы Ф.И.Макарченко, С.А.Зайцев, А.И.Калинин, Г.Н.Румянцев. Недостатком данного способа является увеличение веса и габаритов БИБ вследствие использования двухосного карданова подвеса для выставки измерительных осей калибруемых акселерометров по положительному и отрицательному направлению вектора ускорения силы тяжести в месте проведения калибровки и для выставки измерительных осей калибруемых датчиков угловой скорости вдоль соответствующей оси карданова подвеса для калибровки ДУСов. Однако этот недостаток компенсируется существенным повышением точности БИНС.

Задачей предлагаемого способа калибровки является уточнение в полете смещений нулей и значений масштабных коэффициентов чувствительных элементов (ЧЭ) (акселерометров и ДУСов) инерциального измерительного блока (ИИБ), жестко закрепленного на изделии.

Уточнение калибруемых параметров в полете основано на сравнении информации о векторе кажущейся скорости и векторе углов поворота изделия, полученной от чувствительных элементов инерциальных измерительных блоков БИНС, с информацией о векторе кажущейся скорости и векторе углов поворота изделия, полученной в полете на том же интервале времени от комплекса командных приборов системы управления носителя, которая является, в данном случае, эталоном.

Предлагаемый способ состоит в следующем. Перед началом калибровки ЧЭ БИНС в полете проводят согласование инерциальной системы координат, моделируемой системой управления БИНС, с базовой инерциальной системой координат (БСК), моделируемой системой управления носителя. По результатам векторного согласования корректируют матрицу В перехода от приборной системы координат бесплатформенного инерциального блока к базовой инерциальной системе координат БИНС, используя зависимость С=А·В, а также корректируют значение матрицы С, которая определяется СУ носителя С=А_Г·А_θ·А₀.

Затем на некотором интервале времени по информации ЧЭ БИНС и ЧЭ комплекса командных приборов (ККП) носителя измеряют «n» приращений вектора кажущейся скорости (ВКС) на оси инерциальной СК, моделируемой СУ БИНС, и на оси базовой СК, моделируемой СУ носителя. Определяют величины рассогласований между проекциями ВКС на инерциальной СК БИНС и соответствующими проекциями на оси базовой системы координат, одновременно проводят пересчет полученных рассогласований проекций ВКС к осям приборной системы координат БИБ, используя скорректированную при векторном согласовании матрицу перехода от базовой СК к приборной системе координат, определяют «n» приращений составляющих вектора поворота приборной СК вследствие погрешностей ДУСов и корректируют полученные рассогласования проекций ВКС на оси ПСК на величины рассогласований ВКС вследствие погрешностей ДУСов.

Далее по полученным рассогласованиям ВКС, используя принятую математическую модель погрешностей акселерометров, определяют в вычислительном устройстве БИНС калибруемые параметры (смещение нуля и масштабный коэффициент) каждого акселерометра. Для повышения точности определения калибруемых параметров используют метод наименьших квадратов. Полученные калибруемые параметры акселерометров учитывают в алгоритмах расчета ВКС БИНС.

Калибруемые параметры ДУСов системы БИНС определяют с использованием проекций вектора поворота, полученных из сравнения матрицы перехода от приборной системы координат к базовой системе координат, которая формируется путем решения уравнений Пуассона по информации ДУСов СУ БИНС, с соответствующей матрицей перехода от ПСК к базовой системы координат, полученной из системы управления носителя. При этом определяют «n» приращений составляющих вектора поворота приборной СК вследствие погрешностей ДУСов.

Затем, используя принятую математическую модель погрешностей ДУСов, методом наименьших квадратов определяют смещение нуля и масштабный коэффициент каждого ДУСа.

Полученные калибруемые параметры ДУСов учитывают в алгоритмах СУ БИНС.

Для пояснения предлагаемого способа калибровки введем обозначения:

А_г - матрица углового положения системы координат O₁X₁Y₁Z₁, связанной с ГСП носителя, относительно базовой системы координат Оξηζ, которая зависит от погрешностей ориентации при начальной выставке и от уходов ГСП носителя;

А_θ - матрица углового положения системы координат О_кX_кY_кZ_к, связанной с корпусом карданова подвеса ГСП, относительно системы координат O₁X₁Y₁Z₁, определяемая по показаниям датчиков углов, установленных на осях карданова подвеса ГСП носителя;

А₀ - матрица углового положения приборной системы координат O_nX_nY_nZ_n, связанной с приборной площадкой бесплатформенного инерциального блока, относительно системы координат О_кX_кY_кZ_к;

С - матрица углового положения приборной системы координат O_nX_nY_nZ_n относительно базовой системы координат Оξηζ;

В - матрица углового положения приборной системы координат O_nX_nY_nZ_n относительно системы координат O₂X₂Y₂Z₂, которая вырабатывается БИНС в результате решения уравнений Пуассона при наличии погрешностей начальной ориентации и погрешностей ДУСов;

А - матрица углового положения инерциальной системы координат O₂X₂Y₂Z₂ моделируемой БИНС относительно базовой системы координат Oξηζ, которая определяется методом векторного согласования.

В результате векторного согласования системы координат О₂X₂Y₂Z₂ и базовая система координат Oξηζ совпадают, матрица А=0; В=С; кроме того С=А_гА_θА₀.

Выделим из скорректированной матрицы С матрицу, равную А_θ. Для этого воспользуемся равенством:

$$\text{С}={\text{А}}_{\text{г}}{\text{А}}_{\text{θ}}{\text{А}}_{\text{0}}\text{, (1)}$$

откуда получим:

$${\text{А}}_{\text{θ}}={\text{А}}_{\text{Г}}^{\text{Т}}{\text{СА}}_{\text{0}}^{\text{Т}}\text{. (2)}$$

Равенство (1) определяет способ формирования матрицы С по информации СУ носителя.

Равенство (2) показывает возможность формирования матрицы А_θ, используя матрицу С системы БИНС и матрицы А_г и А₀, полученные от СУ носителя.

Калибровка ДУСов проводится путем сравнения углов Эйлера, полученных из матрицы А_θ равенства (2), с углами, определенными по информации ДУ, установленных на осях карданова подвеса ГСП носителя, или вторым способом: получить вектор поворота, соответствующий матрице С равенства (1), и сравнить его с вектором поворота, который соответствует скорректированной матрице С, полученной на участке калибровки по информации БИНС.

Таким образом, для калибровки ДУСов БИНС в качестве исходной информации можно использовать:

1) разность углов Эйлера, полученных из матрицы $${А}_{\theta }={А}_{г}^TС{А}_0^{Т}$$

, сформированной системой управления БИНС, и углов Эйлера, снимаемых с ДУ карданова подвеса ГСП носителя;

2) разность углов, вычисленных как разность приращений векторов поворота, полученных на участке калибровки, из матрицы В БИНС, скорректированной после векторного согласования, и из матрицы С=А_гА_θА₀, полученной по информации от системы управления носителя, которая является эталоном.

Следует отметить, что в обоих случаях для калибровки ДУСов необходимо иметь высокоточные датчики углов, установленные на оси карданова подвеса ГСП, а также достаточно жесткую конструкцию между местом крепления ГСП носителя и местами установки бесплатформенных инерциальных блоков системы управления БИНС, от которой зависит требуемое постоянное значение матрицы А₀.

Для получения проекций вектора кажущейся скорости на оси базовой СК Oξηζ носителя и на оси инерциальной системы координат OX₂Y₂Z₂, моделируемой БИНС, используются штатные алгоритмы и программы систем управления носителя и изделия ДС, управляемого с помощью БИНС. Для согласования названных систем координат можно использовать способ векторного согласования, изложенный в заявке на изобретение 2010123610/28 (033598) приоритет от 09.06.2010 г. «Способ повышения точности наведения доводочных ступеней различного назначения».

Для реализации предлагаемого способа калибровки ЧЭ БИБ в полете необходимо обеспечить выполнение следующих действий.

Для калибровки акселерометра в течение некоторого интервала времени определяют «n» приращений проекции ВКС на оси инерциальных систем координат носителя и БИНС, формируют из них разности, перепроектируют их на оси, связанной с БИБ СК OX_nY_nZ_n, и учитывают влияние погрешностей ДУСов.

Затем, используя математическую модель погрешностей акселерометров, определяют смещение нулей и поправок к масштабным коэффициентам методом наименьших квадратов.

Для оценки погрешности масштабного коэффициента δµ и смещения нуля δε математическая модель погрешностей акселерометров имеет вид

$${\text{ΔW}}_{\text{А}}={\text{W}}_{\text{А}}\text{δμ}+\text{δεΔt}\text{, (3)}$$

где W_А - составляющая вектора кажущейся скорости, измеренная акселерометром на интервале времени Δt;

ΔW_А - погрешность измерения составляющей W_А;

δµ, δε - погрешность масштабного коэффициента и смещение нуля акселерометра, которые подлежат определению при калибровке;

Δt=t-t_Н - время на участке калибровки, отсчитанное от момента времени t_Н,

t_Н - время начала калибровки акселерометра.

Величины погрешностей ΔW_iА (i=X,Y,Z) i-го акселерометра определяют путем пересчета рассогласований между проекциями ВКС на оси инерциальной СК, моделируемой СУ БИНС, и соответствующими проекциями ВКС на оси инерциальной СК, формируемой СУ носителя, к осям приборной системы координат бесплатформенного инерциального блока БИНС и учета в этих рассогласованиях влияния погрешностей ДУСов. Пересчет производят, используя следующие зависимости

$$\left|\begin{array}{l}{\text{ΔW}}_{\text{XA}}\\ {\text{ΔW}}_{\text{YA}}\\ {\text{ΔW}}_{\text{ZA}}\end{array}\right|={\text{B}}^{\text{Т}}\left|\begin{array}{l}{\text{ΔW}}_{\text{ξ}}\\ {\text{ΔW}}_{\text{η}}\\ {\text{ΔW}}_{\text{ζ}}\end{array}\right|-\left|\begin{array}{l}{\text{ΔW}}_{\text{XD}}\\ {\text{ΔW}}_{\text{YD}}\\ {\text{ΔW}}_{\text{ZD}}\end{array}\right|$$

,

$$\left|\begin{array}{l}{\text{ΔW}}_{\text{ξ}}\\ {\text{ΔW}}_{\text{η}}\\ {\text{ΔW}}_{\text{ζ}}\end{array}\right|=\left|\begin{array}{l}{\text{W}}_{\text{X2}}\\ {\text{W}}_{\text{Y2}}\\ {\text{W}}_{\text{Z2}}\end{array}\right|-\left|\begin{array}{l}{\text{W}}_{\text{ξ}}\\ {\text{W}}_{\text{η}}\\ {\text{W}}_{\text{ζ}}\end{array}\right|$$

,

,

$$\Delta \stackrel{⌣}{\chi }=B^T\Delta B$$

;

ΔВ=С-В,

где

W_X2, W_Y2, W_Z2 - приращения проекций ВКС на оси инерциальной СК СУ БИНС на участке калибровки;

W_ξ, W_η, W_ζ - приращения проекций того же ВКС на оси инерциальной СК СУ носителя;

W_XП, W_YП, W_ZП - приращения проекций того же ВКС на оси ПСК, измеренные акселерометрами БИНС на участке калибровки;

ΔW_XD, ΔW_YD, ΔW_ZD - погрешности проекций ВКС на оси ПСК вследствие погрешностей ДУСов.

С - уточненная после векторного согласования матрица перехода от приборной СК к базовой СК, формируемая СУ носителя,

В - матрица, формируемая СУ БИНС,

- вектор поворота СК OX_ПY_ПZ_П вследствие погрешностей ДУСов.

Для определения масштабного коэффициента и смещения нуля методом наименьших квадратов (МНК) модель погрешностей акселерометров путем деления на Δt приводят к виду

Y=θ₀+θ₁X,

где θ₀ - смещение нуля ε;

θ₁ - погрешность масштабного коэффициента δµ.

Величины Х и Y соответственно равны

$$\text{X}=\frac{{\text{W}}_{\text{А}}}{\text{Δt}}$$

,

$$\text{Y}=\frac{{\text{ΔW}}_{\text{А}}}{\text{Δt}}$$

.

Математическая модель погрешностей ДУСов имеет вид

$$\text{Δχ}=\text{χδh}+\text{δωΔt}\text{, (4)}$$

где χ - угол поворота изделия, измеренный ДУСом;

Δχ - погрешность угла поворота χ;

δh - погрешность масштабного коэффициента ДУСа;

δω - смещение нуля ДУСа или его собственный дрейф вокруг измерительной оси.

Величины δh и δω подлежат определению при калибровке.

При калибровке ДУСов для определения погрешности масштабного коэффициента δh и смещения нуля δω исходной информацией является разность углов поворота изделия, полученных системой управления БИНС, и углов поворота изделия, полученных системой управления носителя.

Исходную информацию в требуемом виде получают следующим образом. На момент начала калибровки после векторного согласования СК определяют начальное значение матрицы В₀, которая получена системой управления БИНС при решении уравнения Пуассона, а также начальное значение матрицы С₀, полученной СУ носителя из равенства

В₀=С₀,

С₀=А_г·А_θ·А₀ при t=t_Н,

где t_Н - время начала калибровки ДУСов.

Уточненные значения матрицы А₀ определяют после векторного согласования систем координат из равенства

А₀=(А_Г·А_θ)^Т·С₀.

Матрица А₀ сохраняет свое значение неизменным в процессе калибровки.

Затем, в полете определяют матрицу ΔВ и определяют вектор поворота Δχ из следующих равенств:

ΔВ=С-В,

где В - матрица, которая моделируется СУ БИНС на участке калибровки при начальном значении В₀;

С - матрица, которая формируется СУ носителя на участке калибровки ДУСов;

С=А_Г·А_θ·А₀,

,

.

Определяют «n» приращений составляющих Δχ_X, Δχ_Y, Δχ_Z вектора поворота $$\Delta \stackrel{⌣}{\chi }$$

ПСК вследствие погрешностей ДУСов, которые используют в методе МНК для определения масштабных коэффициентов и смещения нуля ДУСа.

Модель ошибок ДУСов (4) приводят к виду

Y=θ₀+θ₁X

путем деления правой и левой частей уравнения погрешностей ДУСов на значение Δt,

при этом $$\text{Y}=\frac{\text{Δχ}}{\text{Δt}}$$

;

$$\text{X}=\frac{\text{χ}}{\text{Δt}}$$

;

где θ₀=δω - оценка смешения нуля ДУСов;

θ₁=Δh - оценка погрешности масштабного коэффициента ДУСов;

χ - угол поворота изделия, измеренный ДУСом.

Оценку смещения нуля θ₀ и погрешности масштабного коэффициента θ₁ каждого ЧЭ БИНС методом наименьших квадратов определяют по следующим зависимостям

где

Техническим результатом предлагаемого способа является повышение точности калибруемых параметров.

Claims (1)

1. Способ калибровки чувствительных элементов (ЧЭ) бесплатформенной инерциальной навигационной системы управления (БИНС) в полете, основанный на сравнении информации о векторе кажущейся скорости (ВКС) и векторе углов поворота изделия, полученной от чувствительных элементов БИНС, с информацией о ВКС и векторе углов поворота изделия, полученной на том же интервале времени от комплекса командных приборов (ККП) системы управления (СУ) носителя, которая является в данном случае эталоном, отличающийся тем, что
   перед началом калибровки акселерометров и датчиков угловой скорости (ДУСов) БИНС в полете проводят согласование инерциальной системы координат, моделируемой СУ БИНС, с базовой инерциальной системой координат (БСК), моделируемой СУ носителя, корректируют матрицу В перехода от приборной системы координат БИБ к базовой системе координат, а также корректируют начальное значение матрицы С, которая определяется системой управления носителя;
   затем на некотором интервале времени по информации ЧЭ БИНС и ЧЭ ККП носителя измеряют «n» приращений ВКС на оси инерциальной СК, моделируемой СУ БИНС, и на оси базовой СК, моделируемой СУ носителя, определяют рассогласование между полученными проекциями, одновременно проводят пересчет полученных рассогласований проекций ВКС к осям приборной системы координат, используя скорректированную при векторном согласовании матрицу перехода от базовой к приборной СК, определяют «n» приращений составляющих вектора поворота приборной СК вследствие погрешностей ДУСов, корректируют полученные рассогласования проекций ВКС на оси ПСК на величины рассогласований ВКС вследствие погрешностей ДУСов;
   далее по полученным рассогласованиям ВКС, используя принятую математическую модель погрешностей акселерометров, определяют в вычислительном устройстве БИНС методом наименьших квадратов смещение нуля и масштабный коэффициент каждого акселерометра;
   по полученным «n» приращениям составляющих вектора поворота приборной СК вследствие погрешностей ДУСов, используя принятую математическую модель погрешностей ДУСов, методом наименьших квадратов определяют смещение нуля и масштабный коэффициент каждого ДУСа;
   полученные калибруемые параметры учитывают в алгоритмах СУ БИНС.