Ce face

Robotul meu linefollower este un dispozitiv autonom care urmărește linii trasate pe suprafețe prin intermediul unei matrice de 5 senzori infraroșu. Folosind placa Arduino UNO ca unitate centrală de procesare, robotul detectează linia de sub el și controlează două motoare DC prin intermediul driverului L298N pentru a se menține pe traseu. Construcția sa robustă, cu șasiul imprimat 3D personalizat, îi conferă durabilitate, în timp ce utilizarea chederului lipit pe roți asigură o aderență sporită la suprafață, prevenind alunecarea pe parcursul traseelor.

Care este scopul lui

Scopul principal al acestui robot este să demonstreze principiile de bază ale roboticii autonome și să ofere o platformă educațională pentru înțelegerea controlului de mișcare bazat pe feedback-ul senzorilor. Robotul este proiectat să parcurgă cu precizie trasee complexe la viteze optime, fiind capabil să navigheze prin curbe, intersecții și segmente drepte fără intervenție umană.

Care a fost ideea de la care am pornit

Ideea inițială a proiectului a pornit de la dorința mea de a crea un robot accesibil ca nivel de complexitate, dar suficient de performant pentru a fi competitiv. Am ales configurația cu 5 senzori IR pentru a avea un echilibru între precizie și simplitate, iar pentru alimentare am implementat soluția cu două baterii de 9V conectate pentru a asigura o capacitate energetică sporită și autonomie extinsă. Șasiul imprimat 3D l-am proiectat special pentru acest robot, optimizând distribuția greutății și poziționarea componentelor pentru stabilitate maximă, iar adăugarea chederului pe roți a venit ca soluție inovatoare pentru îmbunătățirea tracțiunii pe orice tip de suprafață.

De ce cred că este util pentru alții și pentru mine

Pentru mine, acest proiect reprezintă o oportunitate excelentă de a aplica practic cunoștințele de programare, electronică și design 3D într-un sistem integrat. Procesul de optimizare a codului pentru a face robotul mai eficient și mai precis mi-a dezvoltat abilitățile de rezolvare a problemelor și gândirea analitică.

Pentru alții, robotul meu oferă:

• O platformă educațională ideală pentru începători în robotică și electronică
• Un exemplu practic de implementare a sistemelor de control în buclă închisă
• O bază solidă care poate fi adaptată și extinsă pentru proiecte mai complexe
• Inspirație pentru explorarea designului 3D în aplicații practice
• Un model funcțional care demonstrează cum soluțiile simple (precum utilizarea chederului pentru aderență) pot îmbunătăți semnificativ performanța

Arduino UNO

Descriere: Microcontroler bazat pe ATmega328P care servește ca unitate centrală de procesare. Interacțiune: Primește date de la senzorii IR prin conexiuni GPIO (D2-D4, D7, D12), procesează informația și transmite comenzi de direcție prin GPIO (D8-D11) și viteză prin PWM (D5, D6) către driverul de motor. Comunică cu PC-ul prin UART (D0, D1) pentru debugging. Primește alimentare de 5V de la driverul L298N.

Driver Motor L298N

Descriere: Driver dual H-bridge pentru controlul independent al celor două motoare DC. Interacțiune: Primește semnale de control logic (IN1-IN4) și PWM (ENA, ENB) de la Arduino pentru a controla direcția și viteza motoarelor. Furnizează tensiune de 5V către Arduino și transformă semnalele logice în curenți de putere pentru motoare prin ieșirile OUT1-OUT4. Este alimentat cu 12V de la baterii.

Matrice IR cu 5 Canale

Descriere: Set de 5 senzori infraroșu pentru detectarea liniei negre pe fundal deschis. Interacțiune: Trimite semnale digitale către Arduino (OUT1-OUT5) indicând poziția liniei față de robot. Primește alimentare de 5V de la Arduino.

Motoare DC (2)

Descriere: Motoare de curent continuu pentru propulsia robotului. Interacțiune: Primesc semnale de alimentare și control de la driverul L298N prin ieșirile OUT1-OUT4, transformând semnalele electrice în mișcare mecanică. Sunt echipate cu chedere lipite pe roți pentru aderență îmbunătățită. Baterii 2x9V Descriere: Sursă de alimentare pentru întregul sistem, oferind autonomie extinsă. Interacțiune: Furnizează 12V către driverul L298N pentru alimentarea motoarelor și 5V pentru circuitele logice.

PC

Descriere: Computer utilizat pentru debugging și monitorizare. Interacțiune: Comunică cu Arduino prin conexiune UART (serial) pentru a primi date de diagnostic și a trimite comenzi de test.

Șasiu Imprimat 3D

Descriere: Structură fizică a robotului realizată prin imprimare 3D. Interacțiune: Integrează toate modulele electronic într-un design compact și robust, permițând poziționarea optimă a senzorilor IR față de suprafață. Sistemul funcționează în buclă închisă: senzorii IR detectează poziția liniei, Arduino procesează aceste date și calculează corecțiile necesare, apoi trimite comenzi către driverul motor pentru a ajusta direcția și viteza robotului, menținându-l astfel pe traseul dorit.

Listă de Componente

Arduino UNO

• Descriere: O placă microcontroler bazată pe ATmega328P.
• Pini: UNUSED, IOREF, Reset, 3.3V, 5V, GND, Vin, A0, A1, A2, A3, A4, A5, SCL, SDA, AREF, D13, D12, D11, D10, D9, D8, D7, D6, D5, D4, D3, D2, D1, D0.

Driver de Motor DC L298N

• Descriere: Un driver de motor cu punte H dublă care permite controlul a două motoare DC.
• Pini: OUT1, OUT2, 12V, GND, 5V, OUT3, OUT4, 5V-ENA-JMP-I, 5V-ENA-JMP-O, +5V-J1, +5V-J2, ENA, IN1, IN2, IN3, IN4, ENB.

Motor DC (x2)

• Descriere: Motoare DC standard utilizate pentru propulsia robotului.
• Pini: pin 1, pin 2.

Matrice IR cu 5 Canale

• Descriere: O matrice de senzori infraroșu utilizată pentru detectarea liniilor de pe sol.
• Pini: OUT5, OUT4, OUT3, OUT2, OUT1, 5V, GND.

Baterie de 9V (x2)

• Descriere: Sursă de alimentare pentru circuit.
• Pini: -, +.

Mufă Universală Tip Baril (tată)

• Descriere: Conector pentru sursa de alimentare.
• Pini: Power Out, V+, V-.

Detalii de Cablare

Arduino UNO

• 5V: Conectat la 5V al Matricei IR cu 5 Canale.
• GND: Conectat la GND al Matricei IR cu 5 Canale.
• D2: Conectat la OUT1 al Matricei IR cu 5 Canale.
• D3: Conectat la OUT2 al Matricei IR cu 5 Canale.
• D4: Conectat la OUT3 al Matricei IR cu 5 Canale.
• D7: Conectat la OUT4 al Matricei IR cu 5 Canale.
• D12: Conectat la OUT5 al Matricei IR cu 5 Canale.
• D5: Conectat la ENB al Driverului de Motor DC L298N.
• D6: Conectat la ENA al Driverului de Motor DC L298N.
• D8: Conectat la IN4 al Driverului de Motor DC L298N.
• D9: Conectat la IN3 al Driverului de Motor DC L298N.
• D10: Conectat la IN2 al Driverului de Motor DC L298N.
• D11: Conectat la IN1 al Driverului de Motor DC L298N.

Driver de Motor DC L298N

• GND: Conectat la V- al Mufei Universale Tip Baril (tată) și - al ambelor Baterii de 9V.
• 5V: Conectat la V+ al Mufei Universale Tip Baril (tată).
• 12V: Conectat la + al ambelor Baterii de 9V.
• OUT1: Conectat la pinul 2 al primului Motor DC.
• OUT2: Conectat la pinul 1 al primului Motor DC.
• OUT3: Conectat la pinul 2 al celui de-al doilea Motor DC.
• OUT4: Conectat la pinul 1 al celui de-al doilea Motor DC.

Motoare DC

• Primul Motor DC:
  • pin 1: Conectat la OUT2 al Driverului de Motor DC L298N.
  • pin 2: Conectat la OUT1 al Driverului de Motor DC L298N.
• Al Doilea Motor DC:
  • pin 1: Conectat la OUT4 al Driverului de Motor DC L298N.
  • pin 2: Conectat la OUT3 al Driverului de Motor DC L298N.

Matrice IR cu 5 Canale

• 5V: Conectat la 5V al Arduino UNO.
• GND: Conectat la GND al Arduino UNO.
• OUT1: Conectat la D2 al Arduino UNO.
• OUT2: Conectat la D3 al Arduino UNO.
• OUT3: Conectat la D4 al Arduino UNO.
• OUT4: Conectat la D7 al Arduino UNO.
• OUT5: Conectat la D12 al Arduino UNO.

Baterii de 9V

• -: Conectat la V- al Mufei Universale Tip Baril (tată) și GND al Driverului de Motor DC L298N.
• +: Conectat la 12V al Driverului de Motor DC L298N.

Pentru acest proiect am optat pentru o abordare minimalistă, folosind doar Arduino.h ca bibliotecă principală. Această alegere a fost motivată de:

• Simplicitate și performanță: Evitarea dependențelor externe reduce overhead-ul și îmbunătățește timpul de răspuns al sistemului
• Control direct asupra hardware-ului: Accesul direct la funcțiile Arduino oferă control precis asupra pin-ilor digitali și PWM
• Stabilitate: Cod mai puțin predispus la erori cauzate de conflicte între biblioteci
• Optimizare pentru microcontrolere: Codul este optimizat pentru resursele limitate ale Arduino-ului

Principalul element inovator al proiectului constă în implementarea unui filtru low-pass pe eroarea PID:

error = error * 0.4 + input * 0.6;

Această abordare oferă:

• Reducerea zgomotului: Filtrarea fluctuațiilor bruște ale senzorilor
• Stabilitate îmbunătățită: Mișcări mai line ale robotului
• Adaptabilitate: Posibilitatea de fine-tuning prin modificarea coeficienților (0.4/0.6)

Un alt aspect inovator este sistemul de detectare a cazurilor speciale pentru diferite configurații ale senzorilor, cu tratare separată pentru intersecții și pierderea liniei.

Funcționalitățile implementate sunt direct derivate din conceptele de laborator:

• Proporțional (KP=17.00): Corecție bazată pe eroarea curentă
• Derivativ (KD=600.00): Anticiparea schimbărilor pentru stabilitate
• Integral (KI=0.00): Dezactivat pentru evitarea oscilațiilor în acest caz specific

• PWM pentru viteza: Utilizarea analogWrite pentru control precis
• Control direcțional: Utilizarea pin-ilor digitali pentru forward/backward
• Maparea valorilor: Conversie din procentaj (-100 la 100) în valori PWM (0-255)

• Array de 5 senzori: Configurație standard pentru detectarea precisă a liniei
• Logică inversată: !digitalRead() pentru adaptarea la tipul de senzor utilizat

┌─────────────────┐    ┌──────────────┐    ┌─────────────────┐
│  Senzori Linie  │───▶│ Algoritm PID │───▶│   Motoare DC    │
│   (5 senzori)   │    │              │    │ (Stânga/Dreapta)│
└─────────────────┘    └──────────────┘    └─────────────────┘

1. Inițializare (setup()):
   • Configurarea pin-ilor pentru motoare și senzori
   • Setarea orientării motoarelor
   • Inițializarea comunicației seriale

1. Bucla principală (loop()):
   • Citirea valorilor de la senzori
   • Calculul erorii de poziție
   • Aplicarea algoritmului PID
   • Ajustarea vitezei motoarelor

• Testarea senzorilor: Funcția SerialLineAnalyzer() permite monitorizarea în timp real
• Calibrarea PID: Constante ajustabile pentru fine-tuning
• Debugging: Output serial pentru verificarea valorilor

Pentru acest proiect am utilizat CLion IDE în combinație cu PlatformIO, o alegere motivată de următoarele avantaje:

• IntelliSense avansat: Autocompletare inteligentă și detecția erorilor în timp real
• Debugging integrat: Posibilitatea de debug pas cu pas pentru identificarea problemelor
• Refactoring tools: Restructurarea facilă a codului pentru optimizare
• Git integration: Control versiuni integrat pentru managementul modificărilor

• Managementul dependențelor: Gestionarea automată a bibliotecilor și framework-urilor
• Suport multi-platformă: Compatibilitate cu diverse tipuri de microcontrolere
• Build system optimizat: Compilare rapidă și eficientă
• Library manager: Acces facil la biblioteca vastă de componente Arduino

; platformio.ini
[env:uno]
platform = atmelavr
board = uno
framework = arduino
monitor_speed = 9600

Această combinație oferă:

• Productivitate crescută: Mediu profesional de dezvoltare
• Debugging eficient: Identificarea rapidă a problemelor
• Managementul dependencies: Evitarea conflictelor de versiuni
• Scalabilitate: Posibilitatea de extindere pentru proiecte mai complexe

1. Maparea pozițiilor: Fiecare combinație de senzori este mapată la o valoare specifică:
   • Centru (00100): valoare 0
   • Stânga extremă (10000): valoare -6
   • Dreapta extremă (00001): valoare +6

1. Modificatorul nearLineModifier (0.50):
   • Reduce sensibilitatea pentru pozițiile apropiate de centru
   • Evită corecțiile bruște pentru deviații mici

1. Tratarea cazurilor speciale:
   • Intersecții (11111, 01110): Păstrarea ultimei valori valide
   • Curbe strânse (11100, 00111): Valori extreme pentru rotire rapidă

// Testare individuală a senzorilor
lineSensorModule.SerialLineAnalyzer("every sensor");
 
// Monitorizare completă
lineSensorModule.SerialLineAnalyzer("all");

• Unde: În funcția PID()
• De ce: Reducerea zgomotului de la senzori
• Cum: error = error * 0.4 + input * 0.6;

• Unde: errorInt = constrain(error + errorInt, -20, 20);
• De ce: Prevenirea wind-up-ului integratorului
• Cum: Limitarea valorii cumulate între -20 și 20

• Unde: Structurile motor și lineSensor
• De ce: Organizarea logică a codului și reutilizarea
• Cum: Encapsularea funcționalităților în metode specifice

• Unde: Metoda setPower() din structura motor
• De ce: Conversie directă din procente în valori PWM
• Cum: Utilizarea funcției map() și constrain()

• Unde: Metoda noDetection()
• De ce: Păstrarea comportamentului predictibil când linia se pierde
• Cum: Returnarea ultimei valori valide în loc de 0

Proiectul implementează un sistem robust de urmărire a liniei cu:

• Control PID optimizat cu filtru low-pass
• Senzoristica redundantă cu 5 senzori
• Gestionarea cazurilor speciale pentru intersecții și curbe
• Arhitectură modulară pentru ușurința în dezvoltare și debug

Rezultatul este un robot stabil și predictibil, capabil să urmărească trasee complexe cu precizie ridicată.

linefollower.zip

• Robotul urmărește linia neagră pe fundal alb
• La intersecții, utilizează ultima valoare validă pentru a continua
• Viteza de bază este 40% din capacitatea maximă pentru stabilitate
• Corecțiile PID sunt vizibile prin mișcările de ajustare ale robotului