foto marker dystans

//Измерение длинны посредством инкрементального энкодера и фотометки.
//Энкодер PIB3806-360-G5-24C, на 360 импулсов на оборот, длина окружности измерительного колеса 200мм

#include <Wire.h>
#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd(0x27,16,2);

volatile long P;                   // количество счетчика прерываний с енкодера
//volatile long P1;                  // количество счетчика прерываний с фотометки
float E;                           // длина по енкодеру
float F;                           //
float M;                           //
float M1;                          //
volatile bool intFlag = false;     // флаг фотометки

void setup() {
pinMode(6, INPUT);                  // кнопка reset
pinMode(2, INPUT_PULLUP);           // вход сигнала А с энкодера
pinMode(3, INPUT);                  // вход сигнала с фотометки
attachInterrupt(0,blink1, RISING);  // 1 прерывание с энкодера
attachInterrupt(1,blink2, RISING);  // 2 прерывание с фотометки
lcd.begin();                        // инициализация экрана
lcd.backlight();                    // вкл. подсветки
}

void loop()                     // обработка вывода на екран и длины с энкодера
{
if (digitalRead(6)) P=0;            // если нажата кнопка reset, то Р сбрасываем в ноль
if (digitalRead(6)) M=0;
lcd.setCursor(0,0);                 // устанавливаем курсор, 1 позиция 0 строка
lcd.print("Enk.L=");               // пишем Enk.L=
E=P*0.277777;                   // расчет длины с енкодера, коефициент= длина окружности колесика на
                                    // енкодере деленое на импульсов на оборо, 720импульсов, 200/720=0,277777
lcd.print(E,3);                     // выводим значение E , просто общая длина с енкодера
lcd.print("mm.        ");           // пишем mm, и остальное затираем
lcd.setCursor(0,1);                 // устанавливаем курсор, 0 позиция 1 строка
lcd.print("F.=");                   // пишем F.=
if (M1>=M);
{
 lcd.print((M1-M)*0.277777);    // расчет длины с фотометки
 }
lcd.print("mm       ");             // пишем mm, и остальное затираем
}


void blink1(){                  // обработчик прерывания c энкодера
P=P+1;                               // инкремент счетчика импульсов энкодера
}


void blink2(){                       // обработчик прерывания c фотометки
if (intFlag=false);

  M=P;                               // длина до первого импульса с фотометки ?
  intFlag = true;

  //M1=P;                              // длина до второго импульса с фотометки ?
  //intFlag =false;

}