FANCLUB-VW-BUS.RU

Код: Выделить всё

//ТАХОМЕТР
volatile unsigned long    micros_th1 = 0;
volatile boolean          sttaho = false;       //триггер тахометра
volatile byte             sztaho = 0;           //счетчик обнуления
volatile unsigned int     sptaho = 0;           //кол-во оборотов

//КОРРЕКЦИЯ ТАХОМЕТРА
volatile unsigned int     InputTaho = 0;
volatile unsigned int     OutputTaho = 0;
double                    popravkaTaho = 0.667;   //ДЛЯ двигателя 4ц приборка от 6ц - коэффициент 1.5


//СПИДОМЕТР
volatile unsigned long    micros_sp = 0;
volatile byte             sz = 0;               //счетчик обнуления
volatile unsigned int     sp = 0;               //скорость
volatile boolean          st = false;           //триггер

//КОРРЕКЦИЯ СПИДОМЕТРА
volatile unsigned int     InputSpeed = 0;
volatile unsigned int     OutputSpeed = 0;
double                    popravka = 1;

//ВРЕМЯ РАБОТЫ ОСНОВНОЙ ПРОГРАММЫ (каждые 50 миллисекунд - указано в loop)
unsigned long timing;

//ГЕНЕРАТОР ИМПУЛЬСОВ СПИДОМЕТРА
unsigned long             timing2;
unsigned long             Period; 
unsigned long             Skvajnost;
bool                      Status=0;

//ГЕНЕРАТОР ИМПУЛЬСОВ ТАХОМЕТРА
unsigned long             timing3;
unsigned long             PeriodTaho=0; 
unsigned long             SkvajnostTaho=0;
bool                      StatusTaho=0;


//ПИНЫ 
int                       OUTSPEEDPIN=4;        //ПИН ВЫХОДА - НА СПИДОМЕТР
int                       OUTTAHOPIN=7;         //ПИН ВЫХОДА - НА ТАХОМЕТР
#define PIN_POT           A0                    //ПИН СИГНАЛА ОТ ПОТЕНЦИОМЕТРА ПОПРАВКИ


//********************************************************************
void setup(){
Serial.begin(115200);                                      //инициализация ком порта
attachInterrupt(1, speedometr, RISING);                    //прерывание спидометра по фронту импульса
attachInterrupt(0, tahometr, RISING);                      //прерывание тахометр по фронту импульса
pinMode(PIN_POT, INPUT);
pinMode(OUTSPEEDPIN, OUTPUT); 
pinMode(OUTTAHOPIN, OUTPUT); 
digitalWrite(OUTSPEEDPIN, LOW);
digitalWrite(OUTTAHOPIN, LOW);
}
//********************************************************************


void loop()
{  
 if (millis() - timing > 50)
 { 
  timing = millis(); 

//Считаем спидометр:
  if (sz != 0)
  {
    sz--;
  }
  else
  {
    sp = 0;
  }
  InputSpeed=sp;                                          //Можно задать для проверки любую скорость
  popravka=map(analogRead(PIN_POT),0,1023,0,200)*0.01;    //Коэффициент умножения входящего сигнала от 0.00 до 2.00. 
  OutputSpeed=InputSpeed*popravka;                        //Вычисление правильной скорости
  
  if((OutputSpeed>1)&&(OutputSpeed<220))
  {
    Period=600000/OutputSpeed;  
  }
  else
  {
  Period=0;                             //Вычисление периода импульса
  }

//Считаем тахометр
  if (sztaho != 0)
  {
    sztaho--;
  }
  else
  {
    sptaho = 0;
  }
  InputTaho=sptaho;                                    
  
  
  OutputTaho=InputTaho*popravkaTaho;                      //Вычисление правильной скорости
  int MPHfromSEC=OutputTaho*50;
  
  
  if((OutputTaho>1) && (OutputTaho<200))
  {
  PeriodTaho=600000/OutputTaho;    
  }
  else{
  PeriodTaho=0;                                       //Вычисление периода импульса
  }
  
Serial.println("");
Serial.print("Скорость:    ");  
Serial.print(OutputSpeed);
Serial.print("км/ч;      Коэффициент: ");
Serial.println(popravka);
Serial.print("Обороты ДВС: ");
Serial.print(MPHfromSEC);
Serial.print("об/сек;     Коэффициент: ");
Serial.println(popravkaTaho);
Serial.println("");

 }


//Генерируем импульсы для СПИДОМЕТРА
Skvajnost= Period/2 ;                                     //такая скважность называется меандр  
   if (Status==0) {
    if ( (micros()-timing2)>= Skvajnost) {
      timing2 = micros(); 
      digitalWrite(OUTSPEEDPIN, HIGH); 
      Status=1;
    }
  }
 
  if (Status==1) {
    if ( (micros()-timing2)>= (Period-Skvajnost) ){
      timing2 = micros(); 
      digitalWrite(OUTSPEEDPIN, LOW); 
      Status=0;
    }
  }




//Генерируем импульсы для ТАХОМЕТРА
SkvajnostTaho=PeriodTaho/2 ;                                     
   if (StatusTaho==0) {
    if ( (micros()-timing3)>= SkvajnostTaho) {
      timing3 = micros(); 
      digitalWrite(OUTTAHOPIN, HIGH); 
      StatusTaho=1;
    }
  }
 
  if (StatusTaho==1) {
    if ( (micros()-timing3)>= (PeriodTaho-SkvajnostTaho) ){
      timing3 = micros(); 
      digitalWrite(OUTTAHOPIN, LOW); 
      StatusTaho=0;
    }
  }




}
//********************************************************************
void speedometr(){                                        //измеряем частоту на входе спидометра по прерыванию
if(!st){micros_sp = micros();}
else {sp = (600000/(micros() - micros_sp));}
st = !st;
sz = 30;
}


void tahometr(){                                          //измеряем частоту на входе тахометра по прерыванию
if(!sttaho){micros_th1 = micros();}
else {sptaho = (600000/(micros() - micros_th1));}
sttaho = !sttaho;
sztaho = 30;
}