Building a Robot That Can Follow a Line and Detect Crossings
Table of Contents
La construction d'un robot capable de naviguer de manière autonome sur une piste marquée par une ligne est un projet fondamental en robotique. Elle encapsule les principes fondamentaux de détection, d'action et de contrôle. Des véhicules guidés automatisés dans les entrepôts à l'aide de la garde des voies dans les voitures modernes, la technologie derrière un simple suiveur de ligne est hautement transférable. Ce guide couvre le processus complet de construction d'une ligne robuste suivant un robot capable de suivre une vitesse élevée et de détection fiable des intersections.
Architecture matérielle pour le suivi de ligne
Le choix du matériel approprié est un équilibre entre performance, coût et complexité. Un suiveur standard de ligne est constitué d'un microcontrôleur, d'un capteur, d'un conducteur de moteur, d'un châssis et d'une alimentation électrique. Chaque composant doit être choisi pour correspondre à la vitesse souhaitée et à la complexité de la piste.
Sélection du microcontrôleur
Le microcontrôleur (MCU) agit comme le cerveau du robot. Il lit les données du capteur, traite l'algorithme de contrôle et envoie des commandes aux moteurs. Arduino Nano est un choix populaire en raison de sa petite empreinte et de la puissance de traitement suffisante pour les boucles PID de base. Pour les projets nécessitant des fonctionnalités plus avancées comme la télémétrie Wi-Fi ou les algorithmes complexes de résolution de la labyrinthe, le ESP32 ou Adolescents 4,0 Les principales caractéristiques à prendre en considération sont le nombre de broches d'entrée analogiques (pour les tableaux de capteurs) et la résolution de modulation de largeur d'impulsion (PWM) pour le contrôle du moteur.
Intégration du conducteur de moteur
Les broches de sortie d'un microcontrôleur ne peuvent pas fournir suffisamment de courant pour conduire directement des moteurs à courant continu. L298N driver est peu coûteux et facile à utiliser, mais a une chute de haute tension, ce qui rend inefficace pour les robots alimentés par batterie. TB6612FNG pilote, qui offre MOSFET-based commutation pour une plus grande efficacité et une production de chaleur plus faible. Autres offre deux ponts H dans un emballage compact. Une sélection adéquate du conducteur assure un contrôle de vitesse fluide et empêche l'arrêt thermique pendant le fonctionnement prolongé.
Conception de l'array de capteur
Alors qu'un capteur infrarouge unique peut suivre une ligne, un ensemble de capteurs permet au robot de détecter la courbure et la position de la ligne avec une grande précision. Système de capteur IR à 8 canaux, comme le Pololu QTR-8A. Ces modules émettent une lumière infrarouge et mesurent l'intensité réfléchie. Une surface blanche reflète la majeure partie de la lumière, tandis qu'une ligne noire l'absorbe. En lisant les niveaux de tension analogique, le microcontrôleur peut déterminer le centre exact de la ligne.
L'espacement entre les capteurs détermine le rayon de virage minimal du robot; un espacement plus étroit permet des courbes plus serrées.
Châssis et alimentation électrique
Le châssis doit être rigide et léger. Un centre de gravité bas empêche le robot de basculer pendant les virages à grande vitesse. L'alimentation doit fournir une tension stable aux moteurs et aux circuits logiques. 7.4V Batterie LiPo (2S) est un choix commun. détendeur (comme le 7805) est utilisé pour fournir un 5V stable au microcontrôleur et aux capteurs. Le découplage des condensateurs placés près des bornes de moteur aide à supprimer le bruit électrique qui peut provoquer la remise à zéro du microcontrôleur.
Montage mécanique et câblage électrique
Un montage adéquat est essentiel pour la fiabilité. Le réseau de capteurs doit être monté parallèlement au sol à une hauteur d'environ 10-15 millimètres. Si les capteurs sont trop élevés, les interférences de la lumière ambiante augmentent; si trop bas, le robot peut gratter sur des voies inégales. Les roues doivent être solidement fixées aux arbres du moteur pour éviter tout glissement. Une roulette à l'avant ou à l'arrière maintient le robot équilibré.
Architecture de contrôle des logiciels
Le logiciel est l'endroit où le robot gagne de l'intelligence. Le programme doit lire des capteurs, calculer la position de la ligne, calculer une valeur de correction, et conduire les moteurs. Cette boucle fonctionne des centaines de fois par seconde pour maintenir un suivi en douceur.
Capteurs de lecture et d'étalonnage
Les capteurs analogiques produisent des valeurs entre 0 et 1023. Une ligne noire peut lire 800, tandis qu'une surface blanche en lit 200. Ces valeurs varient avec l'éclairage ambiant et la réflectivité de surface. routine d'étalonnage automatique Le robot balaye les capteurs sur la ligne et enregistre les valeurs minimales et maximales pour chaque capteur. Ces seuils sont stockés et utilisés pour normaliser les lectures de capteurs à une plage de 0-1000, rendant l'algorithme de contrôle indépendant des conditions d'éclairage.
Position de la ligne informatique
Après étalonnage, le logiciel calcule la position de la ligne à l'aide d'une formule moyenne pondérée:
Position = (Somme du poids du capteur * valeur du capteur) / (Somme des valeurs du capteur)
Ce calcul renvoie une valeur représentant le centre de la ligne. Pour un tableau de 8 capteurs, une ligne parfaitement centrée peut renvoyer une valeur de 3500. Si la ligne est à gauche, la valeur diminue. Ce signal d'erreur est l'entrée du contrôleur.
Bang-Bang contre contrôle PID
Un simple contrôleur "bang-bang" vérifie si l'erreur est positive ou négative et tourne les moteurs en conséquence. Cela entraîne un mouvement oscillatoire et scousse. Contrôleur PID L'algorithme PID utilise trois termes : Proportional (P) réagit à l'erreur actuelle, Integral (I) corrige pour biais systématique, et Derivative (D) prédit l'erreur future en fonction de son taux de changement. L'accord de ces trois constantes permet au robot de suivre la ligne avec un dépassement minimal.
Mise en œuvre d'un PID pour le suivi des lignes
La sortie PID est calculée et cartographiée en fonction des vitesses du moteur comme différentiel. La formule est:
Correction = (Kp * Erreur) + (Kd * dérivé) + (Ki * intégré)
Si le robot tourne à gauche, la valeur de correction est soustraite de la vitesse du moteur gauche et ajoutée à la vitesse du moteur droit. Le mouvement résultant est un arc lisse qui maintient le robot centré sur la ligne. L'environnement Arduino comprend une bibliothèque PID standard qui simplifie l'implémentation. Commencez par Kp, puis ajoutez Kd pour réduire le dépassement, et utilisez Ki avec parcimonie pour corriger la dérive.
Naviguer dans les jonctions et détecter les croisements
Une ligne suivant le robot devient vraiment fonctionnelle lorsqu'elle peut gérer des intersections. Un croisement se produit lorsque la ligne se croise avec une autre ligne ou branches perpendiculaires dans une jonction en T. La détection de celles-ci nécessite de surveiller l'ensemble du modèle de réseau de capteurs.
Conception de machines d'État
Une machine d'état permet au robot de se comporter différemment en fonction des entrées de capteur. Les états primaires sont:
- À l'annexe I, le paragraphe 2 est remplacé par le texte suivant: L'état normal de suivi de ligne en utilisant le contrôle PID.
- Junction détectée : Lorsque tous les capteurs (ou un sous-ensemble central) lisent le noir simultanément, un croisement est détecté.
- Mesures de franchissement : Le robot exécute un virage préprogrammé ou continue tout droit.
- Récupération: Le robot recherche la ligne si elle perd la piste après un virage.
La transition entre les états doit être chronométrée avec précision. Si le robot se déplace rapidement, il pourrait dépasser le croisement avant que la logique de détection ne s'active.
Effectuer des virages fiables
Pour ce faire, il faut utiliser uniquement des encodeurs de roues (déjà comptés) pour éviter de tomber sur les roues. Une méthode plus fiable consiste à utiliser le réseau de capteurs lui-même. Pour tourner à droite, le robot s'arrête, tourne le moteur droit en arrière et le moteur gauche en avant. Il surveille les capteurs latéraux jusqu'à ce qu'ils détectent la nouvelle ligne. Ce tour en boucle fermée assure que le robot s'arrête exactement à l'orientation correcte.
Unité de mesure inertielle (IMU) fournit une rétroaction absolue de l'angle pour des tours encore plus précis.
Cartographie et localisation des réseaux
Dans des applications avancées comme les concours de micro-souris, le robot utilise des croisements pour cartographier une grille. Chaque fois que le robot détecte un croisement, il incrémente un compteur de coordonnées. En stockant des informations sur les chemins ouverts, le robot peut explorer le labyrinthe et trouver le trajet le plus court en utilisant l'algorithme de remplissage de crue.
Étalonnage, réglage et optimisation
Un robot bien calibré est un robot fiable. Le processus d'accordage consiste à ajuster les seuils de capteur et les constantes PID.
La routine de calibration automatique
Au démarrage, le robot doit exécuter une boucle de calibration. L'utilisateur place les capteurs sur la ligne noire puis sur la surface blanche. Le microcontrôleur stocke les valeurs min et max. Ce processus prend moins d'une seconde et compense les changements dans l'éclairage ambiant ou la qualité des bandes réfléchissantes.
Tuning le boucle PID
Le gain proportionnel idéal pousse le robot vers le centre avec une force forte mais provoque un dépassement. Ensuite, augmentez le gain dérivé pour amortir l'oscillation. Le dérivé agit comme un absorbeur de choc, permettant des vitesses plus élevées sans instabilité. Enfin, ajoutez un petit gain intégral pour éliminer l'erreur d'état stable, comme dans les courbes longues et balayantes. La méthode Ziegler-Nichols fournit une approche systématique pour trouver ces valeurs.
Optimisation à haute vitesse
Pour maintenir la stabilité, la boucle de commande doit fonctionner plus rapidement. L'overclocking du microcontrôleur ou l'optimisation du code pour utiliser des mathématiques entières au lieu de point flottant peut sauver des microsecondes. De plus, la mise en œuvre d'un profil de vitesse qui ralentit le robot pendant les courbes pointues (contrôle de l'apparence) et accélère les sections droites permet des temps de tour beaucoup plus rapides que l'approche à vitesse constante.
Dépannage de problèmes communs
Même avec une conception solide, des problèmes peuvent se poser. Voici des solutions à des problèmes communs:
oscillation et dépassement
Si le robot zigzags sauvagement, le gain proportionnel est trop élevé, ou le gain dérivé est trop faible. Essayez de réduire le Kp de 30% et d'augmenter le Kd progressivement. Si le robot dérive de la ligne en courbes, le gain proportionnel peut être trop faible, ou la vitesse est trop rapide pour le rayon de courbe courant. Assurez-vous que le réseau de capteurs est suffisamment large pour détecter la courbe tôt.
Détection de ligne non cohérente
Si le robot perd la ligne de façon intermittente, vérifiez la hauteur du capteur et l'éclairage ambiant. Les lumières fluorescentes peuvent créer un clignotant 100/120Hz qui interfère avec les capteurs IR. Ajouter un filtre logiciel simple ou prendre plusieurs lectures et les moyennes peuvent aider.
Problèmes de stabilité de l'énergie
Lorsque les moteurs démarrent, ils tirent un grand courant d'inrush. Cela peut provoquer une baisse de tension qui réinitialise le microcontrôleur. Placez un grand condensateur (470uF ou plus) sur les bornes de puissance du moteur. Assurez-vous que le circuit logique dispose d'un régulateur de tension séparé.
Prochaines étapes et applications avancées
La maîtrise du suiveur de ligne de base ouvre la porte à des projets plus difficiles. L'ajout de modules Bluetooth ou Wi-Fi permet au robot de transmettre des données de télémétrie à un ordinateur pour analyse. L'utilisation de la technologie en ligne à la suite de concours vous pousse à optimiser la vitesse et la fiabilité contre d'autres robots. L'intégration d'une caméra à l'aide d'OpenCV permet au robot de suivre des lignes colorées ou de naviguer dans des environnements dynamiques. Documentation du capteur Pololu, les Bibliothèque de l'IDP d'Arduino, et des articles approfondis sur Théorie du contrôle de l'IDP La construction d'un robot est un cycle continu de tests, de débogage et d'amélioration, ce qui en fait l'une des expériences d'ingénierie les plus enrichissantes.