способ определения угловой ориентации объекта

Формула изобретения

Способ определения угловой ориентации объекта, включающий получение информации о координатах подвижного объекта от бортовой инерциальной навигационной системы, прием сигналов от спутниковой радионавигационной системы при помощи трех закрепленных на подвижном объекте и не лежащих на одной прямой антенн навигационных приемников А₀, A₁, A₂, последующую обработку информации и получение значений параметров угловой ориентации, отличающийся тем, что обработку информации проводят путем коррекции ошибки в параметрах угловой ориентации, полученных от инерциальной навигационной системы, с использованием сигналов одного доступного навигационного спутника, при этом по разности фаз сигналов, поступающих от спутника на разнесенные антенны А₀ и A₁ определяют угол ₁ между базой антенн d₁ и направлением на спутник, по информации от бортовой инерциальной навигационной системы о координатах и параметрах ориентации объекта и по информации от спутниковой навигационной системы о координатах спутника определяют угол ₁* между базой антенн d₁ и направлением на спутник, по разности фаз сигналов, поступающих от спутника на разнесенные антенны А₀ и A₂, определяют угол ₂ между базой антенн d₂ и направлением на спутник, по информации от бортовой инерциальной навигационной системы о координатах и параметрах ориентации объекта и по информации от спутниковой навигационной системы о координатах спутника определяют угол ₂* между базой антенн d₂ и направлением на спутник, в случае, если величины ₁ и ₁*, ₂ и ₂* отличаются между собой на величину больше заданной, осуществляют коррекцию ошибки в параметрах угловой ориентации, полученных от бортовой инерциальной навигационной системы.

Описание изобретения к патенту

Изобретение относится к области навигации, в частности к способам инерциально-спутниковой навигации, предназначенным для определения углового положения объекта в инерциальном пространстве, и может быть использовано, например, при проектировании интегрированных систем ориентации и навигации.

Угловая ориентация объекта определяется параметрами ориентации, к которым могут быть причислены углы Эйлера-Крылова, параметры Родриго-Гамильтона, а также направляющие косинусы [Ишлинский А.Ю. Гироскопы, ориентация и инерциальная навигация. - М.: «Наука», 1976. - 672 с].

Известен способ определения параметров ориентации объекта при помощи бесплатформенной системы ориентации, построенной на трех датчиках угловой скорости [Анучин О.Н. Интегрированные системы ориентации и навигации для морских подвижных объектов/ О.Н.Анучин, Г.И.Емельянцев. - Санкт-Петербург: ГНЦ РФ ЦНИИ «Электроприбор», 2003. - 390 с.]. Способ состоит в обработке сигналов этих датчиков и получении в результате параметров ориентации. К достоинствам данных систем можно отнести автономность и возможность выдачи информации с высокой частотой.

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

Известен способ определения параметров ориентации объекта по сигналам глобальных спутниковых радионавигационных систем [Описание изобретения к патенту РФ № 2022294 от 27.04.1992, МПК⁵ G01S 5/00, опубл. 30.10.1994], основанный на приеме сигналов навигационных спутников каждым из четырех антенно-приемных устройств, расположенных на объекте, выделении сигнала с частотой Доплера, определении набега фаз колебаний с частотой Доплера путем интегрирования их на мерном интервале и определении углового положения объектов.

Недостатком способа является длительное время, необходимое для определения параметров ориентации, так как для решения задачи ориентации необходимо, чтобы навигационные спутники за время измерения существенно переместились в пространстве. Необходимое время измерения соответствует десяткам минут - часам. Это существенно ограничивает возможность применения этого способа.

Известен способ определения параметров ориентации объекта по сигналам глобальных спутниковых радионавигационных систем [Описание изобретения к патенту РФ № 2248004 от 30.04.2003, МПК⁷ G01S 5/00, опубл. 10.03.2005, Бюл. № 7], основанный на определении координат четырех закрепленных на объекте не лежащих на одной прямой навигационных приемников.

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

Наиболее близким заявляемому способу по совокупности существенных признаков является способ определения угловой ориентации объекта при помощи интегрированной системы ориентации и навигации [Описание изобретения к патенту РФ № 2276384 от 27.04.2004, МПК⁷ G01S 5/00, опубл. 10.05.2006, Бюл. № 13]. Сущность способа заключается в определении параметров ориентации объекта по сигналам от инерциальной навигационной системы (например, бесплатформенной) и по сигналам двух навигационных спутников, принимаемым не менее чем тремя антеннами навигационных приемников, не расположенными на одной прямой. Приемники служат для определения углового положения объекта относительно направления на каждый из двух навигационных спутников. К достоинствам данного способа можно причислить отсутствие зависимости погрешности в определении параметров ориентации от точности начальной выставки и отсутствие нарастающей со временем погрешности в определении параметров ориентации.

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

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

Изобретение иллюстрируется чертежом, где условно изображена решаемая задача определения параметров ориентации.

Для получения заявленного технического результата в известном способе определения угловой ориентации, включающем получение информации о координатах подвижного объекта от бортовой инерциальной навигационной системы, прием сигналов от спутниковой радионавигационной системы при помощи трех закрепленных на подвижном объекте и не лежащих на одной прямой антенн навигационных приемников А₀, A₁, A₂, последующую обработку информации и получение значений параметров угловой ориентации, коррекцию ошибки в параметрах угловой ориентации, полученных от инерциальной навигационной системы, проводят с использованием сигналов одного доступного навигационного спутника, при этом по разности фаз сигналов, поступающих от спутника на разнесенные антенны А₀ и A₁ определяют угол ₁ между базой антенн d₁ и направлением на спутник, по информации от бортовой инерциальной навигационной системы о координатах и параметрах ориентации объекта и по информации от спутниковой навигационной системы о координатах спутника определяют угол ₁ ^* между базой антенн d₁ и направлением на спутник, по разности фаз сигналов, поступающих от спутника на разнесенные антенны А₀ и A₂, определяют угол ₂ между базой антенн d₂ и направлением на спутник, по информации от бортовой инерциальной навигационной системы о координатах и параметрах ориентации объекта и по информации от спутниковой навигационной системы о координатах спутника определяют угол ₂ ^* между базой антенн d₂ и направлением на спутник, в случае, если модуль разностей величин ₁ и ₁ ^*, ₂ и ₂ ^* превышает заданное значение, осуществляют коррекцию показаний ошибки в показаниях бортовой инерциальной навигационной системы.

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

Способ определения угловой ориентации объекта реализуется следующим образом.

1. На подвижном объекте размещают интегрированную систему ориентации и навигации, состоящую из инерциальной системы ориентации и навигации, приемника навигационных сигналов, обрабатывающего информацию от трех антенн А₀, A₁, A ₂, служащих для приема сигналов спутниковых радионавигационных систем (например, ГЛОНАСС).

В общем случае, антенны могут быть размещены произвольным образом, но так, чтобы они не лежали на одной прямой. Для удобства далее рассмотрим случай размещения антенн в одной плоскости таким образом, что антенны А₀ и A₁ находятся на продольной оси ОХ, а антенны А₀ и А₂ находятся на оси OZ, связанной с подвижным объектом системы координат OXYZ. Расстояния между антеннами А₀-А₁ и А₀-A ₂ известны и равны d₁ и d₂ соответственно.

2. При помощи инерциальной системы ориентации и навигации определяют координаты точки закрепления антенны A₀ в базовой системе координат OX_gY_g Z_g и угловую ориентацию связанной с объектом системы координат OXYZ в базовой системе координат OX_gY _gZ_g в виде матрицы направляющих косинусов [Пельпор Д.С. Гироскопические системы. Учебник для вузов. /Д.С.Пельпор, И.А.Мигалев, В.А.Бауман и др.; Под ред. Д.С.Пельпора. - 2-е изд., перереб. и доп. - М.: Высш. шк., 1988. - 424 с.]:

В базисе OX_gY_gZ _g по показаниям инерциальной навигационной системы можно аналитически построить систему координат OX_бY _бZ_б, направление осей которой в результате ошибок начальной выставки или нарастающей со временем погрешности не совпадает с направлением осей системы координат OXYZ.

3. В навигационном сигнале, передаваемом спутником, содержится информация о координатах спутника в геоцентрической системе координат. По этой информации находят координаты спутника в базовой системе координат S .

4. Зная координаты точек A₀ , определенные в соответствии с п.2, и координаты точки S, определяем положение вектора в базовой системе координат:

5. Находим косинус угла между векторами и :

6. По сигналам, поступающим от спутника S на разнесенные антенны A₀ и A₁, определяем косинус угла ₁ между базой антенн d₁ и направлением на спутник, т.е. между векторами и , по формуле:

где ₁ - угол между вектором и направлением на спутник S, определенный с помощью аппаратуры СРНС, - длина волны сигнала, излучаемого спутником S, ₁ - разница фаз сигналов, принимаемых антеннами A₀ и A₁ от спутника S, d₁ - расстояние между антеннами A₀ и A₁.

7. В случае, если величины cos ₁ и cos ₁ отличаются между собой на величину, большую заранее заданной (обозначим ее ), то, следовательно, определенное с помощью БИНС положение оси отличается от истинного положения оси , на которой расположены антенны A₀, A₁ , и поэтому производят вычисление скорректированных параметров угловой ориентации. Находят вектор причем угол между искомым вектором и направлением на спутник S должен составлять ₁.

Составим уравнение плоскости, проходящей через вектора , :

где х_р, у_р, z _p - переменные в уравнении плоскости.

Составим уравнение плоскости, проходящей через вектора , :

Предполагается, что векторы , , и лежат в одной плоскости и, следовательно, вектор может быть найден из решения системы уравнений:

8. В случае, если величины cos ₁ и cos ₁ отличаются между собой на величину, меньшую заранее заданной , то за вектор принимают вектор (c₁₁, c₂₁, c₃₁).

Далее действия повторяются аналогично в отношении антенн A ₀ и A₂.

9. По сигналам, поступающим от спутника S на разнесенные антенны A₀ и A₂ , определяют косинус угла ₂ между базой антенн d₂ и направлением на спутник, т.е. между векторами и , по формуле:

где ₂ - угол между вектором и направлением на спутник S, определенный с помощью аппаратуры СРНС, - длина волны сигнала излучаемого спутником S, ₂ - разница фаз сигналов, принимаемых антеннами A₀ и A₂ от спутника S, d₂ - расстояние между антеннами A₀ и A₂.

10. Находим косинус угла между векторами и :

11. В случае, если величины cos ₂ и cos ₂ отличаются между собой на величину, большую заранее заданной , то, следовательно, определенное с помощью БИНС положение оси отличается от истинного положения оси OZ, на которой расположены антенны A₀, A₂, и поэтому производят вычисление скорректированных параметров угловой ориентации. Находят вектор причем угол между искомым вектором и направлением на спутник S должен составлять ₂.

Составим уравнение плоскости, проходящей через вектора ,

где x_p, y_p, z _p - переменные в уравнении плоскости.

Составим уравнение плоскости, проходящей через векторы ,

В этом случае вектор может быть найден из решения системы уравнений:

12. В случае, если величины cos ₂ и cos ₂ отличаются между собой на величину, меньшую заранее заданной , то за вектор принимают вектор (c₁₃, с₂₃, с₃₃).

13. Положение третьей оси связанной системы координат можно найти как векторное произведение векторов и :

Таким образом получают скорректированную матрицу направляющих косинусов, однозначно определяющую угловую ориентацию объекта относительно базовой системы координат OX _gY_gZ_g:

Проведенное математическое моделирование показало работоспособность предлагаемого способа.

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