Advertisement
makispaiktis

Arduino - Αμάξι: Οι κινήσεις ελέγχονται από console με chars

Apr 16th, 2019 (edited)
296
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #define in1 6
  2. #define in2 5
  3. #define in3 9
  4. #define in4 3
  5.  
  6.  
  7. //in1 high  in2 low mprosta (de3ia)
  8. //in4 high  in3 low mprosta (aristera)
  9.  
  10. void setup() {
  11.   // put your setup code here, to run once:
  12.   Serial.begin(9600);
  13.   pinMode(in1, OUTPUT);
  14.   pinMode(in2, OUTPUT);
  15.   pinMode(in3, OUTPUT);
  16.   pinMode(in4, OUTPUT);
  17.  
  18. }
  19.  
  20. void loop() {
  21.   // put your main code here, to run repeatedly:
  22.  
  23.   char c;
  24.  
  25.   if(Serial.available()) {
  26.    
  27.     c = Serial.read();
  28.    
  29.     if(c == '\n') {
  30.       digitalWrite(in1, LOW);
  31.       digitalWrite(in2, LOW);
  32.       digitalWrite(in4, LOW);
  33.       digitalWrite(in3, LOW);  
  34.     }
  35.     else {    
  36.       if(c == 'w') {
  37.         digitalWrite(in1, HIGH);
  38.         digitalWrite(in2, LOW);
  39.         digitalWrite(in4, HIGH);
  40.         digitalWrite(in3, LOW);
  41.       }
  42.       else if(c == 'a') {
  43.         digitalWrite(in1, LOW);
  44.         digitalWrite(in2, LOW);
  45.         digitalWrite(in4, HIGH);
  46.         digitalWrite(in3, LOW);
  47.       }
  48.       else if (c == 's') {
  49.         digitalWrite(in1, LOW);
  50.         digitalWrite(in2, HIGH);
  51.         digitalWrite(in4, LOW);
  52.         digitalWrite(in3, HIGH);
  53.       }
  54.       else if (c == 'd') {
  55.         digitalWrite(in1, HIGH);
  56.         digitalWrite(in2, LOW);
  57.         digitalWrite(in4, LOW);
  58.         digitalWrite(in3, LOW);  
  59.       }
  60.       else if(c == 'z') {
  61.         digitalWrite(in1, LOW);
  62.         digitalWrite(in2, HIGH);
  63.         digitalWrite(in4, HIGH);
  64.         digitalWrite(in3, LOW);
  65.       }
  66.       else if(c == 'x') {
  67.         digitalWrite(in1, HIGH);
  68.         digitalWrite(in2, LOW);
  69.         digitalWrite(in4, LOW);
  70.         digitalWrite(in3, HIGH);
  71.       }
  72.    
  73.       delay(1000);  
  74.     }
  75.    
  76.    
  77.   }
  78.  
  79.  
  80. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement