Форум РадиоКот

Код: Выделить всё

distance = getDistance();//тут берется расстояние
ledLevel = (int) (distance*10)<=255?255-distance*10:0;//тут вычисляется уровень который нужно подать на моторчик.
}

long getEchoTiming() {
digitalWrite(trigPin, LOW);//тут высталяем на вход тригер логический нуль
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);//ставим единицу
delayMicroseconds(10);//ждем пока сигнал отразится
digitalWrite(trigPin, LOW);//ставим нуль
long duration = pulseIn(echoPin,HIGH);//слушаем эфир (она вычитает сколько микросекунд прошло)
return duration;//возвращяем значение
}


long getDistance() //эта функция возвращает расстояние в сантиметрах до объекта перед сенсором
{
long distacne_cm = getEchoTiming()/29/2;
return distacne_cm;
}

Код: Выделить всё

long distance1 = getDistance(trigPin1, echoPin1);//тут берется расстояние от первой пары датчиков
long distance2 = getDistance(trigPin2, echoPin2); // тут от второй

long getDistance(uint8_7 trig, uint8_t echo) //эта функция возвращает расстояние в сантиметрах до объекта перед сенсором
{
  digitalWrite(trig, LOW);//тут высталяем на вход тригер логический нуль
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);//ставим единицу
  delayMicroseconds(10);//ждем пока сигнал отразится
  digitalWrite(trig, LOW);//ставим нуль
  long duration = pulseIn(echo,HIGH);//слушаем эфир (она вычитает сколько микросекунд прошло)
  long distacne_cm = getEchoTiming()/29/2;
  return distacne_cm;
}

Код: Выделить всё

int trigPin = 4;
int echoPin = 7;
int trigPin1 = 13;
int echoPin1 = 12;
int in4 = 11;
int in3 = 10;
int in2 = 2;
int in1 = 8;
int state = 0;//Переменная которая хранит 1 или 0 нужна она для того что бы определить в какую сторону поворачивать. 

int duration1;
int duration;
long distance2;
int ledLevel;
long distance1;
int ledLevel1;

void setup() {
 
  
Serial.begin(9600);
pinMode(trigPin,OUTPUT);
pinMode(echoPin,INPUT);
pinMode(trigPin1,OUTPUT);
pinMode(echoPin1,INPUT);

pinMode(in4,OUTPUT);
pinMode(in3,OUTPUT);
pinMode(in2,OUTPUT);
pinMode(in1,OUTPUT);
}

void loop() {

}

//все что написано внизу Я взял с этого сайта. Там все подробно описанно. http://research.andbas.com/2011/12/hc-sr04.html
//distance1 = getDistance();//тут берется расстояние
distance1 = getDistance(trigPin1, echoPin1);//тут берется расстояние от первой пары датчиков
ledLevel1 = (int) (distance1*10)<=255?255-distance1*10:0;//тут вычисляется уровень который нужно подать на моторчик

//distance = getDistance();//тут берется расстояние
distance2 = getDistance(trigPin2, echoPin2); // тут от второй
ledLevel = (int) (distance2*10)<=255?255-distance2*10:0;//тут вычисляется уровень который нужно подать на моторчик


long getDistance(uint8_7 trig, uint8_t echo) //эта функция возвращает расстояние в сантиметрах до объекта перед сенсором
{
  digitalWrite(trig, LOW);//тут высталяем на вход тригер логический нуль
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);//ставим единицу
  delayMicroseconds(10);//ждем пока сигнал отразится
  digitalWrite(trig, LOW);//ставим нуль
  long duration = pulseIn(echo,HIGH);//слушаем эфир (она вычитает сколько микросекунд прошло)
  long distacne_cm = getEchoTiming()/29/2;
  return distacne_cm;
}


/*
//)))))))))))))))))))))))))))
long getEchoTiming() {
digitalWrite(trigPin1, LOW);//тут высталяем на вход тригер логический нуль
delayMicroseconds(2);
digitalWrite(trigPin1, HIGH);//ставим единицу
delayMicroseconds(10);//ждем пока сигнал отразится
digitalWrite(trigPin1, LOW);//ставим нуль
long duration1 = pulseIn(echoPin1,HIGH);//слушаем эфир (она вычитает сколько микросекунд прошло)
return duration1;
}
//))))))))))))))))))))))))))))

long getDistance() //эта функция возвращает расстояние в сантиметрах до объекта перед сенсором
{
long distacne_cm1 = getEchoTiming()/29/2;
return distacne_cm1;

long distacne_cm = getEchoTiming()/29/2;
return distacne_cm;
}*/