RU2747672C1 - Устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы - Google Patents
Устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы Download PDFInfo
- Publication number
- RU2747672C1 RU2747672C1 RU2020112329A RU2020112329A RU2747672C1 RU 2747672 C1 RU2747672 C1 RU 2747672C1 RU 2020112329 A RU2020112329 A RU 2020112329A RU 2020112329 A RU2020112329 A RU 2020112329A RU 2747672 C1 RU2747672 C1 RU 2747672C1
- Authority
- RU
- Russia
- Prior art keywords
- output
- multiplier
- input
- adder
- group
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06G—ANALOGUE COMPUTERS
- G06G7/00—Devices in which the computing operation is performed by varying electric or magnetic quantities
- G06G7/12—Arrangements for performing computing operations, e.g. operational amplifiers
- G06G7/22—Arrangements for performing computing operations, e.g. operational amplifiers for evaluating trigonometric functions; for conversion of co-ordinates; for computations involving vector quantities
Landscapes
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Software Systems (AREA)
- Computer Hardware Design (AREA)
- Complex Calculations (AREA)
Abstract
Заявленное изобретение относится к вычислительной технике и может быть использовано в беспилотных летательных аппаратах, радиолокационных, навигационных и других вычислительных комплексах. Заявленное устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы содержит три идентичных блока вычисления половинного аргумента и блок расчета параметров, причем выходы блоков вычисления половинного аргумента соединены со входами блока расчета параметров, при этом введены три идентичных блока вычисления половинного аргумента, каждый из которых содержит два фазовых дискриминатора, три логических переключателя, три инвертора, три группы сумматоров, два умножителя на постоянную величину, умножитель и два идентичных блока разложения, каждый из которых содержит логический переключатель, две группы умножителей на постоянную величину, четыре сумматора, четыре умножителя, два инвертора. Технический результат - повышение точности определения пространственной ориентации подвижных объектов. 2 ил.
Description
Область техники, к которой относится изобретение
Заявленное изобретение относится к вычислительной технике и может быть использовано в беспилотных летательных. аппаратах, радиолокационных, навигационных и других вычислительных комплексах. Уровень техники
а) Описание аналогов
Известно устройство «Бесплатформенная инерциальная навигационная система» патент РФ №2309385 МПК G01C 21/16. В известном устройстве для определения ориентации объекта применяется матрица перехода от нормальной земной к связанной с объектом системе координат. Недостатком данного устройства является использование матрицы направляющих косинусов через углы Эйлера, что требует выполнения тригонометрических операций и сопутствующие данному способу неопределенности - вырождение матрицы при определенных углах поворота объекта, тем самым уменьшается точность определения пространственной ориентации подвижных объектов.
б) Описание ближайшего аналога (прототипа)
Наиболее близким по своей технической сущности к заявленному является «Устройство для преобразования прямоугольных координат в полярные», патент РФ №10011 МПК G06G 7/22, содержащее пять переключателей, инвертор, блоки выделения модуля, компаратор, генератор тактовых импульсов, блок деления, блок умножения, синусно-косинусный преобразователь, цифроаналоговый преобразователь, реверсивный счетчик, сглаживающий фильтр, входы координат Y, X, выход модуля и выход аргумента.
Недостатками прототипа являются: низкое быстродействие, не достаточная устойчивость и точность преобразования измеряемых синусно-косинусными датчиками значений синусов и косинусов углов, неоднозначность определения пространственной ориентации объекта во всем диапазоне изменения углов. Низкая устойчивость связана с неконтролируемым нелинейным взаимодействием большого количества сигналов различной частоты и амплитуды в системе. Малое быстродействие объясняется наличием большого числа составляющих в сигнале, поступающем на блоки вычисления половинных аргументов.
Цель изобретения - повышение точности определения пространственной ориентации подвижных объектов.
Поставленная цель достигается за счет преобразования измеряемых синусно-косинусными датчиками значений синусов и косинусов углов Эйлера-Крылова в линейные кинематические параметры - кватернионы и устранения, таким образом, неоднозначности определения пространственной ориентации объекта во всем диапазоне изменения углов, а также последующего использования в навигационных алгоритмах кватернионов.
Раскрытие изобретения (его сущность)
а) технический результат, на достижение которого направлено изобретение
Предлагаемое устройство направлено на устранение недостатков известного устройства - прототипа путем вычислений половинного аргумента при помощи разложения в ряд Тейлора с точностью до третьего члена ряда с целью уменьшения погрешностей преобразования и достижения требуемой точности.
б) совокупность существенных признаков
Подробное описание изобретения
Устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы содержит три идентичных блока вычисления половинного аргумента и блок расчета параметров, причем выходы блоков вычисления половинного аргумента соединены со входами блока расчета параметров. Введены три идентичных блока вычисления половинного аргумента, каждый из которых содержит два фазовых дискриминатора, три логических переключателя, три инвертора, три группы сумматоров, два умножителя на постоянную величину, умножитель и два идентичных блока разложения, каждый из которых содержит логический переключатель, две группы умножителей на постоянную величину, четыре сумматора, четыре умножителя, два инвертора. Входы фазовых дискриминаторов являются информационными входами устройства. Выход первого фазового дискриминатора является информационным входом первого логического переключателя, первый выход которого соединен с первым входом первого сумматора первой группы сумматоров, а через инвертор - со вторым входом второго сумматора первой группы сумматоров, второй выход первого логического переключателя соединен с управляющим входом второго логического переключателя; информационные входы второго и третьего логических переключателей, второй вход первого сумматора и первый вход второго сумматора первой группы сумматоров, а также вторые входы блока разложения подключены к входному сигналу положительной логической единицы. Выход второго фазового дискриминатора соединен с управляющими входами первого и третьего логических переключателей, выходы сумматоров первой группы сумматоров через умножители на постоянную величину соединены с первыми входами блока разложения. Первый выход второго логического переключателя и через инвертор его второй выход соединены со вторыми входами сумматоров третьей группы сумматоров, первый выход третьего логического переключателя и через инвертор его второй выход соединены со входами сумматора второй группы сумматоров, выход которого соединен со вторым входом умножителя. Входы первого умножителя на постоянную величину первой группы умножителей и первого умножителя на постоянную величину второй группы умножителей блока разложения подключены к входному сигналу положительной логической единицы. Выход первого умножителя на постоянную величину второй группы умножителей блока разложения соединен с первым входом его третьего сумматора и с первыми входами первого, второго и третьего умножителей блока разложения, выход первого умножителя на постоянную величину первой группы умножителей блока разложения через инвертор соединен с первым входом второго сумматора блока разложения, первый выход логического переключателя блока разложения соединен с первым входом его первого сумматора и третьим входом четвертого сумматора, второй выход логического переключателя соединен со входом второго умножителя на постоянную величину первой группы умножителей, выход которого соединен со вторым входом первого сумматора блока разложения и через третий умножитель на постоянную величину второй группы умножителей - со вторым входом четвертого сумматора, третий выход логического переключателя блока разложения соединен через второй умножитель на постоянную величину второй группы умножителей с третьим входом его первого сумматора и через третий умножитель на постоянную величину первой группы умножителей - с первым входом четвертого сумматора блока разложения. Выход первого сумматора блока разложения соединен со вторым входом его второго сумматора, выход которого соединен со вторым входом первого умножителя блока разложения, со вторым и третьим входом его второго умножителя, со вторым, третьим и четвертым входами его третьего умножителя. Выход первого умножителя блока разложения соединен со вторым входом третьего сумматора; выход второго умножителя блока разложения через инвертор и четвертый умножитель на постоянную величину первой группы умножителей соединен с третьим входом третьего сумматора; выход третьего умножителя блока разложения через пятый умножитель на постоянную величину первой группы умножителей соединен с четвертым входом третьего сумматора блока разложения, выход которого соединен с первым входом четвертого умножителя; выход четвертого сумматора блока разложения соединен со вторым входом четвертого умножителя, выход которого является выходом блока разложения.
Выход первого блока разложения соединен с первым входом первого сумматора третьей группы сумматоров блока вычисления половинного аргумента, а выход второго блока - соединен с первым входом умножителя, выход которого соединен с первым входом второго сумматора третьей группы сумматоров.
Выходы сумматоров третьей группы сумматоров блока вычисления половинного аргумента подключены к входам умножителей соответствующих блоков блока расчета параметров, где выходы первого и второго умножителя группы умножителей соединены со входами первого сумматора, выходы третьего и четвертого умножителей через инверторы соединены со входами второго сумматора блока расчета параметров. Выход пятого умножителя и через инвертор выход шестого умножителя соединены со входами третьего сумматора. Выход седьмого умножителя и через инвертор выход восьмого умножителя соединены со входами четвертого сумматора блока расчета параметров. Выходы сумматоров блока расчета параметров являются выходами устройства.
Сопоставительный анализ заявляемого решения с прототипом показывает, что предлагаемый способ отличается от известного.
Краткое описание чертежей
Заявленное изобретение поясняется чертежами, на которых показаны:
фиг. 1 - блок-схема устройства преобразования сигналов датчиков углов в кватернионы;
фиг. 2 - блок-схема блока разложения.
Блок-схема предлагаемого устройства преобразования сигналов датчиков углов в кватернионы содержит три идентичных блока вычисления половинного аргумента 11, 12, 13 и блок расчета параметров 2. Каждый из блоков вычисления половинного аргумента содержит фазовые дискриминаторы 3, группу логических переключателей 4, группу умножителей на постоянную величину 6, группы сумматоров 5, 10, 11, группу инверторов 7, два идентичных блока разложения 8 и умножитель 9. Блок-схема блока разложения 8 содержит логический переключатель 12, две группы умножителей на постоянную величину 13, 14, группу умножителей 15, группу инверторов 16, группу сумматоров 17. Блок расчета параметров 2 содержит группу умножителей 18, группу инверторов 19 и группу сумматоров 20.
Осуществление изобретения
Реализация действия заявленного устройства объясняется следующим образом. Каждая из трех пар сигналов, соответствующих углам Эйлера-Крылова α1, α2, α3, поступает на информационные входы 21, 22 блоков вычисления половинных аргументов 11, 12, 13, где по измеренным значениям рассчитываются синусы и косинусы половинных аргументов:
где А=α1, α2, α3.
На входы 211, 212, 213 подаются синусоидальные напряжения, фазы которых пропорциональны косинусу каждого из трех текущих углов Эйлера-Крылова. На входы 221, 222, 223 подаются сигналы, фазы которых пропорциональны синусу каждого из трех текущих углов Эйлера-Крылова.
В фазовых дискриминаторах 3 входные сигналы преобразуются в сигналы постоянного напряжения с амплитудами, пропорциональными, соответственно, синусу или косинусу каждого углов α1, α2, α3. Выходной сигнал с фазовых дискриминаторов 3 с максимальной амплитудой напряжения принят за логическую единицу: ±Umax = ±"1". С фазовых дискриминаторов 3 сигналы подаются на входы логических переключателей 4. На вход 23 устройства подается постоянный сигнал с амплитудой, соответствующей уровню +"1".
Логические переключатели обеспечивают выбор полярности выходных сигналов блоков вычисления половинных аргументов 11, 12, 13. Исходное положение переключателей, показанное на фиг. 1, соответствует отсутствию сигналов на их управляющих входах. Логический переключатель 4b находясь в положении "2", формирует управляющий сигнал на логический переключатель 42. Для логических переключателей 41 и 43 управляющим сигналом является выходной сигнал фазового дискриминатора 32. Переключатель 41 переключается в положение "1" при сигнале на управляющем входе, неравном "0", а переключатель 43 - при отрицательном управляющем сигнале. Логический переключатель 42 переключается в положение "1", если на его управляющем входе сигнал равен "1", а в положение "2" - при сигнале, равном
Коэффициенты умножения в блоках умножения на постоянную величину 61, 62 выбираются равными "1/2". Таким образом, на входы 241 и 242 блоков разложения 8 поступают сигналы, пропорциональные значениям
Вычисление корня осуществляется разложением в ряд Тейлора с точностью до третьего члена ряда. Так как пределы изменения сигналов равны [-1, 1], то, с целью уменьшения погрешностей преобразования, используется разложение в окрестности уровня сигнала, равного "1/2". Это достигается за счет усиления или ослабления сигналов V1, V2 и таким образом,
где i=1, 2;
Выбор коэффициента k осуществляется логическим переключателем 12. Коэффициенты умножения в блоках умножения на постоянную величину 13 и 14 выбираются равными:
Таким образом, на входы блока расчета параметров 2 поступают сигналы, пропорциональные ±sin (αl/2), ±cos (α2/2), …, ±cos (α3/2).
В блоке 2 реализуется следующий алгоритм вычисления кватернионов 
Таким образом, как видно из вышеизложенного, предлагаемое устройство обеспечивает надежное преобразование углов Эйлера-Крылова в линейные параметры - кватернионы во всем диапазоне изменения углов.
в) причинно-следственная связь между признаками и техническим результатом
Благодаря новой совокупности существенных признаков в заявленном изобретении при использовании в разложении трех членов ряда, методическая погрешность вычисления корня не превышает 5⋅10-3.
Проведенный анализ уровня техники позволил установить, что аналоги, характеризующиеся совокупностью признаков, тождественных всем признакам заявленного технического решения, отсутствуют, что указывает на соответствие заявленного изобретения условию патентоспособности «новизна».
Результаты поиска известных решений в данной и смежных областях техники с целью выявления признаков, совпадающих с отличительными от прототипа признаками заявленного объекта, показали, что они не следуют явным образом из уровня техники. Из уровня техники также не выявлена известность отличительных существенных признаков, обусловливающих тот же технический результат, который достигнут в заявляемом способе. Следовательно, заявленное изобретение соответствует условию патентоспособности «изобретательский уровень».
Claims (1)
- Устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы, содержащее три идентичных блока вычисления половинного аргумента и блок расчета параметров, причем выходы блоков вычисления половинного аргумента соединены со входами блока расчета параметров, отличающееся тем, что введены три идентичных блока вычисления половинного аргумента, каждый из которых содержит два фазовых дискриминатора, три логических переключателя, три инвертора, три группы сумматоров, два умножителя на постоянную величину, умножитель и два идентичных блока разложения, каждый из которых содержит логический переключатель, две группы умножителей на постоянную величину, четыре сумматора, четыре умножителя, два инвертора; входы фазовых дискриминаторов являются информационными входами устройства, выход первого фазового дискриминатора является информационным входом первого логического переключателя, первый выход которого соединен с первым входом первого сумматора первой группы сумматоров, а через инвертор - со вторым входом второго сумматора первой группы сумматоров, второй выход первого логического переключателя соединен с управляющим входом второго логического переключателя, информационные входы второго и третьего логических переключателей, второй вход первого сумматора и первый вход второго сумматора первой группы сумматоров, а также вторые входы блока разложения подключены к входному сигналу положительной логической единицы, выход второго фазового дискриминатора соединен с управляющими входами первого и третьего логических переключателей, выходы сумматоров первой группы сумматоров через умножители на постоянную величину соединены с первыми входами блока разложения, первый выход второго логического переключателя и через инвертор его второй выход соединены со вторыми входами сумматоров третьей группы сумматоров, первый выход третьего логического переключателя и через инвертор его второй выход соединены со входами сумматора второй группы сумматоров, выход которого соединен со вторым входом умножителя; входы первого умножителя на постоянную величину первой группы умножителей и первого умножителя на постоянную величину второй группы умножителей блока разложения подключены к входному сигналу положительной логической единицы, выход первого умножителя на постоянную величину второй группы умножителей блока разложения соединен с первым входом его третьего сумматора и с первыми входами первого, второго и третьего умножителей блока разложения, выход первого умножителя на постоянную величину первой группы умножителей блока разложения через инвертор соединен с первым входом второго сумматора блока разложения, первый выход логического переключателя блока разложения соединен с первым входом его первого сумматора и третьим входом четвертого сумматора, второй выход логического переключателя соединен со входом второго умножителя на постоянную величину первой группы умножителей, выход которого соединен со вторым входом первого сумматора блока разложения и через третий умножитель на постоянную величину второй группы умножителей - со вторым входом четвертого сумматора, третий выход логического переключателя блока разложения через второй умножитель на постоянную величину второй группы умножителей соединен с третьим входом его первого сумматора и через третий умножитель на постоянную величину второй группы умножителей - с первым входом четвертого сумматора блока разложения, выход первого сумматора блока разложения соединен со вторым входом его второго сумматора, выход которого соединен со вторым входом первого умножителя блока разложения, со вторым и третьим входом его второго умножителя, со вторым, третьим и четвертым входами его третьего умножителя, выход первого умножителя блока разложения соединен со вторым входом третьего сумматора, выход второго умножителя блока разложения через инвертор и четвертый умножитель на постоянную величину первой группы умножителей соединен с третьим входом третьего сумматора, выход третьего умножителя блока разложения через пятый умножитель на постоянную величину первой группы умножителей соединен с четвертым входом третьего сумматора блока разложения, выход которого соединен с первым входом четвертого умножителя, выход четвертого сумматора блока разложения соединен со вторым входом четвертого умножителя, выход которого является выходом блока разложения, выход первого блока разложения соединен с первым входом первого сумматора третьей группы сумматоров блока вычисления половинного аргумента, а выход второго блока соединен с первым входом умножителя, выход которого соединен с первым входом второго сумматора третьей группы сумматоров; выходы сумматоров третьей группы сумматоров блока вычисления половинного аргумента подключены к входам умножителей соответствующих блоков блока расчета параметров, где выходы первого и второго умножителя группы умножителей соединены со входами первого сумматора, выходы третьего и четвертого умножителей через инверторы соединены со входами второго сумматора блока расчета параметров, выход пятого умножителя и через инвертор выход шестого умножителя соединены со входами третьего сумматора, выход седьмого умножителя и через инвертор выход восьмого умножителя соединены со входами четвертого сумматора блока расчета параметров, выходы сумматоров блока расчета параметров являются выходами устройства.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| RU2020112329A RU2747672C1 (ru) | 2020-03-24 | 2020-03-24 | Устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| RU2020112329A RU2747672C1 (ru) | 2020-03-24 | 2020-03-24 | Устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| RU2747672C1 true RU2747672C1 (ru) | 2021-05-12 |
Family
ID=75919851
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| RU2020112329A RU2747672C1 (ru) | 2020-03-24 | 2020-03-24 | Устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы |
Country Status (1)
| Country | Link |
|---|---|
| RU (1) | RU2747672C1 (ru) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4914598A (en) * | 1986-10-07 | 1990-04-03 | Bodenseewek Geratetechnik Gmbh | Integrated redundant reference system for the flight control and for generating heading and attitude informations |
| RU2085995C1 (ru) * | 1992-11-12 | 1997-07-27 | Борис Георгиевич Келехсаев | Устройство для преобразования прямоугольных координат в полярные |
| RU2241959C1 (ru) * | 2003-05-20 | 2004-12-10 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А.Пилюгина" | Способ определения навигационных параметров управляемых подвижных объектов и устройство для его осуществления |
| RU2309385C2 (ru) * | 2005-11-15 | 2007-10-27 | Открытое акционерное общество Арзамасское научно-производственное предприятие "ТЕМП-АВИА" (ОАО АНПП "ТЕМП-АВИА") | Бесплатформенная инерциальная навигационная система |
-
2020
- 2020-03-24 RU RU2020112329A patent/RU2747672C1/ru active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4914598A (en) * | 1986-10-07 | 1990-04-03 | Bodenseewek Geratetechnik Gmbh | Integrated redundant reference system for the flight control and for generating heading and attitude informations |
| RU2085995C1 (ru) * | 1992-11-12 | 1997-07-27 | Борис Георгиевич Келехсаев | Устройство для преобразования прямоугольных координат в полярные |
| RU2241959C1 (ru) * | 2003-05-20 | 2004-12-10 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А.Пилюгина" | Способ определения навигационных параметров управляемых подвижных объектов и устройство для его осуществления |
| RU2309385C2 (ru) * | 2005-11-15 | 2007-10-27 | Открытое акционерное общество Арзамасское научно-производственное предприятие "ТЕМП-АВИА" (ОАО АНПП "ТЕМП-АВИА") | Бесплатформенная инерциальная навигационная система |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPH0627653B2 (ja) | 位置、速度検出方法及び装置 | |
| RU2747672C1 (ru) | Устройство преобразования сигналов датчиков углов беспилотного летательного аппарата в кватернионы | |
| Vachhani et al. | Efficient FPGA realization of CORDIC with application to robotic exploration | |
| RU2622866C1 (ru) | Формирователь сигнала треугольной формы | |
| Hajdu et al. | Complementary filter based sensor fusion on FPGA platforms | |
| CN110022097B (zh) | 一种旋转变压器角位置解算装置及方法 | |
| RU2326349C2 (ru) | Инерциальная система | |
| CN113074712B (zh) | 一种光纤陀螺环路增益优化方法 | |
| RU2602342C2 (ru) | Устройство определения углов пространственной ориентации летательного аппарата | |
| CN102044053B (zh) | 基于fpga的逆透视变换方法 | |
| RU2016117404A (ru) | Способ контроля пилотажно-навигационного комплекса и устройство для его осуществления | |
| CN114111797B (zh) | 基于fpga的卡尔曼滤波器、ip核及导航用芯片 | |
| RU2251712C1 (ru) | Способ определения координат объекта и оптико-электронное устройство для его осуществления | |
| Sheela et al. | New star identification technique for attitude control | |
| KR101865325B1 (ko) | 2축 김발용 bldc 모터의 회전자 위치 검출 방법 | |
| Yepez et al. | An FPGA-based closed-loop approach of angular displacement for a resolver-to-digital-converter | |
| RU2523186C1 (ru) | Устройство для формирования программных сигналов управления пространственным движением динамических объектов | |
| RU2625609C1 (ru) | Синусно-косинусный цифровой преобразователь | |
| US11722343B1 (en) | Resolver integral demodulation using zero crossing points | |
| RU2559722C1 (ru) | Преобразователь период-напряжение | |
| US8742960B2 (en) | Three-frequency phase digitizing system and method of three-phase digitizing an interferometer signal using the same | |
| RU2549115C1 (ru) | Способ формирования функциональных-интегральных-дифференцированных квадратурных опорных сигналов | |
| RU2298803C2 (ru) | Пассивная пеленгационная система | |
| SU1083184A1 (ru) | Устройство дл вычислени координат | |
| Han et al. | Resolver-to-digital converter based on tangent algorithm |