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

Когда команды FIRST Tech Challenge (FTC) или школьники-робототехники сталкиваются с описанием ПИД-регулирования в документации, они часто видят знаки интегралов и производных, которые пугают любого, кто еще не изучал углубленный курс математики. На практике же код, исполняемый на роботе, не решает непрерывных дифференциальных уравнений. Он выполняет базовые арифметические действия раз в несколько миллисекунд. Как только учащиеся поймут физический смысл составляющих P, I и D, они смогут уверенно писать, настраивать и отлаживать контуры управления.

Главная идея: ошибка

Любой контур управления существует ради одной цели — свести к минимуму одно число: ошибку.

Ошибка — это просто Целевое значение - Текущее положение. Если манипулятор робота находится на 20 градусах, а должен быть на 90, ошибка равна +70. Если маховик должен вращаться со скоростью 2000 об/мин, но крутится на 2100 об/мин, ошибка равна -100. Каждая составляющая ПИД берет эту величину ошибки и преобразует ее в мощность мотора.

1. Пропорциональная составляющая (P): настоящее

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

Если вы ведете машину и сместились на пять метров левее центра полосы, вы делаете резкий поворот руля вправо. Если вы отклонились всего на два сантиметра, вы лишь слегка корректируете траекторию. В коде с математической точки зрения это просто kP * error.

Где одной лишь пропорциональной составляющей недостаточно:

• Перерегулирование и колебания: если kP слишком велик, робот разгоняется к цели настолько агрессивно, что по инерции проскакивает нужную точку. Затем он резко тянет назад, снова проскакивает цель и начинает сильно раскачиваться.
• Статическая ошибка: если kP слишком мал, то по мере уменьшения ошибки мощность мотора падает настолько, что не может преодолеть физическое трение или силу тяжести. Механизм подъема, удерживающий 500-граммовый захват, просто остановится на несколько сантиметров ниже цели, поскольку развиваемая мотором мощность сравняется с силой тяжести, и он заглохнет.

2. Дифференциальная составляющая (D): будущее (тормоз)

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

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

В коде: derivative = (current_error - previous_error) / time_elapsed. Когда робот стремительно приближается к цели, ошибка быстро уменьшается, из-за чего дифференциальная составляющая становится отрицательной и снижает мощность мотора еще до того, как произойдет проскок. D гасит колебания и позволяет использовать более высокий коэффициент P, не боясь разрушительной тряски робота.

3. Интегральная составляющая (I): прошлое (память)

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

Представьте, что вы толкаете тележку в гору. Вы толкаете (P), но гравитация останавливает вас прямо перед вершиной. Если вы стоите на месте пять секунд, не в силах добраться до верха, интегральная составляющая, по сути, заявляет: «Мы застряли здесь слишком надолго; добавь мощности, пока мы не преодолеем склон».

Подводный камень: интегральная составляющая опасна при неправильном использовании. Если манипулятор физически заклинит, интегральная сумма начнет бесконтрольно расти (явление, известное как «интегральное насыщение» или integral windup). Когда заклинивание устранится, мотор с огромной силой ударит механизм об упоры. В соревнованиях FTC и школьной робототехнике интеграл следует ограничивать лимитом накопителя или использовать только в узком диапазоне ошибки.

4-шаговый алгоритм настройки для мастерской

Не пытайтесь угадывать все три числа одновременно. Предложите учащимся следовать повторяемой последовательности настройки на полностью заряженном аккумуляторе (изменение напряжения меняет отклик моторов):

Распространенные ошибки в школьных роботах

• Шум датчиков: оптические энкодеры на шасси FTC обычно дают чистый сигнал, однако механический люфт может сбивать дифференциальную составляющую. Если в редукторе есть зазор, D будет реагировать на люфт механики, а не на реальное движение.
• Нестабильное время цикла: если код вашей команды выполняет фоновую обработку технического зрения в одном потоке с управлением, время цикла может непредсказуемо подскакивать с 10 мс до 80 мс, нарушая стандартные вычисления ПИД. Держите контуры управления изолированными и легковесными.
• Маховики и манипуляторы: управление скоростью (маховики) принципиально отличается от позиционирования (манипуляторы). В контурах управления скоростью составляющая D требуется редко, так как инерция системы уже работает как фильтр низких частот; для них лучше всего подходит базовое упреждающее управление (feedforward, kV) в сочетании с умеренными P и I.

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