Управление углом (PWM сигнал) — Язык аналоговых сервомашинок

PWM-управление сервоприводом — это классический протокол на доверии, превращающий однобитную временную информацию в точное механическое положение. Несмотря на свою аналоговую природу и ограничения, он остаётся lingua franca в хобби- и образовательной робототехнике в 2026 году благодаря своей простоте, универсальности и мгновенной понятности: «шире импульс — больше угол».

«Длина импульса напрямую кодирует целевой угол.»

• Принцип: Ширина импульса в микросекундах соответствует конкретному угловому положению.
• Протокол: Стандартный RC-сервопротокол (1-2 мс при 50 Гц).
• Аналогия: Длина ключа определяет, какой замок он откроет.
• Недостаток: Требует точного тайминга, чувствительно к джиттеру.

«Отклонение от нейтральной ширины задаёт направление и величину поворота.»

• Принцип: Импульс фиксированной частоты, где скважность определяет угол.
• Протокол: Некоторые цифровые сервоприводы (например, некоторые модели Dynamixel в аналоговом режиме).
• Аналогия: Смещение руля от центрального положения.
• Преимущество: Легче фильтровать шум.

«Импульсы для разных сервоприводов передаются последовательно в одном проводе.»

• Принцип: Последовательность импульсов разной ширины в одном кадре, где позиция импульса указывает на адрес сервопривода.
• Протокол: PPM (Pulse Position Modulation), используемый в старых радиоаппаратурах.
• Аналогия: Временные слоты в расписании.
• Современность: Вытеснена цифровыми шинами (UART, CAN), но остаётся в legacy-системах.

Сервопривод ожидает повторяющийся импульс с определёнными характеристиками:

• Частота повторения (Frame Rate): 50 Гц (период 20 мс). Исторически обусловлено характеристиками аналоговой RC-аппаратуры.
  • Допустимый диапазон: 40–200 Гц. Более высокая частота может повысить отзывчивость, но не все сервоприводы её поддерживают.
• Ширина импульса (Pulse Width): Активная часть сигнала, определяющая угол.
  • Нейтральное положение (Neutral): 1.5 мс ± допуск.
  • Минимальный угол (Typical): 1.0 мс (обычно соответствует -90° или 0°).
  • Максимальный угол (Typical): 2.0 мс (обычно соответствует +90° или 180°).
  • Расширенный диапазон (Many servos): 0.5 мс – 2.5 мс (для увеличения угла поворота до 270° и более).

Математика преобразования «ширина → угол»: Для линейной сервомашинки с диапазоном импульсов \([PW_{min}, PW_{max}]\) и угловым диапазоном \([\theta_{min}, \theta_{max}]\): \[ \theta_{target} = \theta_{min} + \frac{(PW - PW_{min}) \cdot (\theta_{max} - \theta_{min})}{PW_{max} - PW_{min}} \] где \(PW\) — ширина импульса в мкс, \(\theta\) — угол в градусах или радианах.

Важно: Это линейное преобразование по умолчанию. Многие сервоприводы имеют нелинейную механическую или электрическую характеристику, которую нужно учитывать калибровкой.

• Уровень напряжения: 3.3В или 5.0В (TTL/CMOS). Большинство хобби-сервоприводов рассчитаны на 5В, но прекрасно работают и от 3.3В микроконтроллеров.
• Ток управления: Незначительный (несколько мА). Основной силовой ток поступает по отдельной линии питания.
• Полярность: Импульс — положительный (высокий уровень). Низкий уровень между импульсами.

Идеальный сигнал (50 Гц, нейтраль):
Высокий |   _|   |_______________________|   |_______________________|
Уровень |  | |   |                       |   |                       |
Низкий  |__| |___|                       |___|                       |
         <--> <--------------------------->
         1.5мс           20 мс (период)
         [Импульс]        [Пауза]

Допуски (типичные):
- Джиттер импульса (jitter): ±1-2 мкс (критично для высокоточной работы).
- Дрейф частоты (frame rate drift): ±5% обычно допустимо.

Сигнальный провод (PWM Input)
         |
         v
+---------------------------------------------+
|         ДЕШИФРАТОР ИМПУЛЬСА                |
|  - Таймер/Счётчик для измерения ширины.    |
|  - Схема сравнения с опорным напряжением   |
|    (в аналоговых сервоприводах).           |
+---------------------------------------------+
         |
         v (Целевое напряжение, пропорциональное ширине)
+---------------------------------------------+
|      КОМПАРАТОР ОШИБКИ (Error Amplifier)   |
|  - Сравнивает целевое напряжение с         |
|    напряжением с потенциометра на валу.    |
|  - Выдаёт сигнал ошибки (+, -, 0).         |
+---------------------------------------------+
         |
         v (Усиленный сигнал ошибки)
+---------------------------------------------+
|        СИЛОВОЙ ДРАЙВЕР МОТОРА              |
|  - H-мост (чаще) или простой драйвер.      |
|  - Управляет направлением и мощностью      |
|    мотора в зависимости от знака ошибки.   |
+---------------------------------------------+
         |
         v (Мощность на мотор)
+---------------------------------------------+
| ДВИГАТЕЛЬ -> РЕДУКТОР -> ВЫХОДНОЙ ВАЛ      |
|  + ПОТЕНЦИОМЕТР (обратная связь) <---------+
+---------------------------------------------+

Ключевой момент: Это аналоговая система с пропорциональным управлением (не ПИД!). Скорость движения мотора примерно пропорциональна величине ошибки. Когда вал приближается к цели, напряжение с потенциометра сравнивается с целевым, ошибка уменьшается, мотор замедляется и в конце концов останавливается. Люфт и трение могут вызывать «дребезг» вокруг целевой позиции.

Плохая практика, но для понимания:

void setServoAngle_naive(uint8_t pin, float angle) {
    float pulse_us = map(angle, 0, 180, 1000, 2000); // Преобразование угла в мкс
    digitalWrite(pin, HIGH);
    delayMicroseconds(pulse_us);
    digitalWrite(pin, LOW);
    delay(20 - pulse_us/1000.0); // Ожидание оставшейся части периода (грубо)
}

Проблемы: Блокирует выполнение на 20 мс, джиттер из-за прерываний, низкая точность.

Современные МК (ESP32, STM32, RP2040, ATmega на 16 МГц) имеют таймеры, способные генерировать ШИМ с точной шириной импульса.

Концепция кода для 16-битного таймера (например, на AVR):

class HardwareServo {
private:
    volatile uint8_t* ocr_register; // Указатель на регистр сравнения (e.g., &OCR1A)
    uint16_t min_ticks, max_ticks;  // Границы в тиках таймера
    const uint16_t period_ticks;    // Период в тиках (для 50 Гц)

    // Преобразование микросекунд в тики таймера
    uint16_t usToTicks(float us) {
        float ticks = (us * F_CPU) / (prescaler * 1e6);
        return static_cast<uint16_t>(ticks);
    }

public:
    void init(uint8_t timer_channel, uint8_t pin) {
        // 1. Настройка пина как выход (например, PD5 для OC1A на ATmega328)
        pinMode(pin, OUTPUT);
        
        // 2. Настройка таймера в режиме Fast PWM, Top = ICR1 (или OCR1A)
        TCCR1A = (1 << COM1A1) | (1 << WGM11); // Non-inverting PWM, Fast PWM mode 14
        TCCR1B = (1 << WGM13) | (1 << WGM12) | (1 << CS11); // Prescaler = 8
        
        // 3. Установка периода для 50 Гц (16 МГц / 8 / 50 Гц = 40000 тиков)
        ICR1 = 40000 - 1; // Top value (период)
        
        // 4. Расчёт границ в тиках (1 мс и 2 мс)
        min_ticks = usToTicks(1000.0f); // 1 мс -> 2000 тиков при prescaler=8
        max_ticks = usToTicks(2000.0f); // 2 мс -> 4000 тиков
        ocr_register = &OCR1A; // Регистр сравнения для канала A
    }

    void setAngle(float angle_deg) {
        // Ограничение и преобразование угла в ширину импульса
        angle_deg = constrain(angle_deg, 0.0f, 180.0f);
        float pulse_us = 1000.0f + (angle_deg / 180.0f) * 1000.0f; // 1000-2000 мкс
        
        // Преобразование в тики и запись в регистр сравнения (атомарно)
        uint16_t ticks = usToTicks(pulse_us);
        ticks = constrain(ticks, min_ticks, max_ticks);
        *ocr_register = ticks;
    }
};

Для современных 32-битных МК (STM32, ESP32) всё проще:

// Пример для ESP32 с использованием LEDC (PWM) драйвера
ledcSetup(SERVO_CHANNEL, 50, 16); // 50 Гц, 16 бит разрешения
ledcAttachPin(SERVO_PIN, SERVO_CHANNEL);

void setAngleESP32(float angle) {
    const uint32_t min_us = 500;   // Расширенный диапазон
    const uint32_t max_us = 2500;
    uint32_t pulse_us = min_us + (angle / 180.0f) * (max_us - min_us);
    
    // Преобразование микросекунд в duty (0..2^resolution)
    uint32_t duty = (pulse_us * (1 << 16)) / (1000000 / 50); // период = 20000 мкс
    ledcWrite(SERVO_CHANNEL, duty);
}

Случайные вариации ширины импульса из-за прерываний, сборки мусора (в микропитоне) или неточных таймеров приводят к «дрожанию» сервопривода.

Решение 2026: Аппаратная генерация и буферизация.

• Выделенные PWM-генераторы: Использование чипов, специально предназначенных для генерации множества стабильных PWM-сигналов (например, PCA9685 по I²C). Он разгружает CPU и обеспечивает джиттер < 0.5 мкс.
• Двойная буферизация на таймерах: Современные таймеры (например, в STM32) имеют регистры сравнения с preload-регистром. Новое значение ширины записывается в фоновый регистр и автоматически применяется в начале следующего периода, избегая «разрыва» импульса.

При команде на крайнее положение (например, 0° или 180°) сервопривод упирается в механический ограничитель, но мотор продолжает пытаться повернуть вал, потребляя большой ток и производя характерный звук «визга». Это ведёт к перегреву и износу.

Решение: Программное ограничение диапазона и токовая защита.

class SafeServo {
    const float ANGLE_MIN = 5.0f;   // Не доходить до механического 0°
    const float ANGLE_MAX = 175.0f; // Не доходить до механического 180°
public:
    void setAngleSafe(float angle) {
        angle = constrain(angle, ANGLE_MIN, ANGLE_MAX);
        setAngleRaw(angle); // Вызов низкоуровневой функции
        // Дополнительно: мониторинг тока питания сервопривода (если возможно)
    }
};

Заявленный диапазон «1000–2000 мкс на 180°» часто не соответствует действительности из-за производственных допусков. Центр (нейтраль) также может смещаться.

Решение: Процедура калибровки с обратной связью.

1. Подать импульс 1500 мкс, считать фактический угол с внешнего датчика (например, компьютерного зрения или второго энкодера).
2. Подать импульсы на минимальном и максимальном ожидаемом угле, считать фактические углы.
3. Построить калибровочную кривую (полином 1-й или 2-й степени) и использовать её для преобразования «желаемый угол → ширина импульса».

Всё больше «сервоприводов» с PWM-интерфейсом на деле являются цифровыми устройствами с микроконтроллером внутри. Они принимают классический PWM-сигнал, оцифровывают его, а затем используют внутренний цифровой ПИД-регулятор и управление двигателем по ШИМ с частотой в десятки кГц. Это даёт более плавный ход, меньший нагрев и возможность настройки параметров через дополнительные интерфейсы (например, одиночный импульс особой длины для входа в режим конфигурации).

Устройства (например, на базе ESP32 или RP2040), которые по одной цифровой команде (UART, I²C) могут управлять 16 и более сервоприводами, генерируя для каждого идеальный PWM-сигнал. Они также могут выполнять сложные движения (слаженное изменение углов нескольких сервоприводов) по заранее загруженным траекториям, разгружая основной контроллер робота.

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

PWM-управление сервоприводом — это входные ворота в мир робототехники, но не её вершина.

1. Цифровые сервоприводы и шинные протоколы (UART, RS-485) — следующий шаг для увеличения скорости, точности и надёжности управления.
2. ПИД-регуляция и теория управления — чтобы понять, что происходит внутри сервопривода и как улучшить его поведение.
3. Силовые сервоприводы для высоких нагрузок — когда нужно двигать не модельный руль, а манипулятор весом в килограммы.
4. Интеграция сервоприводов в кинематические цепи — как координировать множество сервоприводов для движения руки или ноги робота.

Итог: В 2026 году PWM-протокол для сервоприводов — это устоявшийся, проверенный временем стандарт, идеально подходящий для образования, прототипирования и хобби. Его сила — в предельной простоте и совместимости. Однако для создания профессиональных, точных и надёжных робототехнических систем он уступает место цифровым шинам, которые обеспечивают не только управление, но и диагностику, конфигурацию и синхронизацию. Понимание работы PWM — это обязательный базис, с которого начинается путь к более сложным системам управления движением.