Создание собственной системы стабилизации

ИльяПРо

Провел тест на отключенном GPS, то есть как работает удержание высоты по барометру

Лог высоты

Еще тест оказания ускорений на ориентацию.

И еще очередной тест новой фичи со стабилизацией.

Есть код, могу скинуть, кому надо.

kasmirov

Да, очень интересно посмотреть алгоритм.
Можно скинуть на мой ник @yandex.ru

jShadow
ИльяПРо:

Есть код, могу скинуть, кому надо.

Очень интересно! Можно в личку.

ИльяПРо

www.dropbox.com/s/…/opencv_test3.zip?dl=0 проект
к нему еще нужно установить опенсв 3.2,
дополнительно нужны последовательности кадров с бортовой камеры в формате 640 на 360 opencv_test3\opencv_test2\seq2
файл .csv где прописаны имена кадров и время opencv_test3\opencv_test2\frames2.csv
и файл с углами и временем opencv_test3\opencv_test2\angles2.csv

oleg70
ИльяПРо:

Еще тест оказания ускорений на ориентацию.

Как реализована компенсация линейных ускорений ? (в общих словах, сама идея, так сказать) или просто коэффициент влияния акселя сильно мал ?

ИльяПРо

norm = __sqrtf(accX*accX + accY*accY + accZ*accZ);

noise = UKF_ACC_N + fabsf(9.81 - norm) * UKF_DIST_N;

Увеличиваю дисперсию шума в модели датчика, и UKF меньше доверяет акселю.

Ориентация ведь из GPS корректируется в том числе, но на самом деле по видео сложно сказать о качестве ориентации. Искажения линзы и подобранные коэффициенты перемщения картинки от угла все портят.

rual
oleg70:

Как реализована компенсация линейных ускорений ? (в общих словах, сама идея, так сказать) или просто коэффициент влияния акселя сильно мал ?

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

oleg70
rual:

вносить коррекцию в ориентацию

Под “ориентацией” что подразумевается (?), (я конкретно - крен и тангаж имел ввиду), вот, судя по видео от Ильи, смотрю что при затяжных виражах по кругу, после отпускания стиков, его аппарат сразу “находит” правильный горизонт, хотя по идее должен лететь вбок, так как вектор гравитации акселя уплывает при центробежном ускорении. у меня к сожалению пока так… Еще не испытывал, но сделал, полное отключение акселя, при превышении некоторого порога лин.ускорений (а у Ильи динамичекое регулирование по факту). Видимо надо тоже так сделать, иначе от вибраций кульбит может произойти)))
тут, как бы, ГНСС не помощник(?) или я че туплю…

rual
oleg70:

я конкретно - крен и тангаж имел ввиду

Я тоже это имел ввиду

oleg70:

при превышении некоторого порога лин.ускорений (а у Ильи динамичекое регулирование по факту).

да

oleg70:

тут, как бы, ГНСС не помощник(?)

Как не помощник ? По нему видны итоги перемещения которые можно сравнить с интгралом акселя и выполнить корректировку.

oleg70
rual:

По нему видны итоги перемещения которые можно сравнить с интгралом акселя

А ведь да, - факт…, надо пробовать, спасибо (!). Хотя, помню, давно еще пробовал интегрировать линейные ускорения, это ж сразу интеграл “в небо” улетает, их как то надо корректировать тем же ЖПС чтоль (?)
(сразу скажу что Калмана так и не осилил, - слабО…))

rual
oleg70:

Хотя, помню, давно еще пробовал интегрировать линейные ускорения, это ж сразу интеграл “в небо” улетает, их как то надо корректировать тем же ЖПС чтоль (?)

В каждой итерации надо корректировать, кроме того, сам понимаешь, что важно верное направление на север, оно тоже должно корректироваться по акселю.

10 days later
rual
ИльяПРо:

По-моему крутое применение алгоритмов и всей математики помимо коптеров

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

9 days later
mahowik
ИльяПРо:

Видели что нить подобное? По-моему крутое применение алгоритмов и всей математики помимо коптеров

На втором ролике классный хренолет! Аж захотелось себе собрать такой! 😃
Распросил немного хозяина видео. Там впринципе ничего хитрого нет, т.е. все теже алгоритмы, единственное конечные миксы другие чутка…

1 month later
seaowl

Создание собственной системы стабилизации - это имхо в первую очередь программный код. Для тех, кто хочет попробовать свой программный код (и не хочет проектировать-изготавливать печатные платы, подбирать и паять компоненты), может быть интересная такая платка. Подключив внешние датчики (IMU) - можно сконфигурировать и залить для начала Pixhawk, ну а дальше что-нибудь своё.

stm32f407vet6

rual
seaowl:

Создание собственной системы стабилизации - это имхо в первую очередь программный код.

Совершенно верно.

seaowl:

Для тех, кто хочет попробовать свой программный код (и не хочет проектировать-изготавливать печатные платы, подбирать и паять компоненты), может быть интересная такая платка. Подключив внешние датчики (IMU) - можно сконфигурировать и залить для начала Pixhawk, ну а дальше что-нибудь своё.

Плата неплохая, но сейчас не актуальна, ибо за 20-30уё доступны очень неплохие и самодостаточные с теми же вычислительными мощностями.
А в те далекие времена 😒, когда начиналась эта ветка, вопрос о доступности достойной платформы (вычислитель+датчики) был архиважен.

kasmirov

Вы наверное на какой-то своей волне общаетесь ������
Один выкладывает фотки платы, но не приводит ни ее производителя, ни ссылку где купить.
Второй говорит, все хорошо, но дорого и неактуально, и есть дешевле с теми же характеристиками. Но также ничерта не приводит.

Зы. Плата из сообщения выше стоит 600 руб, это дешевле, 20 уе.

rual
kasmirov:

Один выкладывает фотки платы, но не приводит ни ее производителя, ни ссылку где купить.

На фото достаточно инфы. Покупать не планирую. Кому интересно - спросят.

kasmirov:

Второй говорит, все хорошо, но дорого и неактуально, и есть дешевле с теми же характеристиками. Но также ничерта не приводит.

А что хотели узнать? Макс частота, МИПСы и пр. характеристики есть в документации на STM32F4xx. А за рекламу не аффилиированных ресурсов здесь бьють.

kasmirov:

Зы. Плата из сообщения выше стоит 600 руб, это дешевле, 20 уе.

Добавьте датчики и сравните. + масса и рукоделие.

alexeykozin
seaowl:

Подключив внешние датчики (IMU) - можно сконфигурировать и залить для начала Pixhawk, ну а дальше что-нибудь своё.

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

в этом ключе Серега Липницкий нарисовал дизайн платы сенсоров. на этой плате размещены все основные компоненты необходимые для полетника (фрам, сдкарта, регуляторы питания ) и несколько типов сенсоров являющихся перспективными для новых версий полетных контроллеров
на плату можно поставить перспективные барометры от боша и новые сенсоры от инвенсенс а также собрать эквивалент pixhawk2 или иного контроллера.

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

сенсоры
icm20608
icm20689
mpu9250
hm5983 /spi
bmp380
ms5611

прочее
microsd
fram
4 отдельных регулятора питания
сигналы всех шин предусматривают установку шунтирующих резисторов
все шины заведены на колодки под пайку модных ныне JST GH (с защелками и надежным контактом)
схемка тут

если говорить о перспективных дискавери платах то имхо целиться сейчас нужно на STM32 F7 и иметь в перспективе STM32 H7

alexeykozin
ИльяПРо:

Есть код, могу скинуть, кому надо.

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

а такая програмулька могла бы помочь разобраться в случаях когда бортовое видео с осд не писалось, но есть видео с курсовой камеры и логи

seaowl
kasmirov:

Один выкладывает фотки платы, но не приводит ни ее производителя, ни ссылку где купить.

stm32f407vet6 - вполне достаточно, чтоб загуглить. А цену - какую цену Вы хотите? Она на китайских сайтах отличается в зависимости от доставки и продавца.

Для меня до сих пор остается загадкой почему все новые и новые полетные контроллеры делают на STM32, в то время как платы типа Raspberry Pi и подобные - сравнялись по цене и размеру с платами на stm32, но более производительны, работают с удобным Linux, и уже летают ???

Мне кажется stm32 хорош там где нужно сверзнизкое потребление в режимах сна, батарейное питание, или экономия 1-2 доллара на каждом устройстве. Например stm32 esc.

Но зачем stm32 в полетнике квадрокоптера?