1501 datline kalibr: различия между версиями
		
		
		
		
		
		Перейти к навигации
		Перейти к поиску
		
				
		
		
	
Woronin (обсуждение | вклад) Нет описания правки  | 
				Woronin (обсуждение | вклад)  Нет описания правки  | 
				||
| Строка 1: | Строка 1: | ||
<syntaxhighlight lang="C++">  | <syntaxhighlight lang="C++">  | ||
//////////////////////////////////////////////  | //////////////////////////////////////////////  | ||
//       | //     2021.02.22 woronin,  umkiedu@gmail.com  | ||
//     Датчик линии цифровой сигнал, калибруем показания  | //     Датчик линии цифровой сигнал, калибруем показания  | ||
//     Robot UMKI controller  K6_3  | //     Robot UMKI controller  K6_3  | ||
//     тестируем работу правого и левого датчика линии  | //     тестируем работу правого и левого датчика линии  | ||
//////////////////////////////////////////////  | //////////////////////////////////////////////  | ||
const int sensorR = A1; //   | const int sensorR = A1; // Присоедниняем правый датчик к A1  | ||
const int sensorL = 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);   |   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);
}