MultiWii - обсуждаем и отлаживаем Alt Hold

skyrider

Плата у меня тоже Crius SE, сонар есть, если прошивка с работающим сонаром не опасна для коптера ,меня и окружающего мира, можно выложить готовый скетч для Crius SE 😃, и если можно , Алексей, скрин работающих пидов.
Если на выходные не будет дождя попробую подлетнуть.

gensek

Не компилируется, в папке лежат и MultiWii.ino и MultiWii.pde

[IMG][/IMG]

alexmos

На первом скриншоте непонятная ошибка, а на втором - прошу прощения, есть такая. Выложил по той же ссылке исправленную версию. Компилировал в IDE 0023

soliada

Аналогичная ситуация.Та же ошибка при компиляции.

alexmos:

Выложил по той же ссылке исправленную версию.

Спасибо,теперь компилируется.

У меня вопрос по GPS,какие настройки для модуля нужны МультиВи?
Если я правильно понимаю,то они отличны от настроек для Мегапирата?

skyrider

Подлетнул, видимо нужно настраивать (правда не знаю что), явно видно что пытается держать высоту, но в итоге рывками либо уходит в низ либо в верх, правда не понял сонар это или барометр т.к. включаются вместе с одного тумблера. Заметил в GUI такую штуку, если смотрим debug1 без активации баро и сонара - высоту показывает идеально, стоит щелкнуть тумблер (активация баро и сонара) - начинает шуметь. Квадрик весит примерно 1.5 кг, моторы 750кв, винты 12х4.7, пиды ALT ставил как на скрине выше, аксель по шести точкам не калибровал, куда копать?

alexmos

Сонар отключается в режиме Passthru - проверьте не включается ли у вас этот режим по тумблеру. Аксель желательно окалибровать по 6 точкам, делов 30 сек (это для парвильной работы барометра). По идее сонар не должен выключаться в режиме удержания высоты. Он отключается, если начнет терять сигнал, также при углах наклона больше 60.

soliada:

У меня вопрос по GPS,какие настройки для модуля нужны МультиВи?

по ЖПС - это не ко мне, никогда с им дела не имел.

gensek
alexmos:

На первом скриншоте непонятная ошибка, а на втором - прошу прощения, есть такая. Выложил по той же ссылке исправленную версию. Компилировал в IDE 0023

Спасибо, залил, в гуи все крутится правильно, по блютусу изменений нет с версией r15? помнится там не мог подцепится, а сейчас на r18 проверить нет возможности.

skyrider
alexmos:

Сонар отключается в режиме Passthru - проверьте не включается ли у вас этот режим по тумблеру.

шорт побьери, т.е. если я активирую Passthru сонар отключается? я думал он в таком режиме включается…
У меня на одном тумблере включение BARO и включение Passthru, получается в GUI на чекбоксах просто нужно оставить активацию BARO а Passthru не трогать вообще, при этом сонар по умолчанию будет постоянно активным?

После калибровки по этой методике ROLL почемуто стоит ровно под 45 градусов, что то делаю не так…

skyrider

Заработал сонар, почти отлично, на видео ручку газа не трогал вообще, видно как несколько раз “чихает” по высоте, а так все отлично! Браво Алексей!

Получается до этого я летал с отключенным сонаром, и рывки по высоте до этого были по барометру, как и сейчас если подняться метров на 5 и включить удержание, видимо для правильной работы калибровка по шести точкам обязательна, у меня почему то по ROLL становится криво. Алексей, последовательность калибровки не имеет значения (естественно кроме позиции №1)

soliada

Возник вопрос такого характера. А на какие пины подключать сонар на Ардуине с 2560АТмегой?

alexmos
skyrider:

После калибровки по этой методике ROLL почемуто стоит ровно под 45 градусов, что то делаю не так…

По GUI у вас по двум осям 255… а должно быть только по одной. Какая у вас схема расположения моторв? на рисунке для QUADX - т.е. оси датчика должны смотреть ровно под 90 градусов по горизонту. Сорри если по схеме это не очень понятно 😃 Порядок не имеет значения, да и точность расположения не надо выерять до 1 градуса- удерживать в руках вполне достаточно.

soliada:

Возник вопрос такого характера. А на какие пины подключать сонар на Ардуине с 2560АТмегой?

Не знаю, дело в том что мегу я в глаза не видел, и писать для нее код вслепую смысла нет. Trig можно на любую ногу вешать, а вот Echo - только там где есть свободное прерывание. Попробуйте разобраться в Sonar.pde как правильно настроить прерывания на мегу и на каком порту/ноге, а я включу в основной код…

skyrider:

видно как несколько раз “чихает” по высоте, а так все отлично

Это плохой симптом - на такой высоте как на видео сонар должен работать идеально. У меня при висении до 2-х метров никаких намеков нет на провалы. Если быстро носиться туда сюда с наклонами 45 град. - тогда да, начинает слегка подергивать по высоте.
Очень важно свободное пространство в угле 120 градусов от датчиков сонара, а также не должно быть наводок (типа проводов от ESC и моторов вблизи платы, серв на той же линии питания и т.д.), т.к. сонар имеет очень чувствителен к питанию, там же микрофонные усилители по сути.

skyrider
alexmos:

По GUI у вас по двум осям 255

Теперь только по Z 255

alexmos:

Какая у вас схема расположения моторв? на рисунке для QUADX - т.е. оси датчика должны смотреть ровно под 90 градусов по горизонту. Сорри если по схеме это не очень понятно Порядок не имеет значения

Схема расположения моторов QUAD X, пробовал менять последовательность, добился правильной калибровки в такой последовательности по Вашей схеме : 1 , 2 , 5 , 4 , 3 , 6. Не знаю почему , но в моем случае именно эта последовательность сработала, перепроверял три раза.
Если завтра позволит погода, проверю работу барометра, пропадут рывки по высоте после правильной калибровки акселя или нет.

alexmos:

чень важно свободное пространство в угле 120 градусов от датчиков сонара

С этим все в порядке.

alexmos:

а также не должно быть наводок (типа проводов от ESC и моторов вблизи платы, серв на той же линии питания и т.д.)

Попробую поменять на провода в изоляции.

alexmos:

на такой высоте как на видео сонар должен работать идеально

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

alexmos
skyrider:

Схема расположения моторов QUAD X, пробовал менять последовательность, добился правильной калибровки в такой последовательности по Вашей схеме : 1 , 2 , 5 , 4 , 3 , 6. Не знаю почему , но в моем случае именно эта последовательность сработала, перепроверял три раза.
Если завтра позволит погода, проверю работу барометра, пропадут рывки по высоте после правильной калибровки акселя или нет.

Хм, похоже баг где то в алгоритме. Последовательность не должна играть никакой роли, кроме того что Z всегда в начале. Подумаю…

skyrider:

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

Нет, по видео очень похоже на кратковременные лаги сонара. От веса конечно зависит, но просто будет чуть медленне стабилизация - а тут из стабилного состояния рывки в нестабильное. Попробуйте запустить моторы на рабочую мощность с подключением в ГУИ и гляньте что показывает сонар. Высота не должна прыгать.

Вообще с сонаром надо быть осторожнее, т.к. если он начнет выдавать неправильные данные (например от наводок решит что высота всегда равна 1 метру) - коптер может как свалиться, так и в небеса улететь. Я сделал ограничитель по барометру для крайних случаев, но не проверял его работу. Так что при испытаниях надо руку всегда держать на ручке отключения режима Alt Hold 😃

skyrider

Изменил пару параметров в config.h
#define MINTHROTTLE 1130
#define INTERNAL_I2C_PULLUPS
#define DEADBAND 20
#define MAXTHROTTLE 1900
#define THROTTLE_HOVER 1440
#define SHIFT_HOVER 1450
#define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;}
Откалибровал по шести точкам и подлетнул на метровой высоте - дергается при включении Alt Hold по высоте как припадошный каждые 2-3 секунды, что то из того что я сделал ему явно не понравилось, нужно цеплять блютус и смотреть что кажет в полете.

alexmos:

Попробуйте запустить моторы на рабочую мощность с подключением в ГУИ и гляньте что показывает сонар. Высота не должна прыгать.

Скачет примерно + - 0.1-0.3

HikeR

народы, подскажите, плиз, по работе сонара.
если заявлена дальность 5 метров, то что выдает сонар на бОльшей высоте?
какой примерный “угол охвата”?
какая средняя по больнице частота опроса?

alexmos
HikeR:

народы, подскажите, плиз, по работе сонара.
если заявлена дальность 5 метров, то что выдает сонар на бОльшей высоте?
какой примерный “угол охвата”?
какая средняя по больнице частота опроса?

Правильный ответ - зависит от сонара. Как у него определено в датащите для таких случаев, то и должен выдавать.
Но к примеру тот, что я использую - ему плевать на датащит и он выдает при потере сигнала 1 метр (все 4 штуки что я тестил - по разному). Но при этом время измерения подскакивает до 250мс, и вот так можно распознать ошибку.

Частота измерений зависит от расстояния… При нулевом - близко к нулю, +50мс на паузу между измерениями.

Угол охвата также зависит от сонара, на практике градусов 60. В датащите приводится диаграмма направленности.

5 метров это для идеальных условий. Реально в условиях зашумленного питания, ненулевого угла наклона будет меньше. Я ставлю с 2 до 3 метров плавный переход на барометр. При наклонах лимит опускается (я заложил примерную диаграмму направленности в алгоритм).

mahowik
alexmos:

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

Попробовал. По графикам пока очень нравится. Выводил одновременно 2 графика: ускорение “с минус acc_1G” и “c минус 1/InvG”. В ГУИ они практически совпадают.
Профит:

  1. скорость не шумит
  2. высота соот-но шумит меньше, а если повысить коэф. компл. фильтра до 200-300, то вообще меедленно плавает +/-0.2…0.4 м
  3. простота настройки, т.к. нет зависимых параметров типа ПИДы в интеграторе и коэф. компл. фильтра

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

alexmos

Ок, жду тогда твоих тестов и сравнения. У меня задача на ближайшее время - мигрировать на 2.0 и исправить ситуацию с нестабильным временем цикла.

mahowik

На 2.0 перевести не долго, я уже с ним и тестировал… а цикл будешь паузами выравнивать, чтобы сводить время итерации к константе?

alexmos

Нет, в 2.0 вроде сделали некоторое подобие таймслотов для распределения медленных вычислений, вот их заюзаю.

Полетал сегодня - барометр не нравится как держит. Все равно склонен к осцилляциям. Иногда и до 3 метров прыгал верх вниз. Не то, к чему стремился 😦