Arduino.ru

День добрый.

Пытаюсь заставить конечный автомат работать правильно, но пока тщетно.

Прощу помощи, т.к. в программировании я очень слаб.

Суть программы: существует некий конечный автомат с определенными режимами (GOROD, TRASSA,DOGD,OFF).

Каждый режим отвечает за включение мотора в определенных временных условиях, перключение режимов осуществляется кнопкой1 

Режим OFF выключает мотор-кнопка 2

Также есть определенные ограничения описанные в функциях Regim_t SpeedSensorReturnRegim() и void SpeedSensor() которые отвечают за выключение мотора (при наступлении определенных условий) и возврат режима после после окончания ограничения.

Есть еще вольтметр, термометр и вывод всего этого на экран, но это уже суть.

Проблема в следующем: после загрузки скетча в ардуино уно включается первый режим (GOROD), по нажатию кнопки должна происходить смена режима, но ничего не происходит (сам режим  GOROD работает вроде правильно). 

Код писал не сам (выдирал куски кода аналогичного уствроства и переделывал под себя).  Подразумеваю, что ошибка либо в определение typedef enum или в функции Button_1().

//Управление сказчиком

//пины 6 и 3 это кнопки
//пин 2 выход на насос
//программа 1 - "город" - 2 капли в минуту (2 открытия в минуту)
//программа 2 - "трасса" - 3-4 капли в минуту (3-4 открытия в минуту)
//программа 3 - "дождь" - 10 капель в минуту (10 открытия в минуту)
//кнопка 3 - выключает автосмажчик
//!!!!количество открытий в минуту и время открытия пока ориентировочное!!!!

//Вывод на экран
//пины 4,5,10-13 для соединения с экраном
//на экран выводится только информация какой режим сейчас включен
//Подключаем стандартную библиотеку LiquidCrystal
//--------------------------------------------------------------------------------------------------



#define BUTTON_1 6            //включает программу смазки 1 - "город" на второй ноге
                    //каждое последующее нажатие включает следующую программу
#define BUTTON_2 3            //batton_2 - выключает смазчик на 3-й ноге
#define motor 7              //транзистор управляющий насосом на 7-й ноге
#define speedsensor 2         //датчик скорости подключен к пину D2
long speedlimit=5;            //количество импульсов за один оборот колеса (при скорости примерно 7км/ч)
                    //!!!!! ВНИМАНИЕ
                    //ЭТО ЗНАЧЕНИЕ НУЖНО ПОЛУЧИТЬ НАТУРНО (ИЗМЕРИТЬ НА ДАТЧИКЕ ПРИ ВРАЩАЮЩЕМСЯ КОЛЕСЕ

#define SEC 1000            //1секунда=период таймера(1мс)*коэффициет(1000)
#define TIME_MEASURE_VOLTAGE 1*SEC
#define K_VOLT 0.14//0.18//0.14     //коэффициент делителя(для определения напряжения) (0.14 R1 = 13k, R2 = )
#define V_MAX 5
#define VIN A1


unsigned long sp=0;           //переменная для хранения данных с датчика скорости
long T_speed = 1000;          //интервал времени для определения текущей скорости (1 секунда)
unsigned long previousMillis_sp = 0;  //время последнего импульса

unsigned long previousMillis = 0;   //храним время последнего переключения светодиода

long interval_on = 3000;        //интервал между вкл/выкл насоса (3 секунда)
long interval_7 = 7000;         //интервал между вкл/выкл насоса (7 секунда)
long interval_17 = 17000;       //интервал между вкл/выкл насоса (17 секунда)
long interval_27 = 27000;       //интервал между вкл/выкл насоса (27 секунда)

#include <LiquidCrystal.h>        //библиотека экрана
LiquidCrystal lcd(4,5,10,11,12,13);

#include <math.h>
#define T A0                //датчик температуры подключен к А0

//--------------------------------------------------------------------------------------------------
boolean buttonWasUp_1 = true;  // была ли кнопка1 отпущена?
boolean buttonWasUp_2 = true;  // была ли кнопка2 отпущена?
//--------------------------------------------------------------------------------------------------

uint16_t voltage = 0;
boolean fMeasureVoltage = true;
uint16_t tMeasureVoltage = TIME_MEASURE_VOLTAGE;

//--------------------------------------------------------------------------------------------------

typedef enum{GOROD, TRASSA, DOGD, OFF} Regim_t;
Regim_t regim, prevRegim;
//enum Regim_t regim = GOROD;
bool fOn = false;

//--------------------------------------------------------------------------------------------------

void OutLCD(String s){           //функция печати на экран режима 
  lcd.setCursor(8,1);           //устанавливаем курсор в первую строку, 8-я колонна
  lcd.print(s); 
}

//--------------------------------------------------------------------------------------------------

void On(){                //функция отвечающая за включение насоса
  digitalWrite(motor, HIGH); 
}

void Off(){               //функция отвечающая за выключение насоса
  digitalWrite(motor, LOW);
}

//--------------------------------------------------------------------------------------------------

void WorkPump(int delay){               //функция отвечающая за выбор режима
  unsigned long currentMillis = millis();
  if (fOn) {
    On();
  if(currentMillis - previousMillis > interval_on){ //проверяем не прошел ли нужный интервал,если прошел то
    Off();                      //закрыть клапан
    fOn = false;
    previousMillis = currentMillis;         //сохраняем время последнего переключения
  }
}
  if (!fOn) {
    Off();
  if(currentMillis - previousMillis > delay){     //проверяем не прошел ли нужный интервал,если прошел то
    fOn = true;
    previousMillis = currentMillis;         //сохраняем время последнего переключения
  }
  }
}

//--------------------------------------------------------------------------------------------------

Regim_t SpeedSensorReturnRegim() {
  unsigned long currentMillis = millis();
    if ((currentMillis - previousMillis_sp > T_speed)&&sp++ <speedlimit){
    prevRegim = regim;
    regim = OFF;
    previousMillis_sp = currentMillis;        //сохраняем время последнего переключения    
	lcd.setCursor(11,1);           //устанавливаем курсор в первую строку, 11-я колонна
	lcd.print("non active");
      }
  else{
    regim = prevRegim;
    return regim;
  }
}

//--------------------------------------------------------------------------------------------------
void SpeedSensor(){                   //функция отвечающая за расчет  ограничителя
  unsigned long currentMillis = millis();
  sp++;
    if(((currentMillis - previousMillis_sp) > T_speed) && sp++ <speedlimit){
      regim = OFF;
      previousMillis_sp = currentMillis;        //сохраняем время последнего переключения
      sp=0;
    }
}

//--------------------------------------------------------------------------------------------------

void SensorVolt() {
  int sensorValue;

  if (fMeasureVoltage)
  {
    sensorValue = analogRead(VIN);
    voltage = (int)(((sensorValue / 1023.0f * V_MAX) / K_VOLT) * 1000);
    fMeasureVoltage = false;
  }
  lcd.setCursor(9,2);
  lcd.print(voltage);
  delay(1000);
}

void SensorTemp(){
  int val;
  double temp;
  val=analogRead(T);
  temp=Thermister(val);
	long Temperature=temp;
  lcd.setCursor(13,3);
  lcd.print(Temperature);
  delay(1000);
}
//--------------------------------------------------------------------------------------------------

void Button_1(){
	boolean buttonIsUp_1 = digitalRead(BUTTON_1);

	if (buttonWasUp_1 && !buttonIsUp_1) {
		delay(10);
		buttonIsUp_1 = digitalRead(BUTTON_1);
		if (!buttonIsUp_1) {
			int a=(int)regim;
			regim=(Regim_t)a++;			
		}
	}
// запоминаем последнее состояние кнопки для новой итерации
buttonWasUp_1 = buttonIsUp_1;
}

void Button_2(){
	boolean buttonIsUp_2 = digitalRead(BUTTON_2);

	if (buttonWasUp_2 && !buttonIsUp_2) {
		delay(10);
		buttonIsUp_2 = digitalRead(BUTTON_2);
		if (!buttonIsUp_2) { 
			regim = OFF;
		}
	}
// запоминаем последнее состояние кнопки для новой итерации
buttonWasUp_2 = buttonIsUp_2;
}

//--------------------------------------------------------------------------------------------------

void setup (){
pinMode(motor, OUTPUT);           //транзистор управляющий клапаном на 6-й ноге
pinMode(BUTTON_1, INPUT_PULLUP);         //кнопка 1 - вход
pinMode(BUTTON_2, INPUT_PULLUP);         //кнопка 2 - вход
pinMode(speedsensor, INPUT);
attachInterrupt(0,SpeedSensor, FALLING);  //Подсчет импульсов
voltage = analogRead(VIN);
lcd.begin(20, 4);             //устанавливаем размер (количество столбцов и строк) экрана
lcd.setCursor(0,1);             //устанавливаем курсор
lcd.print("Smazka-");           //печатаем первую часть строки

lcd.setCursor(1,2);             //устанавливаем курсор
lcd.print("Voltage-");            //печатаем первую часть строки

lcd.setCursor(1,3);             //устанавливаем курсор
lcd.print("Temperature-");          //печатаем первую часть строки
}

//--------------------------------------------------------------------------------------------------
double Thermister(int RawADC){  
double Temp;
Temp = log(((10240000/RawADC) - 10000));
Temp = 1 / (0.001129148 + (0.000234125 + (0.0000000876741 * Temp * Temp ))* Temp );
Temp = Temp - 273.15;
return Temp;
}
//--------------------------------------------------------------------------------------------------

void loop() {

  if ((int)regim > DOGD){
    regim = GOROD;
  }

  SpeedSensorReturnRegim();

  SensorTemp();

  SensorVolt();

  SpeedSensor();

Button_1()

 Button_2()

switch (regim){ case GOROD: OutLCD("Gorod"); WorkPump( interval_27 ); break; case TRASSA: OutLCD("Trassa"); WorkPump( interval_17 ); break; case DOGD: OutLCD("Dogd"); WorkPump( interval_7 ); break; case OFF: OutLCD("OFF"); Off(); break; } }