аппаратура счисления координат по двум составляющим скорости

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

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

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

Изобретение относится к области навигации наземных транспортных средств (НТС).

Общей особенностью АСК на самолетах и кораблях является требование учета "сноса" транспортного средства из-за увлечения их воздушной и водной средой. Однако такая же необходимость стоит и перед АСК сухопутного транспортного средства. При этом под "сносом" сухопутного транспортного средства понимается как поперечный "снос" машины на наклонной дороге, так и разворот машины на подвеске.

Известно множество вариантов технической реализации аппаратуры счисления координат (АСК) на плавающих, летательных и НТС. Ранние АСК не учитывали бокового "сноса", более поздние учитывали "снос" и обеспечивали большую точность определения координат. Известная АСК с учетом "сноса", которая взята за прототип, описана в [1 - с. 100, 288, 2 - с. 323]. Ее структурная схема представлена на фиг.1.

АСК-прототип состоит из курсовой системы (КС1), вырабатывающей угол положения оси транспортного средства в ГСК (_КС), трехлучевого доплеровского датчика скорости (ДДС2), блока выработки приращения пути в продольном (вдоль оси НТС) направлении (Sпр) 3, блока выработки приращения пути в поперечном направлении и его знака (Sп и signSп) 4, блока выработки угла "сноса" 5, блока введения поправки в показания КС6, формирователя тригонометрических функций 7, формирователя приращения пути двух одинаковых навигационных вычислителей Х и Y 9 и 10 и блока ввода начальных координат 11, при этом выход курсовой системы 1 соединен с входом с блока ввода поправки (на "снос") 6, выход которого соединен с входом формирователя триглномнтрических функций 7, а другие входы соединены с выходом блока вычисления угла "сноса" 5 и выходом блока формирования приращения пути в поперечном направлении 4 по знаку соответственно, выходы блоков 3 и 4 соединены с входами блока 5 и с входами формирователя приращения пути а выход последнего соединен с первыми входами навигационных вычислителей 9 и 10; ДДС2 состоит из трех однолучевых ДДС (ОДДС_1-2, ОДДС_2-2, ОДДС_3-2), направления излучения которых относительно осей Х и Y системы координат, связанной с НТС, задаются следующими углами: ₁,₁- для ОДДС_1-2, (180-₁),₁- для ОДДС_2-2, ₁,(180-₁) - для ОДДС3, выходы которых соединены с соответствующими входами блока выработки Sпр 3 и с соответствующими входами блока выработки Sп и signSп 4, вторые входы НВ9 и НВ10 соединены с выходами формирователя тригонометрических функций 7 по cos_V и sin_V соответственно, выходы блока ввода начальных координат 11 соединены с дополнительными входами навигационных вычислителей 9 и 10 соответственно, а выходы навигационных вычислителей 9 и 10 являются выходами аппаратуры по координатам Х и Y.

Данная АСК реализует алгоритм определения координат движущейся точки, приведенной в конце описания

Здесь: V - модуль скорости движения;

_V = _КС+ _CH- направление (угол) вектора скорости в геодезической системе координат;

_КС- показания КС;

_CH- угол "сноса", измеряемый по показаниям ДДС;

Х_H, Y_H - координаты начальной точки маршрута движения.

При этом из сигналов трехлучевого ОДДС вырабатываются сигналы о V_ПР, V_поп, _CH, _V = _КС+ _CH. Вычисление текущих координат проводится с использованием начальных координат, V и _V.

Работает АСК - прототип следующим образом.

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







Здесь: (VR_i) - угол между вектором скорости и осью диаграммы направленности i-го однолучевого ДДС;

- длина волны излучаемого сигнала;

V_X, V_Y, V_Z - проекции вектора скорости на оси системы координат, связанной с НТС следующим образом:

ось Х - продольная ось НТС;

ось Y - направлена вправо;

ось Z - направлена вниз (правосторонняя система).

С учетом того, что тригонометрические функции периодичны, ОДДСы вырабатывают модуль частоты, и что V_X>>V_Y, V_Z, формулы можно привести к виду:







Отсюда для частот сигналов на выходе блоков 3 и 4 получим:





т. е. сигнал о V_X формируют ОДДС_1-2 и ОДДС_2-2, а о V_Y - ОДДС_1-2 и ОДДС_3-2.

Число импульсов за такт опроса равно соответственно





откуда





Знак S_П определяется по знаку разности S₁-S₃, _ПР и _П определяются при калибровке, величина угла "сноса" на выходе блока 5 равна: а значение угла направления скорости (непродольной оси машины) _V = _KC+_CH. Из _V и навигационные вычислители 9 и 10 с использованием сигналов блока ввода начальных координат 11 получают координаты:



и



Недостатком данной АСК является появление изменений счисляемых координат при изменении скорости движения.

Дело в том, что сигналы о V_пр и V_п и, соответственно, S_ПР и S_п содержат большую короткопериодную (быстрофлуктуирующую) погрешность, обусловленную явлениями биений в сигналах ДДС из-за конечной ширины их спектров. При проведении вычислений на ЭВМ обрабатываются приращения путей (S_пР и S_п) за такт обмена (Т), а это означает, что величина зависит от скорости движения, соответственно от скорости движения зависят и координаты. Диапазон этой зависимости достигает (0,1-0,2)% в зависимости от ширины диаграммы направленности антенны ДДС.

Предлагаемое изобретение направлено на устранение зависимости показаний АСК от скорости движения.

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

Для этого в АСК состоящую из курсовой системы, трех однолучевых ДДС, блоков выработки приращений пути в продольном и поперечном направлениях, формирователя тригонометрических функций, двух вычислителей и блока ввода начальных координат, при этом выход курсовой системы соединен с входом формирователя тригонометрических функций, выход которого по cos_ПР и sin_ПР соединены с первыми входами вычислителей соответственно, выход доплеровских датчиков скорости соединены с соответствующими входами блоков выработки приращений пути в продольном и поперечном направлениях (от продольного и поперечного движения) соответственно, выход первого из них соединен с вторыми входами вычислителей соответственно, на третьи входы которых подаются величины координат начальной точки маршрута из блока ввода начальных координат, а для увеличения точности счисления координат в нее введены два вычислителя приращенной координат от поперечной скорости (от движения в поперечном направлении) и два арифметических устройства, при этом первые входы введенных вычислителей соединены с выходом по пути блока выработки приращений пути в поперечном направлении (от поперечного движения), вторые входы соединены с выходами формирователя тригонометрических функций по _ПР и _{ПР =} соответственно, а выходы - с первыми входами соответствующих арифметических устройств, вторые входы которых соединены с выходами вычислителей соответственно, а третьи входы (управляющие) соединены с выходом по знаку "сноса" блока выработки приращений пути в поперечном направлении, а выходы являются выходами аппаратуры счисления координат.

Сущность изобретения поясняется чертежами, где на фиг.1 изображена блочная схема АСК-прототипа, на фиг.2 - блочная схема заявляемой АСК, а на фиг.3 приведен чертеж, поясняющий образование формулы разнесения ДДС на бампере для обеспечения "засветки" одного участка поверхности земли.

Предлагаемое изобретение (см. фиг.2), представляющее собой АСК с учетом "сноса", на показания которой не оказывают влияние изменения скорости движения НТС, содержит курсовую систему 1, три однолучевых доплеровских датчика скорости 2, 3, 4, блоки выработки приращений пути в продольном и поперечном направлениях 5, 6, формирователь тригонометрических функций 7, вычислители 8, 9 и блок ввода начальных координат 10, при этом выход курсовой системы 1 соединен с входом формирователя тригонометрических функций 7, выходы которого по _ПР и _ПР соединены с первыми входами вычислителей 8,9 соответственно, выходы однолучевых доплеровских датчиков скорости 2,3,4 соединены с соответствующими входами блоков выработки приращения пути в продольном и поперечном направлениях 5,6, выход первого из них соединен с вторыми входами вычислителей 8,9, на третьи входы которых подаются величины координат начальной точки движения из блока ввода начальных координат 10; а для увеличения точности счисления координат в нее введены два вычислителя приращений координат от поперечной скорости 11, 12 и два арифметических устройства 13, 14, при. этом первые входы введенных вычислителей приращений координат от поперечной скорости 11, 12 соединены с выходом по пути блока выработки приращения пути в поперечном направлении 6, вторые входы соединены с выходами формирователя тригонометрических функций 7 по _ПР и _ПР соответственно, а выходы - с первыми входами соответствующих арифметических устройств 13, 14, вторые входы которых соединены с выходами соответствующих вычислителей 8,9, третьи (управляющие) входы соединены с выходом по знаку "сноса" блока выработки приращения пути в поперечном направлении 6, а выходы являются выходами аппаратуры счисления координат.

Работает данная АСК следующим образом.

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

Одновременно однолучевые доплеровские датчики скорости 2,3,4 и блоки выработки приращения пути в продольном и поперечном направлениях 5,6 посылают свои сигналы на вычислители 8,9 и вычислители приращений координат от движения в поперечном направлении 11,12, на другие входы которых поступают значения cos_ПР и sin_ПР, которые выработаны формирователем тригонометрических функций 7 из сигнала курсовой системы 1. Вычислители 8,9 из этих сигналов совместно со значениями начальных координат, поступающих из блока ввода начальных координат 10, вырабатывают координаты машины, как если бы машина имела только продольную скорость по правилу:



и

Вычислители приращений координат в поперечном направлении X_CH и Y_CH11,12 вырабатывают величины приращений по правилу:





Полученные величины с выходов вычислителей 8,9 и вычислителей приращений координат от движения в поперечном направлении 11,12 поступают после i-го цикла вычислений в арифметические устройства 13,14, где по сигналу о знаке "сноса", поступающему со второго выхода блока выработки приращения пути в поперечном направлении 6, они суммируются и формируют выходные значения координат.

Алгоритм работы заявляемой АСК имеет вид, приведенный в конце описания.

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

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

Проведенные испытания АСК показали;

- АСК-прототип действительно имеет скоростную зависимость показаний;

- заявляемая АСК не имеет зависимости показаний от скорости движения и учет угла "сноса" проводится с точностью до 0,10,2 мрад на S=30 км;

- оставшаяся поперечная погрешность целиком определяется погрешностью определения начального угла движения и "уходами" гироскопических приборов при движении.

Библиографические данные:

1. Колчинский В. Е. , Мандуровский И.А., Константиновский М.И.. Доплеровские устройства и системы навигации - М.: "Советское радио", 1975.

2. Селезнев В.П. "Навигационные устройства", М., Машиностроение, 1974.