Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- const int analogInPin1=A0;
- const int analogInPin2=A1;
- int sensor1=0;
- int sensor2=0;
- void setup () {
- Serial.begin(9600);
- pinMode(2,OUTPUT);
- pinMode(3,OUTPUT);
- }
- void loop() {
- sensor1 = analogRead(analogInPin1);
- sensor2 = analogRead(analogInPin2);
- Serial.print("sensor1 = " );
- Serial.print(sensor1);
- Serial.print(" sensor2 = " );
- Serial.print(sensor2);
- if (sensor1<300&&sensor2<300)
- {
- Serial.println(" frwd");
- frwd();
- }
- if (sensor1>300&&sensor2<300)
- {
- left();
- Serial.println(" left");
- }
- if (sensor2>300&&sensor1<300)
- {
- rite();
- Serial.println(" rite");
- }
- if (sensor2>300&&sensor1>300){
- back();
- Serial.println(" back");
- }
- delay(2);
- }
- void left(){
- digitalWrite(3,1);
- digitalWrite(2,1);
- delay(0.5);
- digitalWrite(3,0);
- delay(2);
- digitalWrite(2,0);
- }
- void rite(){
- digitalWrite(3,1);
- digitalWrite(2,1);
- delay(0.5);
- digitalWrite(2,0);
- delay(2);
- digitalWrite(3,0);
- }
- void frwd(){
- digitalWrite(3,1);
- digitalWrite(2,1);
- delay(2.5);
- digitalWrite(3,0);
- digitalWrite(2,0);
- }
- void back(){
- digitalWrite(3,1);
- digitalWrite(2,1);
- delay(0.5);
- digitalWrite(3,0);
- digitalWrite(2,0);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement