Алгоритм определения ориентации наноспутника по показаниям инерциальных датчиков
Математическое постановка задачи определение ориентации наноспутника. Алгоритм точного размещения полюсов при решении задач наблюдения и идентификации. Разработка и реализация алгоритма по показаниям инерциальных датчиков с использованием пакета Matlab.
Рубрика | Коммуникации, связь, цифровые приборы и радиоэлектроника |
Вид | дипломная работа |
Язык | русский |
Дата добавления | 16.12.2016 |
Размер файла | 701,9 K |
Отправить свою хорошую работу в базу знаний просто. Используйте форму, расположенную ниже
Студенты, аспиранты, молодые ученые, использующие базу знаний в своей учебе и работе, будут вам очень благодарны.
При ориентации НС в орбитальной системе координат имеем:
(2.2.2)
- орбитальная угловая скорость движения НС.
Для возможности применения к (2.2.1) - (2.2.2) теории линейных наблюдателей, как это сделано в [5], проведем линеаризацию. Это вполне допустимо, т.к. в режиме орбитальнойстабилизации подразумевает малые значения угловПосле линеаризации система(2.2.2) примет следующий вид:
(2.2.3)
Подставляя линеаризованные кинематические соотношения (2.2.3) в динамические уравнения Эйлера (2.2.1) при сохранении величин первого порядка малости относительно производных от углов ориентации, а также учитывая выражение для гравитационногомомента [10], получим:
(2.2.4)
Канал тангажа является автономным, его можно рассматривать независимо от движения по двум другим каналам. Каналы же крена и курса взаимно связаны. Это объясняется наличием угловой скорости орбитальной системы координат в плоскостиорбиты, что приводит к появлению гироскопических перекрестных связей.
Используя системы (2.2.3) - (2.2.4), получим линеаризованную систему в матричном виде
(2.2.5)
(2.2.6)
Где
(2.2.7)
(2.2.8)
Для дальнейшего применения метода точного размещения полюсов необходимо ввести многоуровневую декомпозицию системы (1), представляемую парой матриц (A,C)(2.2.6), (2.2.8).
Согласно [9] число уровней декомпозиции линейной системы вида (1)
(2.2.9)
Для системы представленной матрицами (2.2.6), (2.2.8) размерность вектора состояния - ,вектора наблюдаемых переменных , а число уровней декомпозиции:
В соответствие с [9]
нулевой (исходный) уровень
(2.2.10)
первый уровень
(2.2.11)
здесь - аннулятор (делитель нуля) матрицы ,т.е- 2-полуобратная матрица для , т.е матрица, удовлетворяющая условиям регулярности
(2.2.12)
Тогда искомая матрица вычисляется по рекурсивным формулам
(2.2.13)
и обеспечивает точное заданное размещение полюсов. Это действительно так, поскольку все элементы множества собственных значений совпадают с собственнымзначения заданных устойчивых матриц порядкаЗдесь -псевдообратные матрицы Мура-Пенроуза.
Основная область применения разрабатываемого алгоритма - получение оценки вектора состояния в бортовой вычислительной машине. Поэтому необходимо перейти кдискретному описанию системы. С учетом (2.2.10) на основании (2.2.6), (2.2.8)., для нулевогоуровня дискретной системы с тактом запишем
(2.2.14)
(2.2.15)
Согласно многоуровневой декомпозиции, представленной выше, матрицы имеют вид:
(2.2.16)
(2.2.17)
(2.2.18)
(2.2.19)
На основании формул (2.2.13) и (2.2.14) - (2.2.19) можно найти матрицу наблюдателя . Для обеспечения максимально быстрой сходимости процесса определения угловогоположения космического аппарата с использованием решения, полученного в даннойстатье, необходимо в (2.1.13) положить нулевые значения корней, т.е
Тогда матрица наблюдателя 0 L будет иметь следующий вид
(2.1.20)
Уравнения же оценки вектора углового положения космического аппарата при отсутствии управления запишутся следующим образом
(2.1.21)
Здесь
2.3 Реализация алгоритма по показаниям инерциальных датчиков с использованием пакета Matlab
functionghy()
Ix=0.00402;
Iy=0.01454;
Iz=0.01422;
eps=0.0001;
gama=0;
omegax=0.001;
kseta=0;
h=0.00001;
omegay=-0.002;
teta=0;
omegaz=0.001;
omegax1=0.00;
omegay1=0.00;
omegaz1=0.00;
om=sqrt(omegax^2+omegay^2+omegaz^2);
mass=zeros(6,1);
mass2=zeros(6,1);
mass3=zeros(6,1);
for i=1:1:6
a21=4*(om^2)*(Iy-Iz)/Ix;
a43=(om^2)*(Ix-Iz)/Iy;
a65=3*(om^2)*(Iy-Ix)/Iz;
a42=om*(Ix+Iy-Iz)/Ix;
a24=om^2*(Ix+Iy-Iz)/Ix;
ex=omegax-omegax1;
ey=omegay-omegay1;
ez=omegaz-omegaz1;
gama1=gama+h*omegax1+(h+1/a21*h)*ex
kseta1=kseta+h*omegay1+(h+1/a21*h)*ey
teta1=teta+h*omegaz1+(h+1/a21*h)*ez
omegax=omegax1;
omegay=omegay1;
omegaz=omegaz1;
omegax1=omegax1-omegay1*(a24*h-a42*h)+gama1*h+a24*h*omegay1;
omegay1=omegay1-omegax1*(a24*h-a42*h)+kseta1*h+a24*h*omegax1;
omegaz1=omegaz1+h*teta1;
mass(i)=gama-gama1;
mass2(i)=kseta-kseta1;
mass3(i)=teta-teta1;
gama=gama1;
kseta=kseta1;
teta=teta1;
c(i)=i-1;
%if abs(gama-gama1)<eps
%break;
%end
end
subplot(1,3,1);
plot(c,mass);
subplot(1,3,2);
plot(c,mass2);
subplot(1,3,3);
plot(c,mass3);
end
2.4 Алгоритм определения ориентации НС по показаниям ДУС
Описание структурной схемы и принципов функционирования бесплатформенной системы ориентации
В работе предложения структурная схема БСО (рисунок. 1), которая включает в себе: блок гироскопов, блок акселерометров, вычислитель углов Эйлера-Крылова на основе алгоритма кватернионов.
Рис. 1 Структурная схема БСО:
ускорения по осям чувствительности акселерометров;угловые скорости по осям чувствительности гироскопов начальные углы Эйлера-Крылова углов Эйлера-Крылова;угловые скорости по тангажу и крену соответственно.
Алгоритм определения параметров ориентации
Алгоритм определения параметров ориентации базируется на использовании промежуточных параметров ориентации Родрига-Гамильтона (кватернионах). Определение начального кватерниона осуществляется по следящим зависимостям:
где рыскание, крен, тангаж соответственно, числа кватерниона.
Изменение параметров Родрига-Гамильтона определяются численным алгоритм, построенным на основе метода последовательных приближений:
где
коррекция нормы кватерниона
числа текущего кватерниона,
числа предыдущего кватерниона,
проекция угловых скоростей по осям чувствительности гороскопов.
Определение текущих углов ориентации по кватерниону осуществляется по следующим зависимостям:
3. Анализ результатов моделирование
Выполним математическое моделирование. Пусть главные моменты инерции наноспутникаимеют следующие значения:
а начальные значения вектора состояния наноспутника равны:
В качестве начального приближения значений оценки вектора углового положения, выберем начало координат:
Результаты моделирования приведены на рисунке. 1 - 3, на которых представленоизменение невязок компонент вектора углового положения (рис. 1 соответствует , рис. 2 - , рис. 3 - ) в зависимости от номера итерации. Анализ данных рисунков показывает, что вектор оценки углового положения космического аппарата с высокой точностью сходится к реальному значению углового положения за несколько итераций.
Рис. 1 Канал крена
Рис. 2 Канал рысканья
Заключение
В выпускной квалификационной работе рассмотрена возможность применения метода точного размещения полюсов для решения задач оценки углового положения наноспутник при малых углах ориентации. С помощью данного метода решена задача аналитического синтеза наблюдателя вектора углового положения космического аппарата относительно орбитальной системы координат по измерениям датчика угловой скорости. Следует также отметить, что реальный сигнал с датчика угловой скорости содержит шумы. Этот факт неминуемо влияет на точность оценки углового положения. Особого внимания исследованию влияния шумов не уделялось, так как начальной целью работы являлась разработка алгоритма для оценки принципиальной возможности решения задачи определения ориентации по показаниям ДУС.
Приведенные результаты моделирования, подтверждают работоспособность предложенного подхода.
Список использованных источников
1. Симоньянц Р.П. Обеспечение качества процессов управления в релейной системе без датчика скорости // Наука и образование. МГТУ им. Н.Э. Баумана. Электрон.журн.2014. № 10. С. 152-178. DOI: 10.7463/1014.0729606.
2. Зубов Н.Е., Микрин Е.А., Олейник А.С., Рябченко В.Н., Ефанов Д.Е. Оценка угловойскорости космического аппарата в режиме орбитальной стабилизации по результатамизмерения датчика местной вертикали // Вестник МГТУ им. Н.Э. Баумана. Сер. Приборостроение. 2014. № 5. C. 3-15.
3. Кузовков Н.Т. Модельное управление и наблюдающие устройства. Стр 67-73.
4. Зубов Н.Е., Микрин Е.А., Олейник А.С., Рябченко В.Н. Линейные наблюдающиеустройства для нелинейных динамических систем // Известия РАН. Теория и системы. Издательство ленинградского университета, 1968управления. 2014. № 5. С. 3-16. DOI: 10.7868/S0002338814050151.
5. Зубов Б.И., Ермолин В.С., Иголкин В.Н., Ковригин А.Б., Мартыненко И.А., Тихомиров Б.П. Динамика свободного твердого тела и определение его ориентации в пространстве.
6. Справочник по теории автоматического управления / под ред. А.А. Красовского. М.: Наука, 1987. 712 с.
7. Крамлих, А.В. Метод векторного согласования для определения ориентации космического аппарата по показаниям магнитометрической системы [Текст]/А.В. Крамлих //Студенческая наука аэрокосмическому комплексу: сб. трудов студентов и аспирантов факультета летательных аппаратов. Самара, 2004. Вып. 7. С. 47-50.
8. Сайт invensense [Электронный ресурс]. Режим доступа http://www.invensense.com/mems/gyro/mpu9250.html (Дата обращения: 23.05.2016).
9. Раушенбах Б.В., Токарь Е.Н. Управление ориентацией космических аппаратов. М.: Наука, 1974. 600 с.
10. Крамлих, А.В. Комплексирование измерений навигационного приемника и магнитометра для определения пространственной ориентации КА [Текст]/А.В. Крамлих//Научная сессия ГУАП: сб. докладов. Часть II. Технические науки. Санкт-Петербург, 2006. С.120-122.
11. Пельпор Д.С. Гироскопические системы ориентации и стабилизации. М.: Машиностроение, 1982. 167с.
12. Разоренов Г.Н., Бахрамов Э.А., Титов Ю.Ф. Системы управления летательными аппаратами. 20003. 584 с.
13. Анучин О.Н., Емельянцев Г.И. Интегрированные системы ориентации и навигации для морских подвижных объект/ Под обшей ред. Чл. кор. РАН Пешехонова В.Г.. СПб.,1999. 357 с.
14. Крамлих, А.В. Алгоритм определения ориентации космического аппарата при слабосвязанной схеме комплексирования радионавигационных и магнитометрических измерений [Текст]/А.В. Крамлих//Аэрокосмическое приборостроение. Москва, 2008. № 7. С. 9-13.
15. Деденко Л.Г., Керженцев В.В. Математическая обработка и оформление результатов эксперимента. М.: Изд-во МГУ, 1977.
16. Крамлих, А.В. Определение ориентации малого спутника, используя приемник радионавигационных сигналов и магнитометр [Текст]/А.В. Крамлих//Современные технологии в задачах управления, автоматики и обработки информации: труды XIII Международного научно-технического семинара. Ч. III. Алушта, Украина, 2006. С. 235.
17. Григорьев, П.Ю. Лабораторное исследование характеристик солнечного датчика на основе полупроводникового кристалла для системы определения ориентации микроспутников[Текст]/ П.Ю. Григорьев. М. 2014. 28 с.
Размещено на Allbest.ru
...Подобные документы
Методы определения пространственной ориентации вектора-базы. Разработка и исследование динамического алгоритма определения угловой ориентации вращающегося объекта на основе систем спутниковой навигации ГЛОНАСС (GPS). Моделирование алгоритма в MathCad.
дипломная работа [2,0 M], добавлен 11.03.2012Критерии эффективности и обоснование выбора базисных элементов для записи отсчетов от 16 аналоговых датчиков в область памяти. Функциональная схема компьютерной системы управления железнодорожным переездом. Алгоритм работы микропроцессорной системы.
курсовая работа [1,4 M], добавлен 14.06.2016Классификация акустических локационных систем по назначению и типу первичного преобразователя, по характеру частотного спектра сигнала, по типу модулирующего воздействия, по избирательности. Область применения датчиков локации. Алгоритм идентификации.
курсовая работа [2,2 M], добавлен 11.08.2010Разработка принципиальных схем блоков чтения информации с датчиков. Сопряжение с цифровыми и аналоговыми датчиками. Алгоритм работы блока чтения информации с цифровых датчиков. Расчет электрических параметров микропроцессорной системы управления.
дипломная работа [760,0 K], добавлен 27.06.2016Разработка алгоритма нахождения оптимальной сети наземного цифрового телевизионного вещания. Программная реализация поиска точного решения задачи полным перебором множества проектов сетей. Обзор и схема коммуникационных операций типа точка-точка.
дипломная работа [1,3 M], добавлен 22.08.2016Решение задачи компоновки для функциональной схемы с использованием последовательного алгоритма, пошаговое описание алгоритма. Размещение элементов в принципиальной электрической схеме. Трассировка цепей питания и земли с помощью волновых алгоритмов.
курсовая работа [1,1 M], добавлен 19.06.2010Разработка системы считывания данных с пяти четырехбитных датчиков. Проектирование структурной схемы микроконтроллера, схемы электрической принципиальной, блок-схемы работы программного обеспечения устройства. Разработка алгоритма основной программы.
контрольная работа [275,4 K], добавлен 08.01.2014Проектирование вычислительного модуля, состоящего из 2 датчиков давления и 4 датчиков температуры (до +125 и до +400). Составление схемы подключения датчиков. Написание демонстрационных программ для работы с устройствами DS18B20, АЦП DS2450 и MPX2010.
курсовая работа [190,3 K], добавлен 24.12.2010Преимущества использования генетических алгоритмов в решении оптимизационных задач. Расчет микрополосковой антенны с круговой поляризацией, имеющей в составе хромосомы двоичные и действительные переменные. Оптимизация антенны с прореженными подрешетками.
реферат [20,6 K], добавлен 30.03.2011Виды и использование датчиков автоматического контроля режимных параметров технологических процессов химического производства. Принцип действия измеряемых датчиков, регуляторов температуры, модульных выключателей. Средства защиты электроустановок.
дипломная работа [770,6 K], добавлен 26.04.2014Особенности применения электрохимических датчиков в составе мультисенсорных пожарных извещателей. Сравнение технических характеристик. Конструкция, принцип действия электролитических датчиков. Перспективы развития технологий изготовления извещателей.
курсовая работа [1,7 M], добавлен 09.12.2015Последовательность и методика разработки датчиков расстояния и касания. Принцип работы поверяемых датчиков и образцовых приборов (микрометра или индикатора часового типа ИЧ-25). Соотношение показаний поверяемого датчика. Обработка результатов измерений.
дипломная работа [947,7 K], добавлен 10.07.2012Основная идея адаптивной обработки сигнала. Алгоритмы адаптивной фильтрации. Детерминированная задача оптимальной фильтрации. Адаптивные фильтры в идентификации систем. Алгоритм RLS с экспоненциальным забыванием. Реализация моделей адаптивных фильтров.
курсовая работа [1,0 M], добавлен 11.03.2015Принцип действия датчиков сейсмического типа, предназначенных для проведения исследований влияния ускорений и вибрационных нагрузок на элементы радиоэлектронной аппаратуры. Разработка схем приборов, расчет статических и динамических характеристик.
курсовая работа [737,5 K], добавлен 10.01.2014Обзор современного состояния систем охранной сигнализации. Характеристика комбинированных датчиков обнаружения технических средств охраны. Помехи, влияющие на работу одноканальных датчиков обнаружения. Оценка финансовых затрат на установку и эксплуатацию.
дипломная работа [2,3 M], добавлен 05.11.2016Реализация КИХ и БИХ фильтра на процессоре TMS320C50. Блок-схема алгоритма программы, командные файлы компоновки и программного имитатора. Расчет максимально возможной частоты дискретизации. Расчет и результаты фильтра с помощью пакета Filter Design.
курсовая работа [1,3 M], добавлен 26.05.2014Понятие и общие свойства датчиков. Рассмотрение особенностей работы датчиков скорости и ускорения. Характеристика оптических, электрических, магнитных и радиационных методов измерения. Анализ реальных оптических, датчиков скорости вращения и ускорения.
курсовая работа [1,4 M], добавлен 14.01.2016Особенности выбора типа датчиков. Создание датчиков контроля параметров внешней среды (уровня воды) в системе автоматизированного прогнозирования затоплений и подтоплений. Способы измерения уровня жидкости. Устройство датчиков для измерения уровня воды.
реферат [1,8 M], добавлен 04.02.2015Разработка алгоритма управления и расчёт параметров устройств управления: моделирование процессов управления, определение и оценка показателей качества, разработка принципиальной электрической схемы и выбор датчиков управления элементами электропривода.
курсовая работа [1,5 M], добавлен 05.01.2010Алгоритм работы охранной сигнализаций. Датчик движения, звуковая сирена, реле, транзистор, резистор, конденсатор, цифровой сегментный индикатор. Изготовка домашней охранной сигнализации. Определение зон установки датчиков для обеспечения охраны объекта.
дипломная работа [1,7 M], добавлен 22.07.2013