//ultrasonic 1
float echoPin1 =2;
float initPin1 =3;
float distance1 =0;
void setup() {
pinMode(initPin1, OUTPUT);
pinMode(echoPin1, INPUT);
Serial.begin(9600);
}
void loop() {
distance1 = getDistance(initPin1, echoPin1);
printDistance(1, distance1);
Serial.println("");
delay(100);
}
float getDistance (float initPin, float echoPin){
digitalWrite(initPin, HIGH);
delayMicroseconds(10);
digitalWrite(initPin, LOW);
float pulseTime = pulseIn(echoPin, HIGH);
float distance = pulseTime/58;
return distance;
}
void printDistance(int id, float dist){
Serial.print(dist);
Serial.print(",");
}