Симулятор ПИД-регулятора (PID) для робототехники

Управление

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

Теория

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

Возможности регулятора ограничены объектом. Слишком медленная дискретизация скрывает движение; превышение предела исполнительного механизма приводит к насыщению; зашумлённые измерения делают нефильтрованную производную неустойчивой. Поэтому настройка — это эксперимент одновременно с регулятором и системой.

Алгоритм

1. Считывайте измерение через фиксированный интервал и вычисляйте ошибку.
2. Накапливайте ограниченный интеграл с использованием фактического шага времени.
3. Оценивайте производную по измерению или ошибке и применяйте подходящую фильтрацию.
4. Складывайте три взвешенных слагаемых и ограничивайте результат диапазоном исполнительного механизма.
5. Применяйте команду, сохраняйте предыдущий отсчёт и записывайте метрики.
6. Сбрасывайте интеграл и историю при существенном изменении режима управления или объекта.

Исходный код

В этой реализации есть простая защита от интегрального насыщения:

float updatePid(float setpoint, float measured, float dt) {
  const float error = setpoint - measured;
  const float derivative = (error - previousError) / dt;
  const float candidateIntegral = integral + error * dt;
  const float raw = kp * error + ki * candidateIntegral + kd * derivative;

  const float output = constrain(raw, outputMin, outputMax);
  if (raw == output) integral = candidateIntegral;
  previousError = error;
  return output;
}

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

Допущения и отличия от реального оборудования

Объект здесь — упрощённая модель второго порядка с известными массой, демпфированием и задержкой, которые задаются ползунками, а не настоящий двигатель с трением, мёртвой зоной, моментом, снижающимся с ростом скорости, и нагревающимся драйвером. Дискретизация фиксирована по построению, поэтому производная составляющая остаётся управляемой; на Arduino вызов delay() или другая блокирующая работа вызывают дрожание интервала, и составляющая D ведёт себя некорректно даже при неизменных коэффициентах. Насыщение исполнительного механизма моделируется жёстким ограничением с защитой от интегрального насыщения, но у физической системы также есть ограничения тока, просадка питания и нагрев, меняющие предел во время работы. Настройте переходный процесс здесь, затем проверьте на реальной системе, где объект известен лишь приближённо.

Схема соединений

Датчик обратной связи сообщает фактический выход; он не заменяет ограничение тока или аппаратный аварийный останов. Регулятор сравнивает уставку с отфильтрованным показанием датчика, а затем управляет исполнительным механизмом через ШИМ-каскад (PWM), рассчитанный на нагрузку.

Управляемые эксперименты

Читать о перерегулировании и намеренно получать его — не одно и то же. Каждый эксперимент ниже занимает несколько минут и изолирует ровно один эффект.

1. Найдите предельный коэффициент

Установите Ki и Kd в ноль. Увеличивайте Kp, пока выход не начнёт колебаться с постоянной амплитудой — не растущей и не убывающей. Запишите коэффициент (Ku) и период колебаний (Tu).

Для первой настройки достаточно этих двух чисел:

Введите эти значения и сравните. Классическая строка агрессивна и перерегулирует на 20–40%; вторая достигает цели без перерегулирования, но занимает больше времени. Ни одна из них не является «правильной» — это разные ответы на разные требования, в чём и состоит суть.

2. Посмотрите, как происходит накопление интеграла

Установите низкий предел исполнительного механизма — около 20% диапазона, — затем задайте большой ступенчатый скачок уставки. Посмотрите на график усилия управления: оно мгновенно насыщается и остаётся там, а интеграл продолжает накапливать ошибку, на которую не может повлиять. Когда выход наконец достигает уставки, накопленная интегральная составляющая разгружается, и система выходит далеко за цель.

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

3. Докажите, что контур убивает задержка, а не шум

Увеличивайте интервал дискретизации от минимального значения шагами, сохраняя коэффициенты. Качество отклика ухудшается задолго до того, как график станет шумным: перерегулирование растёт, затем появляются колебания, после чего система становится неустойчивой.

Поэтому удаление вызова delay() из цикла робота часто улучшает слежение сильнее любой настройки. Устаревшую информацию нельзя восстановить коэффициентом.

4. Подайте шум на производную

Увеличьте величину возмущения при Kd, равном нулю, затем увеличьте Kd. Траектория усилия управления становится рваной задолго до того, как это происходит с выходом, — вы наблюдаете, как дифференцирование усиливает высокочастотные составляющие, как и должно быть.

Именно такое поведение заставляет людей считать D бесполезным и обнулять его. Настоящее исправление — на входе контура: отфильтруйте измерение или саму производную.

Что следует наблюдать

Постоянное смещение при P и D без I стоит один раз получить намеренно. Это самый наглядный пример того, для чего на самом деле нужен интегральный член: пропорциональное действие требует ненулевой ошибки, чтобы вообще дать выход, поэтому выход неизбежно остаётся немного ниже уставки.

Переход к реальному оборудованию

Найденные здесь коэффициенты — это отправная точка, а не переносимое значение. Полностью переносится процедура; числа не переносятся, поскольку они описывают этот объект.

Последняя строка чаще всего вызывает путаницу на практике. Настройка, идеальная на свежих элементах питания, будет вялой на разряженных элементах питания, потому что та же команда теперь создаёт меньший момент. Это не сбой метода — коэффициенты являются свойствами объекта, а объект изменился. Профессиональные решения — контур скорости снизу или планирование коэффициентов. Пройдите руководство по настройке ПИД-регулятора для полной процедуры, а затем перейдите к лаборатории робота, следующего по линии, где объект начинает сопротивляться.