Artykuł przedstawia praktyczne zasady, kluczowe komponenty, procedury montażu oraz metody programowania potrzebne do zbudowania w pełni funkcjonalnego robota typu line follower.

Line follower to jeden z najłatwiejszych punktów wejścia do robotyki mobilnej i systemów autonomicznych, łączący mechanikę, elektronikę i oprogramowanie w spójnym projekcie edukacyjnym. Podstawowym celem takiego robota jest wykrywanie i autonomiczne podążanie po oznaczonej linii (zwykle czarnej na białym tle lub odwrotnie) przy minimalnej lub zerowej ingerencji człowieka, z możliwością pokonywania złożonych tras z różnymi prędkościami. Budowa line followera wymaga zrozumienia detekcji optycznej, systemów sterowania silnikami, programowania mikrokontrolerów oraz algorytmów teorii sterowania (PD, PID). Artykuł oferuje kompletną ścieżkę dla konstruktorów od poziomu początkującego po zaawansowany, kładąc nacisk na skuteczną kalibrację i strojenie sterowania.

Podstawowe zasady i koncepcje działania

Wykrywanie linii i czujniki optyczne

Trzon działania line followera opiera się na wykrywaniu różnic kontrastu między linią a otoczeniem. Odbiciowe czujniki optyczne (transoptory IR: emiter + fototranzystor) wysyłają światło podczerwone i mierzą jego odbicie od podłoża. Białe powierzchnie odbijają więcej światła (silniejszy sygnał), a czarne je pochłaniają (słabszy sygnał), co pozwala odróżnić linię od tła.

Klasyczne modele, takie jak CNY70 i TCRT5000L, oraz zintegrowane linijki QTR firmy Pololu zapewniają niezawodność i wygodę integracji. Umożliwiają jednoczesny odczyt wielu punktów, dzięki czemu mikrokontroler wyznacza pozycję linii względem osi robota, co jest kluczowe dla płynnego i szybkiego śledzenia trasy.

Dla szybkiego porównania najpopularniejszych rozwiązań zestaw czujników można opisać następująco:

Model Wyjście Liczba czujników Atuty Uwagi
CNY70 Analog 1 kompaktowy, tani, łatwy w montażu wymaga własnego toru wzmacniania/kalibracji
TCRT5000L Analog/Cyfrowe (z LM393) 1 dobra dostępność, moduły z potencjometrem progu wersje z komparatorem tracą informację analogową
Pololu QTR-8A / QTR-8RC Analog (A) / Cyfrowe czasowe (RC) 8 (skalowalne do 16) wysoka rozdzielczość położenia, biblioteki do Arduino wymaga starannej kalibracji i stabilnego zasilania

Podstawy działania i logika ruchu

Najprostszy line follower używa binarnego algorytmu decyzyjnego z dwoma czujnikami. Mimo prostoty taki układ potrafi stabilnie przejechać umiarkowanie złożone trasy i bardzo dobrze ilustruje pętlę sprzężenia zwrotnego.

Podstawowa pętla decyzyjna działa następująco:

  1. odczytaj stan lewego i prawego czujnika (linia: tak/nie);
  2. jeśli lewy wykrywa linię, skoryguj tor w lewo (zmniejsz moc lewego i/lub zwiększ prawego);
  3. jeśli prawy wykrywa linię, skoryguj tor w prawo; w przeciwnym razie jedź prosto.

Bardziej zaawansowane roboty korzystają z linijki wielu czujników i obliczają pozycję linii jako ważoną średnią odczytów. Daje to ciągłą informację o błędzie położenia i umożliwia sterowanie proporcjonalne, które wygładza tor jazdy i pozwala zwiększać prędkość bez utraty stabilności.

Kluczowe komponenty elektroniczne i architektura sprzętowa

Moduły czujników i systemy detekcji

Moduł czujnika odbiciowego integruje emiter IR i fototranzystor. W konfiguracji odbiciowej elementy sąsiadują, a światło wraca od podłoża do detektora. Prąd fototranzystora rośnie wraz z natężeniem odbitego promieniowania IR, co przekłada się na napięcie odczytywane przez mikrokontroler.

Standardowe moduły (TCRT5000L, CNY70) podłącza się do wejść analogowych. Typowo występuje dzielnik z rezystorem podciągającym (np. 100 kΩ), a odczyty wymagają kalibracji względem jasności emitera, czułości sensora i oświetlenia otoczenia. Przed startem należy wyznaczyć progi nad czernią i bielą, aby wiarygodnie odróżniać linię od tła.

Zaawansowane moduły z komparatorami, np. LM393, zamieniają sygnał analogowy na cyfrowy z progiem ustawianym potencjometrem. Upraszcza to logikę (wejścia cyfrowe zamiast ADC), ale kosztem precyzyjnej informacji analogowej potrzebnej do sterowania P/PD/PID.

Układy napędowe i sterowanie zasilaniem

Napęd najczęściej stanowią dwa niezależne silniki DC z przekładniami, które zapewniają wysoki moment przy kontrolowanej prędkości. Małe koła z oponami gumowymi o średnicy ~30–70 mm oferują dobrą trakcję i niskie opory.

Sterowanie prędkością realizuje się techniką PWM (modulacja szerokości impulsu), gdzie średnia moc zależy od wypełnienia impulsu. Częstotliwość ~10 kHz jest typowa i bezpieczna dla driverów oraz silników.

Kierunek i rozdział mocy kontroluje mostek H, np. L293D lub L298N, który przełącza polaryzację na zaciskach silnika i współpracuje z PWM. Najczęstsze tryby ruchu, które umożliwia mostek H, to:

  • jazda na wprost,
  • łuki z różnymi prędkościami kół,
  • skręty w miejscu (jedno koło w przód, drugie wstecz),
  • hamowanie aktywne przez zwarcie zacisków,
  • cofanie i szybkie przełączanie kierunków.

Diody flyback muszą odprowadzać przepięcia z indukcyjności silników, aby chronić sterowniki i mikrokontroler.

Platformy mikrokontrolerowe i systemy obliczeniowe

Mikrokontroler w pętli odczytuje czujniki, oblicza sterowanie i generuje sygnały dla silników. Najpopularniejsze wybory i ich atuty prezentują się następująco:

  • Arduino UNO (ATmega328) – niski koszt, bogate IDE i biblioteki, wystarczająca liczba pinów i wyjścia PWM do nauki i projektów hobbystycznych;
  • Arduino Mega2560 – więcej pamięci i pinów dla rozbudowanych linijek czujników oraz złożonych algorytmów;
  • STM32F103 / Pololu 32U4 – wyższe taktowanie, lepsze peryferia i łączność (USB, Bluetooth) do zastosowań turniejowych.

Montaż i metodyka budowy

Integracja komponentów krok po kroku

Budowę warto prowadzić etapami, od mechaniki po oprogramowanie, aby wcześnie wychwycić błędy i zminimalizować ryzyko przeróbek:

  1. zaprojektuj i przygotuj podwozie (cięcie laserowe, druk 3D, gotowe zestawy),
  2. zamontuj silniki i koła z dbałością o osiowość i symetrię,
  3. zamocuj linijkę czujników nisko nad podłożem (2–3 mm) i równolegle do podłogi,
  4. zaplanuj zasilanie: oddziel logikę od napędu, dodaj stabilizator LM7805 i kondensatory ~100 µF,
  5. połącz elektronikę (mostek H, mikrokontroler, czujniki), uruchom kalibrację i testy jazdy.

Bezpośrednie zasilanie silników z baterii (przez mostek H) zwykle daje lepszą dynamikę niż wspólny stabilizator dla całego systemu.

Prowadzenie przewodów i połączenia komponentów

Aby zapewnić odporność na zakłócenia i niezawodność połączeń, stosuj następujące praktyki:

  • separuj przewody sygnałowe od wysokoprądowych linii silników,
  • zapewnij wspólną masę dla wszystkich modułów i prowadź powroty prądów napędu osobno od mas sygnałowych,
  • skręcaj pary przewodów lub stosuj ekranowanie tam, gdzie to możliwe,
  • unikaj płytek stykowych w finalnym robocie – wybierz proste PCB lub płytki uniwersalne,
  • zabezpieczaj złącza przed wibracjami (klej na gorąco, opaski, koszulki termokurczliwe).

Jednowarstwowe PCB z przemyślanym rozmieszczeniem elementów upraszczają lutowanie i serwis, minimalizując wymagania warsztatowe.

Programowanie i algorytmy sterowania

Podstawowe struktury algorytmów

Oprogramowanie działa w pętli: odczyt czujników → obliczenie sterowania → wyjście na silniki. Sterowanie proporcjonalne ustala różnicę prędkości kół proporcjonalnie do błędu położenia linii. To prosta, skuteczna metoda znacząco wygładzająca tor jazdy względem logiki binarnej.

W systemach Arduino funkcja analogWrite() generuje PWM w zakresie 0–255, upraszczając sterowanie mostkiem H.

Poniższy szkic demonstruje minimalną pętlę sterowania PD z linijką czujników (pseudokod Arduino):


// odczyt pozycji linii (0 = skrajnie lewo ... 1000 = skrajnie prawo)
int pos = readLinePosition();
int error = pos - 500; // 500 = środek
int dError = error - prevError;

int control = Kp * error + Kd * dError; // regulator PD
prevError = error;

// bazowa prędkość i różnicowanie
int base = BASE_SPEED; // np. 120 (0..255)
int left = constrain(base - control, 0, 255);
int right = constrain(base + control, 0, 255);

// kierunek + PWM
setForward(); // ustaw mostek H na jazdę do przodu
analogWrite(PWM_LEFT, left);
analogWrite(PWM_RIGHT, right);

Implementacja sterowania pd

Regulator PD łączy natychmiastową korektę (P) z tłumieniem gwałtownych zmian (D). P dba o szybkie „dociągnięcie” do linii, a D ogranicza oscylacje i przeregulowania przy wyższych prędkościach.

Najtrudniejszym elementem jest empiryczne strojenie Kp i Kd. Charakterystyczne objawy nieoptymalnych ustawień wyglądają tak:

  • zbyt małe Kp – ospała reakcja, dryf od linii;
  • zbyt duże Kp – oscylacje, „zygzakowanie” i przeregulowania;
  • zbyt małe Kd – brak tłumienia, nadmierne kołysanie przy zakrętach;
  • zbyt duże Kd – ociężałość reakcji, spowolnienie korekt.

W praktyce zaczyna się od zwiększania Kp, aż robot stabilnie śledzi linię przy niskiej prędkości, a następnie podnosi Kd do momentu zniknięcia oscylacji przy wyższych prędkościach.

Pełne sterowanie pid

Regulator PID dodaje całkowanie (I) do kompensacji błędów systematycznych (np. asymetrie mechaniczne). Wymaga jednak ochrony przed „wind‑up”, czyli niekontrolowanym narastaniem składowej I. Popularne metody anty‑wind‑up:

  • integrator clamping – ograniczenie zakresu całki do bezpiecznych wartości;
  • back‑calculation – korekcja całki na podstawie różnicy między sygnałem nasyconym a nienasyconym;
  • conditional integration – wstrzymanie całkowania, gdy wyjście regulatora jest nasycone.

Kalibracja, testy i procedury optymalizacji

Metodyka kalibracji czujników

Poprawna kalibracja progów (czerń/biel) jest krytyczna dla niezawodności w zmiennym oświetleniu. Zalecana procedura wygląda następująco:

  1. zbierz odczyty minimalne i maksymalne, przesuwając robota od tła po linię,
  2. przeskaluj sygnały do ujednoliconego zakresu (np. 0–1000),
  3. zapisz wartości w pamięci robota i aktualizuj je przy starcie na torze,
  4. rozważ adaptacyjną kalibrację w trakcie jazdy (kompensacja zmian oświetlenia),
  5. zweryfikuj stabilność odczytów w miejscach łączeń taśmy i na łukach.

Weryfikacja i korekcja symetrii silników

Nawet przy starannym montażu pojawiają się asymetrie napędu, które skutkują zjazdem w jedną stronę przy równej mocy. Korekcję można wykonać na kilka sposobów:

  • sprzętowo: korekta osiowości, wymiana zużytych kół, wyrównanie promieni opon,
  • programowo: indywidualne ofsety PWM dla lewego i prawego silnika,
  • sprzężeniem z enkoderów: zamknięta pętla prędkości obu kół, która wyrównuje obroty.

Techniki optymalizacji wysokich prędkości

Sprzężenie zwrotne z enkoderów umożliwia dokładny pomiar prędkości i przewidywanie toru, co poprawia stabilność na łukach. Dodatkowo warto różnicować strategię jazdy na podstawie lokalnej krzywizny trasy (ostrzejsze zakręty = mniejsza prędkość, większe wzmocnienia; proste = wyższa prędkość, mniejsze wzmocnienia).

W aspekcie mechanicznym największy wpływ mają następujące czynniki:

  • odchudzona konstrukcja ograniczająca bezwładność,
  • wysokoprzyczepne opony zmniejszające poślizg,
  • zrównoważony rozkład masy dla równej trakcji,
  • dobre łożyskowanie i precyzyjne osie zmniejszające opory,
  • sztywność podwozia ograniczająca niepożądane drgania.

Praktyczne przykłady konstrukcji i warianty projektowe

Zestawy i projekty dla początkujących

Gotowe zestawy obniżają próg wejścia: zawierają proste moduły czujników, mikrokontroler (zwykle Arduino UNO), silniki DC z przekładniami i elementy mechaniczne. Instrukcje krok po kroku oraz materiały wideo ułatwiają montaż i pierwszą kalibrację.

Platformy średnio zaawansowane z integracją Arduino

Projekty na Arduino UNO lub Arduino Mega z wieloma czujnikami pozwalają przejść od logiki binarnej do sterowania P, PD i PID. Samodzielne strojenie Kp i Kd buduje intuicję działania pętli regulacji i znacząco skraca czas optymalizacji.

Konstrukcje klasy turniejowej o wysokiej wydajności

Roboty konkursowe stosują szybkie mikrokontrolery (STM32, Pololu 3pi), linijki 8–16 czujników, precyzyjne enkodery magnetyczne, własne zintegrowane PCB oraz pakiety Li‑Po. Mechanika jest lekka i sztywna, a algorytmy łączą regulację prędkości, kierunku i przewidywanie krzywizny toru.

Standardy zawodów i kontekst działania

Specyfikacja torów i zasady zawodów

Typowe tory składają się z powtarzalnych elementów i jasnych reguł:

  • linia: czarna taśma o szerokości ~19 mm na białym podłożu,
  • geometria: łagodne łuki, ostre zakręty 90°, proste do rozpędzania,
  • czas: limity przejazdu (np. 5 min eliminacje, 2 min finały),
  • autonomia: bez zdalnego sterowania i bez zapamiętywania trasy,
  • procedura: powrót na tor w pobliże miejsca wypadnięcia, jeśli to nastąpi.

Ograniczenia regulaminowe i optymalizacja projektu

Najczęściej obowiązują limity wymiarów (np. obrys A4: 210 × 297 mm) i wymogi bezpieczeństwa (zakaz nietypowych napędów). Brak możliwości „uczenia” trasy wymusza reagowanie wyłącznie na bieżące dane sensoryczne, co premiuje dobrą kalibrację i solidny regulator.

Wnioski i perspektywy rozwoju

Line follower to idealny start w autonomicznej robotyce mobilnej – łączy prostą mechanikę z realnymi wyzwaniami z zakresu elektroniki i sterowania. Skuteczny projekt wynika z synergii: precyzji mechaniki, poprawnej architektury zasilania, rzetelnej kalibracji czujników i dobrze zestrojonych algorytmów.

Najważniejsze kierunki rozwoju obejmują:

  • rozszerzoną sensorykę (IMU, enkodery) dla lepszej estymacji stanu,
  • łączność bezprzewodową (Bluetooth) do telemetrii i szybkiego debugowania,
  • algorytmy adaptacyjne i elementy uczenia maszynowego do automatycznej optymalizacji parametrów,
  • optymalizację mechaniki (masa, sztywność, trakcja) pod większe prędkości,
  • lepsze zarządzanie energią i stabilność zasilania przy dużych prądach.

Rozpocznij od prostej konstrukcji (2 czujniki, logika binarna), a następnie przechodź do wieloczujnikowego sterowania P/PD i – w razie potrzeby – PID z enkoderami.