Контроль PID є загальним методом, що використовується в навігації мобільних роботів для підтримки бажаних шляхів і швидкості. Він регулює рухи роботи на основі різниці між бажаними і фактичними положеннями або онкостями. Ця стаття забезпечує покроковий процес розрахунку для застосування PID управління на мобільних роботах навігації.

Розуміння контролю PID

PID призначений для пропортаційних, інтегральних і деривативних. Ці три компоненти працюють разом з виправленням помилок в рухі роботи. Контрольний сигнал розраховується як:

Control Signal = Kp * помилка + Кі * інтеграція помилки + Kd * похідна помилки

Покроковий розрахунок

Поставляйте роботу, щоб слідувати прямій лінії в цільовому положенні 10 метрів. Поточна позиція становить 8 метрів. Параметри PID - Kp=1.0, Ki=0.1, Kd=0.05. Розрахунок триває наступним чином:

1. Розрахувати помилку:

error = цільова позиція - поточна позиція = 10 - 8 = 2 м

2. Розрахунок цілісності помилки за час. Припустимо, це перший розрахунок, інтеграція:

інтегральна = помилка * дельта = 2 * 1 = 2

3. Розрахувати похідну помилку. Припустимо, що попередня помилка склала 1,5 метрів, похідна:

деріватив = (error - попередня помилка) / дельта час = (2 - 1.5) / 1 = 0.5

4. Поповнити сигнал керування:

Control = (1.0 * 2) + (0.1 * 2) + (0.05 * 0.5) = 2 + 0.2 + 0.025 = 2.225

Застосування сигналу управління

Розрахований сигнал керування (2.225) регулює командами двигуна роботи для зменшення помилки. Процес повторюється в кожному кроці часу, безперервно переробляючи траєкторію роботи.

Ключові зауважень

Правильне тюнінг Кп, Ки та Кд є важливим для ефективного управління. Надвисокі значення можуть викликати коливання, при цьому низькі значення можуть призвести до повільного реагування. Регулярні налаштування забезпечують плавну навігацію.