1501 datline kalibr
Перейти к навигации
Перейти к поиску
//////////////////////////////////////////////
// 2019.12.17 woronin, umkiedu@gmail.com
// Датчик линии цифровой сигнал, калибруем показания
// Robot UMKI controller K6_3
// тестируем работу правого и левого датчика линии
//////////////////////////////////////////////
const int sensorR = A1; // Подсоедниняем правый датчик к A1
const int sensorL = A0; // Подсоедниняем левый датчик к A0
int Rsensor; // Проверяем правый датчик
int Lsensor; // Проверяем левый датчик
void setup()
{
pinMode( sensorR , INPUT);
pinMode( sensorL , INPUT);
Serial.begin(9600);
}
// Основной бесконечный цикл
void loop()
{
Rsensor=digitalRead(sensorR);
Lsensor=digitalRead(sensorL);
if ((Lsensor == 0)&&(Rsensor==0)) {// если оба датчика видят белый
Serial.println("Lsensor=0 Rsensor=0");
}
if ((Lsensor == 1)&&(Rsensor==0)) {// если левый датчик видит черный
Serial.println("Lsensor=1 Rsensor=0");
}
if ((Lsensor == 0)&&(Rsensor==1)) {// если правый датчик видит черный
Serial.println("Lsensor=0 Rsensor=1");
}
if ((Lsensor == 1)&&(Rsensor==1)) {// если оба датчика видит черный
Serial.println("Lsensor=1 Rsensor=1");
}
delay(100);
}