Comment écrire un programme de commande de servomoteur : un guide complet étape par étape

Étape 1 : Connectez correctement le matériel

Avant tout code, établissez les connexions physiques :

Exemple de cas courant :Un débutant connecte souvent l’alimentation du servo directement à la broche 5 V du microcontrôleur. Lorsque le servo bouge, la carte se réinitialise en raison d'une surtension. La solution : utilisez une alimentation externe de 5 V (par exemple, 4 piles AA) avec une masse partagée.

Étape 2 : Écrivez le code d'initialisation

Chaque programme d'asservissement doit d'abord configurer les paramètres du signal PWM. Vous trouverez ci-dessous une structure de code générique (adaptable à tout environnement de type C) :

// 1. Définir des constantes (ne pas modifier ces valeurs) #define SERVO_PIN 9 #define PWM_FREQUENCY_HZ 50 // 50 Hz = période de 20 ms #define PULSE_MIN_US 1000 // 1,0 ms pour 0° #define PULSE_MID_US 1500 // 1,5 ms pour 90° #define PULSE_MAX_US 2000 // 2,0 ms pour 180°// 2. Fonction de configuration (s'exécute une fois à la mise sous tension)void setup() { // Configure la broche comme sortie pinMode(SERVO_PIN, OUTPUT); // Configurer le matériel PWM pour une impulsion initiale de 50 Hz et 1,5 ms (position centrale) configurePWM(SERVO_PIN, PWM_FREQUENCY_HZ, PULSE_MID_US); retard (1000); // Laisser le servo se stabiliser }// 3. Assistant : Convertir l'angle (0-180) en largeur d'impulsion en microsecondesint angleToPulse(int angle) { // Mappage linéaire : angle 0 -> 1000us, angle 180 -> 2000us return PULSE_MIN_US + (angle(PULSE_MAX_US - PULSE_MIN_US) / 180) ; }

Étape 3 : écrire la fonction de contrôle de base

La logique principale qui déplace le servo vers un angle spécifique :

// Déplacez le servo à un angle donné (0 à 180) et maintenez cette positionvoid setServoAngle(int angle) { // Angle de serrage dans la plage valide if (angle 180) angle = 180 ; int pulseWidthUs = angleToPulse(angle);// Génère un seul cycle de 20 ms avec l'impulsion haute spécifiéegeneratePulse(SERVO_PIN, pulseWidthUs); // Élevé pour pulseWidthUs microsecondes delayMicroseconds(pulseWidthUs); digitalWrite(SERVO_PIN,LOW); retard(20 - (pulseWidthUs / 1000.0)); // Reste de la période de 20 ms }

Note:LegénérerPulse()l'abstraction représente la manipulation directe du registre matériel. Dans des implémentations réelles, vous utiliseriez le périphérique PWM intégré du microcontrôleur ou une méthode logicielle de bit-banging.

Étape 4 : Rédigez un exemple de travail complet

Vous trouverez ci-dessous un programme complet qui balaie le servo de 0° à 180° et inversement, avec des délais pour observer le mouvement. Cet exemple utilise une approche bit-banging courante qui fonctionne sur n'importe quelle broche numérique.

// Code de travail complet (aucune bibliothèque requise, indépendante de la plate-forme) int servoPin = 9; non signé long précédentMicros = 0 ; int angle actuel = 0 ; int stepDirection = 1 ; // 1 = angle croissant, -1 = vide décroissant setup() { pinMode(servoPin, OUTPUT); // Commence à 90° (centre) currentAngle = 90; } void loop() { unsigned long currentMicros = micros(); // Actualise la position du servo toutes les 20 ms (50 Hz) if (currentMicros - previousMicros >= 20000) { previousMicros = currentMicros; // Envoie l'impulsion PWM pour l'angle actuel int pulseWidth = 1000 + (currentAngle 1000 / 180); // 1 000 us à 2 000 us digitalWrite (servoPin, HIGH ); delayMicroseconds(pulseWidth); digitalWrite (servoPin, FAIBLE); // Changer l'angle pour l'effet de balayage (facultatif) currentAngle += stepDirection; if (angleactuel >= 180) {angleactuel = 180 ; stepDirection = -1 ; retard (500); // Pause à l'extrême } else if (currentAngle

Étape 5 : Test et débogage des problèmes courants

Exemple de cas courant :Un utilisateur écrit du code qui envoie des impulsions toutes les 5 ms au lieu de 20 ms. Le servo reçoit des signaux trop rapidement, surchauffe et vibre. La solution consiste à assurer exactement 20 ms entre le début de chaque impulsion.