Да уж, картинка удручающая.
А если полосовой фильтр попробовать? Частоту можно с мотора(ов) снять, к примеру.
И совсем уж дурная мысль: а может этот сигнал тоже проинтегрировать? Он периодический, симметричный (относительно). Вдруг прокатит?
Я имел в виду интегрирование «пачек» усреднённых значений в течении промежутка времени. Не последовательное складывание величин приходящих сдатчика после каждого замера, а, скажем, по 4 значения и потом уже усреднять результат этих малых порций. Для этого и понадобится увеличение частоты опроса.
Я опробовал этот способ, но результат не порадовал. Может и стало чуть лучше, но глазом не видно.
Цель — лишь убрать постоянную состовляющую ошибки, а не корректировать на каждом такте. Это похоже на интегральную составляющую в ПИ регуляторе.
Интеграл (ФНЧ) как раз постоянную составляющую и выделяет. Убрать постоянную составляющую можно дифференцируя (ФВЧ), только зачем? Вопорс у меня в том, как убрать непериодическую помеху случайной амплитуды?
Один умник посоветовал корелляционный фильтр, но с чем кореллировать не сказал. В принципе, это универсальный способ, только как его применить в моём случае?
Вот теплится мысль, выложу её пока не угасла: можно попробовать способ дифференциального съёма показаний с двух симметрично и разнонаправлено расположеных датчиков. К примеру: один сверху платы, другой снизу. Нигде пока не виде подобного, но почему нет?
По поводу числовых данных. Мне кажется, достаточно стабильности +/- 1 градус за десяток секунд.
Ха-ха, это шутка?
Оценку нулевого сигнала можно производить и во время работы системы.
Это плавающее ил динамическое усреднение. Я тоже думал об этом, но тогда должна быть достаточно высокая скорость опроса датчиков — никак не 100Гц, а раз в 10-20 больше.
Опробовал увеличенную выборку усреднения сначала на 128, потом на 256 замеров. Разница с выборкой в 64 замера малозаметна. Увеличил частоту опроса до 200Гц — стало чуть лучше, но всё равно угол набегает очень шустро. Причём тенденция сохранилась — пока в покое всё нормально, качнёшь и угол уезжает в плюс.
Подпаял интегрирующую цепь на выход ШИМ и увеличил частоту ШИМ до 31,25кГц. Потыкал осциллографом — на выходе, оказывается присутствуют периодические (2-3Гц)выбросы в плюс амплитудой от 1 до 3 гр/сек, в минус шум более-менее однородный. Теперь стало понятно поведение интеграла: редкие, но большие положительные выбросы утягивают интеграл в плюс.
Пробовал сделать ФНЧ с минимально возможной частотой среза: картинка стала стабильнее, но, естественно, большие угловые скорости перестали отслеживаться. Увеличение частоты среза возвращает всю ситуацию и угол вновь уходит в плюс.
Честно сказать, я расстроен. Ни ожидал столь геморройного расклада. Мыслей пока больше нет, кроме как начать корректировать показания гироскопа акселерометром, но это уже вопиюще неправильно — это как бороться со стуками в подвеске машины путём умягчения сидений.
Спасибо за разъяснения по проге визуализации. Что за мутный язык в программе? Я окончательно определился в том, что ваш вариант визуализации использовать не стану. Склоняюсь к самому простому для меня варианту — увеличу частоту моего выходного ШИМ и банально проинтегрирую его. Сделаю к-т ШИМ функцией не от угла, а от угловой скорости и буду в реальном времени смотреть на осциллографе. Мне так проще, поскольку программист я начинающий и не шибко способный.
По поводу инициализации: Попробую по Вашему примеру взять побольше значений и посмотрю что будет на выходе.
Я для телеметрии повторил протокол телеметрии из MultiWii 2.0.
Честно сказать, я ленюсь разбираться с чужими программами. Нельзя ли в двух словах пояснить принцип?
изначально, я просто отбрасывал логи в UART
Я к этому тоже склоняюсь, а потом можно, к примеру, в Exel визулизировать.
Выборка из 32 значений для усреднения очень мало, я использую 500.
Да уж, я догадывался, что всё не очень хорошо, но чтобы настолько плохо! В апноуте ST говорится, что достаточно 50-100 замеров. Вертолётные модельные гироскопы инициализиуются меньше, чем за полминуты. При этом стабильность даже у самых дешёвых моделей весьма достойная. В чём фокус? Частота опроса больше или алгоритмы другие? Инициализировать пять минут — это невозможно долго!
Да, графики хороши! Вы как их строили? Мне до такого результата, похоже, ещё очень далеко.
Сегодня попробовал способ, который умники из ST описывают в своих апноутах: сначала усреднить Zero Rate Level, а потом урезать оставшиеся шумы с помощью установки порогового значения в регистре REFERENCE. Получилось не очень. Сначала усреднял по 32 значениям — практически то же, что и без усреднения, потом по 64 значениям — стало чуть получше, но всё равно ошибка набегает очень быстро. У меня индикация довольно убогая — угол пересчитывается в 10-битный ШИМ и светят два светодиода — красный минус, зелёный плюс, по яркости свечения определяю величину угла.
В итоге: в покое всё хорошо, стоит качнуть и… привет — сразу появляется непредсказуемая ошибка и один из светодиодов уверенно набирает яркость. Хуже всего, что ошибка непредсказуема.
Вчера дети отобрали ноутбук и я не смог продолжить обсуждение, поэтому пишу только сейчас с работы.
мы просто фильтруем данные с акселерометра, а не интегрируем показания акселерометра
А «просто фильтруем» — это что за процедура? ФНЧ по сути интегратор, а в цифровом виде и подавно.
комплементарный фильтр учитывает только текущую ошибку (рассогласование) между расчетным углом и углом, полученным с акселерометра.
Я понимаю, что комплементарный фильтр корректирует мгновенное значение угла с акселерометра при помощи интегрального значения с гироскопа. В результате получается полосовой фильтр ограниченный снизу частотой среза ФНЧ гироскопа, а сверху ФВЧ акселерометра. Применительно к ПИД — это сумма дифференциальной и интегральной составляющей, а пропорциональная составляющая вносится опционально, если нужно увеличить скорость реакции.
По поводу zero rate level гироскопа что-нибудь посоветуете? Что у вас сыпется с выходов гироскопа в состоянии покоя?
Более эффективно ИМХО, использовать ПИ-регулятор для корректировании (я вскользь описывал это здесь)
Вы сами писали в тексте по ссылке, что по сути ПИД-регулятор — тот же комплементарный фильтр. В данном случае так оно и есть, поскольку складываются дифференциальная составляющая с акселерометра и интегральная с гироскопа — две комплементарных(дополняющих) величины. Акселерометр отсекает постоянную составляющую(ФВЧ), а гироскоп переменную (ФНЧ).
не знаю, что получится если использовать акселерометр одновременно и для коррекции расчетных углов и для определения собственного ускорения.
Я пока тоже не знаю, но буду пробовать. Пока же я хочу добиться максимально чистых данных с гироскопа, чтобы весь матаппарат не работал только на очистку данных, а занимался именно отслеживанием движения ЛА.
Грубо говоря, можно попробовать вносить коррекцию из данных акселерометра пропущенных через ФНЧ,
Это будет уже скорость, а не ускорение и получить такой интеграл из данных с акселерометра не очистив их от проекции g не получится — будет шустро набегать неслабая погрешность. Я уже через это прошёл.
А что, если не секрет, Вы делаете? Тоже коптер или какой-то другой проект?
Мне коптер как ЛА неинтересен, я летаю на вертолётах…
Может стоит перенести наше обсуждение в личку? Вроде бы больше никто не интересуется.
Еще одна проблема, о которой я уже говорил – вибрации.
Вибрации можно отрезать ФНЧ, если они не совсем низкочастотные. Я думаю вибрации от моторов всё же выше 20-25Гц, а частоту среза ФНЧ вполне можно взять и 5Гц.
Есть ещё одна проблема с гироскопом — нулевой уровеь показаний, т.е. выдаваемое значение ускорения при фактическом отсутствии угловой скорости. Иными словами: ЛА неподвижен, а с гиры идут показания, что ЛА поворачивается с какой-то скоростью. Для моего датчика по даташиту эта мнимая угловая скорость довольно велика — при шкале в 500гр/сек она может лежать в пределах +-10гр/сек. Я пытался подбором корректировать эту ошибку вычитая её из показаний гироскопа, но на данный момент при интегрировании она всё равно накапливается довольно быстро.
Сталкивались ли Вы с этой проблемой?
А как Вы планируете водить, в этом случае, коррекцию расчетного угла с гироскопа.
Честно сказать, ещё не обдумал детально этот вопрос. На вскидку, можно так же применить коррекцию угла с гироскопа при помощи показаний акселерометра, т.е. откорректировать угол применив тот же комплементарный фильтр. Основная идея — учёт силы тяжести.
А как выделить линейные ускорения? Акселерометр дает «смешанное» ускорение (g+линейное ускорение).
Например так: a=Ax-g*sinA, где а — линейное ускорение, Ах — значение снятое с соответствующей оси акселерометра, sinA — синс угла наклона ЛА измеренный гироскопом.
Я сейчас пытаюсь реализовать подобную систему.
Будут но не так существенно (собственное ускорение нашего ЛА незначительное и непродолжительное).
Ускорения ЛА существенны, поскольку, чтобы достичь скорости хотя бы 5-6км/ч, ЛА должен довольно продолжительное время (по крайней мере пару секунд)испытывать ускорение порядка 1,5м/с*с. За это время акселерометр подмешает к данным по углу, который он меряет порядка 15% ошибки (соотношение a/g).
Я попытался сделать макет платформы, которая должна была возвращаться в исходное положение после её перемещения по горизонтали на основании показаний акселерометра. Даже не смотря на коррекцию силы тяжести, которую я пытался вводить в программу, влияние силы тяжести при интегрировании вносило такую ошибку, что платформа просто не могла стоять на месте и всё время укатывалась. Данный макет работал удовлетворительно только в условиях установки платформы на качающуюся плоскость и отключении интегрирования показаний, т.е. только при отслеживании измениения проекции g на ось Х акселерометра.
Оттого я и пытаюсь реализовать сейчас систему выделяющую непосредственно линейное ускорение объекта. Может я заблуждаюсь, но пока не нахожу доводов опровергающих мои построения. На данном этапе моя проблема — сильный дрейф гироскопа L3G4200D фирмы ST. Tо ли мне такой экземпляр достался, то ли я обсчитываю неверно? Кто-нибудь имел опыт работы с этим прибором?
Всем здрасьте.
Я, вероятно, немного опоздал, но все же попробую поучаствоваь в обсуждении. Статьи понравились, однако есть вопросы:
— отчего не учитывается влияние линейных ускорений при расчёте угла наклона? На осях акселерометра при отклонении от горизонтали отображаются проекции ветора g. По сути, проекции g на оси и есть значения углов отклонения (например: X=g*sinA). Но они, даже при малых углах наклона, будут сравнимы со значениями ускорения вдоль осей. Как тогда отслеживать перемещения коптера?
Мне кажется, что использование комплементарного фильтра будет эффективно лишь при условии, что ЛА висит в точке и регуляторы компенсируют только лишь отклонение от гризонтали. Перемещения коптера будут вносить ошибку в работу фильтра.
И вот ещё: "… акселерометр дает нам проекцию вектора, который направлен вертикально вверх..." почему ветор силы тяжести направлен вверх?
А если полосовой фильтр попробовать? Частоту можно с мотора(ов) снять, к примеру.
И совсем уж дурная мысль: а может этот сигнал тоже проинтегрировать? Он периодический, симметричный (относительно). Вдруг прокатит?
Я опробовал этот способ, но результат не порадовал. Может и стало чуть лучше, но глазом не видно.
Интеграл (ФНЧ) как раз постоянную составляющую и выделяет. Убрать постоянную составляющую можно дифференцируя (ФВЧ), только зачем? Вопорс у меня в том, как убрать непериодическую помеху случайной амплитуды?
Один умник посоветовал корелляционный фильтр, но с чем кореллировать не сказал. В принципе, это универсальный способ, только как его применить в моём случае?
Это плавающее ил динамическое усреднение. Я тоже думал об этом, но тогда должна быть достаточно высокая скорость опроса датчиков — никак не 100Гц, а раз в 10-20 больше.
Подпаял интегрирующую цепь на выход ШИМ и увеличил частоту ШИМ до 31,25кГц. Потыкал осциллографом — на выходе, оказывается присутствуют периодические (2-3Гц)выбросы в плюс амплитудой от 1 до 3 гр/сек, в минус шум более-менее однородный. Теперь стало понятно поведение интеграла: редкие, но большие положительные выбросы утягивают интеграл в плюс.
Пробовал сделать ФНЧ с минимально возможной частотой среза: картинка стала стабильнее, но, естественно, большие угловые скорости перестали отслеживаться. Увеличение частоты среза возвращает всю ситуацию и угол вновь уходит в плюс.
Честно сказать, я расстроен. Ни ожидал столь геморройного расклада. Мыслей пока больше нет, кроме как начать корректировать показания гироскопа акселерометром, но это уже вопиюще неправильно — это как бороться со стуками в подвеске машины путём умягчения сидений.
По поводу инициализации: Попробую по Вашему примеру взять побольше значений и посмотрю что будет на выходе.
Я к этому тоже склоняюсь, а потом можно, к примеру, в Exel визулизировать.
Да уж, я догадывался, что всё не очень хорошо, но чтобы настолько плохо! В апноуте ST говорится, что достаточно 50-100 замеров. Вертолётные модельные гироскопы инициализиуются меньше, чем за полминуты. При этом стабильность даже у самых дешёвых моделей весьма достойная. В чём фокус? Частота опроса больше или алгоритмы другие? Инициализировать пять минут — это невозможно долго!
Сегодня попробовал способ, который умники из ST описывают в своих апноутах: сначала усреднить Zero Rate Level, а потом урезать оставшиеся шумы с помощью установки порогового значения в регистре REFERENCE. Получилось не очень. Сначала усреднял по 32 значениям — практически то же, что и без усреднения, потом по 64 значениям — стало чуть получше, но всё равно ошибка набегает очень быстро. У меня индикация довольно убогая — угол пересчитывается в 10-битный ШИМ и светят два светодиода — красный минус, зелёный плюс, по яркости свечения определяю величину угла.
В итоге: в покое всё хорошо, стоит качнуть и… привет — сразу появляется непредсказуемая ошибка и один из светодиодов уверенно набирает яркость. Хуже всего, что ошибка непредсказуема.
А «просто фильтруем» — это что за процедура? ФНЧ по сути интегратор, а в цифровом виде и подавно.
Я понимаю, что комплементарный фильтр корректирует мгновенное значение угла с акселерометра при помощи интегрального значения с гироскопа. В результате получается полосовой фильтр ограниченный снизу частотой среза ФНЧ гироскопа, а сверху ФВЧ акселерометра. Применительно к ПИД — это сумма дифференциальной и интегральной составляющей, а пропорциональная составляющая вносится опционально, если нужно увеличить скорость реакции.
По поводу zero rate level гироскопа что-нибудь посоветуете? Что у вас сыпется с выходов гироскопа в состоянии покоя?
Я пока тоже не знаю, но буду пробовать. Пока же я хочу добиться максимально чистых данных с гироскопа, чтобы весь матаппарат не работал только на очистку данных, а занимался именно отслеживанием движения ЛА.
Это будет уже скорость, а не ускорение и получить такой интеграл из данных с акселерометра не очистив их от проекции g не получится — будет шустро набегать неслабая погрешность. Я уже через это прошёл.
Мне коптер как ЛА неинтересен, я летаю на вертолётах…
Может стоит перенести наше обсуждение в личку? Вроде бы больше никто не интересуется.
Есть ещё одна проблема с гироскопом — нулевой уровеь показаний, т.е. выдаваемое значение ускорения при фактическом отсутствии угловой скорости. Иными словами: ЛА неподвижен, а с гиры идут показания, что ЛА поворачивается с какой-то скоростью. Для моего датчика по даташиту эта мнимая угловая скорость довольно велика — при шкале в 500гр/сек она может лежать в пределах +-10гр/сек. Я пытался подбором корректировать эту ошибку вычитая её из показаний гироскопа, но на данный момент при интегрировании она всё равно накапливается довольно быстро.
Сталкивались ли Вы с этой проблемой?
Я сейчас пытаюсь реализовать подобную систему.
Ускорения ЛА существенны, поскольку, чтобы достичь скорости хотя бы 5-6км/ч, ЛА должен довольно продолжительное время (по крайней мере пару секунд)испытывать ускорение порядка 1,5м/с*с. За это время акселерометр подмешает к данным по углу, который он меряет порядка 15% ошибки (соотношение a/g).
Я попытался сделать макет платформы, которая должна была возвращаться в исходное положение после её перемещения по горизонтали на основании показаний акселерометра. Даже не смотря на коррекцию силы тяжести, которую я пытался вводить в программу, влияние силы тяжести при интегрировании вносило такую ошибку, что платформа просто не могла стоять на месте и всё время укатывалась. Данный макет работал удовлетворительно только в условиях установки платформы на качающуюся плоскость и отключении интегрирования показаний, т.е. только при отслеживании измениения проекции g на ось Х акселерометра.
Оттого я и пытаюсь реализовать сейчас систему выделяющую непосредственно линейное ускорение объекта. Может я заблуждаюсь, но пока не нахожу доводов опровергающих мои построения. На данном этапе моя проблема — сильный дрейф гироскопа L3G4200D фирмы ST. Tо ли мне такой экземпляр достался, то ли я обсчитываю неверно? Кто-нибудь имел опыт работы с этим прибором?
Я, вероятно, немного опоздал, но все же попробую поучаствоваь в обсуждении. Статьи понравились, однако есть вопросы:
— отчего не учитывается влияние линейных ускорений при расчёте угла наклона? На осях акселерометра при отклонении от горизонтали отображаются проекции ветора g. По сути, проекции g на оси и есть значения углов отклонения (например: X=g*sinA). Но они, даже при малых углах наклона, будут сравнимы со значениями ускорения вдоль осей. Как тогда отслеживать перемещения коптера?
Мне кажется, что использование комплементарного фильтра будет эффективно лишь при условии, что ЛА висит в точке и регуляторы компенсируют только лишь отклонение от гризонтали. Перемещения коптера будут вносить ошибку в работу фильтра.
И вот ещё: "… акселерометр дает нам проекцию вектора, который направлен вертикально вверх..." почему ветор силы тяжести направлен вверх?