Advertisement
Guest User

Untitled

a guest
Mar 22nd, 2018
66
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.54 KB | None | 0 0
  1. //#include <Wire.h>
  2. //#include "rgb_lcd.h"
  3. #define capteurav A1
  4. #define capteurco A0
  5. #define capteurar A4
  6. #define MAVDR 9
  7. #define MARDR 10
  8. #define MAVGA 6
  9. #define MARGA 2
  10. #define ENAGA 3
  11. #define ENADR 5
  12.  
  13. void setup()
  14. {
  15. pinMode(capteurav,INPUT);
  16. pinMode(capteurco,INPUT);
  17. pinMode(capteurar,INPUT);
  18. Serial.begin(57600);
  19. }
  20.  
  21. void AvanceLignedroite()
  22. {
  23. digitalWrite(MAVGA,HIGH);digitalWrite(MAVDR,HIGH); //Activer marche avant des moteurs sur la carte moteurs
  24. digitalWrite(MARGA,LOW);digitalWrite(MARDR,LOW); //Desactiver marche arrière des moteurs sur la carte moteurs
  25. analogWrite(ENAGA,100);analogWrite(ENADR,100); //Reglage de l'intensité des moteurs
  26. }
  27.  
  28. void ArretDuVehicule();
  29. {
  30. digitalWrite(MAVGA,LOW);digitalWrite(MAVDR,LOW); //Desctiver marche avant des moteurs sur la carte moteurs
  31. digitalWrite(MARGA,LOW);digitalWrite(MARDR,LOW); //Desactiver marche arrière des moteurs sur la carte moteurs
  32. analogWrite(ENAGA,0);analogWrite(ENADR,0); //Reglage de l'intensité des moteurs
  33. }
  34.  
  35.  
  36. void loop() {
  37. if (analogRead(capteurav)< 152 ) // si voiture devant (-15cm)
  38. { ArretDuVehicule();
  39.  
  40. if (analogRead(capteurav)> 152 ) // si la voiture de devant a avancée
  41. { Avancelignedroite();
  42. }
  43. }
  44.  
  45. if (analogRead(capteurar)< 220 ) // si voiture derrière (-15cm)
  46. { ArretDuVehicule;
  47.  
  48. if (analogRead(capteurar)> 220 ) // si la voiture de devant a reculée
  49. { AvanceLigneDroite
  50. }
  51. }
  52.  
  53. Serial.println(analogRead(capteurco));
  54.  
  55. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement