Калибровка магнитометра космического аппарата с учетом характера температурной зависимости матрицы чувствительности и вектора смещений нуля
- Авторы: Кириллов К.А.1, Кириллова С.В.2, Мелентьев Д.О.2,3, Титов Г.П.3, Гашин А.А.1
-
Учреждения:
- Сибирский государственный университет науки и технологий имени академика М. Ф. Решетнева
- Сибирский федеральный университет
- Акционерное общество «Информационные спутниковые системы» имени академика М. Ф. Решетнёва»
- Выпуск: Том 26, № 1 (2025)
- Страницы: 21-33
- Раздел: Раздел 1. Информатика, вычислительная техника и управление
- Статья опубликована: 16.04.2025
- URL: https://journals.eco-vector.com/2712-8970/article/view/678592
- DOI: https://doi.org/10.31772/2712-8970-2025-26-1-21-33
- ID: 678592
Цитировать
Аннотация
В настоящей работе предложен аналитический метод решения задачи калибровки магнитометра для модели, учитывающей вектор температурной зависимости смещений нуля для каждой из измерительных осей блока магнитометра и матрицу линейной температурной зависимости каждого из членов матрицы чувствительности, масштабирующей сигнал на основе реальной чувствительности каждой оси и включающей линейные внеосевые эффекты. При решении задачи определения калибровочных параметров блока магнитометра учитывается, что для измерений с любой пространственной ориентацией блока магнитометра величина измеряемого вектора магнитной индукции сохраняется и является известной модельной величиной. Вводится в рассмотрение штрафная функция 24 переменных, равная сумме квадратов невязок. Алгоритм решения задачи калибровки измерительных осей блока магнитометра сводится к поиску методом наименьших квадратов таких значений переменных этой функции, которые при заданном наборе векторов измерений магнитометра доставляют ей минимум. С этой целью указанная функция исследуется на экстремум. Исходя из необходимого условия экстремума штрафной функции, формируется система 24 уравнений относительно 24 неизвестных, которая для удобства разбивается на три системы (каждая из них есть система 8 линейных алгебраических уравнений относительно 8 неизвестных). Доказывается, что основная матрица каждой из этих трех систем не вырождена, откуда следует, что каждая из них имеет решение, и притом только одно. Компоненты решений этих систем (координаты стационарной точки штрафной функции) находятся по правилу Крамера. Доказывается, что второй дифференциал штрафной функции в найденной стационарной точке положителен, откуда следует, что эта точка действительно доставляет минимум указанной функции.
Полный текст
Введение
Магнитометры входят в состав системы ориентации и стабилизации (СОС) низкоорбитальных малогабаритных космических аппаратов (МКА), где являются основными источниками информации о положении МКА после отделения от разгонного блока. Магнитометры осуществляют измерение величины и направления вектора магнитной индукции магнитного поля Земли. Получаемые данные необходимы для формирования управляющих моментов МКА, при этом длительность режима успокоения во многом зависит от точности показаний прибора и шумовой составляющей.
Современные магнитометры СОС МКА разрабатываются на базе эффекта магнитосопротивления и вследствие физических особенностей чувствительного элемента требуют проведения математической калибровки прибора. На данный момент предложены различные методы калибровки магнитометров [1–16], в частности, статья [11], в которой приведен обзор различных способов проведения таких операций.
Ранее задача калибровки магнитометра космического аппарата решалась с применением численных методов. В настоящей работе предложен аналитический метод решения этой задачи для модели, учитывающей вектор температурной зависимости смещений нуля для каждой из измерительных осей блока магнитометра и матрицу линейной температурной зависимости каждого из членов матрицы чувствительности, масштабирующей сигнал на основе реальной чувствительности каждой оси и включающей линейные внеосевые эффекты.
1. Модель погрешностей измерений вектора магнитной индукции
Обозначим через h = (h1, h2, h3)T значение измеренного вектора магнитной индукции при некотором пространственном положении блока магнитометра (БМ). Воспользуемся моделью измерений, рассмотренной в [1]:
B = (S + τ KS) h + b + τ kb, (1)
В (1) использованы следующие обозначения:
B = (B1, B2, B3)T – истинный вектор магнитной индукции;
b = (b1, b2, b3)T – постоянный вектор, отвечающий смещениям нуля для каждой из измерительных осей БМ;
kb = (θ1, θ2, θ3)T – вектор температурной зависимости смещений нуля для каждой из измерительных осей БМ;
– матрица чувствительности, которая масштабирует сигнал на основе реальной чувствительности каждой оси и включает линейные внеосевые эффекты;
– матрица линейной температурной зависимости каждого из членов матрицы чувствительности;
τ – температура, передаваемая датчиком (скалярная величина).
При этом компоненты векторов B, h, b и kb выражены в одинаковых единицах измерения.
Задача калибровки измерительных осей БМ сводится к нахождению элементов матриц S и KS, а также компонент векторов b и kb.
2. Разработка алгоритма определения калибровочных параметров БМ
При решении задачи определения калибровочных параметров БМ воспользуемся тем, что для измерений с любой пространственной ориентацией БМ величина измеряемого вектора магнитной индукции B сохраняется и является известной модельной величиной.
Пусть в результате измерений магнитометра в дискретные моменты времени получен набор векторов h(l) = (h1(l), h2(l), h3(l))T, а в результате измерений в те же дискретные моменты времени передающего температуру датчика получен набор значений τ(l), l = 1, 2,…, N. Без ограничения общности можно считать, что если (l = 1, 2,…, N) рассматривать как координаты точек 7-мерного аффинного пространства, то эти точки не лежат в одной гиперплоскости. Обозначим эти точки следующим образом:
l = 1, 2, …, N. (2)
Докажем вспомогательное утверждение.
Лемма 1. Если точки
…, (3)
n-мерного аффинного пространства не лежат в одной гиперплоскости (N ≥ n), то среди них найдутся n аффинно независимых точек.
Доказательство. Лемму докажем методом «от противного». Предположим, что любые n точек из набора (3) аффинно зависимы. Обозначим через m максимальное число аффинно независимых точек (3), 1 ≤ m < n. Пусть …, – аффинно независимые точки, а Пn–1 – любая из гиперплоскостей, проходящих через эти точки. Выберем в гиперплоскости Пn–1 такие точки …, что точки …, …, аффинно независимы. Запишем уравнение гиперплоскости Пn–1 [17]:
(4)
Легко видеть, что любая из точек (3) удовлетворяет уравнению (4). Действительно, если в определитель, фигурирующий в левой части этого уравнения, вместо x1, x2, …, xn подставить координаты любой из точек Ul (l = 1, 2,…, N), то получим определитель
(5)
Если l = i1, то первая строка определителя (5) нулевая, и поэтому он равен нулю. Если то определитель (5) равен нулю в силу того, что первая его строка совпадает с одной из строк с номерами 2, …, m. Если же то в силу аффинной зависимости точек …, векторы …, линейно зависимы, следовательно, линейно зависимы первые m строк определителя (5), а значит этот определитель и в данном случае равен нулю.
Таким образом, все N точек (3) принадлежат гиперплоскости Пn–1, что противоречит условию леммы. Следовательно, наше предположение о том, что любые n точек из набора (3) аффинно зависимы, не верно, а значит, среди точек (3) действительно найдутся n аффинно независимых точек. Лемма 1 доказана.
Из (1) получаем:
B(l) = (S + τ(l) KS) h(l) + b + τ(l) kb, l = 1, 2, …, N, (6)
где B(l) = (B1(l), B2(l), B3(l))T – истинный вектор магнитной индукции в той же точке пространства, что и измеренный вектор h(l), l = 1, 2,…, N.
Перепишем равенство (6) в развернутом виде:
(7)
l = 1, 2, …, N. Каждое из N векторных равенств (7) запишем в виде системы трех скалярных равенств:
l = 1, 2,…, N.
Введем в рассмотрение штрафную функцию 24 переменных sij, tij (i, j = 1, 2, 3), bi, θi (i = 1, 2, 3):
(8)
Алгоритм решения задачи калибровки измерительных осей БМ сводится к поиску методом наименьших квадратов [18] таких значений переменных sij, tij (i, j = 1, 2, 3), bi, θi (i = 1, 2, 3), которые при заданном наборе векторов измерений {h(l)} (l = 1, 2,…, N) доставляют минимум функции Ф. С этой целью требуется исследовать функцию Ф на экстремум [19]. Запишем необходимое условие локального экстремума этой функции:
(9)
Требуется найти стационарные точки функции Ф, т. е. решение системы (9) – системы линейных алгебраических уравнений относительно 24 неизвестных sij, tij (i, j = 1, 2, 3), bi, θi (i = 1, 2, 3).
Для удобства разобьем (9) на три системы
(10)
i = 1, 2, 3. Заметим, что i-я система (10) представляет собой систему линейных алгебраических уравнений относительно восьми неизвестных bi, θi, si1, si2, si3, ti1, ti2, ti3, i = 1, 2, 3.
Докажем, что каждая из трех систем уравнений (10) имеет решение, и притом только одно. Для этого достаточно показать, что основная матрица каждой из этих трех систем не вырождена. Основная матрица каждой из указанных систем – матрица Грама, составленная из скалярных произведений следующих восьми векторов:
(),
(). (11)
При этом скалярное произведение двух векторов определяется как сумма произведений их компонент с одинаковыми номерами.
Докажем, что система векторов (11) линейно независима, откуда будет следовать невырожденность матрицы Грама этой системы [20], т. е. основной матрицы каждой из этих трех систем уравнений (10). Доказательство проведем методом «от противного». Предположим, что система векторов (11) линейно зависима. Тогда ранг матрицы
столбцы которой составлены из компонент векторов (11), меньше 8. Следовательно, любой минор 8-го порядка этой матрицы равен нулю (считаем, что N ≥ 8), откуда вытекает справедливость равенства
(12)
где – аффинно независимые точки из набора точек (2), l = 1, 2,…, 7 (семь таких точек существуют в силу Леммы 1), а – координаты любой из остальных (N – 7) точек набора (2). Равенство (12) равносильно равенству
которое представляет собой уравнение гиперплоскости, проходящей через аффинно независимые точки , , …, . Из вышесказанного следует, что этому уравнению удовлетворяют координаты любой из N точек набора (2), а это противоречит тому, что N точек (2) не лежат в одной гиперплоскости.
Таким образом, система векторов (11) линейно независима, а значит основная матрица каждой из трех систем уравнений (10) не вырождена. Следовательно, каждая из этих систем имеет решение, и притом только одно, что и требовалось доказать.
Введем следующие обозначения:
Тогда каждую из трех систем уравнений (10) можно записать в виде
(13)
i = 1, 2, 3. В каждой из трех систем (13) выразим из первых двух уравнений bi и θi через si1, si2, si3, ti1, ti2, ti3, затем исключим bi и θi из остальных шести уравнений системы и умножим обе части каждого из последних шести уравнений на (T 2 – NR):
(14)
(15)
i = 1, 2, 3, где коэффициенты при неизвестных и свободные члены определяются равенствами
i, j, k = 1, 2, 3.
Заметим, что хотя бы один из миноров третьего порядка, расположенных в первых трех столбцах основной матрицы,
(16)
каждой из трех систем уравнений (15), отличен от нуля. Действительно, в силу теоремы Лапласа, определитель матрицы (16) равен сумме произведений всех миноров третьего порядка, расположенных в первых трех столбцах этой матрицы, на их алгебраические дополнения, и если бы все указанные миноры равнялись нулю, то нулю равнялся бы и определитель матрицы (16), что противоречило бы необходимому и достаточному условию существования единственного решения каждой из трех систем уравнений (15), а значит и каждой из трех систем уравнений (10).
Пусть j1, j2, j3 (1 ≤ j1 < j2 < j3 ≤ 6) – номера строк матрицы (16), на пересечении которых с первыми тремя столбцами этой матрицы расположен отличный от нуля минор третьего порядка. Поменяем местами уравнения каждой из трех систем (15) так, чтобы уравнения с номерами j1, j2, j3 оказались соответственно первым, вторым и третьим. Номера уравнений, оказавшихся при этом на четвертом, пятом и шестом местах, обозначим соответственно через j4, j5, j6. Введем также следующие обозначения:
i = 1, 2, 3. Тогда расширенная матрица системы, полученной из i-й системы (15) в результате указанной выше перестановки уравнений, примет вид
(17)
i = 1, 2, 3. При этом Ω11 – невырожденная матрица в силу ее определения и условия выбора номеров j1, j2, j3 строк матрицы (16). Из второй строки i-й блочной матрицы (17) вычтем ее первую строку, умноженную слева на :
(18)
i = 1, 2, 3, где O – нулевая квадратная матрица третьего порядка. Полученная матрица (18) эквивалентна матрице (17) [21]. Для каждого i = 1, 2, 3 последние три уравнения системы, соответствующей расширенной матрице (18), образуют систему, матричная запись которой выглядит следующим образом:
(19)
где Λi = (ti1, ti2, ti3)T, i = 1, 2, 3.
Заметим, что основная матрица каждой из трех систем уравнений (19) не вырождена, так как в противном случае нарушалось бы необходимое и достаточное условие существования единственного решения каждой из трех систем (19), а значит и каждой из трех систем (15) и, следовательно, каждой из трех систем (10).
Значения неизвестных ti1, ti2, ti3 для каждого i = 1, 2, 3 находим из системы уравнений (19) по формулам Крамера
(20)
где
а каждый из определителей Δi,k получаем из определителя Δ заменой его k-го столбца на столбец свободных членов
i, k = 1, 2, 3.
Подставляя для каждого i = 1, 2, 3 в первые три уравнения системы, соответствующей расширенной матрице (18), вместо ti1, ti2, ti3 значения этих неизвестных, вычисленные по формулам (20), получим систему трех уравнений относительно трех неизвестных si1, si2, si3, матричная запись которой имеет вид
(21)
где – вектор-столбец решений системы уравнений (19), Σi = (si1, si2, si3)T, i = 1, 2, 3. Значения неизвестных si1, si2, si3 для каждого i = 1, 2, 3 находим из системы уравнений (21) по формулам Крамера
где
а каждый из определителей получаем из определителя заменой его k-го столбца на столбец свободных членов
i, k = 1, 2, 3.
После нахождения значений неизвестных ti1, ti2, ti3, si1, si2, si3 находим значения неизвестных bi и θi по формулам (14), i = 1, 2, 3.
Докажем, что найденная стационарная точка функции Φ, определенной равенством (8), т. е. решение системы уравнений (9), полученное изложенным выше способом, доставляет минимум функции Φ. Выведем выражение второго дифференциала d 2Φ функции Φ:
где Δsij = dsij, Δtij = dtij (i, j = 1, 2, 3), Δbi = dbi, Δθi = dθi (i = 1, 2, 3). Из полученного выражения для d 2Φ следует, что при условии неравенства нулю хотя бы одного из слагаемых
В последней двойной сумме (с физической точки зрения это вполне естественно) имеет место неравенство d 2Φ > 0 в любой точке, а значит, и в найденной стационарной точке функции Φ. Следовательно, полученное решение системы уравнений (9) действительно доставляет минимум функции Φ [19].
Заключение
Итак, мы получили аналитическое решение задачи калибровки магнитометра космического аппарата для модели, учитывающей вектор температурной зависимости смещений нуля для каждой из измерительных осей блока магнитометра и матрицу линейной температурной зависимости каждого из членов матрицы чувствительности, масштабирующей сигнал на основе реальной чувствительности каждой оси и включающей линейные внеосевые эффекты.
Процедура вычисления калибровочных параметров БМ по выведенным формулам обладает следующими очевидными преимуществами по сравнению с численными методами решения этой задачи:
- существенно уменьшается число арифметических операций;
- исчезает проблема возможной неустойчивости метода.
Об авторах
Кирилл Анатольевич Кириллов
Сибирский государственный университет науки и технологий имени академика М. Ф. Решетнева
Автор, ответственный за переписку.
Email: kkirillow@yandex.ru
ORCID iD: 0000-0002-3763-1303
доктор физико-математических наук, доцент, профессор кафедры прикладной математики
Россия, 660037, г. Красноярск, просп. им. газ. «Красноярский Рабочий», 31Светлана Владимировна Кириллова
Сибирский федеральный университет
Email: svkirillova2009@yandex.ru
ORCID iD: 0000-0003-3779-2825
кандидат технических наук, доцент, доцент кафедры прикладной математики и анализа данных
Россия, 660041, г. Красноярск, просп. Свободный, 79Денис Олегович Мелентьев
Сибирский федеральный университет; Акционерное общество «Информационные спутниковые системы» имени академика М. Ф. Решетнёва»
Email: denes.2000@mail.ru
ORCID iD: 0009-0009-6187-4098
аспирант, Сибирский федеральный университет; инженер, АО «РЕШЕТНЁВ»
Россия, 660041, г. Красноярск, просп. Свободный, 79; 662972, г. Железногорск Красноярского края, ул. Ленина, 52Геннадий Павлович Титов
Акционерное общество «Информационные спутниковые системы» имени академика М. Ф. Решетнёва»
Email: titov@iss-reshetnev.ru
ORCID iD: 0009-0009-1223-9434
ведущий специалист
Россия, 662972, г. Железногорск Красноярского края, ул. Ленина, 52Артем Александрович Гашин
Сибирский государственный университет науки и технологий имени академика М. Ф. Решетнева
Email: artem.gashin@gmail.com
ORCID iD: 0009-0000-7062-6285
аспирант кафедры прикладной математики
Россия, 660037, г. Красноярск, просп. им. газ. «Красноярский Рабочий», 31Список литературы
- Belsten N., Knapp M., Masterson R., Payne C., Ammons K., Lind F.D., Cahoy K. Verification and calibration of a commercial anisotropic magnetoresistive magnetometer by multivariate non-linear regression // Geoscientific Instrumentation, Methods and Data Systems. 2023. Vol. 12, No. 2, P. 201–213. doi: 10.5194/gi-12-201-2023.
- Chen M., Liu K., Hu X., Li Y., Hao X., Pan Z. Ground calibration of the Mars orbiter magnetometer onboard Tianwen-1 // Earth and Planetary Physics. 2023. Vol. 7, No. 3. P. 371–377. doi: 10.26464/epp2023004.
- Cheng S., Wang G., Zhang T., Pan Z., Meng L., Yi Z. An optimal method for in-flight calibration of the fluxgate magnetometer when the total magnetic field of alfvén waves has a drift trend // Acta Geophysica Sinica. 2022. Vol. 65, No. 5. P. 1558–1570. doi: 10.6038/cjg2022P0362.
- Crassidis J. L., Cheng Ya. Three-axis magnetometer calibration using total least squares // Journal of Guidance, Control, and Dynamics. 2021. Vol. 44, No. 8. P. 1410–1424. doi: 10.2514/1.g005305.
- Huang Yu., Wu L., Wang Ya., Xu Y. Scalar calibration of total instrument errors of tri-axial magnetometer using constrained optimization independent of magnetic field intensity // IEEE Sensors Journal. 2024. Vol. 24, No. 9. P. 14352–14360. doi: 10.1109/jsen.2024.3370624.
- Kim Ji. H., Lee Ch. Ju., Lee Ju. K. Effects of outlier elimination in magnetometer calibration data on the performance of ellipsoid fitting-based calibration // Journal of Institute of Control, Robotics and Systems. 2024. Vol. 30, No. 12. P. 1373–1379. doi: 10.5302/j.icros.2024.24.0209.
- Kinatas H., Hajiyev Ch. Triad-Aided Multiplicative EKF for Small Satellite Attitude Estimation and Magnetometer Calibration // IEEE Sensors Journal. 2023. Vol. 23, No. 22. P. 27161–27168. doi: 10.1109/jsen.2023.3317969.
- Liu J., Yan Y., Yan Sh., Li X. A hybrid calibration method for a three-axis magnetometer in limited-range attitudes // IEEE Sensors Journal. 2022. Vol. 22, No. 1. P. 203–210. doi: 10.1109/jsen.2021.3123728.
- Integrated calibration of strap-down geomagnetic vector measurement system / H. Pang, Ch. Wan, Sh. Mou et al. // IEEE Sensors Journal. 2022. Vol. 22, No. 11. P. 10476–10484. doi: 10.1109/jsen.2022.3171325.
- Particle swarm optimization for magnetometer calibration with rotation axis fitting using in-orbit data / B. A. Riwanto, P. Niemela, M. R. Mughal et al. // IEEE Transactions on Aerospace and Electronic Systems. 2022. Vol. 58, No. 2. P. 1211–1223. doi: 10.1109/TAES.2021.3122514.
- Soken H. E. A survey of calibration algorithms for small satellite magnetometers // Measurement. 2018. Vol. 122. P. 417–423. doi: 10.1016/j.measurement.2017.10.017.
- Song H., Park Ja., Lee Ja. Magnetometer calibration based on the Chaos-7 model // Journal of Astronomy and Space Science. 2021. Vol. 38, No. 3. P. 157–164. doi: 10.5140/jass.2021.38.3.157.
- Wang Y., Yu X., Zong Q., Xiao Ch., Liu Si., Chen H., Zou H., Shi W. In-flight vector magnetometer calibration for FY-3E satellite // Science China Technological Sciences. 2023. Vol. 66, No. 6. P. 1867–1868. doi: 10.1007/s11431-022-2338-1.
- Withanage D. Ch., Teramoto M., Cho M. On-orbit magnetometer data calibration using genetic algorithm and interchangeability of the calibration parameters // Applied Sciences (Switzerland). 2023. Vol. 13, No. 11. P. 6742. doi: 10.3390/app13116742.
- Attitude-independent magnetometer calibration based on adaptive filtering / W. Zeng, Q. Bian, Ju. Gao et al. // IEEE Sensors Journal. 2022. Vol. 22, No. 1. P. 195–202. doi: 10.1109/jsen.2021. 3114347.
- Калибровка магнитометра космического аппарата «Декарт» в полёте / П. Е. Розин, А. В. Симонов, Е. С. Гордиенко, Ю. К. Зайко // Труды МАИ. 2022. № 124. Doi: 10.34759/ trd-2022-124-19.
- Розенфельд Б. А. Многомерные пространства. М. : Ленанд, 2021. 672 с.
- Зоркальцев В. И. Метод наименьших квадратов: геометрические свойства, альтернативные подходы, приложения. Новосибирск : Наука, 1995. 220 с.
- Цирлин А. М. Методы оптимизации для инженеров. Москва, Берлин : Директ-Медиа, 2015. 214 с.
- Horn R. A., Johnson C.R. Matrix Analysis (2nd ed.). Cambridge University Press, 2012, 643 p.
- Гантмахер Ф. Р. Теория матриц. М. : Физматлит, 2004. 560 с.
Дополнительные файлы
