Motrun Florin 334CA

Inca de mic copil am fost fascinat de lumea teleghidarii, mereu cumparand “masini cu telecomanda”, urmand mai apoi sa le dezasamblez, asa ca m-am decis sa-mi construiesc chiar eu una.

Proiectul constă în dezvoltarea unei mașini controlate la distanță, prin joystick sau accelerometru, si capabilitatea de self-drive, in care evita obstacole. Un aspect important este afișarea a diferite date înregistrate de mașină pe un ecran OLED al telecomenzii. De asemenea, pe telecomandă vor fi butoane pentru diferite functionalitati.

Ideea mi-a venit pentru ca in liceu am incercat sa fac o masina self-drive, insa din cauza ca nu aveam destule cunostinte in domeniu nu am reusit.

• Masina va fi controlata cu o telecomanda.
  
  
• Pe un ecran oled al telecomenzii se va afisa temperatura, umiditatea si intensitatea luminii prin I2C la apasare buton print, timp de 3 secunde in care masina se va opri; se va afisa tot timpul functionarii modul de condus, cel default fiind “Joystick mode”.
  
  
• In self-drive se va afisa automat temperatura, umiditatea, intensitatea luminii (updatate la fiecare 3 secunde) sau distanta unui obstacol la intalnire (timp de 3 secunde;nu se mai afiseaza senzor data); luminile se vor aprinde/stinge automat in functie de lumina mediului.
  
  
• Butoanele:
  • print: va afisa datele inregistrate;
  • lights: va aprinde/stinge luminile la apasare;
  • buzzer: cat timp este apasat masina va claxona;
  • joystick: va activa modul JOYSTICK;
  • gesture: va activa modul GESTURE(MPU6050);
  • self_drive: va activa modul de conducere automata al masinii(evitarea obstacolelor).
    
    
• Butoanele print, lights si buzzer sunt folosite doar in modurile JOYSTICK sau GESTURE.

• Mediu de dezvoltare: Arduino IDE.
  
  
• Librării folosite:
  • RF24.h: pentru comunicare radio dintre masina si telecomanda;
    
    
  • Telecomanda:
    • Wire.h - comunicare I2C;
    • MPU6050.h - accelerometru;
    • ezButton.h : pentru logica butoanelor;
    • Adafruit_GFX.h si Adafruit_SSD1306.h - oled.
      
      
  • Masina:
    • NewPing.h - sensor ultrasonic;
    • Servo.h - servomotor;
    • SimpleDHT.h - DHT11.
      
      
• Algoritmi:
  • Deplasare:
    • Pentru controlarea motoarelor se schimba rapid starea pinilor driver-ului de motor (motoarele sunt pornite secvential, cand unul cand altul, insa insesizabil pentru miscarea masinii) pentru a realiza tranzitii line, influentand impulsul si puterea motoarelor:
      • Schimabrea rapida creeaza un efect de PWM: motorul primeste impulsuri scurte de tensiune pentru controlul lin al vitezei, aceasta fiind constanta;
        
        
      • Aceasta crestere graduala a vitezei prin PWM reduce socurile initiale sau miscarile bruste, prevenind stresul mecanic si instabilitatea sistemului;
        
        
      • Cu semnalul PWM se moduleaza eficient tensiunea medie furnizata (tensiune maxima cand e activ; tensiune 0 cand e inactiv); aceasta comutare ajuta la controlul puterii efective livrate, fara a fi nevoie de sursa de putere variabila; astfel curentul de varf este gestionat in perioadele active fara a supraincalzi sau deteriora driverul motor.
        
        
  • Lumina:
    • Se convertește valoarea analogică citită de la senzor într-o tensiune de ieșire; se scaleaza valoarea analogică în intervalul adecvat pentru tensiunea de ieșire măsurată de senzor prin impartire la 204.6, obtinadu-se tensiunea corespunzătoare măsurată de senzor;
    • Se calculează rezistența senzorului de lumină pe baza tensiunii de ieșire;
    • Se utilizează rezistența calculată pentru a determina intensitatea luminii în unități de lux, folosind o formulă empirică specifică pentru senzor: lux=(R / -0.8616) ^ (1 / -0.8616) x 10 ^ (5.118 / -0.8616) , unde:
      • R = rezistenta calculata a senzorului;
      • coeficienții -0.8616 și 5.118 sunt constante empirice derivate din calibrarea senzorului.
        
        
  • Distanta:
    • Pentru a calcula distanta folosind HC-SR04 va fi utilizata formula: Viteza = 331.4 + 0.6 x Temperatura + 0.0124 x Umiditate;
    • Se calculeaza viteza sunetului cu formula de mai sus, apoi aflam durata in care unda calatoreste in microsecunde (care apoi va fi transformata in secunde) si la final se calculeaza distanta de la obstacol la senzor in centimetri.
      
      
  • Evitare obstacole:
    • Pentru evitarea obstacolelor in self drive atunci cand se intalneste un obstacol frontal, masina se opreste, da cu spatele apoi servo-ul pe care se afla senzorul de proximitate se invarte la 90 de grade spre stanga si spre dreapta, timp in care se calculeaza distantele spre eventualele obstacole din acele directii, si se alege directia de deplasare spre obstacolul cel mai indepartat (daca exista, daca nu, tot spre acea directie se deplaseaza).
      
      
  • MPU6050 si ecranul OLED vor comunica cu placuta Nano prin I2C.
    
    
• Funcţii implementate pentru modularizarea codului:
  • Telecomanda:
    • functii citire si trimitere coordonate pentru joystick si MPU6050: joystick() si accel();
    • functie afisare pe display: displayMode().
      
      
  • Masina:
    • functii pentru miscarea motoarelor: moveStop(), moveBackward(), moveForward(), turnLeft(), turnRight();
      
      
    • functii primire coordonate si executia logicii pentru JOYSTICK MODE si GESTURE MODE: joystick() si accel();
      
      
    • functii calculare date inregistrate de senzori: calculateLux() si getSensorData() (temperatura, umiditate, intensitate lumina);
      
      
    • functie ajutatoare folosita in logica de self-drive: calculateDistance();
      
      
      • calcularea distantei se face folosind unde si temperatura si umiditatea aerului;
        
        
    • functie pentru logica de self-drive: self_drive().

  5 mai: crearea paginii si descrierea generala a proiectului
  8 mai : am lipit pinii pentru OLED si MPU6050 si firele pentru motoare
  15 mai : am asamblat telecomanda
  16 mai : am terminat schemele pentru circuite
  17 mai : am asamblat masina
  24 mai : am facut ultimele modificari la cod

Export to PDF