1501 datline kalibr: различия между версиями

Материал из УМКИwiki
Перейти к навигации Перейти к поиску
Нет описания правки
Нет описания правки
 
Строка 1: Строка 1:
<syntaxhighlight lang="C++">
<syntaxhighlight lang="C++">
//////////////////////////////////////////////
//////////////////////////////////////////////
//    2019.12.17 woronin,  umkiedu@gmail.com
//    2021.02.22 woronin,  umkiedu@gmail.com
//    Датчик линии цифровой сигнал, калибруем показания
//    Датчик линии цифровой сигнал, калибруем показания
//    Robot UMKI controller  K6_3
//    Robot UMKI controller  K6_3
//    тестируем работу правого и левого датчика линии
//    тестируем работу правого и левого датчика линии
//////////////////////////////////////////////
//////////////////////////////////////////////
const int sensorR = A1; // Подсоедниняем правый датчик к A1
const int sensorR = A1; // Присоедниняем правый датчик к A1
const int sensorL = A0; // Подсоедниняем левый датчик к A0
const int sensorL = A0; // Присоедниняем левый датчик к A0
int Rsensor; // Проверяем правый датчик
int Rsensor; // Проверяем правый датчик
int Lsensor; // Проверяем левый датчик
int Lsensor; // Проверяем левый датчик
Строка 13: Строка 13:
void setup()
void setup()
{
{
  pinMode( sensorR , INPUT); // конфигурим  порт на вход
  pinMode( sensorR , INPUT); // конфигурим  порт на вход
  pinMode( sensorL , INPUT);
  pinMode( sensorL , INPUT);
  Serial.begin(9600); // Для отладки. Подключаем монитор порта на скорости общения 9600 байт в сек
  Serial.begin(9600);   // Для отладки. Подключаем монитор порта на скорости общения 9600 байт в сек
}
}


Строка 21: Строка 21:
void loop()
void loop()
{
{
  Rsensor=digitalRead(sensorR);
  Rsensor=digitalRead(sensorR); //  считываем значения для правого датчика. 0 - черный; 1 - белый
  Lsensor=digitalRead(sensorL);
  Lsensor=digitalRead(sensorL); //  считываем значения для левого датчика. 0 - черный; 1 - белый
  if ((Lsensor == 0)&&(Rsensor==0)) {// если оба датчика видят белый
  if ((Lsensor == 0)&&(Rsensor==0)) {// если оба датчика видят черный
   Serial.println("Lsensor=0 Rsensor=0");
   Serial.println("Lsensor=0 Rsensor=0");
  }
  }


  if ((Lsensor == 1)&&(Rsensor==0)) {// если  левый датчик видит черный
  if ((Lsensor == 1)&&(Rsensor==0)) {// если  правый датчик видит черный
   Serial.println("Lsensor=1 Rsensor=0");
   Serial.println("Lsensor=1 Rsensor=0");
  }
  }


  if ((Lsensor == 0)&&(Rsensor==1)) {// если  правый датчик видит черный
  if ((Lsensor == 0)&&(Rsensor==1)) {// если  левый датчик видит черный
   Serial.println("Lsensor=0 Rsensor=1");
   Serial.println("Lsensor=0 Rsensor=1");
  }
  }


  if ((Lsensor == 1)&&(Rsensor==1)) {// если  оба датчика видит черный
  if ((Lsensor == 1)&&(Rsensor==1)) {// если  оба датчика видит белый
   Serial.println("Lsensor=1 Rsensor=1");
   Serial.println("Lsensor=1 Rsensor=1");
  }
  }

Текущая версия от 13:13, 22 февраля 2021

//////////////////////////////////////////////
//     2021.02.22 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);   // Для отладки. Подключаем монитор порта на скорости общения 9600 байт в сек
}

// Основной бесконечный цикл 
void loop()
{
 Rsensor=digitalRead(sensorR); //  считываем значения для правого датчика. 0 - черный; 1 - белый
 Lsensor=digitalRead(sensorL); //  считываем значения для левого датчика. 0 - черный; 1 - белый
 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);
}