Advertisement
SageScroll18144

PrototypeLineF

May 26th, 2019
94
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. int dir[] = {8,9,10,11};
  2. int sen[] = {A1,A0};
  3.  
  4. void setup(){
  5.    for(int i = 0; i  < 4; i++){
  6.       pinMode(dir[i], OUTPUT);
  7.    }
  8.    for(int i = 0; i < 2; i++){
  9.       pinMode(sen[i], INPUT);
  10.    }
  11.    Serial.begin(9600);
  12. }
  13. void loop(){
  14.   Serial.print(analogRead(sen[0]));
  15.   Serial.print("\t");
  16.   Serial.println(analogRead(sen[1]));
  17.   if(analogRead(sen[0]) < 600 && analogRead(sen[1]) < 600){
  18.     motors(0,'F');
  19.     motors(1,'F');
  20.   }
  21.   else if(analogRead(sen[0]) < 600 && analogRead(sen[1]) > 600){
  22.     motors(0,'F');
  23.     motors(1,'B');
  24.   }
  25.   else if(analogRead(sen[0]) > 600 && analogRead(sen[1]) < 600){
  26.     motors(0,'B');
  27.     motors(1,'F');
  28.   }
  29. }
  30.  
  31. void motors(int motor, char sen){
  32.   if(sen == 'F'){
  33.     digitalWrite(dir[motor*2], HIGH);
  34.     digitalWrite(dir[(motor*2)+1], LOW);  
  35.   }
  36.   else if(sen == 'B'){
  37.     digitalWrite(dir[motor*2], LOW);
  38.     digitalWrite(dir[(motor*2)+1], HIGH);
  39.   }
  40. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement