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);
}