Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- Servo Motor[2];
- int sensorPins[]={A0,A1};
- int sensorValues[] = {0, 0};
- int motorTurn[] = {0, 0};
- int echoPin= 12;
- int trigPin = 11;
- long duration ;
- long distance;
- void setup() {
- // put your setup code here, to run once:
- Motor[0].attach(9);
- Motor[1].attach(13);
- Serial.begin(9600);
- pinMode(trigPin, OUTPUT);
- pinMode(echoPin, INPUT);
- }
- void loop() {
- digitalWrite(trigPin,LOW);
- delayMicroseconds(2);
- digitalWrite(trigPin,HIGH);
- delayMicroseconds(10);
- digitalWrite(trigPin,LOW);
- duration= pulseIn(echoPin ,HIGH);
- distance=duration/29.1;
- Serial.println(distance);
- motorTurn[0] = map(distance, 0, 200, 0, 150);
- motorTurn[1] = map(distance, 0, 200, 0, 150);
- Motor[0].write(motorTurn[0]);
- Motor[1].write(motorTurn[1]);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement