Ели предположить что модель абстрактна, то, ИМХО, лучше для примера взять апериодическое звено первого порядка. Такая модель проста, понятна и к такой модели можно свести многие реальные системы (по крайней мере приближенно).
Касательно модели в файле. А так понял, вы вяли за основу формулу типа
X(n) = X(n – 1) + Ut + at^2/2
и подставили выход регулятора вместо ускорения (а).
Я правильно понял?
Почему выход регулятора вы считаете ускорением?
Касательно Wi-Fi — коллеги уже предложили несколко опримальных вариантов .
Мои 5 копеек — если говорить о
Основное направление использования — робототехника (квадрокоптеры, rc model).
Wi-Fi — это немного не то, о чем мечтают моделисты (из-за радиуса действия, задержки, надежности, и т. д.). Пока для моделизма используют аналоговую придачу видео. Получается намного дешевле и надеже. Из вариантов с Wi-Fi – могу вспомнить только ArDrone
Я так понимаю, что вы говорите о медленных процессах, когда получается, что e(t)-e(t-1) = 0 из-за ограниченной точности вычислений («округления»), а, на самом деле, e(t) не равно e(t-1) просто нам не хватает точности при вычислении?
Но если переходной процесс насколько медленный, что из-за округления при расчетах мы теряем дифф. составляющую – может она (в данном случае) и не особо нужна. Ваша мысль интересная, но ели считать e(t)-e(t-k) – мы вводим искусственную задержку при дифференцировании – оправдано ли это?
Насколько я понял, автор предлагает добиться атомарности посредством атомарного чтения/записи переменной (извиняюсь, ели я неправильно понял автора), и я хотел сказать, что просто чтение/запись float не будет атомарным для многих МК (если не использовать critical sections или другие «спец. средства»).
Даже если конкретная платформа может атомарно сохранить/прочитать 32-х битную переменную (при условии properly aligned), для float (в общем случае, при программной реализации) атомарность не гарантирована.
Не совсем понял вашу логику: как скользящее средне (ФНЧ) в обратной связи связанно с точностью расчетов самого ПИД (фиксированная / плавающая точка). В обратную связь есть смысл поставить ФНЧ, если там действительно присутствуют помехи на высокой частоте. Просто так ФНЧ ставить смысла нет, т. к. фильтр внесет задержку.
Вот, например, у Вас обратная связь по показаниям тахометра — откуда там возьмутся высокочастотные помехи. Насколько я понимаю, тахометр реализован как счетчик импульсов с датчика на валу двигателя. Или я что-то упустил?
Поэтому переменная с воздействием должна изменяться атомарно, да и считываться тоже: 1) меняться только в конце вычисления, 2) считываться только в одном месте потока воздействия.
Я так понимаю, Вы таким образом хотите добиться атомарности операций в многозадачной системе? Но МК (например AVR) не сможет изменить значение типа float атомарно. Даже если в коде на С мы изменяем значение «в одном месте», этот код разобьется на кучу инструкций процессора, атомарной эта операция не будет.
Формула в вышеприведенном виде хороша для изучения, но неудобна для расчетов.
e(t) – это функция, зависимость ошибки от времени. У нас эта непрерывная функция заменяется на значение ошибки через определенный период времени (дискретизация). Именно поэтому у нас дискретная реализация, а не потому, что ферула «удобна» для расчетов :)
В языке программирования Си – как минимум float, а лучше бы и double.
Ели уж говорить о МК и оптимизации, может есть смысл перейти к операциям с фиксированной точкой?
Об одной из этих статей я и говорил. Понятно, что при корректной реализации регулятора по рекуррентной формуле он будет корректно работать. Просто в такой реализации есть много неочевидных мест (собственно описанию этих мест и повещена одна из статей).
Вопрос в другом, бытует мнение (и я подозреваю, что оно правильное), что рекуррентная формула более опимизированна для реализации. Например, в Вики явно пишут:
В программной реализации для оптимизации расчетов переходят к рекуррентной формуле.
Но я, глядя на формулу не вижу чем она более оптимальна, ИМХО, реализация «в лоб» требует меньше вычислений.
Подозреваю, что я чего-то не замечаю, или что-то не учитываю. Может кто подскажет, в чем плюс данной реализации?
Вы неправильно поняли.
Обе формулы – это дискретная реализация ПИД. Просто эта, для расчета воздействия U, использует значение воздействия с предыдущего шага U(n — 1 ). Отличаются они только реализацией.
Ну, в многозадачной среде кроме отдельного потока и прерывания особо вариантов нет.
Я имею виду неэффективность создания 2 потоков один для управления (с высоким приоритетом), другой для расчетов (с низким).
Хотя, конечно это все очень индивидуально, сильно зависит от других задач/потоков и т. д. поэтому, без конкретно примера эти рассуждения особо смысла не имеют.
Ну, решение задачи в лоб, это 4 сложения, одно вычитание и 3 умножения. Вроде ничего не забыл.
Я, безусловно, не предлагаю это все считать в прерывании, но вынесение расчетов в отдельный поток с другим приоритетом, тоже, ИМХО, не фонтан.
Если уж оптимизировать, то первое, что напрашивается перейти к операциям с фиксированной точкой. Я много где читал, что рекуррентная формула эффективнее в реализации, но, честно говоря я не вижу, в чем ее эффективность.
Хм. Все равно не пойму Вашей логики. У вас в коде 3 аналогичных конструкции:
case ComputeI: // вычисление интегрального коэф.
PID_step = ComputeP;
if (Ki)
{
U = I + Ki * E;
I = U;
}
else break;
То есть, если все коефициенты Ki, Kp, Kd отличны от 0 (а это как раз ПИД регулятор) то не один из «break» не сработает, ваш код рассчитает воздействие за один вызов функции. А вот если один из коэффициентов равен 0 (частый случай ПИД регулятора) то сработает один из «break» и вычисление произойдет за несколько вызовов. Может у вас в этой конструкции «else» лишний?
Кстати, может кто подскажет, почему считается, что программная реализация ПИД по рекуррентной формуле более оптимизирована? Глядя на формулу, мне кажется, что решение «в лоб» проще, меньше действий. Плюс, при реализации по рекуррентной формуле есть много неочевидных тонкостей (по этому поводу где-то на Хабре была статья).
А считать можно как попало, лишь бы уложиться в период дискретизации.
Спорный момент. Там вычислений – пара-торойка сложений да сколько же умножений. Создавать ради этого отдельный поток – накладные расходы на его обслуживание будут соизмеримы с временем расчета воздействия. Плюс, потоки (управление и расчеты) нужно будет как-то синхронизировать. Плюс, что делать, если «рассчитывающий» поток не успел посчитать к нужному времени значение управляющего воздействия (был все время вытеснен другими потоками)?
Коллега, я не спорю, что метод трапеций должен быть точнее чем метод квадратов. Для этого даже не нужно приводить формул для оценки погрешности, достаточно взглянуть на рисунки, иллюстрирующие данные методы, там все наглядно видно. Раньше я всегда использовал метод трапеций, т. к. его реализация не намного сложнее, а точность должна быть выше. Но, прочитав статью тов. amaora я удивился и решил перепроверить на практике. В моих случаях действительно получилось, что разницы в этих двух методах, нет (в тех случаях, о которых идет речь в статье).
Это Вы так тонко тролите? :)
X(n) = X(n – 1) + Ut + at^2/2
и подставили выход регулятора вместо ускорения (а).
Я правильно понял?
Почему выход регулятора вы считаете ускорением?
Мои 5 копеек — если говорить о
Wi-Fi — это немного не то, о чем мечтают моделисты (из-за радиуса действия, задержки, надежности, и т. д.). Пока для моделизма используют аналоговую придачу видео. Получается намного дешевле и надеже. Из вариантов с Wi-Fi – могу вспомнить только ArDrone
Но если переходной процесс насколько медленный, что из-за округления при расчетах мы теряем дифф. составляющую – может она (в данном случае) и не особо нужна. Ваша мысль интересная, но ели считать e(t)-e(t-k) – мы вводим искусственную задержку при дифференцировании – оправдано ли это?
Не совсем понятно высказался, правильнее сказать
Даже если конкретная платформа может атомарно сохранить/прочитать 32-х битную переменную (при условии properly aligned), для float (в общем случае, при программной реализации) атомарность не гарантирована.
Вот, например, у Вас обратная связь по показаниям тахометра — откуда там возьмутся высокочастотные помехи. Насколько я понимаю, тахометр реализован как счетчик импульсов с датчика на валу двигателя. Или я что-то упустил?
Я так понимаю, Вы таким образом хотите добиться атомарности операций в многозадачной системе? Но МК (например AVR) не сможет изменить значение типа float атомарно. Даже если в коде на С мы изменяем значение «в одном месте», этот код разобьется на кучу инструкций процессора, атомарной эта операция не будет.
e(t) – это функция, зависимость ошибки от времени. У нас эта непрерывная функция заменяется на значение ошибки через определенный период времени (дискретизация). Именно поэтому у нас дискретная реализация, а не потому, что ферула «удобна» для расчетов :)
Ели уж говорить о МК и оптимизации, может есть смысл перейти к операциям с фиксированной точкой?
Вопрос в другом, бытует мнение (и я подозреваю, что оно правильное), что рекуррентная формула более опимизированна для реализации. Например, в Вики явно пишут:
Но я, глядя на формулу не вижу чем она более оптимальна, ИМХО, реализация «в лоб» требует меньше вычислений.
Подозреваю, что я чего-то не замечаю, или что-то не учитываю. Может кто подскажет, в чем плюс данной реализации?
Обе формулы – это дискретная реализация ПИД. Просто эта, для расчета воздействия U, использует значение воздействия с предыдущего шага U(n — 1 ). Отличаются они только реализацией.
Я имею виду неэффективность создания 2 потоков один для управления (с высоким приоритетом), другой для расчетов (с низким).
Хотя, конечно это все очень индивидуально, сильно зависит от других задач/потоков и т. д. поэтому, без конкретно примера эти рассуждения особо смысла не имеют.
Я, безусловно, не предлагаю это все считать в прерывании, но вынесение расчетов в отдельный поток с другим приоритетом, тоже, ИМХО, не фонтан.
Если уж оптимизировать, то первое, что напрашивается перейти к операциям с фиксированной точкой. Я много где читал, что рекуррентная формула эффективнее в реализации, но, честно говоря я не вижу, в чем ее эффективность.
Я помню, это я исправлял :)
Но в данном случае я омел ввиду именно рекуррентную формулу,
Вот эту:
Это тоже дискретная реализация.
То есть, если все коефициенты Ki, Kp, Kd отличны от 0 (а это как раз ПИД регулятор) то не один из «break» не сработает, ваш код рассчитает воздействие за один вызов функции. А вот если один из коэффициентов равен 0 (частый случай ПИД регулятора) то сработает один из «break» и вычисление произойдет за несколько вызовов. Может у вас в этой конструкции «else» лишний?
Спорный момент. Там вычислений – пара-торойка сложений да сколько же умножений. Создавать ради этого отдельный поток – накладные расходы на его обслуживание будут соизмеримы с временем расчета воздействия. Плюс, потоки (управление и расчеты) нужно будет как-то синхронизировать. Плюс, что делать, если «рассчитывающий» поток не успел посчитать к нужному времени значение управляющего воздействия (был все время вытеснен другими потоками)?
Но, я могу ошибаться.