Создание собственной системы стабилизации
чюйка акселя ой как нужна…
Могу заметить что при изменении чуйки акселя от 2G до 16G инерциалка работает практически одинаково (код от Madgwick на кватернионах), меняется в этом случае как раз только степень влияния линейной составляющей ускорения на углы и скорость стабилизации горизонта…
Таким образом, подобрав коэфициент усиления для IMU (в коде он представлен как “float Kp=…”) добиваемся нужного компромиса между влиянием линейных ускорений и скоростью реакции системы… ВСЁ !
Как результат, это “паразитное” влияние практически не сказывается в реальном полете (ну если только не делать виражи с ОГРОМНЫМИ перегрузками на протяжении длительного времени).
Что 400 грамм, что 400 кг
Акселю то все равно, а вот тяжелая и легкая модели при одинаковом радиусе разворота требуют разных скоростей и как следствие разных центростремительных ускорений… Я не прав ???
Правы конечно, но здесь масса не причем. Только линейная скорость и радиус.
Вообще эти магвики и дэцээмы…Палка, смотрящая вниз и определяет кажущийся горизонт в зависимости от к веса, не более того. А вот когда вы вращаетесь относительно “стен комнаты”, которая неподвижна в мире, вот тут никакие центростремительные ускорения не собьют ваше положение.
Углы понятно посчитаются, а скорости, ускорения, пройденный путь?
Тут вот попробовал получить чисто из акселя скорость и путь (для высотомера) и понял, что это практически невозможно…
Даже применив математические извраты типа как у известных прошивок, результат не особо порадовал. В результате экспериментов остановился на данных только барометра, дополнительно усредненных (шум получился на уровне 10 см.!!)
В результате моё крылышко вполне приемлемо держит высоту (может сервы чуть чуть “вешаются” конечно 😃).
Так что сделал вывод: толку от акселерометра, как источника данных для расчета скорости и уж тем более пройденного пути, НИКАКАЯ. Единственное что с него можно взять полезного -
это в чистом виде “D” компонента ПИДа для коптера для “альт холда”…
НИКАКАЯ
сразу вспоминается эксперимент: мужику надели браслет на ногу (на ступню), в браслете стандартный набор 9-DOF и проц, мужика отправили бегать по кварталу. когда прибежал обратно, то когда по полученным данным восстановили траекторию, то начальная и конечная точки не сошлись меньше чем на 100 метров.
в масштабах квартала и с учетом перемещения браслета (на ноге!) точность очень даже КАКАЯ. ссылку пошукаю, давненько это было.
а чуть выше rcopen.com/forum/f134/topic224458/4898 кино не вставляет? 😃
не, в том кино был негр спортивного сложения )
то начальная и конечная точки не сошлись меньше чем на 100 метров
Там, похоже, просто шаги считаются ? , неужели пройденное расстояние можно узнать “сложив” вычисленные кусочки, пройденные одной ногой ? не верю… (если только с лошадиной ошибкой, а мы тут сантиметры пытаемся учесть…)
проинтегрировав ускорение можно получить что угодно, хоть шаги, хоть расстояние. правда, только относительно начальной точки измерений.
проинтегрировав ускорение можно получить что угодно
Вот в этом интегрировании как раз и вся загвоздка… Скорость начинает “сходить с ума” при возникновении шумов (собственных,температурных, механических и пр.) и нет никакой информации с датчика ускорения чтоб обнулить или остановить рост интеграла, поэтому метод с аксель+ПИД+AB+баро фактически рассчитывает не расстояние, а коэфициент воздействия на систему…
у нас маленькие ракеты сбивали маленькие самолеты на больших дистанциях во времена, когда к микросхемам прилагался ящик для переноски. на компьютерах, которые слабее и медленнее нынешних калькуляторов, летали на Венеру.
так что перестаньте жаловаться на “шумы” и идите работать (с) ;)
ракеты сбивали маленькие самолеты
Согласен, но и датчики положения были сделаны мягко говоря по другой технологии и мягко говоря из других материалов…
Тут же вопрос конкретный… есть пожелания ? советы ? (кроме идти… и работать…)
конечно есть — использовать для измерения физ. величин специально созданные для этого датчики: глонасы, датчики воздушной скорости, ультразвуковые/лазерные дальномеры.
вот по поводу жалобы, “нет никакой информации с датчика ускорения чтоб обнулить или остановить рост интеграла”. я нигде не видел, чтобы показания акселя имели некий весовой коэф. “доверия”, все берут его показания независимо от текущих пере-/недогрузок и “исправляют” результат с гиры. почему никто не “доверяет” акселю в моменты, когда измеренное им ускорение ~= G и не “слушает его совсем” когда там наизмеряли 4-8-16G?
я нигде не видел, чтобы показания акселя имели некий весовой коэф.
Кусочек рабочего кода двумя страницами выше:
// By using CF it’s possible to correct the drift of integrated accZ (velocity) without loosing the phase, i.e without delay
vel = vel * 0.985f + baroVel * 0.015f;
Обращаю внимание на то “vel” - скорость взятая именно с акселя (интеграл), а “baroVel” - скорость высчитанная из показаний барометра. Таким образом “капризный” интеграл от ускорения имеет основной вес и сглаживается непосредственно барометром…
Метод работает, НО у MS5611 достигнут собственный дрейф в 10-15 см. и от акселя толку уже практически никакого, вся эта математическая каша не может дать более точного результата с меньшим шумом…
Эту мысль я и озвучил, проделав эксперименты, а вовсе не “жаловался” на тяжелую жизнь 😃…
вот о чем и речь. барометром “поправляем” ось Y модели взятую с акселя, которая была расчитана с гироскопа и “поправлена” акселем же. а то что аксель при любом измерении не равном G неправильно “поправляет” гироскоп забыли?
у MS5611 достигнут собственный дрейф в 10-15 см
почему вы считаете что это дрейф, а не атмосфера вокруг? ветер дунул, температура изменилась, влажность повысилась — вот и изменение давления на ровном месте.
Эту мысль я и озвучил, проделав эксперименты, а вовсе не “жаловался” на тяжелую жизнь
0.994 0.06 😃 надо с коэфф баловаться, желательно постоянно в зависимости от прогноза(не гидрометцентра)… барометр нужен для коррекции если шум акселя в один бок… спрогнозировать датчик можно где-то с вероятностью разброса 68% если показания вышли за вероятность, то тупо уменьшать вес датчика - в конечном счёте если датчик нагло врёт - исключать из расчётов…
при любом измерении не равном G неправильно “поправляет” гироскоп забыли?
Чуток не так, коллега…,: за ускорение по оси Z принимается разница из “сырых” данных Z акселя и вектора G рассчитанного IMU, таким образом имеем “чистое” вертикальное ускорение при любом наклоне аппарата…
А уж потом интегрируем его и получаем скорость… а потом и расстояние (второй интеграл)…
почему вы считаете что это дрейф,
Точнее сказать - “шум”, , во первых паспорт на 5611, во вторых очевидная вещь при наблюдении графика в динамике (пользуюсь Pithon_ом), какие могут быть сомнения ?
надо с коэфф баловаться,
Так вот у меня получилось (?) что баловаться нет смысла, т.к. получить на выходе меньший “шум” чем просто с барометра не выходит… (есть предположение что алгоритм был разработан для “дубовых” барометров)…
эх блин… приведу еще пример - маховий прошивка, там как раз основное по расчету высоты - аксель, лично у меня не раз было что держал одну высоту по 10-15 мин, причем не в висении, а в полете
маховий прошивка, там как раз основное по расчету высоты - аксель
Нельзя ли на этот кусочек кода взглянуть ?? (для анализа)
за ускорение по оси Z принимается разница из “сырых” данных Z акселя и вектора G рассчитанного IMU
а IMU-то откуда данные берет? интегрирует гиру и исправляет ее дрейф показаниями акселя, которому можно доверять только когда он находится в покое.
в OP когда-то мелькала эта фишка: гира интегрируется как обычно, но чем больше цифра с акселя отличается от 1G (в любую сторону), тем меньше он участвует в коррекции гиры. образно говоря, введен динамический “коэффициент доверия” примерно так:
len = accel.lenght()
// 0 <= k <= 1
if (len > G)
k = G / len
else
k = len / G
result.x = gyro_integrated.x*(1-k) + accel.x*k
// и так далее
Точнее сказать - “шум”
шум так шум.
смотрю в даташит на MS5611, 24 бита, диапазон 10…1200 мбар, считаю разрешение — 0.000071 мбар.
они пишут сначала 0.0024, затем через строчку 0.012, как так?
Нельзя ли на этот кусочек кода взглянуть ?? (для анализа)
// apply CF with dynamic coefficient to keep the calculated altitude near real baro/sonar altitude
uint16_t altDiff = abs(alt - EstAlt);
dynK = 0.015f + ( ((altDiff > 100) && (EstAlt > 0)) ? (min(altDiff - 100, 500)/10000.0f) : 0.0f );
alt = alt * (1.0f - dynK) + sensorAlt * dynK;
это финишный кусок
они пишут сначала 0.0024, затем через строчку 0.012, как так?
Эт надо еще и в высоту пересчитывать, а там логарифмы и прочее…(лень) , короче, точность MS5611 меньше метра, это общепризнанный экспериментально доказанный факт, в отличие например от BMP85… (тут погрубее)
а IMU-то откуда данные берет?
В нашем случае это не важно, главное что на выходе мы имеем “приличный” вектор G (“гира рулит”), который и нужно вычесть из оси Z акселя… Да, так и получается, сначала Z-acs участвует в коррекции гиры в IMU, а потом из нее же и вычитается полученное G…
baro/sonar
Смущает сие… (мы о баро/аксель ведем речь)