Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- int dir[] = {8,9,10,11};
- int sen[] = {A1,A0};
- void setup(){
- for(int i = 0; i < 4; i++){
- pinMode(dir[i], OUTPUT);
- }
- for(int i = 0; i < 2; i++){
- pinMode(sen[i], INPUT);
- }
- Serial.begin(9600);
- }
- void loop(){
- Serial.print(analogRead(sen[0]));
- Serial.print("\t");
- Serial.println(analogRead(sen[1]));
- if(analogRead(sen[0]) < 600 && analogRead(sen[1]) < 600){
- motors(0,'F');
- motors(1,'F');
- }
- else if(analogRead(sen[0]) < 600 && analogRead(sen[1]) > 600){
- motors(0,'F');
- motors(1,'B');
- }
- else if(analogRead(sen[0]) > 600 && analogRead(sen[1]) < 600){
- motors(0,'B');
- motors(1,'F');
- }
- }
- void motors(int motor, char sen){
- if(sen == 'F'){
- digitalWrite(dir[motor*2], HIGH);
- digitalWrite(dir[(motor*2)+1], LOW);
- }
- else if(sen == 'B'){
- digitalWrite(dir[motor*2], LOW);
- digitalWrite(dir[(motor*2)+1], HIGH);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement