Advertisement
Guest User

Untitled

a guest
Nov 21st, 2019
102
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.16 KB | None | 0 0
  1. #define md1  1
  2. #define md2  2
  3. #define mg1  3
  4. #define mg2  4
  5. #define enD  10
  6. #define enG  9
  7. void setup() {
  8.   // put your setup code here, to run once:
  9.  
  10. pinMode(md1,OUTPUT);
  11.  pinMode(md2,OUTPUT);
  12.  pinMode(mg1,OUTPUT);
  13.  pinMode(mg2,OUTPUT);
  14.  pinMode(enD,OUTPUT);
  15.  pinMode(enG,OUTPUT);
  16. }
  17. void marcheav() {
  18.   digitalWrite(md1,1);digitalWrite(md2,0);//sens avant moteur droite
  19.  digitalWrite(mg1,1);digitalWrite(mg2,0);//sens avant moteur gauche
  20.  analogWrite(enD,70);//pwm vitesse 70 moteur D
  21.  analogWrite(enG,70);//pwm vitesse 70 moteur G
  22.   }
  23. void gauche90deg () {
  24.  
  25.   digitalWrite(md1,1);digitalWrite(md2,0);//sens avant moteur droite
  26.  digitalWrite(mg1,1);digitalWrite(mg2,1);//stop moteur gauche
  27.  analogWrite(enD,70);//pwm vitesse 70 moteur D
  28.   }
  29.  
  30. void droite90deg () {
  31.  
  32.   digitalWrite(mg1,1);digitalWrite(mg2,0);//sens avant moteur gauche
  33.  digitalWrite(md1,1);digitalWrite(md2,1);//stop moteur droite
  34.  analogWrite(enG,70);//pwm vitesse 70 moteur G
  35.   }
  36. void stp() {
  37.   digitalWrite(md1,1);digitalWrite(md2,1);//stop md
  38.   digitalWrite(mg1,1);digitalWrite(mg2,1);//stop mg
  39.  
  40.   }
  41.  
  42. void loop() {
  43.   // put your main code here, to run repeatedly:
  44.  
  45. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement