УСТРОЙСТВО ДЛЯ ВЫЧИСЛЕНИЯ МАТРИЦЫ НАПРАВЛЯЮЩИХ КОСИНУСОВ Российский патент 1995 года по МПК G06F7/548 

Описание патента на изобретение RU2037192C1

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

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

Наиболее близким по технической сущности к изобретению является устройство для вычисления матрицы направляющих косинусов через параметры Родрига-Гамильтона, содержащее блок сопряжения, блок регистровой памяти, блок устройства управления, четыре блока вычисления переменных параметров Родрига-Гамильтона соответственно, три блока вычисления диагональных косинусов соответственно и шесть блоков вычисления недиагональных косинусов соответственно [2]
Недостатком данного устройства является сложность технической реализуемости алгоритма вычисления матрицы направляющих косинусов путем интегрирования системы кинематических дифференциальных уравнений в параметрах Родрига-Гамильтона и отсутствие технической возможности определения начальных значений компонентов кватерниона.

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

Поставленная цель достигается тем, что в устройство для вычисления матрицы направляющих косинусов, содержащее блок регистровой памяти, введены первый и второй блоки формирования параметра Леви-Чивита, блок формирования промежуточной матрицы, первый и второй блоки формирования матрицы направляющих косинусов, три блоки формирования знака, шесть умножителей, три вычитателя, первый и второй блоки элементов И, сумматор, триггер и элемент НЕ, а блок регистровой памяти выполнен в виде набора регистров для хранения кодов, из них три регистра хранения кодов номеров осей исходной системы координат, шесть регистров хранения кодов синусов и косинусов углов поворота и регистр хранения кода числа "6", причем первые три выхода блока регистровой памяти соединены соответственно с входами первого, второго и третьего блоков формирования знака и с первыми входами первого, второго и третьего умножителей, вторые входы которых соединены соответственно с выходами первого, второго и третьего блоков формирования знака и с первыми входами четвертого, пятого и шестого умножителей, вторые входы четвертого и пятого умножителей соединены с выходом первого блока формирования параметра Леви-Чивита, второй вход шестого умножителя соединен с выходом второго блока формирования параметра Леви-Чивита, выходы с четвертого по восьмой блока регистровой памяти соединены соответственно с входами строк блока формирования промежуточной матрицы, входы столбцов которого соединены соответственно с выходами четвертого, пятого и шестого умножителей, девятый выход блока регистровой памяти соединен с входами столбцов первого и второго блоков формирования матрицы направляющих косинусов, десятый выход блока регистровой памяти соединен с входом уменьшаемого первого вычитателя, выход которого соединен с входами уменьшаемого второго и третьего вычитателей, входы вычитаемого первого, второго и третьего вычитателей соединены соответственно с выходами второго, первого и третьего умножителей, выходы первого и второго умножителей соединены соответственно с первым и вторым входами первого блока формирования параметра Леви-Чивита, третий вход которого соединен с выходом второго вычитателя, выходы второго и третьего умножителей соединены соответственно с первым и вторым входами второго блока формирования параметра Леви-Чивита, третий вход которого соединен с выходом третьего вычитателя, выходы четвертого и пятого умножителей соединены с первым и вторым входами сумматора, выход которого соединен с управляющими входом первого блока элементов И и с входом элемента НЕ, выход которого соединен с управляющим входом второго блока элементов И, выходы блока формирования промежуточной матрицы соединены с информационными входами первого и второго блоков элементов И, выходы которых соединены соответственно с входами строк первого и второго блоков формирования матрицы направляющих косинусов, выходы которых являются выходами устройства.

На фиг. 1 изображена функциональная схема предлагаемого устройства; на фиг.2 и 3 функциональные схемы блоков формирования параметра Леви-Чивита; на фиг.4 функциональная схема блока формирования промежуточной матрицы; на фиг. 5 и 6 функциональные схемы блоков формирования матрицы направляющих косинусов.

Устройство для вычисления матрицы направляющих косинусов содержит блок 1 регистровой памяти, первый, второй и третий блоки 2-4 формирования знака, первый, второй и третий умножители 5-7, первый блок 8 формирования параметра Леви-Чивита, четвертый и пятый умножители 9 и 10, первый, второй, третий вычитатели 11-13, второй блок 14 формирования параметра Леви-Чивита, шестой умножитель 15, сумматор 16, триггер 17, элемент НЕ 18, блок 19 формирования промежуточной матрицы, первый, второй блоки элементов И 20 и 21, первый блок 22 формирования матрицы направляющих косинусов, второй блок 23 формирования матрицы направляющих косинусов, соединенные между собой функционально.

Первый блок 8 формирования параметра Леви-Чивита содержит вычитатели 24, 25 и 28, умножитель 26 и делитель 27 на два, соединенные между собой функционально.

Второй блок 14 формирования параметра Леви-Чивита содержит вычитатели 29, 30 и 33, умножитель 31 и делитель 32 на два, соединенные между собой функционально.

Блок 19 формирования промежуточной матрицы содержит умножитель 34, элемент НЕ 35, умножители 36-40, элемент НЕ 41 и умножитель 42, соединенные между собой функционально.

Первый блок 22 формирования матрицы направляющих косинусов содержит умножитель 43, элемент НЕ 44, умножитель 45, элемент НЕ 46, умножители 47 и 48, сумматор 49, умножители 50 и 51, сумматор 52, умножитель 53, сумматор 54, умножители 55 и 56, сумматор 57 и умножитель 58, соединенные между собой функционально.

Второй блок 23 формирования матрицы направляющих косинусов содержит элемент НЕ 59, умножители 60-62, сумматор 63, умножители 64 и 65, сумматор 66, умножители 67 и 68, сумматор 69, умножители 70-72 и сумматор 73, соединенные между собой функционально.

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

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

Устройство реализует следующую последовательность действий.

1. Задается условная формула матрицы
ФМ P1P2P3∈{ ± 1, ± 2, ± 3} где P1, P2 и P3 последовательность номеров осей исходной системы координат со своими знаками, соответствующие задаваемой последовательности введения элементарных углов поворота относительно указанных осей и правилу их отсчета.

2. Последовательно рассчитываются индексы
i P1SignP1
j P2SignP2
k P3SignP3
l 6 i j
m 6 j k
ijl= (i-j)(j-l)(l-i)/2
jkm= (j-k)(k-m)(m-j)/2
q1= ∈ijlSignP1
q2= ∈ijlSignP2
q3= ∈ikmSignP3 где Sign операция выделения знака.

3. Определяются элементы вспомогательной матрицы:
Uij C2 Uij UjlUli Uil C1Uli
Uji q3S3 Ujj C1 Ujl= q1S1
Uli q2S2 Ulj C2Ujl Ull C1C2 C1, S1, C2, S2, C3, S3 задаваемые на входе соответственно синус и косинус n-го элементарного угла поворота, при этом n 1,2,3 порядковый номер поворота.

4. Определяются элементы матрицы направляющих косинусов перехода от исходной системы координат к заданной системе координат
Vmi C3Uii Vmj UijC3 + UijUjj Vml UijUjl + C3Uil
Vji UjiUii Vjj UjjC3 UijUji Vjl UjlC3 UilUji
Vki Uli Vki Ulj Vkl Ull
если q1 + q2 ≠ 0
Vmi C3Uli Vmj UjjUji + C3Ulj Vml UjlUji + C3Ull
Vji -UjiUli Vjj -UjiUli+ C3Ujj Vjl -UjiUll + C3Ujl
Vki Uii Vki Uij Vkl Uil
если q1 + q2 0
Устройство формирования матрицы направляющих косинусов работает следующим образом.

В момент его включения по сигналу внешнего запуска выдается импульс на блок 1, представляющий собой набор регистров для хранения кодов, с 1-3 выходов которого на входы блоков 2,3,4 и 5,6,7 выдаются соответственно коды P1, P2 и P3 со своими знаками (номера осей исходной системы координат, относительно которых осуществляются последовательно элементарные углы поворота; с 4-5 и 7-9 выходов блока 1 на входы 4-8 блока 19 выдаются соответственно коды С1 cos ϕ1, C2 cos ϕ2, S1sin ϕ1, S2 sin ϕ2, S3 sin ϕ3 синусы и косинусы элементарных углов поворота; с выхода 6 блока 1 на входы блоков 22 и 23 поступает код C3 cos ϕ3 а с выхода 10 блока 1 на вход блока 11 код "6"). На выходах блоков 2,3,4 сформированные коды SignP1, SignP2, SignP3, где Sign P1= , Sign P2= , Sign P3= поступают на входы блоков 5,6,7 соответственно, с выходов которых соответственно на вход блока 8 формирования параметра Леви-Чивита и блока 12 поступает код i P1SignP1, на вторые входы блоков 11 и 8, а также на первый вход второго блока 14 формирования параметра Леви-Чивита поступает код j P2SignP2; на второй вход блока 14 и блока 13 код k P3SignP3. Код 6 j на выходе блока 11 в блоке 12 преобразуется к виду l 6 i j и поступает на 3-й вход блока 8, одновременно с этим код 6 j в блоке 13, преобразуясь к виду m 6 j k, поступает на третий вход блока 14. Блоки 8 и 14 формируют на выходах соответственно коды символов Леви-Чивита
ijl= (i-j)(j-l)(l-i)/2 , ∈jkm= (j-k)(k-m)(m-j)/2, которые с помощью блоков 9, 10 и 15, на вторые входы которых поступают, соответственно, коды SignP1, SignP2, SignP3 преобразуются к виду q1ijlSignP1, q2ijlSignP2, q3jkmSignP3
Преобразованные коды q1, q2 и q3 поступают на вход блока 19 формирования промежуточной матрицы, которые вместе с кодами синусов и косинусов элементарных углов поворота С1, С2, S1, S2, S3 используются для формирования на выходе блока 19 кодов элементов промежуточной матрицы Uii, Uji, Uli, Ujj, Ujl, Ull, Uij, Uil, Ulj.

Одновременно коды q1 и q2 поступают на вход первого блока 16 суммирования. С выхода блока 16 на вход установки в единицу триггера 17 поступает сигнал, если q1 + +q2 ≠ 0. В зависимости от значения кода управляющего сигнала триггер 17 с помощью блоков элементов И 20 и 21, на входы которых с выходов блока 19 подаются коды элементов промежуточной матрицы Uii, Uji, Uli, Ujj, Ujl, Ull, Uij, Uil, Ulj, выдает управляющее воздействие на функционирование первого блока 22 формирования матрицы направляющих косинусов, если сигнал на выходе триггера 17 равен "1" или запуск второго блока 23 формирования матрицы направляющих косинусов, если сигнал на выходе триггера равен "0". На выходах блоков 22 и 23 формируются элементы матрицы преобразования координат Vmi, Vji, Vmj, Vki, Vjj, Vkj, Vml, Vjl, Vkl в соответствии с выше приведенным алгоритмом.

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

Похожие патенты RU2037192C1

название год авторы номер документа
Устройство для формирования изображения при коническом сканировании 1989
  • Гавенко Виктор Васильевич
SU1734233A1
Датчик случайных кодов 1981
  • Бугрим Елена Ивановна
SU997036A1
Устройство для преобразования координат 1989
  • Жалило Алексей Александрович
  • Борисенко Сергей Анатольевич
  • Рудич Александр Васильевич
  • Свечкарева Людмила Михайловна
SU1681313A1
Устройство для вычисления функции арктангенса 1985
  • Протченко Николай Николаевич
SU1273920A1
УСТРОЙСТВО ДЛЯ ФОРМИРОВАНИЯ ТЕЛЕВИЗИОННОГО ИЗОБРАЖЕНИЯ С ИЗМЕНЕНИЕМ МАСШТАБА УПРАВЛЯЕМОГО ФРАГМЕНТА 1993
  • Жирков Владислав Федорович
  • Арнос Башир Али
RU2065206C1
УСТРОЙСТВО ДЛЯ ВЫДЕЛЕНИЯ ТОНАЛЬНЫХ СИГНАЛОВ В КАНАЛАХ СВЯЗИ 2001
  • Егоров А.И.
  • Каленков Б.О.
  • Щевьев В.Н.
RU2214051C2
УСТРОЙСТВО ОДНОКРАТНОГО ФОРМИРОВАНИЯ СИГНАЛА ИЗОБРАЖЕНИЯ 1998
  • Смелков В.М.
  • Михайлов В.Н.
  • Маклашевский В.Я.
RU2146080C1
Устройство для вычисления функции Z= @ х @ +у @ 1981
  • Протченко Николай Николаевич
SU962925A1
Устройство для формирования изображения 1987
  • Решетников Александр Анатольевич
  • Терешко Сергей Михайлович
  • Трацевский Александр Викторович
SU1474633A1
Устройство для операций над матрицами 1985
  • Вышков Сергей Дмитриевич
  • Петров Игорь Евгеньевич
  • Денисов Вячеслав Григорьевич
  • Сабаев Лев Васильевич
  • Шептулин Сергей Александрович
SU1292008A1

Реферат патента 1995 года УСТРОЙСТВО ДЛЯ ВЫЧИСЛЕНИЯ МАТРИЦЫ НАПРАВЛЯЮЩИХ КОСИНУСОВ

Изобретение относится к вычислительной технике и может быть использовано при моделировании динамики и управления полетами летательных аппаратов. Цель изобретения - расширение области применения устройства за счет возможности перехода от одной декартовой системы координат к другой во всем диапазоне входных величин. Устройство для вычисления матрицы направляющих косинусов содержит блок регистровой памяти, три блока формирования знака, шесть умножителей, два блока формирования параметра Леви-Чивита, три вычитателя, сумматор, триггер, элемент НЕ, блок формирования промежуточной матрицы, два блока элементов И и два блока формирования матрицы направляющих косинусов, соединенные между собой функционально. 4 з. п. ф-лы, 6 ил.

Формула изобретения RU 2 037 192 C1

1. УСТРОЙСТВО ДЛЯ ВЫЧИСЛЕНИЯ МАТРИЦЫ НАПРАВЛЯЮЩИХ КОСИНУСОВ, содержащее блок регистровой памяти, отличающееся тем, что, с целью расширения области применения путем обеспечения перехода от одной декартовой системы координат к другой во всем диапазоне входных величин, в него введены первый и второй блоки формирования параметра Леви Чивита, блок формирования промежуточной матрицы, первый и второй блоки формирования матрицы направляющих косинусов, первый, второй и третий блоки формирования знака, первый, второй и третий вычитатели, первый шестой умножители, первый и второй блоки элементов И, сумматор, триггер и элемент НЕ, а блок регистровой памяти выполнен в виде набора регистров для хранения кодов, из них три регистра хранения кодов номеров осей исходной системы координат, шесть регистров хранения кодов синусов и кусинусов углов поворота и регистр хранения кода числа "6", причем первый, второй и третий выходы блока регистровой памяти соединены соответственно с входами первого, второго и третьего блоков формирования знака и с первыми входами первого, второго и третьего умножителей, вторые входы которых соединены соответственно с выходами первого, второго и третьего блоков формирования знака и с первыми входами четвертого, пятого и шестого умножителей, вторые входы четвертого и пятого умножителей соединены с выходом первого блока формирования параметра Леви Чивита, второй вход шестого умножителя с выходом второго блока формирования параметра Леви Чивита, четвертый - восьмой выходы блока регистровой памяти соединены соответственно с входами строк блока формирования промежуточной матрицы, входы столбцов которого соединены соответственно с выходами четвертого, пятого и шестого умножителей, девятый выход блока регистровой памяти соединен с входами столбцов первого и второго блоков формирования матрицы направляющих косинусов, десятый выход соединен с входом уменьшаемого первого вычитателя, выход которого соединен с входами уменьшаемого второго и третьего вычитателей, входы вычитаемого первого, второго и третьего вычитателей соединены соответственно с выходами второго, первого и третьего умножителей, выходы первого и второго умножителей соединены соответственно с первым и вторым входами первого блока формирования параметра Леви Чивита, третий вход которого соединен с выходом второго вычитателя, выход второго и третьего умножителей соединены соответственно с первым и вторым входами второго блока формирования параметра Леви Чивита, третий вход которого соединен с выходом третьего вычитателя, выходы четвертого и пятого умножителей соединены с первым и вторым входами сумматора, выход которого соединен с входом триггера, выход которого соединен с управляющим входом первого блока элементов И и с входом элемента НЕ, выход которого соединен с управляющим входом второго блока элементов И, выходы блока формирования промежуточной матрицы соединены с информационными входами первого и второго блоков элементов И, выходы первого блока элементов И соединены с входами строк первого блока формирования матрицы направляющих косинусов, выходы второго блока элементов И с входами строк второго блока формирования матрицы направляющих косинусов, выходы первого и второго блоков формирования матрицы направляющих косинусов являются выходом устройства. 2. Устройство по п.1, отличающееся тем, что блок формирования параметра Леви Чивита содержит первый, второй и третий вычитатели, умножитель и делитель на два, причем первый вход блока соединен с входом уменьшаемого первого вычитателя и входом вычитаемого третьего вычитателя, второй вход блока с входами вычитаемого первого и второго вычитателей, третий вход с входами уменьшаемого второго и третьего вычитателей, выходы первого, второго и третьего вычитателей соединены соответственно с вторым, первым и третьим входами умножителя, выход которого соединен с входом делителя на два, выход которого является выходом блока. 3. Устройство по п.1, отличающееся тем, что блок формирования промежуточной матрицы содержит первый седьмой умножители и первый и второй элементы НЕ, причем вход первой строки блока формирования промежуточной матрицы соединен с входом первого элемента НЕ и с первым входом первого умножителя, второй вход которого соединен с входом второй строки блока формирования промежуточной матрицы, с входом второго элемента НЕ и является первым выходом блока, входы третьей строки и первого столбца которого соединены с входами шестого умножителя, входы четвертой строки и второго столбца с входами четвертого умножителя, входы пятой строки и третьего столбца с входами третьего умножителя, выход которого является вторым выходом блока, третий выход которого соединен с выходом четвертого умножителя и первым входом пятого умножителя, выход которого является четвертым выходом блока, пятый вход которого соединен с его же первым входом, выход шестого умножителя соединен с вторыми входами пятого и седьмого умножителей, первый вход последнего соединен с выходом второго элемента НЕ, а выход является шестым выходом блока, седьмой выход которого соединен с выходом второго умножителя, первый вход которого соединен с выходом первого элемента НЕ, а второй вход с выходом четвертого умножителя, выход шестого умножителя является восьмым выходом блока, девятый выход которого соединен с выходом первого умножителя. 4. Устройство по п. 1, отличающееся тем, что первый блок формирования матрицы направляющих косинусов содержит первый десятый умножители, первый - четвертый сумматоры и первый и второй элементы НЕ, причем входы первой строки и столбца блока соединены с входами первого умножителя, выход которого является первым выходом блока, второй выход которого соединен с выходом второго умножителя, первый вход которого соединен с вторым входом первого умножителя, а второй вход второго умножителя соединен с первым входом десятого умножителя и выходом первого элемента НЕ, вход которого соединен с входом второго элемента НЕ, первый входом третьего умножителя и является входом второй строки блока, вход третьей строки которого является третьим выходом блока, четвертый выход которого соединен с выходом первого сумматора, первый вход которого соединен с выходом четвертого умножителя, второй вход которого соединен с вторым входом пятого умножителя и является входом четвертой строки блока, вход пятой строки которого соединен с вторыми входами шестого и третьего умножителей, выход последнего соединен с вторым входом первого сумматора, вход столбца блока соединен с первыми входами четвертого и шестого умножителей, выход последнего соединен с вторым входом второго сумматора, выход которого является пятым выходом блока, шестой выход которого соединен с входом шестой строки блока, вход седьмой строки которого соединен с вторыми входами десятого и восьмого умножителей, выход последнего соединен с вторым входом третьего сумматора, выход которого является седьмым выходом блока, восьмой выход которого соединен с выходом четвертого сумматора, второй вход которого соединен с выходом десятого умножителя, а первый вход с выходом девятого умножителя, первый вход которого соединен с вторым входом седьмого умножителя и является входом восьмой строки блока, вход столбца которого соединен с первым входом восьмого и вторым входом девятого умножителей, вход первого элемента НЕ соединен с первым входом седьмого умножителя, выход которого соединен с первым входом третьего сумматора, выход второго элемента НЕ соединен с первым входом пятого умножителя, выход которого соединен с первым входом второго сумматора, вход девятой строки блока является его же девятым выходом. 5. Устройство по п.1, отличающееся тем, что второй блок формирования матрицы направляющих косинусов содержит первый десятый умножители, первый - четвертый сумматоры и элемент НЕ, причем вход первой строки блока является его же третьим выходом, вход второй строки соединен с входом элемента НЕ, выход которого соединен с первым входом первого умножителя, выход которого является вторым выходом блока, первый выход которого соединен с выходом второго умножителя, первый вход которого соединен с входом столбца блока, вход третьей строки которого соединен с вторыми входами первого и второго умножителей, вход четвертой строки блока является его же шестым выходом, вход пятой строки соединен с первым входом шестого умножителя и вторым входом третьего умножителя, выход которого соединен с первым входом первого сумматора, выход которого является четвертым выходом блока, пятый выход которого соединен с выходом второго сумматора, первый вход которого соединен с выходом пятого умножителя, первый вход которого соединен с вторым входом четвертого умножителя и является входом шестой строки блока, вход седьмой строки которого является его же девятым выходом, вход восьмой строки соединен с первыми входами девятого и седьмого умножителей, выход последнего соединен с первым входом третьего сумматора, выход которого является седьмым выходом блока, восьмой выход которого соединен с выходом четвертого сумматора, первый вход которого соединен с выходом десятого умножителя, первый вход которого соединен с вторым входом восьмого умножителя и является входом девятой строки блока, вход столбца которого соединен с первым входом четвертого умножителя, вторым входом шестого умножителя, первым входом восьмого умножителя и вторым входом девятого умножителя, выход которого соединен с вторым входом четвертого сумматора, первый вход третьего умножителя соединен с вторым входом седьмого умножителя и с входом элемента НЕ, выход которого соединен с вторыми входами пятого и десятого умножителей, выход четвертого умножителя с вторым входом первого сумматора, выход шестого умножителя с вторым входом второго сумматора, а выход восьмого умножителя с вторым входом третьего сумматора.

Документы, цитированные в отчете о поиске Патент 1995 года RU2037192C1

Аппарат для очищения воды при помощи химических реактивов 1917
  • Гордон И.Д.
SU2A1
Устройство для вычисления матрицы направляющих косинусов 1983
  • Башков Евгений Александрович
  • Кувычко Игорь Юрьевич
SU1233142A1
Приспособление для точного наложения листов бумаги при снятии оттисков 1922
  • Асафов Н.И.
SU6A1

RU 2 037 192 C1

Авторы

Абросимов В.К.

Забиров М.Г.

Кузенков В.М.

Липатов В.М.

Даты

1995-06-09Публикация

1991-06-03Подача