Ioniță Dragoș 332CB, e-mail: dragos.ionita2303@stud.acs.upb.ro

Proiectul constă într-o mașinuță cu două motoare, cu senzori de viteză a rotației celor două motoare și capacitatea de a urma trasee predefinite la apăsarea unor butoane.

Pe parcursul traseului, mașinuța va fi capabilă să identifice obstacolele din fața sa și să le ocolească / să se oprească.

Mașina nu va fi controlată remote / bluetooth / wi-fi, ci va porni la apăsarea unuia din butoanele corespunzătoare pentru un traseu predefinit.

Ideea de la care am pornit a fost folosirea de senzori și întreruperi hardware pentru a crea ceva ce se aseamănă cât mai mult cu o mașină robot 'inteligentă'.

Mașina va fi pre-programată software pentru a urma orice traseu, pe orice direcție, cu viteze diferite, putând astfel simula 'coregrafii', urmând diverse pattern-uri și mișcări stânga-dreapta, înainte-înapoi, inclusiv rotiri în jurul propriei axe.

Senzorii vor fi conectați la motoare, pe șasiul mașinuței și vor măsura viteza de rotație a roților motoare.

Prin intermediul driverului L298N, se vor putea controla motoarele pentru a putea predefini traseele de urmat, iar distanțele și vitezele vor fi calculate cu ajutorul output-ului senzorilor și trimise către motoare prin intermediul driverului L298N.

Va exista si senzorul HC-SR04 ultrasonic pentru măsurarea distanței, care va fi montat în partea din față a mașinuței. Acesta va transmite distanța până la un eventual obstacol din față, iar mașinuța va reacționa, fie prin oprire și schimbarea direcției de mers, fie prin ocolirea acestuia și continuarea drumului.

• Plăcuță Plusivo compatibilă Arduino Uno https://ardushop.ro/ro/home/29-placa-de-dezvoltare-uno-r3.html?search_query=arduino+uno+plusivo&results=243
• Kit Șasiu Mașinuță Inteligentă cu 2 motoare cu angrenaje https://cleste.ro/sasiu-transparent-masina-inteligenta.html
  • 1 x șasiu auto
  • 2 x motoare cu angrenaje
  • 2 x roți
  • 2 x cleme fixare
  • 1 x roată universală
  • 1 x suport de baterii (bateriile nu sunt incluse)
  • Toate șuruburile și piulițele necesare
• Driver motoare (modul L298N cu punte H dublă) https://cleste.ro/modul-l298n-cu-punte-h-dubla.html
• Doi senzori fotoelectrici cu infraroșu L393M https://cleste.ro/senzor-fotoelectric-cu-infraro-u.html
• Senzor ultrasonic HC-SR04 https://cleste.ro/senzor-ultrasonic-hc-sr04.html
• 2 x condensator ceramic 10nF și 2 x condensator ceramic 3,3nF https://ardushop.ro/ro/electronica/714-condensator-ceramic-50v-2pf-220nf.html
• Breadboard mini pentru interconectare mai facilă https://cleste.ro/breadboard-mini-170-puncte.html
• 4 x baterii de 1.5V pentru motoarele mașinuței (4 x baterii clasice de 1,5 V)
• Baterie de 9V pentru alimentarea Arduino + conector pentru Arduino (baterie clasică Alkaline de 9V)
• Fire mamă-tată și tată-tată https://cleste.ro/10-x-fire-dupont-tata-tata-10cm.html și https://cleste.ro/10xfire-dupont-mama-tata-20cm.html
• Unul sau două push buttons https://cleste.ro/butoane-tactile-6x6x5mm.html
• Unul sau două led-uri https://cleste.ro/led-rgb-5mm-4pini.html

• Pistol de lipit (pentru firele alimentării motoarelor)
• Șuruburi și piulițe (1,5mm; 2mm; 2,5mm; 3mm) pentru fixarea tuturor componentelor pe șasiul de plexiglas
• Pistol cu super-glue (pentru fixarea senzorilor)
• Mini-bormașină (pentru a da găuri în șasiu, pentru o mai bună fixare a componentelor pe el)

• Mediu de dezvoltare și testare: Arduino IDE
• Planificare pași implementare și testare software:
  • 1. Senzorii fotoelectrici LM393
  • 2. Senzorul fotoelectric HC-SR04
  • 3. Driverele motoare L298N
  • 4. Implementarea pre-programării urmăririi traseelor
  • 5. Implementarea evitării obstacolelor, fie prin oprire și schimbarea direcției, fie prin ocolire

• 14 Mai 2021
  • Montare motoare și roata ajutătoare pe șasiu

• 16 Mai 2021
  • Comanda 2 x condensator ceramic de 10nF și 2 x condensator ceramic de 3,3nF
  • Montare senzori fotoelectrici LM393 și interfațarea acestora cu Arduino.
  • În urma testării acestora după cum se vede în următoarele videoclip-uri [4], roțile encodoare ale motoarelor ce conțin 20 de fante se învârt trecând printre stâlpii optocuplatorului H2010 al senzorului fotoelectric cu comparator LM393.
  • Conform specificațiilor motoarelor, la alimentarea acestora la 6V (am alimentat la 4 x baterii de 1,5V în videoclip), acestea se învârt la aproximativ 200-230 RPM.
  • După cum se vede în screenshot-urile atașate, senzorii măsoară mult mai mult, undeva la 2700-2800 RPM, calculat după formula

     RPM = (counter / diskslots) * 60.00 

    , unde counter este de câte ori se întrerupe fascicolul infraroșu al optocuplatorului, diskslots sunt numărul de fante din roțile encodoare ale motoarelor (20 în cazul meu), iar * 60.00 pentru a transforma in Rotații Pe Minut (RPM).

  • Diferența survine din cauza că senzorul cu comparator LM393 este foarte sensibil și, aparent, declanșează mult mai multe întreruperi pe RISING EDGE al semnalului digital OUT decât cele declanșate în mod real prin obstrucția razei infraroșii a optocuplatorului.
  • Acest senzor este foarte sensibil la interferențele care pot fi introduse între pinii VCC și GND. Dacă alimentăm senzorul de la Arduino cu 5V, regulatorul de tensiune al Arduino poate introduce curenți de fugă în senzor, ceea ce duce la declanșarea mult mai multor întreruperi pe rising edge al semnalului digital OUT (sursa: [3]).
  • În acest sens, am comandat condensatori ceramici de 3,3 si 10 nF, pentru a-i lipi între pinii GND și OUT ai senzorilor, pentru a netezi semnalele și a mitiga problema.

• 21 Mai 2021
  • Lipire condensatoare pe unul din senzori și testarea unui motor, dacă se ajunge cu măsurătorile la 200-230 RPM, valoarea optimă pentru motorul DC de 6V (video la link-ul [5]).
  • Comanda condensatoare ceramice mai mici, de 2 pF si de 10pF, în speranța că măsurătorile senzorilor vor fi cele bune, de 200-230 RPM, întrucât cu condensatoarele de 3,3 nF si de 10 nF, acestea dau aproximativ 450 RPM (cum se vede în link-ul [5]), dublu față de cât trebuiau să dea, însă un progres față de 2800 RPM, cât măsurau înainte de a folosi condensatoare (link-ul [4]).
  • Testare senzor ultrasonic de distanță HC-SR04, cu ajutorul librăriei New Ping, care ajută setup-ul software pentru măsurarea precisă a distanțelor (eroare de 1, 2 centrimetri, suprafețele folosite nu sunt perfect plane și nici senzorul nu este perfect perpendicular pe direcția normalelor acestora, însă este suficient de precis pentru scopul acestui proiect), video-ul la link-ul [6]. Codul folosit pentru calculul distanței măsurate de senzor este:

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);
 
void loop() {
  // put your main code here, to run repeatedly:
  duration = sonar.ping(); // get the duration between sending and receiving the signal on the sensor pins
 
  distance = (duration / 2) * 0.0343; // 343 m/s, speed of light, in transformed in cm/s
 
  Serial.print("Distance = ");
  if (distance >= 400 || distance <= 2) {
    Serial.println("OUT OF RANGE!\n");
  } else {
    Serial.print(distance);
    Serial.println(" cm");
    delay(500);
  }
  delay(500);
}

Pentru video-ul de la link-ul [4], pozele cu măsurătorile în urma demo-ului, unde se măsoară (eronat) 2800 RPM, din cauza curenților de fugă existenți în circuitul intern Arduino (nu folosisem condensatori pentru stabilizare aici):

Pentru video-ul de la link-ul [5], poza cu măsurătoarea îmbunătățită, de 450 RPM, pentru unul din motoare (dar încă eronate, față de referința de 200-230 RPM conform catalogului motoarelor). Aici am folosit condensatori de 10 nF. O posibilă îmbunătățire este folosirea unor condensatori de capacitate mai mică (pF):

Pentru video-ul de la link-ul [6], poza cu măsurătoarea distanței cu senzorul ultrasonic HC-SR04, pentru 30cm, 25cm, 20cm, 15cm și 10cm (rigla din video pentru referință). Se observa erori de 1, 2 cm când se stabiliează poziția senzorului pentru fiecare din cele 5 valori de mai sus:

https://ocw.cs.pub.ro/courses/pm/prj2021/avaduva/obstacleavoidingcar?do=export_pdf

[1] https://dbot.ws/rbtcar​

[2] https://dronebotworkshop.com

[3] http://androminarobot-english.blogspot.com/2017/03/encoder-and-arduinotutorial-about-ir.html

[4] https://youtu.be/5BZTMBUdEPs

[5] https://youtu.be/IS9QvN5y_8c

[6] https://youtu.be/H9Kglekphdg