Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- int l=9;
- int lc;
- int r=11;
- int rc;
- //servos
- Servo left;
- int lpos=0;
- Servo right;
- int rpos=0;
- void setup(){
- left.attach(6);
- right.attach(5);
- Serial.begin(9600);
- }
- void loop(){
- //left sensor
- lc=0;
- pinMode(l,OUTPUT);
- digitalWrite(l,HIGH);
- delay(1);
- pinMode(l,INPUT);
- digitalWrite(l,LOW);
- while(digitalRead(l)==HIGH){
- lc++;
- }
- Serial.print(lc );
- //rightsensor
- rc=0;
- pinMode(r,OUTPUT);
- digitalWrite(r,HIGH);
- delay(1);
- pinMode(r,INPUT);
- digitalWrite(r,LOW);
- while(digitalRead(r)==HIGH){
- rc++;
- }
- Serial.println(rc);
- //servo
- //left
- left.write(lpos);
- right.write(rpos);
- if(lc<150){
- lpos=0;
- }
- else{
- lpos=45;
- }
- // //right
- if(rc<150){
- rpos=180;
- }
- else{
- rpos=135;
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement