#include int trigPin=9; int echoPin=10; long duration; int distance; Servo servo; void setup() { pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); Serial.begin(9600); servo.attach(8); } void loop() { for(int i=0;i<=180;i++) { servo.write(i); delay(100); distance=calculateDistance(); Serial.print(i); Serial.print(","); Serial.print(distance); Serial.print("."); } for(int i=180;i>0;i--) { servo.write(i); delay(100); distance=calculateDistance(); Serial.print(i); Serial.print(","); Serial.print(distance); Serial.print("."); } } int calculateDistance() { digitalWrite(trigPin,LOW); delayMicroseconds(2); digitalWrite(trigPin,HIGH); delayMicroseconds(10); digitalWrite(trigPin,LOW); duration=pulseIn(echoPin,HIGH); distance=duration*0.034/2; return distance; }