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

Geniok
Alexsis1109:

так получается система не универсальная. под каждый приемник настраивать надо

Ну в вообщем-то да, вся настройка выглядит вот так:

int main(void)
{
STM32* mk = STM32::getInstance();
Clock* clc = Clock::getInstance();
PWM* pwm = PWM::getInctance();

// Инициализируем железо
mk->Init();

// Настраиваем системный таймер
clc->Setup();

pwm->Setup(PB7, TIM4, CH_2, INPUT, 50); // приемник
pwm->Setup(PA0, TIM2, CH_1, OUTPUT, 50); // мотор

while(1)
{
pwm->Write(TIM2, CH_1, pwm->Read(TIM4, CH_2)); // передаю на мотор сигнал с приемника
}
}

Это полный текст главного цикла, где с одного канала ( с приемника) получаю ШИМ и передаю на другой ( на мотор).

Цифра 50 - это и есть частота ШИМ.

oleg70
Geniok:

TIM_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_BothEdge;

Видимо у 407-го (не смотрел) есть настройка на оба фронта, а у меня F303 только “или”-“или”…
Вы посмотрите, - есть ли аппаратная возможность сброса счетчика по первому фронту (в моем кажется есть, сейчас как раз копаюсь), тогда все проблемы отпадут…

Geniok
oleg70:

Видимо у 407-го (не смотрел) есть настройка на оба фронта, а у меня F303 только “или”-“или”…
Вы посмотрите, - есть ли аппаратная возможность сброса счетчика по первому фронту (в моем кажется есть, сейчас как раз копаюсь), тогда все проблемы отпадут…

А сбрасывать ведь нельзя…
Если к этому таймеру подключены еще 3 канала ШИМ ?
Вы ведь сбросите счетчик таймера для все каналов он же единый…
И если на одном получите правильное значение, то для всех остальных будет “мусор”

Я бы тогда конечно сбрасывал по второму фронту и проблем бы с переполнением не было.

oleg70
Geniok:

А сбрасывать ведь нельзя…
.

Согласен…, затупил , к тому же “разул глаза” благодаря Вам, и на моем можно по обеим фронтам настроить…, будем думать…

Однако имейте в виду (проверено) что в реальном времени импульсы всех каналов разнесены и не пересекаются (они из PPM вырезаны), так что насчет сброса еще подумать надо…

Geniok
oleg70:

Согласен…, затупил , к тому же “разул глаза” благодаря Вам, и на моем можно по обеим фронтам настроить…, будем думать…

Однако имейте в виду (проверено) что в реальном времени импульсы всех каналов разнесены и не пересекаются (они из PPM вырезаны), так что насчет сброса еще подумать надо…

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

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

Alexsis1109
Geniok:

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

на то они и прерывания чтобы в них не задерживаться

oleg70
Geniok:

и все, пиши пропало.

Вот и я всю голову изломал, даже всерьез подумываю слепить преобразователь на простеньком Avr-e в PPM и тогда получим: 1 нога STM под приемник ! ПДП на чтение всех каналов ! никаких прерываний !

Geniok
Alexsis1109:

на то они и прерывания чтобы в них не задерживаться

Ну имелось в виду не само прерывание как таковое, а функция его обработки.
Пока обработываешь, пришло другое прерывание, значение счетчика изменилось, а мы его сбросили… Потому сбрасывать его не желательно. ИМХО.
Вообщем, проверять это все дело надо.

oleg70:

Вот и я всю голову изломал, даже всерьез подумываю слепить преобразователь на простеньком Avr-e в PPM и тогда получим: 1 нога STM под приемник ! ПДП на чтение всех каналов ! никаких прерываний !

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

leprud
oleg70:

Однако имейте в виду (проверено) что в реальном времени импульсы всех каналов разнесены и не пересекаются

Увы, не во всех приемниках так. В некоторых они как раз одновременно идут
Вот пример картинки с сайта Эксперта

Geniok
leprud:

Увы, не во всех приемниках так. В некоторых они как раз одновременно идут
Вот пример картинки с сайта Эксперта

Вот-вот, тем более даже если взять 1-ю картинку, то по ней спад 1 канала совпадает с фронтом 2-го. Даже в этом случае расчитывать на сброс счетчика уже опасно, пока считаешь первый канал, со второго пришло прерывание. И не факт что сбросить счетчик успеешь до прихода прерывания со второго канала.
А если учесть что на 1 таймере весит аж 4 канала управления, игра в рулетку какая-то получается.

oleg70
leprud:

Увы, не во всех приемниках так.

Странно… не знал, ведь в радиосигнале информация не может быть параллельна, как же это они так “измудрились” к одному фронту привязать все каналы, хотя … пути господни…

Получается, что все алгоритмы летят к “… бабушке”.

Alexsis1109
Geniok:

И не факт что сбросить счетчик успеешь до прихода прерывания со второго канала.

действительно, что делать если прерывание следующего канала сработает сразу с завершением фронта предыдущего? как успеть записать значение шима???

DVE
oleg70:

Странно… не знал, ведь в радиосигнале информация не может быть параллельна, как же это они так “измудрились” к одному фронту привязать все каналы, хотя … пути господни…

Это же цифровой сигнал, приходит пакет, приемник его декодирует и выставляет значения каналов, к примеру.

oleg70
DVE:

Это же цифровой сигнал.

У меня futaba PCM (типа “цифра”) но импульсы всеж разнесены причем с “зазором”, как и в реале…

SergDoc

Вот rcopen.com/forum/f123/topic264377/49 простая ловилка PWM на tiny 2313 сам сейчас с такой летаю, как пишет автор, там ссылка есть на первоисточник, работает с любыми выходами приёмника…

I have used it without problems with my mikrokopter. It works without skipping frames on my Corona CR8D type 2 receiver (all servo channels output simultaneously). It should work fine on type 1 receivers also (servo channels output sequentially), but I don’t own any so I can’t test it.

Geniok
Alexsis1109:

действительно, что делать если прерывание следующего канала сработает сразу с завершением фронта предыдущего? как успеть записать значение шима???

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

oleg70:

У меня futaba PCM (типа “цифра”) но импульсы всеж разнесены причем с “зазором”, как и в реале…

А зазор какой, сколько есть времени на обработку?

oleg70
Geniok:

А зазор какой, сколько есть времени на обработку?

0.3 мили/сек

SergDoc:

простая ловилка PWM на tiny

Вот, а я еще хочу скажем в RS232 преобразовать (не проблема) тогда прям в USART заливай 16 байт (8х2), ПДП, и вперед…

Geniok

Провел эксперимент.
Вот сигнал с 3-х каналов приемника.
Аппа Турнига 9х

Как видно, фронт идет сразу по всем каналам.

И сразу назревает проблема.
2 канала я еще более-менее успеваю обрабатывать, а вот уже не 3-х происходит сбой. Счетчик же тикает, пока до 3-го канала добираюсь, половину скважности ШИМ успевает обрезать.
Про 4 канала уже и говорить не хочется…

Значит, по фронту необходимо данные заносить сразу во все 4 канала, а уже по спаду в каждый канал свое значение…

Зато теперь знаю как избавится от слеек, сбрасывать счетчик по фронту. 😃

oleg70
Geniok:

И сразу назревает проблема.

“Простая задача” оказалась не простой (хорошо, что я плату еще не начал делать), даааа…
Спасибо за эксперимент… (у меня только футабы есть), не знал…

Geniok

Нашел решение, как обрабатывать все правильно.
Делать надо так:
сначала ловим переход из 0 в 1. Сбрасываем счетчик таймера.
Далее проводим переинициализацию таймера, чтобы он ловил переход из 1 в 0.
Записываем значения. снова проводим перенастройку. чтоб ловил из 0 в 1 и т.д. по кругу.
Таким образом ничего нигде не обрезается и все данные по всем 4-м каналом на 1-м таймере соответствуют действительности.

Плюс к этому избавляемся от переполнения счетчика таймера.

И к 303 камню как раз подходит! 😃

Код нужен ?

oleg70:

“Простая задача” оказалась не простой (хорошо, что я плату еще не начал делать), даааа…
Спасибо за эксперимент… (у меня только футабы есть), не знал…

Возможно для футабы придется писать код отдельно, также как для спектрумов…

Получаем вот такую ровную картину.

Все каналы кроме 3-го в центре, 3-й в минимуме.

Поторопился я, произошла небольшая ошибка.
Данные то считывал не напрямую с приемника, а уже с контроллера.
Напрямую с приемника сигналы выглядят вот так, со смешением. Между спадом и фронтом соседних каналов (величина смещения) 2мкс.

Со сбросом счетчика по фронту прекрасно работает. Значит этот способ будет работать в обоих вариантах, хоть по одному фронту сигналы приходят, хоть со смешением.

Плюс к этому экономим на памяти, так как хранить нужно всего 1 значение, вместо 3-х, как раньше.

rual
oleg70:

В Вашем проекте нашел функции по ДЕинициализации петли ДУСа, каково их применение ?

отключение петли нужно для изменения настройки ДУС штатной функцией Ф3Дисковери.

oleg70:

И еще, я так понял, что для чтения акселя и магнетометра ПДП не применяется (?).

Нет, и2ц замороченный протокол и читается 6 байт, для организации ПДП накладных расходв больше.