Способ определения местоположения подвижных объектов и устройство для его реализации

Способ определения местоположения подвижных объектов и устройство для его реализации

Реферат

 

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

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

Известен способ определения местоположения, описанный в патенте Российской Федерации N 2082098, G 01 C 23/00, 20.06.97 "Способ комплексирования инерциальных навигационных систем и комбинированная навигационная система".

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

Известное устройство содержит автономную навигационную систему, приемник спутниковой навигационной системы, первый, второй, третий сумматоры, фильтр коррекции. Кроме этого, устройство содержит интегратор, фильтр управления, а автономная навигационная система выполнена в виде инерциальной навигационной системы.

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

Наиболее близким по технической сущности к предлагаемому способу является способ, описанный в патенте Российской Федерации N 2098764, G 01 C 21/08, 1997г. "Способ определения местоположения подвижных объектов и устройство для его реализации".

Известный способ определения местоположения подвижных объектов заключается в следующем: 1) в калибровочном цикле осуществляют разворот подвижного объекта на угол не менее 360 градусов и проводят определение значений горизонтальных проекций суммарного вектора напряженности магнитного поля Земли (МПЗ) и магнитного поля объекта в четырех точках горизонтального эллипса магнитного годографа; 2) по контрольным значениям горизонтальных проекций определяют коэффициенты коррекции горизонтального эллипса магнитного годографа - смещение центра эллипса, малую и большую полуоси эллипса и угол поворота осей; 3) в каждом рабочем цикле измеряют усредненные за время 0,1..,2,0 с значения проекций суммарного вектора напряженности МПЗ и магнитного поля объекта и ускорения силы тяжести на оси приборной системы координат; 4) по измеренным значениям проекций с учетом коэффициентов коррекции, полученных в калибровочном цикле, определяют значения горизонтальных проекций вектора напряженности МПЗ на оси горизонтальной системы координат объекта; 5) по значениям горизонтальных проекций вектора напряженности МПЗ с учетом приращения пути и поправки направления определяют в рабочем цикле приращения координат и угол направления движения; 6) с учетом координат исходной точки определяют координаты объекта.

Для реализации известного способа используют устройство, описанное в приведенном выше патенте РФ N 2098764.

Устройство (фиг.1) содержит датчики магнитного поля, датчики вертикали, блок преобразования и усреднения, блок расчета горизонтальных проекций МПЗ, блок управления, датчик перемещения и навигационный блок. Блок расчета горизонтальных проекций МПЗ содержит блок расчета горизонтальных проекций суммарного вектора напряженности МПЗ и магнитного поля объекта, блок расчета коэффициентов коррекции горизонтального эллипса магнитного годографа и блок коррекции горизонтальных проекций суммарного вектора напряженности МПЗ и магнитного поля объекта, выходы которого являются выходами блока расчета горизонтальных проекций МПЗ, а первые входы соединены с первыми выходами блока расчета горизонтальных проекций суммарного вектора напряженности МПЗ и магнитного поля объекта, входы которого являются первыми входами блока расчета горизонтальных проекций МПЗ, а вторые выходы соединены с первыми входами блока расчета коэффициентов коррекции горизонтального эллипса магнитного годографа, вторые входы которого являются вторыми входами блока расчета горизонтальных проекций МПЗ, а выходы соединены со вторыми входами блока коррекции проекций суммарного вектора напряженности МПЗ и магнитного поля объекта. Навигационный блок содержит блок расчета приращений координат, блок расчета угла и сумматор. Выходы датчиков магнитного поля и датчиков вертикали соединены соответственно с первыми и вторыми входами блока преобразования и усреднения, выходы которого соединены с первыми входами блока расчета горизонтальных проекций МПЗ, выходы которого соединены с первыми входами блока расчета приращений координат и первыми входами блока расчета угла, выходы которого соединены с первыми входами блока управления, первые и вторые выходы которого соединены соответственно со вторыми входами блока расчета горизонтальных проекций МПЗ и третьими входами блока преобразования и усреднения, выходы сумматора соединены со вторыми входами блока управления.

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

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

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

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

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

Для решения поставленной задачи предлагается способ, который заключается в следующем: 1) в калибровочном цикле осуществляют разворот подвижного объекта на угол не менее 270 градусов и определяют с помощью автономной навигационной системы значения горизонтальных проекций суммарного вектора напряженности МПЗ и магнитного поля объекта в четырех точках горизонтального эллипса магнитного годографа; 2) по контрольным значениям горизонтальных проекций определяют коэффициенты коррекции горизонтального эллипса магнитного годографа - смещение центра эллипса, малую и большую полуоси эллипса; 3) в каждом рабочем цикле автономной навигационной системы измеряют усредненные за время цикла значения проекций суммарного вектора напряженности МПЗ и магнитного поля объекта и ускорения силы тяжести на оси приборной системы координат; 4) по измеренным значениям проекций с учетом коэффициентов коррекции, полученных в калибровочном цикле, определяют значения горизонтальных проекций вектора напряженности МПЗ на оси горизонтальной системы координат объекта; 5) по значениям горизонтальных проекций вектора напряженности МПЗ с учетом поправки направления определяют угол направления движения и с учетом приращения пути определяют приращения координат за время рабочего цикла; 6) определяют с учетом координат исходной точки координаты подвижного объекта.

Кроме этого, предлагаемый способ включает следующее: 1) дополнительно определяют относительные координаты суммированием приращений координат, измеренных в каждом рабочем цикле; 2) определяют координаты объекта суммированием относительных координат и координат начальной точки; 3) дополнительно измеряют с помощью приемника спутниковой навигационной системы координаты объекта, с учетом которых проводят коррекцию относительных координат и координат начальной точки; 4) в процессе движения объекта на участках пути, превышающих не менее чем в три раза ошибку измерения координат приемником спутниковой навигационной системы, определяют приращения координат с помощью автономной навигационной системы и приемника спутниковой навигационной системы, по которым определяют корректирующие коэффициенты, с учетом которых в каждом рабочем цикле проводят коррекцию угла направления движения и приращения пути.

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

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

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

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

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

Все это обеспечивает решение задачи, на которое направлено заявляемое изобретение.

На фиг. 2 представлена система координат подвижного объекта, на фиг.3 - структурная схема устройства для определения местоположения подвижных объектов.

Предлагаемый способ заключается в следующем.

С помощью датчиков вертикали (трех датчиков линейного ускорения) и трех датчиков магнитного поля проводится измерение значений проекций А_X, А_Y, А_Z ускорения силы тяжести и значений проекций H_X, H_Y, H_Z суммарного вектора напряженности МПЗ и паразитного магнитного поля подвижного объекта по трем взаимно ортогональным направлениям на оси приборной системы координат. Определим приборную систему координат OXYZ (фиг.2) следующим образом: ось OY направим вдоль продольной оси подвижного объекта в направлении движения, ось OZ - вдоль вертикальной оси объекта, а ось ОХ - вдоль поперечной оси объекта. Введем горизонтальную систему координат ОX_BY_BZ_B следующим образом: ось OZ_B направим вертикально вверх, ось ОY_B - в направлении движения в горизонтальной плоскости, ось ОХ_B - перпендикулярно направлению движения. В этом случае горизонтальные проекции Н_XB, Н_YB вектора магнитного поля в системе координат OX_BY_BZ_B определяются в соответствии с выражениями где В идеальном случае при отсутствии паразитных магнитных полей значения Н_XB, H_YB, определенные в соответствии с (1), могут быть использованы для определения азимутального угла направления движения. На практике идеальный магнитный годограф горизонтальной составляющей магнитного поля, имеющий форму окружности, смещен относительно начала координат из-за постоянного магнитного поля, создаваемого подвижным объектом, и принимает форму эллипса из-за индуцированного магнитного поля, формируемого подвижным объектом. Таким образом, в реальной ситуации множество значений Hⁱ _XB, Hⁱ _YB, определенных в соответствии с (1), принимают форму эллипса, оси которого, в общем случае, не параллельны осям чувствительности датчиков, и, следовательно, необходимо провести преобразование координат, которые переводили бы эллипс в окружность. На практике для подвижных объектов угол поворота осей эллипса, особенно при расположении датчиков на внешней части корпуса объекта в продольной плоскости симметрии, можно не учитывать.

В калибровочном цикле предварительно измеряют значения магнитного поля в четырех точках эллипса магнитного годографа горизонтальной составляющей магнитного поля, соответствующих направлениям 0, 90, 180 и 270 градусов, - H^max _XB, H^min _XB, H^max _YB, H^min _YB. Кроме этого, измеряют значение вертикальной проекции Н_ZB.

По этим значениям определяют смещение центра эллипса и полуоси эллипса годографа горизонтальной составляющей магнитного поля из выражений H_X=(H^max _XB+H^min _XB)/2, H_Y=(H^max _YB+H^min _YB)/2, H_Z=H_ZB-H_ZO, a=(H^max _XB-H^min _XB)/2, b=(H^max _YB-H^min _YB)/2, где Н_ZO - значение вертикальной составляющей напряженности МПЗ для данного района. Н_ZO может быть определена с помощью магнитных карт или измерена (при отсутствии паразитных магнитных полей).

Определенные в калибровочном цикле корректирующие коэффициенты магнитного поля Н_X, Н_Y, H_Z, a, b хранятся в запоминающем устройстве и используются в каждом цикле для коррекции (учета) паразитного магнитного поля, создаваемого подвижным объектом.

Движение транспортного средства характеризуется наличием вибраций в широком диапазоне частот, которые воздействуют на датчики магнитного поля и линейного ускорения, что приводит к снижению точности измерения. Поэтому в каждом цикле измерения проводят усреднение в течение 0,1...2,0 с измеряемых значений магнитного поля и ускорения и затем, с учетом корректирующих коэффициентов, полученных в калибровочном цикле, проводят коррекцию измеренных значений путем учета смещения центра эллипса магнитного годографа и сжатия его осей H'_Z=H_Z-H_Z.

Скорректированные значения Н'_X, Н'_Y, Н'_Z используют для расчета горизонтальных проекций магнитного поля Земли в соответствии с (1).

В каждом рабочем цикле определяют приращения Х, Y прямоугольных координат где S - приращение пройденного пути за рабочий цикл; - горизонтальная составляющая МПЗ; - косинус угла наклона подвижного объекта в продольной плоскости, - поправка направления.

Определяют относительные координаты Х, Y объекта Значения прямоугольных координат Х, Y подвижного объекта определяют из выражений где X_O, Y_O - координаты начальной точки.

Магнитный азимут _m направления движения может быть определен по значениям горизонтальных проекций МПЗ следующим образом: Для определения дирекционного угла направления движения необходимо учесть поправку направления = _m+. (8) Погрешность определения координат автономной навигационной системой (S_A) складывается из путевой и угловой составляющих. В обоих случаях ошибку следует считать систематической, линейно увеличивающейся на каждом шаге вычислений. При нормальной работе навигационной системы величина S_A принимается равной 1,5-2,0% от пути, пройденного в автономном режиме.

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

В отсутствие радионавигационных сигналов для расчета координат в каждом рабочем цикле используются формулы (4), (5), (6). При получении координат от приемника спутниковой навигационной системы рассчитанные ранее относительные координаты и координаты начальной точки уточняются в соответствии с формулами где Х, Y - относительные координаты, X_O, Y_O - координаты начальной точки; X_R, Y_R - координаты, измеренные приемником спутниковой навигационной системы, символом^{^} обозначена оценка соответствующей величины с учетом координат Х_R, Y_R.

Элементы К₁, К₂ матрицы усиления вычисляются следующим образом: Здесь P_ij - элементы корреляционной матрицы Р ошибок экстраполяции, которая обновляется при поступлении координат Х_R, Y_R в соответствии с формулой Дисперсия D_A приращений координат, измеренных автономной системой, в период между последними двумя посылками от приемника спутниковой навигационной системы определяется как (S_A)², после чего величина S_A обнуляется. В процессе фильтрации элементы Р₂₁ и Р₂₂ матрицы Р постепенно уменьшаются, что приводит к соответствующему уменьшению параметра К₂. В результате спустя некоторое время оценка координат начальной точки практически не меняется и можно ограничиться лишь фильтрацией приращений координат.

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

Для вычислений по формуле (11) необходимо задать матрицу Р в начальный момент времени. Начальное значение Р=Р₀ определяется величиной дисперсии d₀ координат начальной точки в момент старта Эта дисперсия зависит от условий начала движения. Если при включении аппаратуры начальная точка не вводится оператором с пульта, а вычисляется в процессе движения по показаниям спутниковой навигационной системы, то значение d₀ должно быть выбрано достаточно большим, например 10²⁰ (процесс фильтрации слабо зависит от конкретной величины этого параметра). Если же начальные координаты X₀, Y₀ вводятся оператором, то величина D₀ определяется возможной ошибкой при этом. По умолчанию в этом случае она может быть выбрана в диапазоне 10²10⁴, что соответствует ошибке ввода координат начальной точки от 10 до 100 м.

Если сигналы от приемника спутниковой навигационной системы не поступают, координаты рассчитываются автономной навигационной системой в соответствии с (4), (5), (6) с постепенным накоплением ошибок S_A. При поступлении координат Х_R, Y_R от спутниковой системы, даже после длительного периода работы в автономном режиме, как следует из (9)-(11), происходит довольно быстрое уточнение относительных координат Х, Y и координат начальной точки X₀, Y₀, скорректированные значения которых используются в (5), (6) для последующих расчетов координат объекта. При дальнейшей совместной работе автономной и спутниковой навигационных систем фактически осуществляется сглаживание в динамическом режиме измеряемых координат, тем самым делая их более точными. Отдельные заведомо ложные грубые скачки координат, поступающие от спутниковой системы, в таком режиме будут просто отброшены. Собственная же ошибка автономной навигационной системы в этом случае (за время нескольких рабочих циклов) является совсем незначительной.

Погрешности определения координат при длительной работе аппаратуры в автономном режиме (при отсутствии приема координат от спутниковой системы) в основном зависят от ошибок измерения приращений пройденного пути и угла направления движения. Информация от приемника спутниковой навигационной системы позволяет проводить непрерывную коррекцию этих параметров во время движения. Для этого на участке пути определяют приращения координат, измеренных автономной навигационной системой и приемником спутниковой навигационной системы. Длина участка, на котором проводится сравнение приращений координат, должна значительно превышать ошибку измерений координат спутниковой навигационной системой и составлять не менее 200 м. Обозначим L_A и L_R расстояния между первой и последней точками участка, полученные по результатам измерений автономной и спутниковой навигационных систем. Если разность расстояний _A и L_R по абсолютной величине не превосходит возможной ошибки (3-5% от длины участка), то проводят уточнение на n-м шаге корректирующих коэффициентов автономной системы - коэффициента пути K_S и поправки направления по формулам Здесь - угол между направлениями от первой до последней точек участка соответственно для измерений спутниковой и автономной навигационных систем. Параметры фильтрации Q_S и Q выбирают из диапазона 0,001...0,01.

В каждом рабочем цикле определяют приращение S пути и угол направления движения в соответствии с выражениями где W - показания датчика перемещения.

Таким образом, в процессе движения производится автоматическая, без участия оператора, плавная коррекция приращений пути и поправки направления, значения которых используются в выражениях (4) и (8).

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

Устройство для определения местоположения подвижных объектов представлено на фиг.3 и содержит три датчика магнитного поля 1, три датчика линейного ускорения 2 (датчики вертикали), блок преобразования и усреднения 3, блок расчета горизонтальных проекций МПЗ 4, блок управления 5, датчик перемещения 6, блок расчета угла 7, первый блок расчета приращений координат 8, первый сумматор 9, выходы датчиков магнитного поля 1 и датчиков линейного ускорения 2 соединены соответственно с первыми и вторыми входами блока преобразования и усреднения 3, выходы которого соединены с первыми входами блока расчета горизонтальных проекций МПЗ 4, выходы которого соединены с первыми входами первого блока расчета приращений координат 8 и первыми входами блока расчета угла 7, выходы которого соединены с первыми входами блока управления 5, первые и вторые выходы которого соединены соответственно со вторыми входами блока расчета горизонтальных проекций МПЗ 4 и третьими входами блока преобразования и усреднения 3, выходы первого сумматора 9 соединены со вторыми входами блока управления 5.

Устройство содержит также второй блок расчета приращений координат 10, блок коррекции 11, блок расчета корректирующих коэффициентов 12, блок умножения 13, второй сумматор 14 и приемник спутниковой навигационной системы 15, выходы которого соединены с первыми входами блока коррекции 11 и первыми входами второго блока расчета приращений координат 10, вторые входы которого соединены с выходами первого блока расчета приращений координат 8 и первыми входами второго сумматора 14, а выходы второго блока расчета приращений координат 10 соединены с первыми входами блока расчета корректирующих коэффициентов 12, первые выходы которого соединены с первыми входами блока умножения 13, вторые входы которого соединены с выходами датчика перемещения 6, а выходы блока умножения 13 соединены со вторыми входами блока коррекции 11 и со вторыми входами первого блока расчета приращений координат 8, третьи входы которого соединены со вторыми входами блока расчета угла 7 и вторыми выходами блока расчета корректирующих коэффициентов 12, вторые входы которого соединены с третьими выходами блока управления 5, четвертые выходы которого соединены с третьими входами блока коррекции 11, четвертые входы которого соединены с выходами второго сумматора 14, а первые и вторые выходы блока коррекции соединены соответственно с входами первого сумматора и вторыми входами второго сумматора.

Кроме этого, на фиг.3 показаны пульт управления 16 и блок индикации 17. Работа устройства основана на комплексной обработке информации, поступающей от автономной навигационной системы магнитного типа и приемника спутниковой навигационной системы, входящих в состав устройства.

При отсутствии приема сигналов спутниковой навигационной системы в исходной точке маршрута движения оператор с пульта управления 16 вводит в блок управления 5 исходные данные: координаты начальной точки X₀, Y₀ и значение магнитного склонения (поправки направления ) для данной местности, которые поступают соответственно на третьи входы блока коррекции 11 и вторые входы блока расчета корректирующих коэффициентов 12. В режиме измерения три ортогонально расположенных датчика магнитного поля 1 и три датчика линейного ускорения 2 непрерывно формируют на своих выходах аналоговые сигналы, пропорциональные значениям проекций Н_X, Н_Y, Н_Z магнитного поля и проекций А_X, А_Y, А_Z ускорения силы тяжести на оси приборной системы координат OXYZ (фиг. 2). Аналоговые сигналы датчиков поступают на первые и вторые входы блока преобра