int trigger = 5;
int echo = 3;
long t1;
long t2;
long Dt;
long d1;
long d2;
long Dd;
#include <Servo.h>
Servo sx;
int val;
void setup(){
Serial.begin (9600);
sx.attach(10);
pinMode(trigger, OUTPUT);
pinMode(echo, INPUT); // Echo-Pin ist ein Eingang
}
void loop() {
MO1();
delay(500);
MO2();
/*
d1,t1
d2,t2
Dd,Dt>>>v
Fstop
alphastop
*/
}
/*
val = map(val, 0, 400, 45, 135);
sx.write(val);
*/
void MO1() {
digitalWrite(trigger, LOW);
delay(5);
digitalWrite(trigger, HIGH);
delay(10);
digitalWrite(trigger, LOW);
t1 = pulseIn(echo, HIGH);
d1 = (t1 / 2) * 0.03432;
}
void MO2() {
digitalWrite(trigger, LOW);
delay(5);
digitalWrite(trigger, HIGH);
delay(10);
digitalWrite(trigger, LOW);
t2 = pulseIn(echo, HIGH);
d2 = (t2 / 2) * 0.03432;
}