Проект "Трикоптер"

Материал из Department of Theoretical and Applied Mechanics
Версия от 12:28, 16 октября 2011; 50.18.179.249 (обсуждение) (создание адаптивного регулятора)

Перейти к: навигация, поиск

Проект, осуществляемый Клубом технического творчества при поддержке кафедры "Теоретическая Механика".

Участники

Трикоптер v1.0

Оборудование

  • Платформа сборки: Arduino
  • Гироскопы: Melexis MLX90609 типа MEMS, 300 deg/sec
  • Радиолинк: Spektrum DSM2 FHSS-технология. Аппаратура все время меняет частоту передачи, обеспечивая надежную связь в радиусе до 1км.
  • Серво поворотного механизма: Hitec HS-81MG , с металлическим редуктором.
  • Аккумулятор: Li-Po 2.2Ah 25C 11.1V
  • Двигатели: 200Вт 1000kv бесколлекторные


Рама

Самое начало проекта, установлен только один мотор.

Cptr1.JPG

Поворотный механизм.

Cptr3.JPG

Полностью собранный коптер установлен на стенд для настройки ПИД коэффициентов.

Cptr2 1749.JPG

Cptr4.JPG


Структурная схема

3copter scheme.jpg

Программирование

Программирование осуществлялось на языке/диалекте Wiring-C++ в среде Arduino. Первым делом надо было просто заставить коптер полететь, поэтому алгоритмы обработки датчиков и управления предельно простые.

вычисление угловой скорости

В этом проекте использованы три гироскопа MLX90609 , они имеют аналоговые выходы для данных о угловой скорости и встроенный температурный датчик для устранения дрифта. Микроконтроллер получает от гироскопа значения в диапазоне 0-1024, затем с учетом чувствительности 300 градусов в секунду производит расчет угловой скорости. Кроме того вычитается байес - значение которое показывает сенсор при отсутствии вращения. Таким образом окончательная формула выглядит так:


 for( int i=0; i<3; i++)
 {
   float tmp=0;
     for(int j=0;j<10;j++)
     {
         tmp+=analogRead(pin[i]);// oversampling
     }
  tmp/=10.0;
  omega[i]=(tmp-bias[i])*gain[i]; 
}


Использование оверсэмплинга, тоесть многократного повторного чтения входа, позволяет увеличить разрешение на бит.

задание угловой скорости

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

Futaba.JPG

You have more useful info than the Brtisih had colonies pre-WWII.

трикоптер v1.1

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

Рама собрана, начинается разводка проводов.

Wiring.JPG

Почти вся электроника на своих местах

Wiring1.JPG

Коптер - первые минуты на ногах.

Copter.JPG

Облетал v1.1 - видео

DSC05675.JPG

Heck of a job there, it absotluely helps me out.