MultiWii - обсуждаем и отлаживаем Alt Hold
Когда идеи заканчивались, меня спасали более мягкие ПИД-ы + более зажатые констрэйнты конечного PID регуля, в частности на D часть…
з.ы. Ну все! Желаю удачи! A я собирать чемоданы и лететь туда где не бывает холодно и недоступный интернет, точнее очень дорогой… 😃
Не знаю, дело в том что мегу я в глаза не видел, и писать для нее код вслепую смысла нет. Trig можно на любую ногу вешать, а вот Echo - только там где есть свободное прерывание. Попробуйте разобраться в Sonar.pde как правильно настроить прерывания на мегу и на каком порту/ноге, а я включу в основной код…
Здравствуйте Алексей. Признаться так и не смог разобраться с этим вопросом.Если чесно,в этом вопросе не совсем разбираюсь,вернее совсем не разбираюсь,а точнее не знаю в каком направлении надо мыслить.
Если не трудно,можете подсказать что конкретно надо посмотреть- проанализировать в Sonar.pde?
Очень хочется попробовать сонар.
Я тоже плохо представляю в чем отличия меги от обычной 328/168, а особенно в вашем варанте её включения. Задача - найти свободное прерывание, выбрать ногу, которая ему соотвествует. Далее прописать эту ногу в константе SONAR_READ в конфиге, задействовать прерывание по сигналу на этой ноге:
#if defined(PROMINI)
PCICR |= (1<<0) ; // PCINT activated for PINS [D8-D13] on port B
PCMSK0 = SONAR_READ_MASK; // trigger interrupt on this pin only
#endif
#if defined(MEGA)
// TODO: setup interrupt on MEGA
#endif
Если прерывание отдично от INT0 - переписать заголовок обработчика:
// Install interrupt handler
ISR(PCINT0_vect) {
В общем то это все очень просто но я не могу потестить не имея меги.
Подскажите, а HC-SR04 будет работать ? В Config.h такого не нашел.
И если будет, то где посмотреть схему включения ?
Почитал ветку, сонар HC-SR04 работает. Для его включения надо раскоментировать //#define DYP_ME007 ?
Остается открытый вопрос куда его включать.
Если вы про мой код - то будет. Он и писался под такой сонар. Раскоментируйте #define SONAR и под ним будут определены ноги, куда его цеплять. Также в Sonar.pde есть пояснения насчет включения.
Но дело в том что у меня нет #define DYP_ME007… Так что, возможно, вы смотрите другую прошивку.
Я смотрел код mahowik, я думал вы совместно одну прошивку допиливаете.Сейчас скачал вашу, для CriusSE, что раскоментировать или закоментировать надо ?И если у меня ESC Plush то мне MINTHROTTLE 1300 устанавливать ?
Моя прошивка как раз для CriusSE настроена, на ней и тестирую. Вообще по основным настройкам - выставляйте все так же, как и в обычной 1.8, 1.9. Если есть вопросы - то смотрите в стандартных руководствах как что настроить. Мои настройки в конце, там надо убрать OPTFLOW и настроить SONAR (фактически только его подключить надо и все оставить по умолчанию). И установить THROTTLE_HOVER на покаатели газа в момент отрыва, или закоментировать вообще этот блок.
Если меняем THROTTLE_HOVER 1400 на другое значение, например 1450, значение SHIFT_HOVER 1400 тоже нужно менять?
//#define OPTFLOW ADNS_5050 - режим OPTFLOW полностью отключен, или нужно отрубать что то еще?
Если меняем THROTTLE_HOVER 1400 на другое значение, например 1450, значение SHIFT_HOVER 1400 тоже нужно менять? //#define OPTFLOW ADNS_5050 - режим OPTFLOW полностью отключен, или нужно отрубать что то еще?
SHIFT_HOVER можно менять, можно не менять. Я ставлю 1500 и у меня отрыв всегда на середине газа (по пульту). Если определить в конфиге #define SHIFT_HOVER = THROTTLE_HOVER то будет только экспонента без сдвига.
Закомнтировать //define OPTFLOW достаточно.
Полетал сегодня - барометр не нравится как держит. Все равно склонен к осцилляциям. Иногда и до 3 метров прыгал верх вниз. Не то, к чему стремился
привет Алексей!
На последней 2.0 прошивке теже 3 метра или уже улучшил?
привет Алексей! На последней 2.0 прошивке теже 3 метра или уже улучшил?
± метр гуляет, но медленно. Думаю, лучше уже не будет.
Я уменьшил влияние ACC, оно фактически теперь только за D отвечает. Чтобы уменьшить шум, добавил LPF на выход алгоритма (по моему раньше ты предлагал это). А также сделал зону DEADBAND, в которой P-составляющая обнуляется. За счет этого барометр меньше дергает, пока внутри этой зоны - стабилизируется только за счет очень медленного I и D, который тормозит любое быстрое перемещение.
Хочу сравнить в поле с алгоритмом из официальной 2.0 - если разницы не будет, то можно вообще на него перейти, он в вычислениях проще.
также сделал зону DEADBAND
про деадбенд я тоже писал ранее )), но не для П а для Д…
Хочу сравнить в поле с алгоритмом из официальной 2.0
официальная прошивка с bmp085 вообще не держит нифига… по крайней мере я видел жалкое подобие удержания висоты, толко после того, как коптер приводишь в состояние покоя и только потом включаешь алт холд…
Eщё была мысль поднять дискретность вычисления высоты до уровня точности-погрешности баро (t.е. до 0.5-1м) + добавить НЧ фильтр на выход для более плавных переходов между самплами. Tогда управляющее воздействие на П будет только при переходах между самплами… ну и конечно П сделать как можно более мягким, т.е. низкие значeния… хотя с DEADBAND по П вижу примерно тy же картину, т.e. воздействие только при больших колебаниях высоты…
про деадбенд я тоже писал ранее )), но не для П а для Д…
Да, я помню, но и тогда и сейчас считаю, что это не поможет - как раз D работает в зоне малых возмущений и эта часть отрабатывает неплохо и практически не шумит. А вот высота при жетской привязке к барометру (как я сделал в последней версии), шумит сильно, и для нее DEADBAND реально помогает - как только I-часть выставит точно газ, который нужен для висения, коптер застывает на нужной высоте, пока опять не выйдет за пределы DEADBANd - там P немного подрулит и опять висит ровно.
В общем, мне сейчас работа алгоритма нравится, за исключением одного большого минуса - если не откалибровать акселерометр по 6-ти точкам, то при полете (наклонах) он начинает сильно врать и тогда коптер может и на 10 метров вверх улететь. Т.е. висит вроде как обычно, но как только полетел - сразу косяк. После калибровки - летаю с любой скоростью в любых направлениях без руления газом и высота держится отлично.
Но из-за этого минуса, воспользоваться преимуществами алгоритма сложно - пока все тестеры, кто пытался - так и не смогли правильно его настроить.
А как победить его - не представляю. Разве что отрубать аксель при слишком большой ошибке и переходить на барометр со сглаживанием…
Да, я помню, но и тогда и сейчас считаю, что это не поможет - как раз D работает в зоне малых возмущений и эта часть отрабатывает неплохо и практически не шумит. А вот высота при жетской привязке к барометру (как я сделал в последней версии), шумит сильно, и для нее DEADBAND реально помогает - как только I-часть выставит точно газ, который нужен для висения, коптер застывает на нужной высоте, пока опять не выйдет за пределы DEADBANd - там P немного подрулит и опять висит ровно.
так я нe спорил что в деадбенде на П больше смысла, чем на Д… просто вспомнил ))
Но из-за этого минуса, воспользоваться преимуществами алгоритма сложно - пока все тестеры, кто пытался - так и не смогли правильно его настроить. А как победить его - не представляю. Разве что отрубать аксель при слишком большой ошибке и переходить на барометр со сглаживанием…
Пробовал вмерживать твою калибровку. По всем осям дает стабильные аcc_1g. У народа скорее всего неверная полярностъ осей была или ещё чего нить не то…
Кстати почему ты не хош использовать НЧ флоат фильтр 0.5-1.5Hz на аксель в IMU (см. мою а2 прошивку)?
профиты:
- существенная помощь для левел мода. Доп. защита от вибраций и т.д.
- гиро вектор (который также используется в твоем альт холд алгоритмe как ноль-земля вектор) не уплывает при резких ускорениях, т.к. вектор акселя по осям будет душиться этим НЧ фильтром, по коророму через КФ корректится гиро вектор. Отсюда меньше погрешность вычислений и т.д.
p.s. и именно в такой конфигурации (с НЧ флоат фильтром 0.5-1.5Hz на аксель в IMU) можно использовать длину вектора EstG вместо acc_1G
accZ = (accADC[0] * EstG.V.X + accADC[1] * EstG.V.Y + accADC[2] * EstG.V.Z) * InvG - 1/InvG;
т.е. потому и графики (“с минус acc_1G” и “c минус 1/InvG”) почти совпали тогда
Кстати почему ты не хош использовать НЧ флоат фильтр 0.5-1.5Hz на аксель в IMU (см. мою а2 прошивку)? профиты: 1. существенная помощь для левел мода. Доп. защита от вибраций и т.д. 2. гиро вектор (который также используется в твоем альт холд алгоритмe как ноль-земля вектор) не уплывает при резких ускорениях, т.к. вектор акселя по осям будет душиться этим НЧ фильтром, по коророму через КФ корректится гиро вектор. Отсюда меньше погрешность вычислений и т.д.
Не хочу категорически, по всему выходит от этого филтьра только хуже. Для начала, чем страшен шум акселя сейчас? Да ничем:
- В Level-моде аксель напрямую не влияет на моторы, только через комплементарный фильтр с фактором 500. Это уже достаточно хорошо фильтрует его шум.
- В определении высоты он дважды интегрируется, что также хорошо сглаживает его шум.
Что будет с LPF=1Hz (это достаточно сильный филтр): - гироскоп при резких маневрах начнет врать (сдвиг фазы в акселе). Для FPV не страшно а для акро плохо.
- Интегратор в определении высоты выдаст сильно искаженную скорость, с выбросами в минус.
На мой взгляд никакого смысла сильно фильтровать аксель нет.
Аксель вреден тем, что гира уплывает именно в момент набора скорости, а это далеко не резкие ускорения, эта фаза как раз 1-5 сек в полете. Её не офтилтруешь. Ещё, если аксель плохо окалиброван, гира уплывает при продолжительном равномерном движении из-за смещения точки нулей. С моей калибровкой это решается. А шум акселя - не проблема вообще, пока нет хард-клиппинга в самом сенсоре.
p.s. и именно в такой конфигурации (с НЧ флоат фильтром 0.5-1.5Hz на аксель в IMU) можно использовать длину вектора EstG вместо acc_1G Код: accZ = (accADC[0] * EstG.V.X + accADC[1] * EstG.V.Y + accADC[2] * EstG.V.Z) * InvG - 1/InvG;т.е. потому и графики (“с минус acc_1G” и “c минус 1/InvG”) почти совпали тогда
Если развернуть скобки, подставив InvG - получим тот же НЧ-фильтр на аксель. Я уже писал, что по тестам в ГУИ это работает, но результаты интегрирования хуже, чем калибровка нуля.
Хотя я сейчас думаю, что если доверять больше барометру, а аксель оставить только для D-части, то тогда можно упрощать алгоритм и такая точность, которую я хотел получить (и получал) от акселя, уже не нужна. И тогда это решение надо тоже попробовать. Опять же, сейчас многие платы стали комплектоваться барометром MSxxxx и там точность 10см - народ говорит что отлично работает алгоритм из 2.0
Опять же, сейчас многие платы стали комплектоваться барометром MSxxxx
А это какие?
А это какие?
Да уж… это точно не Криус 😦
Сообщение от alexmos Опять же, сейчас многие платы стали комплектоваться барометром MSxxxx А это какие?
Да в гуле наберите MS5611 flight board, MS5611 imu - там их десятки. А в криусе - не будет, это да, но за 40$ это было б уже альтруизмом 😃
А в криусе - не будет, это да, но за 40$ это было б уже альтруизмом
Сделали бы версию Crius MultiWii Pro, с датчиками по-лучше, и с супер-барометром, пользовалась бы спросом!
Подрубил сегодня сонар (прошивка r23). Держит хорошо +/-10…20см на высоте до 1.5.-2м. Если выше, начинает переходить на баро и тогда дергаться как параноик… Надо фиксить вибрации на акселе, т.к. в IMU аксель фильтрованный, а вычислении ускорения/скорости для “D” сырые raw данные с акселя.
Если кому интересно, вот изменения для сонара на mega1280 (совместимые с пиратом). Т.е. триггер на 9-й пин, эхо на 10-й:
config.h
#define SONAR_PING 9 // PIN that trigger measure
#define SONAR_READ 10 // PIN to read response pulse, 12 or 8
Sonar.pde
...
#if (SONAR_READ==10)
#define SONAR_READ_MASK B00010000
#endif
...
#if defined(MEGA)
// TODO: setup interrupt on MEGA
PCICR |= 1; // PCINT activated for PORTB
PCMSK0 = SONAR_READ_MASK; // sonar port B4 - d10 echo
#endif
НО работать будет только при использовании PPM SUM, т.к. сонар висит на том же прерывании (PCINT0_vect) что и в конфигурации для PROMINI. Если кто поможет перевесить на другое прерывание, ВЕЛКАМ! 😉
p.s. Не везет мне в последнее время с крашами. Раньше с 10м падал и лишь ломал пропы или лучи гнул не критично, а сегодня блинн на ровном месте, на высоте в пределах метра чет крутануло, сбросил газ и вписался в забор металлический … итог: минус 2 пропа, сломал ось, выломал ротор живьем… подшипник так и не нашел ((