Como escrever um programa de controle de servo motor: um guia passo a passo completo

Etapa 1: Conecte o hardware corretamente

Antes de qualquer código, estabeleça as conexões físicas:

Exemplo de caso comum:Um iniciante geralmente conecta a alimentação do servo diretamente ao pino de 5V do microcontrolador. Quando o servo se move, a placa é reiniciada devido ao pico de corrente. A solução: use uma fonte externa de 5 V (por exemplo, 4 baterias AA) com aterramento compartilhado.

Etapa 2: Escreva o código de inicialização

Todo programa servo deve primeiro configurar os parâmetros do sinal PWM. Abaixo está uma estrutura de código genérica (adaptável a qualquer ambiente semelhante ao C):

// 1. Defina constantes (não altere esses valores) #define SERVO_PIN 9 #define PWM_FREQUENCY_HZ 50 // 50 Hz = período de 20 ms #define PULSE_MIN_US 1000 // 1,0 ms para 0° #define PULSE_MID_US 1500 // 1,5 ms para 90° #define PULSE_MAX_US 2000 // 2,0 ms para 180°// 2. Função de configuração (executada uma vez ao ligar)void setup() { // Configure o pino como saída pinMode(SERVO_PIN, OUTPUT); // Configure o hardware PWM para pulso inicial de 50 Hz e 1,5 ms (posição central) configurePWM(SERVO_PIN, PWM_FREQUENCY_HZ, PULSE_MID_US); atraso(1000); //Permite que o servo se estabilize }// 3. Auxiliar: Converta o ângulo (0-180) em largura de pulso em microssegundosint angleToPulse(int angle) { // Mapeamento linear: ângulo 0 -> 1000us, ângulo 180 -> 2000us return PULSE_MIN_US + (ângulo(PULSE_MAX_US - PULSE_MIN_US)/180); }

Etapa 3: Escreva a função de controle central

A lógica principal que move o servo para um ângulo específico:

// Move o servo para um determinado ângulo (0 a 180) e mantém essa posiçãovoid setServoAngle(int angle) { // Ângulo de fixação dentro do intervalo válido if (angle 180) angle = 180; int pulseWidthUs = ânguloToPulse(ângulo);// Gera um único ciclo de 20 ms com o pulso alto especificadogerarPulse(SERVO_PIN, pulseWidthUs); // Alto para microssegundos pulseWidthUs delayMicroseconds(pulseWidthUs); digitalWrite(SERVO_PIN,LOW); atraso(20 - (pulseWidthUs / 1000,0)); // Restante do período de 20 ms }

Observação:OgerarPulso()a abstração representa a manipulação direta do registro de hardware. Em implementações reais, você usaria o periférico PWM integrado do microcontrolador ou um método de software bit-banging.

Etapa 4: escreva um exemplo prático completo

Abaixo está um programa completo que varre o servo de 0° a 180° e vice-versa, com atrasos para observar o movimento. Este exemplo usa uma abordagem comum de bit banging que funciona em qualquer pino digital.

// Código funcional completo (sem necessidade de biblioteca, independente de plataforma) int servoPin = 9; sem sinal longo anteriorMicros = 0; int ânguloAtual = 0; int stepDirection = 1; // 1 = ângulo crescente, -1 = diminuição void setup() { pinMode(servoPin, OUTPUT); // Começa em 90° (centro) currentAngle = 90; } void loop() { unsigned long currentMicros = micros(); // Atualiza a posição do servo a cada 20 ms (50 Hz) if (currentMicros - previousMicros >= 20000) { previousMicros = currentMicros; // Envia o pulso PWM para o ângulo atual int pulseWidth = 1000 + (currentAngle 1000/180); // 1000us a 2000us digitalWrite(servoPin, HIGH); delayMicroseconds(pulseWidth); digitalWrite(servoPin, BAIXO); // Altera o ângulo do efeito de varredura (opcional) currentAngle += stepDirection; if (ângulo atual >= 180) { ângulo atual = 180; stepDirection = -1; atraso(500); // Pausa no extremo } else if (currentAngle

Etapa 5: teste e depuração de problemas comuns

Exemplo de caso comum:Um usuário escreve um código que envia pulsos a cada 5 ms em vez de 20 ms. O servo recebe sinais muito rápido, superaquece e vibra. A solução é garantir exatamente 20 ms entre o início de cada pulso.